Diff: stepper.cpp

Revision:

51:1eb60f0d2f03

Parent:

50:e3a03bc1e1a6

Child:

52:8987e38851e5

--- a/stepper.cpp	Tue Apr 03 17:14:03 2018 +0000
+++ b/stepper.cpp	Tue Apr 03 20:51:20 2018 +0000
@@ -214,6 +214,7 @@
     // find home position
     stp_find_home();
     
+    
     // turn laser on
     wait(1);
     lzr_on();
@@ -231,10 +232,16 @@
             
             // scan all PT sensors again
             ana_scan_mux(sensor_values, TGT_SENSOR_QUAN * 2);
+            
+            for (int j = 0; j < TGT_SENSOR_QUAN; j++) {
+                if (sensor_values[sensor_no + j] > PTTHRESH)
+                    pc.printf("PT %d: %f ", sensor_no + j, sensor_values[sensor_no + j]);     
+            }
+            pc.printf("\n");
         }
         // found the sensor, save it's position
         stp_sensor_pos[i] = stp_cur_pos;
-        pc.printf("Sensor %d = %d\n", i, stp_sensor_pos[i]);
+        //pc.printf("Sensor %d = %d\n", i, stp_sensor_pos[i]);
     }
     // found position of all 8 sensors