/shark/trunk/ports/servo/servo.c |
---|
297,10 → 297,10 |
} |
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++; |