|
@ -74,7 +74,7 @@ write_pn_bit 1 1501 0 1 |
|
|
return 0; |
|
|
return 0; |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
static int32_t abs(int32_t v) { |
|
|
|
|
|
|
|
|
static int32_t prvabs(int32_t v) { |
|
|
if (v < 0) return -v; |
|
|
if (v < 0) return -v; |
|
|
return v; |
|
|
return v; |
|
|
} |
|
|
} |
|
@ -83,7 +83,7 @@ int32_t Eq20ServoMotor::rotate(int32_t rpm, int32_t acctime) { |
|
|
if (rpm == 0) return 0; |
|
|
if (rpm == 0) return 0; |
|
|
int32_t direction = 1; |
|
|
int32_t direction = 1; |
|
|
if (rpm < 0) direction = -1; |
|
|
if (rpm < 0) direction = -1; |
|
|
rpm = abs(rpm); |
|
|
|
|
|
|
|
|
rpm = prvabs(rpm); |
|
|
return move_by(direction * 100000 * 10000, rpm, acctime); |
|
|
return move_by(direction * 100000 * 10000, rpm, acctime); |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|