Merge pull request #45 from bearbotics2358/LED_Fix_The_Squeakquel

LED issue involving the WHITE command has been fixed
bearbotics2358 · Mar 30, 2024 · 44ba9f3 · 44ba9f3
2 parents 1cfa301 + 48f678c
commit 44ba9f3
Show file tree

Hide file tree

Showing 2 changed files with 7 additions and 6 deletions.
diff --git a/src/main/cpp/LED.cpp b/src/main/cpp/LED.cpp
@@ -23,7 +23,8 @@ LED::LED()
 void LED::Init()
 {
 	int i;
-	LED_prevCommand = LED_currentCommand = RIO_msgs_enum::MSG_IDLE;
+	LED_currentCommand = RIO_msgs_enum::MSG_IDLE;
+	LED_prevCommand = RIO_msgs_enum::WHITE;
 
 	/*
 	sport = new SerialPort(baud);
@@ -186,7 +187,7 @@ void LED::SetMSGIdle(){
 
 void LED::SendIdleMSG() {
 	char cmd[10];
-	strncpy(cmd, "(1,0)\r\n", 8);
+	strncpy(cmd, "1,0\r\n", 8);
 	m_pserial->Write(cmd, strlen(cmd));
 	m_pserial->Flush();
 
@@ -203,7 +204,7 @@ void LED::SendNoCommsMSG() {
 
 	printf("in SetNoComms\n");
 	char cmd[10];
-	strncpy(cmd, "(2,0)\r\n", 8);
+	strncpy(cmd, "2,0\r\n", 8);
 	printf("about to Write: %s\n", cmd);
 	ret = m_pserial->Write(cmd, strlen(cmd));
 	printf("written: %d characters\n", ret);
@@ -222,7 +223,7 @@ LED_currentCommand = RIO_msgs_enum::NOTE_ON_BOARD;
 
 void LED::SendNoteOnBoardMSG() {
 	char cmd[10];
-	strncpy(cmd, "(3,0)\r\n", 8);
+	strncpy(cmd, "3,0\r\n", 8);
 	m_pserial->Write(cmd, strlen(cmd));
 	m_pserial->Flush();
 
@@ -253,7 +254,7 @@ LED_currentCommand = RIO_msgs_enum::SHOOTER_READY;
 
 void LED::SendShooterReadyMSG() {
 	char cmd[10];
-	strncpy(cmd, "(5,0)\r\n", 8);
+	strncpy(cmd, "5,0\r\n", 8);
 	m_pserial->Write(cmd, strlen(cmd));
 	m_pserial->Flush();
 

diff --git a/src/main/cpp/Robot.cpp b/src/main/cpp/Robot.cpp
@@ -138,7 +138,7 @@ void Robot::RobotPeriodic() {
 
     a_Gyro.Update();
 
-    //a_LED.Update();
+    a_LED.Update();
 
 
     a_SwerveDrive.updateOdometry();