La Suno / Mbed 2 deprecated afero_poc15_180413

Added a GPIO to power on/off for external I2C sensor(s) (with LEDs)

Dependencies:   UniGraphic mbed vt100

18-Jun-2018 外部センサの電源オン・オフ機能は下位互換の為に無効になっていました。 この版で再度有効にしました。

edge_sensor/edge_pressure.cpp@0:846e2321c637, 2018-04-13 (annotated)

Committer:
Rhyme
Date:
Fri Apr 13 04:19:23 2018 +0000
Revision:
0:846e2321c637
power to color sensor on/off test OK. Currently the function is disabled.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Rhyme 0:846e2321c637 1 #include "mbed.h"
Rhyme 0:846e2321c637 2 #include "edge_sensor.h"
Rhyme 0:846e2321c637 3 #include "edge_time.h"
Rhyme 0:846e2321c637 4 #include "edge_reset_mgr.h"
Rhyme 0:846e2321c637 5 #include "PSE530.h"
Rhyme 0:846e2321c637 6 #include "edge_pressure.h"
Rhyme 0:846e2321c637 7 #include <ILI9341.h>
Rhyme 0:846e2321c637 8 #include "edge_chart.h"
Rhyme 0:846e2321c637 9 // #include "SO1602A.h"
Rhyme 0:846e2321c637 10
Rhyme 0:846e2321c637 11 // extern SO1602A *display ; /* OLED display on I2C */
Rhyme 0:846e2321c637 12 extern ILI9341 *display ;
Rhyme 0:846e2321c637 13
Rhyme 0:846e2321c637 14 #define LOW_THR 0.2
Rhyme 0:846e2321c637 15 #define HIGH_THR 0.3
Rhyme 0:846e2321c637 16 #define MIN_TEMP 12.0
Rhyme 0:846e2321c637 17 #define MAX_TEMP 30.0
Rhyme 0:846e2321c637 18
Rhyme 0:846e2321c637 19 /**
Rhyme 0:846e2321c637 20 * SMC PSE530 pressure sensor
Rhyme 0:846e2321c637 21 * analog output 1.0V - 5.0V
Rhyme 0:846e2321c637 22 * 1.0V : 0
Rhyme 0:846e2321c637 23 * 5.0V : 1MPa
Rhyme 0:846e2321c637 24 * (at 0.6V : -0.1MPa)
Rhyme 0:846e2321c637 25 * Our sensor I/F converts 0-5V to 0-1
Rhyme 0:846e2321c637 26 * So we suppose V = Analog Float Value : Pressure
Rhyme 0:846e2321c637 27 * 0.2 = 0
Rhyme 0:846e2321c637 28 * 1.0 = 1MPa
Rhyme 0:846e2321c637 29 */
Rhyme 0:846e2321c637 30
Rhyme 0:846e2321c637 31 float temp2expected(float temp)
Rhyme 0:846e2321c637 32 {
Rhyme 0:846e2321c637 33 const float coef_A = 0.089 ;
Rhyme 0:846e2321c637 34 const float coef_B = 0.831 ;
Rhyme 0:846e2321c637 35 float pressure ;
Rhyme 0:846e2321c637 36
Rhyme 0:846e2321c637 37 pressure = temp * coef_A + coef_B ;
Rhyme 0:846e2321c637 38 return( pressure ) ;
Rhyme 0:846e2321c637 39 }
Rhyme 0:846e2321c637 40
Rhyme 0:846e2321c637 41 edge_pressure::edge_pressure(PSE530 *pse, DigitalOut *en)
Rhyme 0:846e2321c637 42 {
Rhyme 0:846e2321c637 43 _pse = pse ;
Rhyme 0:846e2321c637 44 _en = en ;
Rhyme 0:846e2321c637 45 _value = 0.0 ;
Rhyme 0:846e2321c637 46 _interval = 30 ;
Rhyme 0:846e2321c637 47 _thr_mode = 0 ;
Rhyme 0:846e2321c637 48 _thr_high = HIGH_THR ;
Rhyme 0:846e2321c637 49 _thr_low = LOW_THR ;
Rhyme 0:846e2321c637 50 }
Rhyme 0:846e2321c637 51
Rhyme 0:846e2321c637 52 edge_pressure::~edge_pressure(void)
Rhyme 0:846e2321c637 53 {
Rhyme 0:846e2321c637 54 if (_pse) {
Rhyme 0:846e2321c637 55 delete _pse ;
Rhyme 0:846e2321c637 56 }
Rhyme 0:846e2321c637 57 _value = 0.0 ;
Rhyme 0:846e2321c637 58 }
Rhyme 0:846e2321c637 59
Rhyme 0:846e2321c637 60 float edge_pressure::get_value(void)
Rhyme 0:846e2321c637 61 {
Rhyme 0:846e2321c637 62 float value = 0.0 ;
Rhyme 0:846e2321c637 63 value = _pse->getPressure() ;
Rhyme 0:846e2321c637 64 return( value ) ;
Rhyme 0:846e2321c637 65 }
Rhyme 0:846e2321c637 66
Rhyme 0:846e2321c637 67 void edge_pressure::reset(void)
Rhyme 0:846e2321c637 68 {
Rhyme 0:846e2321c637 69 _value = 0.0 ;
Rhyme 0:846e2321c637 70 _sampled_time = 0 ;
Rhyme 0:846e2321c637 71 }
Rhyme 0:846e2321c637 72
Rhyme 0:846e2321c637 73 void edge_pressure::prepare(void)
Rhyme 0:846e2321c637 74 {
Rhyme 0:846e2321c637 75 }
Rhyme 0:846e2321c637 76
Rhyme 0:846e2321c637 77 int edge_pressure::sample(void)
Rhyme 0:846e2321c637 78 {
Rhyme 0:846e2321c637 79 int result = 0 ;
Rhyme 0:846e2321c637 80 *_en = 1 ; /* enable pressure sensor */
Rhyme 0:846e2321c637 81 wait_ms(30) ;
Rhyme 0:846e2321c637 82 _value = get_value() ;
Rhyme 0:846e2321c637 83 _sampled_time = edge_time ;
Rhyme 0:846e2321c637 84 *_en = 0 ; /* disable pressure sensor */
Rhyme 0:846e2321c637 85 wait_ms(10) ; /* to avoid power transition effect remaining */
Rhyme 0:846e2321c637 86 return( result ) ; /* this always success */
Rhyme 0:846e2321c637 87 }
Rhyme 0:846e2321c637 88
Rhyme 0:846e2321c637 89 void edge_pressure::set_thr_high(int16_t thr_high)
Rhyme 0:846e2321c637 90 {
Rhyme 0:846e2321c637 91 switch(_thr_mode) {
Rhyme 0:846e2321c637 92 case 0: /* absolute value */
Rhyme 0:846e2321c637 93 _thr_high = (float)thr_high/100.0 ;
Rhyme 0:846e2321c637 94 break ;
Rhyme 0:846e2321c637 95 case 1: /* persentage */
Rhyme 0:846e2321c637 96 _thr_high = (float)(thr_high/100.0) ;
Rhyme 0:846e2321c637 97 break ;
Rhyme 0:846e2321c637 98 default:
Rhyme 0:846e2321c637 99 printf("Unknown Threshold mode %d\n", _thr_mode) ;
Rhyme 0:846e2321c637 100 _thr_high = (float)thr_high/100.0 ;
Rhyme 0:846e2321c637 101 break ;
Rhyme 0:846e2321c637 102 }
Rhyme 0:846e2321c637 103 // printf("thr_high = %.3f\n", _thr_high) ;
Rhyme 0:846e2321c637 104 }
Rhyme 0:846e2321c637 105
Rhyme 0:846e2321c637 106 float edge_pressure::get_thr_high(float expected)
Rhyme 0:846e2321c637 107 {
Rhyme 0:846e2321c637 108 float thr_high ;
Rhyme 0:846e2321c637 109
Rhyme 0:846e2321c637 110 switch(_thr_mode) {
Rhyme 0:846e2321c637 111 case 0: /* absolute value */
Rhyme 0:846e2321c637 112 thr_high = expected + _thr_high ;
Rhyme 0:846e2321c637 113 break ;
Rhyme 0:846e2321c637 114 case 1: /* persentage */
Rhyme 0:846e2321c637 115 thr_high = expected * (1.0 + _thr_high) ;
Rhyme 0:846e2321c637 116 break ;
Rhyme 0:846e2321c637 117 default:
Rhyme 0:846e2321c637 118 printf("Unknown Threshold mode %d\n", _thr_mode) ;
Rhyme 0:846e2321c637 119 thr_high = expected + _thr_high ; /* use this as default */
Rhyme 0:846e2321c637 120 break ;
Rhyme 0:846e2321c637 121 }
Rhyme 0:846e2321c637 122 return (thr_high) ;
Rhyme 0:846e2321c637 123 }
Rhyme 0:846e2321c637 124
Rhyme 0:846e2321c637 125 void edge_pressure::set_thr_low(int16_t thr_low)
Rhyme 0:846e2321c637 126 {
Rhyme 0:846e2321c637 127 switch(_thr_mode) {
Rhyme 0:846e2321c637 128 case 0: /* absolute value */
Rhyme 0:846e2321c637 129 _thr_low = (float)thr_low/100.0 ;
Rhyme 0:846e2321c637 130 break ;
Rhyme 0:846e2321c637 131 case 1: /* persentage */
Rhyme 0:846e2321c637 132 _thr_low = (float)(thr_low/100.0) ;
Rhyme 0:846e2321c637 133 break ;
Rhyme 0:846e2321c637 134 default:
Rhyme 0:846e2321c637 135 printf("Unknown Threshold mode %d\n", _thr_mode) ;
Rhyme 0:846e2321c637 136 _thr_low = (float)thr_low/100.0 ;
Rhyme 0:846e2321c637 137 break ;
Rhyme 0:846e2321c637 138 }
Rhyme 0:846e2321c637 139 //printf("thr_low = %.3f\n", _thr_low) ;
Rhyme 0:846e2321c637 140 }
Rhyme 0:846e2321c637 141
Rhyme 0:846e2321c637 142 float edge_pressure::get_thr_low(float expected)
Rhyme 0:846e2321c637 143 {
Rhyme 0:846e2321c637 144 float thr_low ;
Rhyme 0:846e2321c637 145
Rhyme 0:846e2321c637 146 switch(_thr_mode) {
Rhyme 0:846e2321c637 147 case 0: /* absolute value */
Rhyme 0:846e2321c637 148 thr_low = expected - _thr_low ;
Rhyme 0:846e2321c637 149 break ;
Rhyme 0:846e2321c637 150 case 1: /* persentage */
Rhyme 0:846e2321c637 151 thr_low = expected * (1.0 - _thr_low) ;
Rhyme 0:846e2321c637 152 break ;
Rhyme 0:846e2321c637 153 default:
Rhyme 0:846e2321c637 154 printf("Unknown Threshold mode %d\n", _thr_mode) ;
Rhyme 0:846e2321c637 155 thr_low = expected + _thr_low ; /* use this as default */
Rhyme 0:846e2321c637 156 break ;
Rhyme 0:846e2321c637 157 }
Rhyme 0:846e2321c637 158 return (thr_low) ;
Rhyme 0:846e2321c637 159 }
Rhyme 0:846e2321c637 160
Rhyme 0:846e2321c637 161 int edge_pressure::deliver(void)
Rhyme 0:846e2321c637 162 {
Rhyme 0:846e2321c637 163 char str_buf[32] ;
Rhyme 0:846e2321c637 164 char timestr[16] ;
Rhyme 0:846e2321c637 165 int result ;
Rhyme 0:846e2321c637 166
Rhyme 0:846e2321c637 167 reset_watch_dog() ;
Rhyme 0:846e2321c637 168 print_time(_sampled_time) ;
Rhyme 0:846e2321c637 169 if (current_temp != 0) {
Rhyme 0:846e2321c637 170 sprintf(str_buf, "GAS: %.3f kgf/cm2 @ %.1fC", _value, *current_temp ) ;
Rhyme 0:846e2321c637 171 } else {
Rhyme 0:846e2321c637 172 sprintf(str_buf, "GAS: %.3f kgf/cm2", _value ) ;
Rhyme 0:846e2321c637 173 }
Rhyme 0:846e2321c637 174 printf(" ") ;
Rhyme 0:846e2321c637 175 printf(str_buf) ;
Rhyme 0:846e2321c637 176
Rhyme 0:846e2321c637 177 if (current_temp != 0) {
Rhyme 0:846e2321c637 178 reset_watch_dog() ;
Rhyme 0:846e2321c637 179 _expected = temp2expected(*current_temp) ;
Rhyme 0:846e2321c637 180 _higher = get_thr_high(_expected) ;
Rhyme 0:846e2321c637 181 _lower = get_thr_low(_expected) ;
Rhyme 0:846e2321c637 182 printf(" (%.3f, %.3f) ", _higher, _lower) ;
Rhyme 0:846e2321c637 183 }
Rhyme 0:846e2321c637 184
Rhyme 0:846e2321c637 185 reset_watch_dog() ;
Rhyme 0:846e2321c637 186 printf(" %s\n", str_buf) ;
Rhyme 0:846e2321c637 187 time2seq(_sampled_time, timestr) ;
Rhyme 0:846e2321c637 188 // printf(str_buf) ;
Rhyme 0:846e2321c637 189 // printf("\n") ;
Rhyme 0:846e2321c637 190 sprintf(_str_buf,
Rhyme 0:846e2321c637 191 "{\"DEVICE\":\"PRESS\",\"PN\":\"PSE530\",\"VAL\":\"%.3f\",\"UNIT\":\"kgf/cm2\",\"T\":\"%s\",\"E\":\"%d\"}",
Rhyme 0:846e2321c637 192 _value, timestr, _error_count) ;
Rhyme 0:846e2321c637 193 reset_watch_dog() ;
Rhyme 0:846e2321c637 194 result = afero->setAttribute(1, _str_buf) ;
Rhyme 0:846e2321c637 195 return( result == afSUCCESS ) ;
Rhyme 0:846e2321c637 196 }
Rhyme 0:846e2321c637 197
Rhyme 0:846e2321c637 198 int v2x(float value)
Rhyme 0:846e2321c637 199 {
Rhyme 0:846e2321c637 200 int result ;
Rhyme 0:846e2321c637 201 if (value < 0) {
Rhyme 0:846e2321c637 202 result = 20 ;
Rhyme 0:846e2321c637 203 } else if (value > 4) {
Rhyme 0:846e2321c637 204 result = 300 ;
Rhyme 0:846e2321c637 205 } else {
Rhyme 0:846e2321c637 206 result = 20 + (int)(70 * value + 0.5) ;
Rhyme 0:846e2321c637 207 }
Rhyme 0:846e2321c637 208 return( result ) ;
Rhyme 0:846e2321c637 209 }
Rhyme 0:846e2321c637 210
Rhyme 0:846e2321c637 211 int press_v2y(float value, edge_chart_type *p)
Rhyme 0:846e2321c637 212 {
Rhyme 0:846e2321c637 213 int y ;
Rhyme 0:846e2321c637 214 if (value < p->min) {
Rhyme 0:846e2321c637 215 value = p->min ;
Rhyme 0:846e2321c637 216 } else if (value > p->max) {
Rhyme 0:846e2321c637 217 value = p->max ;
Rhyme 0:846e2321c637 218 }
Rhyme 0:846e2321c637 219 y = p->top + p->height - 2
Rhyme 0:846e2321c637 220 - (int)((p->height - 2) * ((value - p->min) /(p->max - p->min))) ;
Rhyme 0:846e2321c637 221 return( y ) ;
Rhyme 0:846e2321c637 222 }
Rhyme 0:846e2321c637 223
Rhyme 0:846e2321c637 224 /**
Rhyme 0:846e2321c637 225 * drawPointer
Rhyme 0:846e2321c637 226 *
Rhyme 0:846e2321c637 227 * draw a triangle pointer at value place
Rhyme 0:846e2321c637 228 * in GAS pressure display mode
Rhyme 0:846e2321c637 229 */
Rhyme 0:846e2321c637 230 void edge_pressure::drawPointer(int c)
Rhyme 0:846e2321c637 231 {
Rhyme 0:846e2321c637 232 float delta_x ;
Rhyme 0:846e2321c637 233 int x[2], y, i ;
Rhyme 0:846e2321c637 234 const int top = 75 ;
Rhyme 0:846e2321c637 235 const int pointer_height = 15 ;
Rhyme 0:846e2321c637 236 for (i = 0 ; i < pointer_height ; i++ ) {
Rhyme 0:846e2321c637 237 y = top + i ;
Rhyme 0:846e2321c637 238 delta_x = i * 5.0 / 8.0 ;
Rhyme 0:846e2321c637 239 x[0] = c - delta_x ;
Rhyme 0:846e2321c637 240 x[1] = c + delta_x ;
Rhyme 0:846e2321c637 241 display->line(x[0], y, x[1], y, White) ;
Rhyme 0:846e2321c637 242 }
Rhyme 0:846e2321c637 243 }
Rhyme 0:846e2321c637 244
Rhyme 0:846e2321c637 245 void edge_pressure::show(void)
Rhyme 0:846e2321c637 246 {
Rhyme 0:846e2321c637 247 edge_chart_type *p = &edge_chart[ _id ] ;
Rhyme 0:846e2321c637 248 uint16_t color = White ;
Rhyme 0:846e2321c637 249 char str_buf[32] ;
Rhyme 0:846e2321c637 250 int i, x, y, l, r, c, str_x ;
Rhyme 0:846e2321c637 251 if (display) {
Rhyme 0:846e2321c637 252 reset_watch_dog() ;
Rhyme 0:846e2321c637 253 /* for debug */
Rhyme 0:846e2321c637 254 // _value = _lower - 0.5 ; /* LOW */
Rhyme 0:846e2321c637 255 // _value = (_higher + _lower) / 2 ; /* GOOD */
Rhyme 0:846e2321c637 256 // _value = _higher + 0.2 ; /* HIGH */
Rhyme 0:846e2321c637 257
Rhyme 0:846e2321c637 258 if (_value > _higher) {
Rhyme 0:846e2321c637 259 sprintf(str_buf, "HIGH") ;
Rhyme 0:846e2321c637 260 color = Red ;
Rhyme 0:846e2321c637 261 str_x = 60 ;
Rhyme 0:846e2321c637 262 } else if (_value < _lower) {
Rhyme 0:846e2321c637 263 sprintf(str_buf, "LOW") ;
Rhyme 0:846e2321c637 264 color = Yellow ;
Rhyme 0:846e2321c637 265 str_x = 60 ;
Rhyme 0:846e2321c637 266 } else {
Rhyme 0:846e2321c637 267 sprintf(str_buf, "GOOD") ;
Rhyme 0:846e2321c637 268 color = Green ;
Rhyme 0:846e2321c637 269 str_x = 35 ;
Rhyme 0:846e2321c637 270 }
Rhyme 0:846e2321c637 271 switch(display_mode) {
Rhyme 0:846e2321c637 272 case DISPLAY_MODE_GAS:
Rhyme 0:846e2321c637 273 display->BusEnable(true) ;
Rhyme 0:846e2321c637 274 display->cls() ;
Rhyme 0:846e2321c637 275 /* printf frame */
Rhyme 0:846e2321c637 276 display->foreground(White) ;
Rhyme 0:846e2321c637 277 display->line(20, 75, 300, 75, White) ;
Rhyme 0:846e2321c637 278 for (i = 0 ; i <= 8 ; i++ ) {
Rhyme 0:846e2321c637 279 x = 20 + i * 35 ;
Rhyme 0:846e2321c637 280 if (i & 0x01) { /* odd */
Rhyme 0:846e2321c637 281 display->line(x, 55, x, 95, White) ;
Rhyme 0:846e2321c637 282 } else { /* even */
Rhyme 0:846e2321c637 283 display->line(x, 45, x, 105, White) ;
Rhyme 0:846e2321c637 284 }
Rhyme 0:846e2321c637 285 }
Rhyme 0:846e2321c637 286 display->set_font((unsigned char*) Arial28x28);
Rhyme 0:846e2321c637 287 for (i = 0 ; i <= 4 ; i++ ) {
Rhyme 0:846e2321c637 288 x = 12 + i * 70 ;
Rhyme 0:846e2321c637 289 display->locate(x, 10) ;
Rhyme 0:846e2321c637 290 display->printf("%d", i) ;
Rhyme 0:846e2321c637 291 }
Rhyme 0:846e2321c637 292 /* print expected area and current pressure */
Rhyme 0:846e2321c637 293 l = v2x(_lower) ;
Rhyme 0:846e2321c637 294 r = v2x(_higher) ;
Rhyme 0:846e2321c637 295 c = v2x(_value) ;
Rhyme 0:846e2321c637 296 // display->fillrect(l, 70, r, 80, Red) ;
Rhyme 0:846e2321c637 297 display->fillrect(l, 65, r, 74, Red) ;
Rhyme 0:846e2321c637 298 // display->fillcircle(c, 75, 10, White) ;
Rhyme 0:846e2321c637 299 drawPointer(c) ;
Rhyme 0:846e2321c637 300
Rhyme 0:846e2321c637 301 /* print status */
Rhyme 0:846e2321c637 302 display->locate(str_x, 140) ;
Rhyme 0:846e2321c637 303 display->set_font_zoom(3, 3) ;
Rhyme 0:846e2321c637 304 display->foreground(color) ;
Rhyme 0:846e2321c637 305 display->printf(str_buf) ;
Rhyme 0:846e2321c637 306 display->set_font_zoom(1, 1) ;
Rhyme 0:846e2321c637 307 display->BusEnable(false) ;
Rhyme 0:846e2321c637 308 break ;
Rhyme 0:846e2321c637 309 case DISPLAY_MODE_SUMMARY:
Rhyme 0:846e2321c637 310 display->BusEnable(true) ;
Rhyme 0:846e2321c637 311 display->set_font((unsigned char*) Arial12x12);
Rhyme 0:846e2321c637 312 display->set_font_zoom(2, 2) ;
Rhyme 0:846e2321c637 313 display->foreground(White) ;
Rhyme 0:846e2321c637 314 display->locate(10, EDGE_SUMMARY_TIME_Y) ;
Rhyme 0:846e2321c637 315 displayTime(_sampled_time) ;
Rhyme 0:846e2321c637 316 // display->locate(10,50) ;
Rhyme 0:846e2321c637 317 // display->printf(timestr) ;
Rhyme 0:846e2321c637 318 display->locate(10, EDGE_SUMMARY_PRESS_Y) ;
Rhyme 0:846e2321c637 319 display->printf("Press: ") ;
Rhyme 0:846e2321c637 320 display->foreground(color) ;
Rhyme 0:846e2321c637 321 display->locate(90, EDGE_SUMMARY_PRESS_Y) ;
Rhyme 0:846e2321c637 322 display->printf("%.3f ", _value) ;
Rhyme 0:846e2321c637 323 display->foreground(White) ;
Rhyme 0:846e2321c637 324 display->printf("kgf/cm2") ;
Rhyme 0:846e2321c637 325 display->BusEnable(false) ;
Rhyme 0:846e2321c637 326 break ;
Rhyme 0:846e2321c637 327 case DISPLAY_MODE_CHART:
Rhyme 0:846e2321c637 328 x = p->left + p->index + 1;
Rhyme 0:846e2321c637 329 y = press_v2y(_value, p) ;
Rhyme 0:846e2321c637 330 display->BusEnable(true) ;
Rhyme 0:846e2321c637 331 if (p->index == 0) {
Rhyme 0:846e2321c637 332 draw_chart_frame(p) ;
Rhyme 0:846e2321c637 333 }
Rhyme 0:846e2321c637 334 display->foreground(color) ;
Rhyme 0:846e2321c637 335 display->pixel(x, y, color) ;
Rhyme 0:846e2321c637 336 display->set_font((unsigned char*) Arial12x12);
Rhyme 0:846e2321c637 337 display->locate(p->left + 40, p->top + 5) ;
Rhyme 0:846e2321c637 338 display->printf("%5s", str_buf) ;
Rhyme 0:846e2321c637 339 display->foreground(White) ;
Rhyme 0:846e2321c637 340 display->BusEnable(false) ;
Rhyme 0:846e2321c637 341 p->index = (p->index + 1) % (p->width - 2) ;
Rhyme 0:846e2321c637 342 break ;
Rhyme 0:846e2321c637 343 }
Rhyme 0:846e2321c637 344 }
Rhyme 0:846e2321c637 345 reset_watch_dog() ;
Rhyme 0:846e2321c637 346 }