X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fdrivers%2Fao_companion.c;h=2315b63f43d5a87ad91ea095386da5d838f4e283;hb=c49bd3cb0c31a51fae79ddc92237cc309be9a242;hp=44868fb646e48faa232ff9192c162c6d3deb06ce;hpb=cdaa0d7b272505c49017f409b7c0b8e3240608f0;p=fw%2Faltos

diff --git a/src/drivers/ao_companion.c b/src/drivers/ao_companion.c
index 44868fb6..2315b63f 100644
--- a/src/drivers/ao_companion.c
+++ b/src/drivers/ao_companion.c
@@ -28,11 +28,13 @@
 #error HAS_COMPANION not set in ao_companion.c
 #endif
 
+#define AO_COMPANION_SPI_SPEED	ao_spi_speed(200000)
+
 #define COMPANION_SELECT()	do {			\
 		ao_spi_get_bit(AO_COMPANION_CS_PORT,	\
 			       AO_COMPANION_CS_PIN,	\
 			       AO_COMPANION_SPI_BUS,	\
-			       AO_SPI_SPEED_200kHz);	\
+			       AO_COMPANION_SPI_SPEED);	\
 	} while (0)
 
 #define COMPANION_DESELECT()	do {			\
@@ -53,12 +55,12 @@ ao_companion_send_command(uint8_t command)
 {
 	ao_companion_command.command = command;
 	ao_companion_command.flight_state = ao_flight_state;
-	ao_companion_command.tick = ao_time();
+	ao_companion_command.tick = (uint16_t) ao_time();
 	ao_companion_command.serial = ao_serial_number;
 	ao_companion_command.flight = ao_flight_number;
-	ao_companion_command.accel = ao_accel;
-	ao_companion_command.speed = ao_speed;
-	ao_companion_command.height = ao_height;
+	ao_companion_command.accel = (int16_t) ao_accel;
+	ao_companion_command.speed = (int16_t) ao_speed;
+	ao_companion_command.height = (int16_t) ao_height;
 	ao_companion_command.motor_number = ao_motor_number;
 	ao_spi_send(&ao_companion_command, sizeof (ao_companion_command), AO_COMPANION_SPI_BUS);
 }
@@ -93,7 +95,7 @@ ao_companion_notify(void)
 	COMPANION_DESELECT();
 }
 
-void
+static void
 ao_companion(void)
 {
 	uint8_t	i;
@@ -113,7 +115,7 @@ ao_companion(void)
 	ao_exit();
 }
 
-void
+static void
 ao_companion_status(void) 
 {
 	uint8_t	i;