X-Git-Url: http://git.droids-corp.org/?p=protos%2Fxbee-avr.git;a=blobdiff_plain;f=spi_servo.c;h=4b0d24191ef9aefb5f140d2309223b40c9e85a5e;hp=c4fe3187dcd02e3084e70b4ba50bbdae279c166c;hb=bf003cd191abeafb1c31a7a24aa573b7a20e527e;hpb=87d9d882059ebe9e34adc088e0d6f4bea984bc91

diff --git a/spi_servo.c b/spi_servo.c
index c4fe318..4b0d241 100644
--- a/spi_servo.c
+++ b/spi_servo.c
@@ -255,3 +255,14 @@ void spi_servo_set_ppm(uint8_t enable)
 	spi_servo_tx.cmd_mask |= (1 << N_SERVO);
 	IRQ_UNLOCK(flags);
 }
+
+void spi_servo_dump(void)
+{
+	uint8_t i;
+
+	for (i = 0; i < N_SERVO; i++)
+		printf_P(PSTR("%d: rx=%4.4d tx=%4.4d\r\n"), i,
+			 spi_servo_get(i), spi_servo_tx.servo[i]);
+	printf_P(PSTR("bypass=%d ppm=%d\n"),
+		 spi_servo_get_bypass(), spi_servo_get_ppm());
+}