Orefatoi
/
afero_poc15_171201
POC1.5 prototype 2 x color sensor 2 x LM75B 3 x AnalogIn 1 x accel
edge_sensor/edge_pressure.cpp@3:cac964851bb6, 2017-12-04 (annotated)
- Committer:
- Rhyme
- Date:
- Mon Dec 04 02:47:38 2017 +0000
- Revision:
- 3:cac964851bb6
- Parent:
- 0:f0de320e23ac
- Child:
- 7:aa858d789025
so1602a renamed to display for future compatibility ; some initial messages to display added
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Rhyme | 0:f0de320e23ac | 1 | #include "mbed.h" |
Rhyme | 0:f0de320e23ac | 2 | #include "edge_sensor.h" |
Rhyme | 0:f0de320e23ac | 3 | #include "edge_time.h" |
Rhyme | 0:f0de320e23ac | 4 | #include "PSE530.h" |
Rhyme | 0:f0de320e23ac | 5 | #include "edge_pressure.h" |
Rhyme | 0:f0de320e23ac | 6 | #include "SO1602A.h" |
Rhyme | 0:f0de320e23ac | 7 | |
Rhyme | 3:cac964851bb6 | 8 | extern SO1602A *display ; /* OLED display on I2C */ |
Rhyme | 0:f0de320e23ac | 9 | |
Rhyme | 0:f0de320e23ac | 10 | #define LOW_THR 0.2 |
Rhyme | 0:f0de320e23ac | 11 | #define HIGH_THR 0.3 |
Rhyme | 0:f0de320e23ac | 12 | #define MIN_TEMP 12.0 |
Rhyme | 0:f0de320e23ac | 13 | #define MAX_TEMP 30.0 |
Rhyme | 0:f0de320e23ac | 14 | |
Rhyme | 0:f0de320e23ac | 15 | /** |
Rhyme | 0:f0de320e23ac | 16 | * SMC PSE530 pressure sensor |
Rhyme | 0:f0de320e23ac | 17 | * analog output 1.0V - 5.0V |
Rhyme | 0:f0de320e23ac | 18 | * 1.0V : 0 |
Rhyme | 0:f0de320e23ac | 19 | * 5.0V : 1MPa |
Rhyme | 0:f0de320e23ac | 20 | * (at 0.6V : -0.1MPa) |
Rhyme | 0:f0de320e23ac | 21 | * Our sensor I/F converts 0-5V to 0-3V |
Rhyme | 0:f0de320e23ac | 22 | * So we suppose V = Analog Float Value : Pressure |
Rhyme | 0:f0de320e23ac | 23 | * 0.6V = 0.2 : 0 |
Rhyme | 0:f0de320e23ac | 24 | * 3.0V = 1.0 : 1MPa |
Rhyme | 0:f0de320e23ac | 25 | */ |
Rhyme | 0:f0de320e23ac | 26 | |
Rhyme | 0:f0de320e23ac | 27 | float temp2expected(float temp) |
Rhyme | 0:f0de320e23ac | 28 | { |
Rhyme | 0:f0de320e23ac | 29 | const float coef_A = 0.089 ; |
Rhyme | 0:f0de320e23ac | 30 | const float coef_B = 0.831 ; |
Rhyme | 0:f0de320e23ac | 31 | float pressure ; |
Rhyme | 0:f0de320e23ac | 32 | |
Rhyme | 0:f0de320e23ac | 33 | pressure = temp * coef_A + coef_B ; |
Rhyme | 0:f0de320e23ac | 34 | return( pressure ) ; |
Rhyme | 0:f0de320e23ac | 35 | } |
Rhyme | 0:f0de320e23ac | 36 | |
Rhyme | 0:f0de320e23ac | 37 | edge_pressure::edge_pressure(PSE530 *pse) |
Rhyme | 0:f0de320e23ac | 38 | { |
Rhyme | 0:f0de320e23ac | 39 | _pse = pse ; |
Rhyme | 0:f0de320e23ac | 40 | _value = 0.0 ; |
Rhyme | 0:f0de320e23ac | 41 | _interval = 30 ; |
Rhyme | 0:f0de320e23ac | 42 | } |
Rhyme | 0:f0de320e23ac | 43 | |
Rhyme | 0:f0de320e23ac | 44 | edge_pressure::~edge_pressure(void) |
Rhyme | 0:f0de320e23ac | 45 | { |
Rhyme | 0:f0de320e23ac | 46 | if (_pse) { |
Rhyme | 0:f0de320e23ac | 47 | delete _pse ; |
Rhyme | 0:f0de320e23ac | 48 | } |
Rhyme | 0:f0de320e23ac | 49 | _value = 0.0 ; |
Rhyme | 0:f0de320e23ac | 50 | } |
Rhyme | 0:f0de320e23ac | 51 | |
Rhyme | 0:f0de320e23ac | 52 | float edge_pressure::get_value(void) |
Rhyme | 0:f0de320e23ac | 53 | { |
Rhyme | 0:f0de320e23ac | 54 | float value = 0.0 ; |
Rhyme | 0:f0de320e23ac | 55 | value = _pse->getPressure() ; |
Rhyme | 0:f0de320e23ac | 56 | return( value ) ; |
Rhyme | 0:f0de320e23ac | 57 | } |
Rhyme | 0:f0de320e23ac | 58 | |
Rhyme | 0:f0de320e23ac | 59 | void edge_pressure::reset(void) |
Rhyme | 0:f0de320e23ac | 60 | { |
Rhyme | 0:f0de320e23ac | 61 | _value = 0.0 ; |
Rhyme | 0:f0de320e23ac | 62 | _sampled_time = 0 ; |
Rhyme | 0:f0de320e23ac | 63 | } |
Rhyme | 0:f0de320e23ac | 64 | |
Rhyme | 0:f0de320e23ac | 65 | void edge_pressure::prepare(void) |
Rhyme | 0:f0de320e23ac | 66 | { |
Rhyme | 0:f0de320e23ac | 67 | } |
Rhyme | 0:f0de320e23ac | 68 | |
Rhyme | 0:f0de320e23ac | 69 | void edge_pressure::sample(void) |
Rhyme | 0:f0de320e23ac | 70 | { |
Rhyme | 0:f0de320e23ac | 71 | _value = get_value() ; |
Rhyme | 0:f0de320e23ac | 72 | _sampled_time = edge_time ; |
Rhyme | 0:f0de320e23ac | 73 | } |
Rhyme | 0:f0de320e23ac | 74 | |
Rhyme | 0:f0de320e23ac | 75 | int edge_pressure::deliver(void) |
Rhyme | 0:f0de320e23ac | 76 | { |
Rhyme | 0:f0de320e23ac | 77 | char str_buf[32] ; |
Rhyme | 0:f0de320e23ac | 78 | int result ; |
Rhyme | 0:f0de320e23ac | 79 | float expected ; |
Rhyme | 0:f0de320e23ac | 80 | print_time(_sampled_time) ; |
Rhyme | 0:f0de320e23ac | 81 | if (current_temp != 0) { |
Rhyme | 0:f0de320e23ac | 82 | sprintf(str_buf, "GAS:%.2f @ %.1fC", _value, *current_temp ) ; |
Rhyme | 0:f0de320e23ac | 83 | } else { |
Rhyme | 0:f0de320e23ac | 84 | sprintf(str_buf, "GAS:%.2f ", _value ) ; |
Rhyme | 0:f0de320e23ac | 85 | } |
Rhyme | 3:cac964851bb6 | 86 | printf(" ") ; |
Rhyme | 0:f0de320e23ac | 87 | printf(str_buf) ; |
Rhyme | 3:cac964851bb6 | 88 | if (display != 0) { |
Rhyme | 3:cac964851bb6 | 89 | display->clearDisplay() ; |
Rhyme | 3:cac964851bb6 | 90 | display->locate(0, 0) ; |
Rhyme | 3:cac964851bb6 | 91 | display->putStr(str_buf) ; |
Rhyme | 0:f0de320e23ac | 92 | } |
Rhyme | 0:f0de320e23ac | 93 | if (current_temp != 0) { |
Rhyme | 0:f0de320e23ac | 94 | expected = temp2expected(*current_temp) ; |
Rhyme | 0:f0de320e23ac | 95 | if (_value > (expected + HIGH_THR)) { |
Rhyme | 0:f0de320e23ac | 96 | sprintf(str_buf, "High [exp %.2f]", expected) ; |
Rhyme | 0:f0de320e23ac | 97 | } else if (_value < (expected - LOW_THR)) { |
Rhyme | 0:f0de320e23ac | 98 | sprintf(str_buf, "Low [exp %.2f]", expected) ; |
Rhyme | 0:f0de320e23ac | 99 | } else { |
Rhyme | 0:f0de320e23ac | 100 | sprintf(str_buf, "Normal") ; |
Rhyme | 0:f0de320e23ac | 101 | } |
Rhyme | 0:f0de320e23ac | 102 | } |
Rhyme | 3:cac964851bb6 | 103 | if (display != 0) { |
Rhyme | 3:cac964851bb6 | 104 | display->locate(0, 1) ; |
Rhyme | 3:cac964851bb6 | 105 | display->putStr(str_buf) ; |
Rhyme | 0:f0de320e23ac | 106 | } |
Rhyme | 3:cac964851bb6 | 107 | printf(" %s\n", str_buf) ; |
Rhyme | 3:cac964851bb6 | 108 | // printf(str_buf) ; |
Rhyme | 3:cac964851bb6 | 109 | // printf("\n") ; |
Rhyme | 0:f0de320e23ac | 110 | sprintf(_str_buf, |
Rhyme | 0:f0de320e23ac | 111 | "{\"DEVICE\":\"GAS\",\"PN\":\"PSE530\",\"PRESSURE\":\"%.3f\",\"UNIT\":\"kgf/cm2\",\"S\":\"%06d\",\"E\":\"%d\"}", |
Rhyme | 0:f0de320e23ac | 112 | _value, time2seq(_sampled_time), _error_count) ; |
Rhyme | 0:f0de320e23ac | 113 | result = afero->setAttribute(1, _str_buf) ; |
Rhyme | 0:f0de320e23ac | 114 | return( result == afSUCCESS ) ; |
Rhyme | 0:f0de320e23ac | 115 | } |
Rhyme | 0:f0de320e23ac | 116 | |
Rhyme | 0:f0de320e23ac | 117 | void edge_pressure::recv_config(void) |
Rhyme | 0:f0de320e23ac | 118 | { |
Rhyme | 0:f0de320e23ac | 119 | } |
Rhyme | 0:f0de320e23ac | 120 | |
Rhyme | 0:f0de320e23ac | 121 | void edge_pressure::send_config(void) |
Rhyme | 0:f0de320e23ac | 122 | { |
Rhyme | 0:f0de320e23ac | 123 | } |