fix min/max range

Author: eigen-value

src/sensor_tof_matrix.h

@@ -168,7 +168,7 @@ class SensorTofMatrix{
 
         int get_max_range_bottom_mm() {
 
-            int16_t bottom_max = results.distance_mm[4?12:48];
+            int16_t bottom_max = results.distance_mm[_size==4?12:48];
 
             for (int i=(_size==4?12:48); i < (_size==4?15:63) ;i++) {
                 bottom_max = max(bottom_max, results.distance_mm[i]);
@@ -206,7 +206,7 @@ class SensorTofMatrix{
 
         int get_min_range_right_mm() {
 
-            int16_t _min = results.distance_mm[4?3:6];
+            int16_t _min = results.distance_mm[_size==4?3:6];
 
             for (int i=(_size==4?3:6); i < (_size==4?16:64) ;i+=_size) {
                 _min = min(_min, results.distance_mm[i]);
@@ -220,7 +220,7 @@ class SensorTofMatrix{
 
         int get_min_range_center_left_mm() {
 
-            int16_t _min = results.distance_mm[4?5:18];
+            int16_t _min = results.distance_mm[_size==4?5:18];
 
             for (int i=(_size==4?5:18); i < (_size==4?13:50) ;i+=_size) {
                 _min = min(_min, results.distance_mm[i]);
@@ -234,7 +234,7 @@ class SensorTofMatrix{
 
         int get_min_range_center_right_mm() {
 
-            int16_t _min = results.distance_mm[4?6:20];
+            int16_t _min = results.distance_mm[_size==4?6:20];
 
             for (int i=(_size==4?6:20); i < (_size==4?14:52) ;i+=_size) {
                 _min = min(_min, results.distance_mm[i]);
@@ -248,9 +248,9 @@ class SensorTofMatrix{
 
         int get_min_range_center_mm() {
 
-            int16_t _min = results.distance_mm[5?6:19];
+            int16_t _min = results.distance_mm[(_size==4?6:19];
 
-            for (int i=(_size==5?6:19); i < (_size==4?13:51) ;i+=_size) {
+            for (int i=(_size==4?6:19); i < (_size==4?13:51) ;i+=_size) {
                 _min = min(_min, results.distance_mm[i]);
                 _min = min(_min, results.distance_mm[i+1]);               
             }