35,7 → 35,7 |
if (rx_pos < RX_BUFFER_SZ) { |
|
uint8_t i = UDR; |
|
|
uart_putchar(i); |
|
if (i == '\r') { |
48,7 → 48,7 |
if (!strcasecmp(rx_buffer, "HELP")) { |
printf("DISPLAY Display servo settings\n" |
"EXPORT Export srvo settings\n" |
"SET s=n,l,u Set servo settings\n" |
"SET s=n[,l,u] Set servo settings\n" |
" s = servo number (1-6)\n" |
" n = neutral position (0-255)\n" |
" l = lower limit (0-255)\n" |
57,19 → 57,19 |
"SAVE Write settings to eeprom\n"); |
} else if (!strcasecmp(rx_buffer, "DISPLAY")) { |
for(i = 0; i < 6; i++) { |
printf("SERVO %d, NEUTRAL %d, LIMIT %d-%d\n", |
(i + 1), |
printf("SERVO %d, NEUTRAL %d, LIMIT %d-%d\n", |
(i + 1), |
(pwm_neutral_position[i]), |
(pwm_limit[i] & 0xff), |
(pwm_limit[i] & 0xff), |
(pwm_limit[i] >> 8) |
); |
} |
} else if (!strcasecmp(rx_buffer, "EXPORT")) { |
for(i = 0; i < 6; i++) { |
printf("SET %d=%d,%d,%d\n", |
(i + 1), |
printf("SET %d=%d,%d,%d\n", |
(i + 1), |
(pwm_neutral_position[i]), |
(pwm_limit[i] & 0xff), |
(pwm_limit[i] & 0xff), |
(pwm_limit[i] >> 8) |
); |
} |
105,10 → 105,10 |
} |
pwm_limit[servo] = (h << 8) | l; |
i = servo; |
printf("SERVO %d, NEUTRAL %d, LIMIT %d-%d\n", |
(i + 1), |
printf("SERVO %d, NEUTRAL %d, LIMIT %d-%d\n", |
(i + 1), |
(pwm_neutral_position[i]), |
(pwm_limit[i] & 0xff), |
(pwm_limit[i] & 0xff), |
(pwm_limit[i] >> 8) |
); |
} |