/shark/trunk/ports/servo/servo.c |
---|
538,7 → 538,7 |
} |
/* 1000.0000:0001.0mmm */ |
/* 1000.0000:0001.Mmmm */ |
int servo_turn_on(int servo) |
{ |
870,7 → 870,7 |
ADDUSEC2TIMESPEC(SERVO_TIMEOUT,¤t_time); |
timeout_event = kern_event_post(¤t_time, set_timer_expired, NULL); |
b = 0x40 | (port & 7); |
b = 0x40 | (port & 0x07); |
err = com_send(servo_port, b); |
err = com_receive(servo_port); |
if (err != (int)(b)) timer_expired = 1; |