Mid level control code

Dependencies:   ros_lib_kinetic

Revision:
36:4459be8296e9
Parent:
34:54e9ebe9e87f
--- a/main.cpp	Mon Apr 15 15:12:51 2019 +0000
+++ b/main.cpp	Tue Jul 09 18:46:44 2019 +0000
@@ -76,7 +76,7 @@
                 double maxDistanceToTarget_mm = 0.0;
                 for(short int i=0; i<3; i++) {
                     short int channel = segNum*3+i;
-                    if(channel>=N_CHANNELS) { // !!!!!!!!!!!!!!!! This is horrible
+                    if(channel>=N_CHANNELS) {
                         continue;
                     }
                     double dblCurrentPosition_mm = llcomms.positionSensor_mm[channel];