| /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; |