Fixed REG_FREQ_SCALED_SET not defined error in vfd_spindle.c

This commit is contained in:
saifullah-N
2023-02-12 19:32:23 +05:30
parent d79c269b66
commit 710cefa050

View File

@@ -48,6 +48,7 @@ typedef enum
REG_FREQ_SET,
REG_FREQ_SIGN_SET,
REG_FREQ_SCALED_SET,
REG_STOP_WRITE,
REG_FWD_WRITE,
@@ -220,6 +221,14 @@ static bool _next_state()
else
vfd.state = REG_FREQ_SET;
break;
case REG_FREQ_SCALED_SET:
if (vfd.power < 0)
vfd.state = REG_REV_WRITE;
else if (0 < vfd.power)
vfd.state = REG_FWD_WRITE;
else
vfd.state = REG_STOP_WRITE;
break;
case REG_FREQ_SIGN_SET:
if (vfd.power < 0)
@@ -385,6 +394,11 @@ static bool _exec_command()
write = true;
reg.value = vfd.power * vfd.max_freq;
break;
case REG_FREQ_SCALED_SET:
write = true;
reg.value = fabs(vfd.power) * reg.value;
break;
case REG_CONNECT_WRITE:
case REG_STOP_WRITE: