test: Update odometer init tests

test/test_main.cpp

@@ -44,18 +44,22 @@ void test_odometer_init_values()
     Encoder rightEncoder(D10, D12, 1000);
     Odometer odom(geometry, leftEncoder, rightEncoder);
 
+    // When creating the odometer, position should be all zeroes, same for speed
     TEST_ASSERT_EQUAL(0, odom.getPosition().x);
     TEST_ASSERT_EQUAL(0, odom.getPosition().y);
     TEST_ASSERT_EQUAL(0, odom.getPosition().theta);
+    TEST_ASSERT_EQUAL(0, odom.getSpeed().linearSpeed);
+    TEST_ASSERT_EQUAL(0, odom.getSpeed().angularSpeed);
+    TEST_ASSERT_EQUAL(0, odom.getSpeed().leftWheelSpeed);
+    TEST_ASSERT_EQUAL(0, odom.getSpeed().rightWheelSpeed);
 }
 
 int main()
 {
-    // NOTE!!! Wait for >2 secs
-    // if board doesn't support software reset via Serial.DTR/RTS
+    // Wait for serial to setup
     wait_ms(2000);
 
-    UNITY_BEGIN(); // IMPORTANT LINE!
+    UNITY_BEGIN();
     RUN_TEST(test_led_builtin_pin_number);
     RUN_TEST(test_led_state_high);
     RUN_TEST(test_led_state_low);