/shark/trunk/ports/servo/servo.c |
---|
297,13 → 297,13 |
} |
w = 1; |
spbrg_temp = (SERVO_CLOCK*10 / (160*baud)) - 10; |
spbrg_temp = (SERVO_CLOCK*10 / (16*baud)) - 10; |
if (spbrg_temp>2550) { |
w = 0; |
spbrg_temp = (SERVO_CLOCK*10 / (640*baud)) - 10; |
spbrg_temp = (SERVO_CLOCK*10 / (64*baud)) - 10; |
} |
spbrg = spbrg_temp / 10; |
if (spbrg_temp%10 > 5) spbrg++; |
if (spbrg_temp % 10 > 5) spbrg++; |
#ifdef SERVO_DEBUG |
kern_printf("(SERVO:SBPRG %d W %d)",spbrg,w); |