/shark/trunk/ports/servo/servo.c |
---|
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 != -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); |