La Suno / Mbed 2 deprecated afero_poc15_180403

I2C hang recover function added

Dependencies:   UniGraphic mbed vt100

In this version, check_i2c_pins function was added in edge_mgr.cpp.

プログラムの起動時、I2Cモジュールを初期化する前に、I2Cに使用するピンの電位を確認し
もし一方でも Low に張り付いていた場合、SCL を GPIO 出力に設定して　
所定回数 (I2C_UNLOCK_TRIAL_CYCLE) 反転させることにより、疑似リセットクロックを生成します。

その後は、通常の起動手順に復帰し、以降はこれまでと同様の動作をします。

edge_sensor/edge_pressure.cpp@2:de22987be9ba, 2018-06-18 (annotated)

Committer:
gaku_miyagawa
Date:
Mon Jun 18 02:55:38 2018 +0000
Revision:
2:de22987be9ba
Parent:
0:d895cd1cd897 
SBU SPECIAL

Who changed what in which revision?

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