got the reorganized gyro board code actually working
diff --git a/gyro_board/src/usb/encoder.c b/gyro_board/src/usb/encoder.c
index 6c4999c..205f44e 100644
--- a/gyro_board/src/usb/encoder.c
+++ b/gyro_board/src/usb/encoder.c
@@ -475,9 +475,15 @@
}
void fillSensorPacket(struct DataStruct *packet) {
- packet->gyro_angle = gyro_output.angle;
- packet->old_gyro_reading = gyro_output.last_reading_bad;
- packet->bad_gyro = gyro_output.gyro_bad;
+ if (gyro_output.initialized) {
+ packet->gyro_angle = gyro_output.angle;
+ packet->old_gyro_reading = gyro_output.last_reading_bad;
+ packet->bad_gyro = gyro_output.gyro_bad;
+ } else {
+ packet->gyro_angle = 0;
+ packet->old_gyro_reading = 1;
+ packet->bad_gyro = 0;
+ }
packet->dip_switch0 = dip_switch(0);
packet->dip_switch1 = dip_switch(1);