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 sensors/PSE530.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/sensors/PSE530.cpp	Fri Feb 23 05:40:22 2018 +0000
@@ -0,0 +1,60 @@
+#include "mbed.h"
+#include "PSE530.h"
+
+/**
+ * SMC PSE530 pressure sensor
+ * analog output 1.0V - 5.0V
+ * 1.0V : 0
+ * 5.0V : 1MPa
+ * (at 0.6V : -0.1MPa)
+ * Our sensor I/F converts 0-5V to 0-3V
+ * So we suppose V = Analog Float Value : Pressure
+ * 0.6V = 0.2 : 0
+ * 3.0V = 1.0 : 1MPa
+ */
+ 
+ /**
+  * conversion from Pa to kgf/cm2
+  * 98,066.5 Pa = 1 kgf/cm2
+  * 1 Pa = 1 / 98066.6 kgf/cm2
+  */
+
+PSE530::PSE530(AnalogIn *ain)
+{
+    _ain = ain ;
+}
+
+PSE530::~PSE530(void) 
+{
+    if (_ain) {
+        delete _ain ;
+    }
+}
+
+/**
+ * On FRDM-KL25Z ADC's AREF is about 3.28V
+ * Where the converted pressure output is 0 to 3.21V
+ * So we must map ADC output 0 to 3.21/3.28 as full scale
+ * 
+ * Then according to the datasheet of PSE530
+ * when full range is 0V to 5V
+ * 1V is 0 and 5V is 1MPa which is converted to
+ * 0.642/3.28 to 3.21/3.28 ~ 0.195731 to 0.9786585.
+ * The linear equation of
+ * y = a x + b
+ * 0 = a * 0.195731 + b
+ * 1 = a * 0.978658 + b
+ * results a = 1.277, b = -0.250
+ */
+float PSE530::getPressure(void)
+{
+    float coef_A = 1.277 ;
+    float coef_B = -0.250 ;
+    float av = 0.0 ;
+    float value = 0.0 ;
+    av = coef_A * _ain->read() + coef_B ;
+//    printf("Pressure ADC = %.4f\n", av) ;
+    value = 1000000 * av  ; /* 1MPa at 1.0 */
+    value = value / 98066.5 ; /* Pa -> kgf/cm2 */
+    return( value ) ;
+}