/shark/trunk/ports/servo/servo.c |
---|
918,9 → 918,13 |
if (servo > 15) return -1; |
if (angle_sec > servo_table[port][servo].max_angle_sec || |
angle_sec < servo_table[port][servo].min_angle_sec) return -1; |
angle_tick = (servo_table[port][servo].zero_tick + angle_sec * |
servo_table[port][servo].delta_tick / |
(servo_table[port][servo].max_angle_sec - servo_table[port][servo].min_angle_sec)) * 1000 / TICK_LEN; |
(servo_table[port][servo].max_angle_sec - servo_table[port][servo].min_angle_sec)) * |
1000 / TICK_LEN; |
timer_expired = 0; |