Color sensor reset at the end of calibration added. sensor id auto assignment was changed to be a fixed value assignment to avoid sensor id shift when some sensor is absent.

Dependencies:   UniGraphic mbed vt100

Revision:
0:ce97f6d34336
diff -r 000000000000 -r ce97f6d34336 edge_sensor/edge_temp.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/edge_sensor/edge_temp.cpp	Fri Feb 23 05:40:22 2018 +0000
@@ -0,0 +1,143 @@
+#include "mbed.h"
+#include "LM75B.h"
+#include "edge_reset_mgr.h"
+#include "edge_sensor.h"
+#include "edge_temp.h"
+#include "edge_chart.h"
+
+float *current_temp = 0 ;
+
+edge_temp::edge_temp(LM75B *temp1, SMTC502AT *temp2, SMTC502AT *temp3, LM75B *temp4) 
+{
+    _temp1 = temp1 ;
+    _temp2 = temp2 ;
+    _temp3 = temp3 ;
+    _temp4 = temp4 ;
+    _ftemp[0] = _ftemp[1] = _ftemp[2] = _ftemp[3] = 0.0 ;
+    _interval = 30 ;
+    current_temp = &_ftemp[1] ; /* use before for current temp */
+}
+
+edge_temp::~edge_temp(void)
+{
+    if (_temp1) {
+        delete _temp1 ;
+    }
+    if (_temp2) {
+        delete _temp2 ;
+    }
+    if (_temp3) {
+        delete _temp3 ;
+    }
+    if (_temp4) {
+        delete _temp4 ;
+    }
+}
+
+void    edge_temp::reset(void) 
+{
+}
+
+void    edge_temp::prepare(void) 
+{
+}
+
+int    edge_temp::sample(void) 
+{
+    int result ;
+    if (_temp1) {
+        result = _temp1->getTemp(&_ftemp[0]) ;
+    }
+    if (_temp2) {
+        _ftemp[1] = _temp2->getTemp() ;
+    }
+    if (_temp3) {
+        _ftemp[2] = _temp3->getTemp() ;
+    }
+    if (_temp4) {
+        _temp4->getTemp(&_ftemp[3]) ;
+    }
+    _sampled_time = edge_time ;
+    return( result ) ;
+}
+
+int    edge_temp::deliver(void) 
+{
+    int result ;
+    char timestr[16] ;
+    
+    print_time() ;
+    printf(" temp: ") ;
+    if (_temp1) {
+        printf("LM75B1 = %.2f ", _ftemp[0]) ;
+    } 
+    if (_temp2) {
+        printf("before = %.2f ", _ftemp[1]) ;
+    }
+    if (_temp3) {
+        printf("after = %.2f ", _ftemp[2]) ;
+    }
+    if (_temp4) {
+        printf("LM75B2 = %.2f ", _ftemp[3]) ;
+    }
+    printf("\n") ;
+    time2seq(_sampled_time, timestr) ;
+    sprintf(_str_buf,
+    "{\"DEVICE\":\"TEMP04\",\"VAL_1\":\"%.1f\",\"VAL_2\":\"%.1f\",\"VAL_3\":\"%.1f\",\"T\":\"%s\",\"E\":\"%d\"}",
+        _ftemp[0], _ftemp[1], _ftemp[2], timestr, _error_count) ;
+    result = afero->setAttribute(1, _str_buf) ;
+    return( result == afSUCCESS ) ;
+}
+
+int temp_v2y(float value, edge_chart_type *p)
+{
+    int y ;
+    if (value < p->min) {
+        value = p->min ;
+    } else if (value > p->max) {
+        value = p->max ;
+    }
+    y = p->top + p->height - 1
+        - (int)((p->height - 2) * (value - p->min) /(p->max - p->min)) ;
+    return( y ) ;
+}
+
+void edge_temp::show(void)
+{
+    edge_chart_type *p = &edge_chart[ _id ] ;
+    int x, temp, before, after ;
+    reset_watch_dog() ;
+    if (display) {
+        switch(display_mode) {
+        case DISPLAY_MODE_SUMMARY:
+            display->BusEnable(true) ;
+            display->set_font((unsigned char*) Arial12x12);
+            display->set_font_zoom(2, 2) ;
+            display->foreground(White) ;
+            display->locate(EDGE_SUMMARY_X, EDGE_SUMMARY_TIME_Y) ;
+            displayTime(_sampled_time) ;
+            display->locate(EDGE_SUMMARY_X, EDGE_SUMMARY_TEMP_Y) ;
+            display->printf("Temp : %.2f %.2f %.2f",_ftemp[0], _ftemp[1], _ftemp[2]) ;
+            display->BusEnable(false) ;
+            reset_watch_dog() ;
+            break ;
+        case DISPLAY_MODE_CHART:
+            x = p->left + p->index + 1;
+            temp =  temp_v2y(_ftemp[0], p) ;
+            before = temp_v2y(_ftemp[1], p) ;
+            after = temp_v2y(_ftemp[2], p) ;
+            display->BusEnable(true) ;
+            if (p->index == 0) {
+                draw_chart_frame(p) ;
+            }
+            display->pixel(x, temp, White) ;
+            display->pixel(x, before, Red) ;
+            display->pixel(x, after, Blue) ;
+            display->BusEnable(false) ;
+            p->index = (p->index + 1) % (p->width - 2) ;
+            break ;  
+        }
+    }
+    reset_watch_dog() ;
+}
+