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