File tree Expand file tree Collapse file tree 2 files changed +22
-16
lines changed Expand file tree Collapse file tree 2 files changed +22
-16
lines changed Original file line number Diff line number Diff line change @@ -15,7 +15,6 @@ extern "C"
1515#include " data.h"
1616#include " state_machine.h"
1717#include " hv_iox.h"
18- #include < braking.h>
1918}
2019
2120
@@ -161,24 +160,10 @@ void *TCPLoop(void *arg)
161160 setMCUHVEnabled (false );
162161 }
163162
164- if (!strncmp (buffer, " override" , 8 ))
165- {
166- fprintf (stderr, " Override received for state: %s\n " , buffer + 9 );
167- sprintf (stateMachine.overrideStateName , " %s\0 " , buffer + 9 );
168- }
169-
170- if (!strncmp (buffer, " safetyOn" , MAX_COMMAND_SIZE)){
171- // TODO Motor Safety on
172- }
173-
174- if (!strncmp (buffer, " safetyOff" , MAX_COMMAND_SIZE)){
175- // TODO Motor Safety off
176- }
177-
178163 if (!strncmp (buffer," override" , 8 )){
179164 fprintf (stderr, " Override received for state: %s\n " , buffer+9 );
180165 sprintf (stateMachine.overrideStateName , " %s\0 " , buffer+9 );
181- }
166+ }
182167
183168 // HEARTBEAT
184169 if (!strncmp (buffer, " ping" , MAX_COMMAND_SIZE))
Original file line number Diff line number Diff line change 1111#include " data.h"
1212#include " connStat.h"
1313
14+ extern " C" {
15+ #include < braking.h>
16+ }
17+
1418pthread_t LVTCPThread;
1519
1620
@@ -90,6 +94,23 @@ void *LVTCPLoop(void *arg){
9094 data->flags ->shouldBrake = true ;
9195 }
9296
97+ if (!strncmp (buffer, " primBrakeOff" , MAX_COMMAND_SIZE))
98+ {
99+ brakePrimaryRelease ();
100+ }
101+ if (!strncmp (buffer, " primBrakeOn" , MAX_COMMAND_SIZE))
102+ {
103+ brakePrimary ();
104+ }
105+ if (!strncmp (buffer, " secBrakeOff" , MAX_COMMAND_SIZE))
106+ {
107+ brakeSecondaryRelease ();
108+ }
109+ if (!strncmp (buffer, " secBrakeOn" , MAX_COMMAND_SIZE))
110+ {
111+ brakeSecondary ();
112+ }
113+
93114 // HEARTBEAT
94115 if (!strncmp (buffer, " ping" , MAX_COMMAND_SIZE)){
95116 // Send acknowledge packet back
You can’t perform that action at this time.
0 commit comments