| 365,12 → 365,18 |
|---|
| err = com_send(servo_port, b); |
| err = com_receive(servo_port); |
| if (err != (int)(b)) timer_expired = 1; |
| |
| res_w = com_receive(servo_port); /* bit W */ |
| res_b = com_receive(servo_port); /* byte SPBRG */ |
| if (res_w) |
| res = SERVO_CLOCK / ( 16 * (res_b + 1) ); |
| else |
| res = SERVO_CLOCK / ( 64 * (res_b + 1) ); |
| |
| if (res_w != -1 && res_b != -1) { |
| if (res_w) |
| res = SERVO_CLOCK / ( 16 * (res_b + 1) ); |
| else |
| res = SERVO_CLOCK / ( 64 * (res_b + 1) ); |
| } else { |
| return -1; |
| } |
| |
| if (timeout_event != NIL) kern_event_delete(timeout_event); |
| |