Orefatoi
/
afero_poc15_171201
POC1.5 prototype 2 x color sensor 2 x LM75B 3 x AnalogIn 1 x accel
edge_utils/edge_mgr.cpp@9:f958fa2cdc74, 2017-12-08 (annotated)
- Committer:
- Rhyme
- Date:
- Fri Dec 08 08:31:30 2017 +0000
- Revision:
- 9:f958fa2cdc74
- Parent:
- 8:5590f55bdf41
- Child:
- 12:4c0bd7fce2fd
result of 8-Dec-2017 mainly source clean-ups
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_mgr.h" |
Rhyme | 2:778a4d4436ff | 3 | #include "af_attributes.h" |
Rhyme | 0:f0de320e23ac | 4 | |
Rhyme | 0:f0de320e23ac | 5 | #include "edge_time.h" |
Rhyme | 0:f0de320e23ac | 6 | #include "edge_pin.h" |
Rhyme | 0:f0de320e23ac | 7 | #include "MMA8451Q.h" |
Rhyme | 0:f0de320e23ac | 8 | #include "VEML6040.h" |
Rhyme | 0:f0de320e23ac | 9 | #include "LM75B.h" |
Rhyme | 0:f0de320e23ac | 10 | #include "SMTC502AT.h" |
Rhyme | 0:f0de320e23ac | 11 | #include "PSE530.h" |
Rhyme | 0:f0de320e23ac | 12 | #include "SO1602A.h" |
Rhyme | 0:f0de320e23ac | 13 | |
Rhyme | 0:f0de320e23ac | 14 | #include "edge_sensor.h" |
Rhyme | 0:f0de320e23ac | 15 | #include "edge_accel.h" |
Rhyme | 0:f0de320e23ac | 16 | #include "edge_color.h" |
Rhyme | 0:f0de320e23ac | 17 | #include "edge_temp.h" |
Rhyme | 0:f0de320e23ac | 18 | #include "edge_pressure.h" |
Rhyme | 0:f0de320e23ac | 19 | |
Rhyme | 0:f0de320e23ac | 20 | #define MMA8451Q_I2C_ADDRESS 0x1C |
Rhyme | 0:f0de320e23ac | 21 | #define VEML6040_I2C_ADDRESS 0x10 |
Rhyme | 0:f0de320e23ac | 22 | #define LM75B_I2C_ADDRESS 0x48 |
Rhyme | 0:f0de320e23ac | 23 | #define SO1602A_I2C_ADDRESS 0x3C |
Rhyme | 0:f0de320e23ac | 24 | |
Rhyme | 0:f0de320e23ac | 25 | #define NUM_MAX_SENSOR 5 |
Rhyme | 0:f0de320e23ac | 26 | |
Rhyme | 9:f958fa2cdc74 | 27 | bool verbos = true ; |
Rhyme | 0:f0de320e23ac | 28 | edge_sensor *sensor[NUM_MAX_SENSOR] ; |
Rhyme | 9:f958fa2cdc74 | 29 | int num_sensor = 0 ; |
Rhyme | 9:f958fa2cdc74 | 30 | |
Rhyme | 9:f958fa2cdc74 | 31 | edge_accel *accel = 0 ; |
Rhyme | 9:f958fa2cdc74 | 32 | edge_color *color[2] = {0, 0} ; |
Rhyme | 9:f958fa2cdc74 | 33 | edge_temp *temp = 0 ; |
Rhyme | 9:f958fa2cdc74 | 34 | edge_pressure *pressure = 0 ; |
Rhyme | 0:f0de320e23ac | 35 | |
Rhyme | 9:f958fa2cdc74 | 36 | PwmOut *led[3] = {0, 0, 0} ; |
Rhyme | 9:f958fa2cdc74 | 37 | uint16_t pwm[3] = { 0x5FA2, 0xB09B, 0x83DF } ; |
Rhyme | 9:f958fa2cdc74 | 38 | I2C *edge_i2c0 = 0 ; |
Rhyme | 9:f958fa2cdc74 | 39 | I2C *edge_i2c1 = 0 ; |
Rhyme | 9:f958fa2cdc74 | 40 | SO1602A *display = 0 ; /* OLED display on I2C */ |
Rhyme | 9:f958fa2cdc74 | 41 | MMA8451Q *mma8451q = 0 ; |
Rhyme | 0:f0de320e23ac | 42 | VEML6040 *veml6040[2] = { 0, 0 } ; |
Rhyme | 9:f958fa2cdc74 | 43 | LM75B *lm75b0 = 0 ; /* for temp1 */ |
Rhyme | 9:f958fa2cdc74 | 44 | AnalogIn *an0 = 0 ; /* for temp2 */ |
Rhyme | 9:f958fa2cdc74 | 45 | SMTC502AT *smtc502at0 = 0 ; |
Rhyme | 9:f958fa2cdc74 | 46 | AnalogIn *an1 = 0 ; /* for temp3 */ |
Rhyme | 9:f958fa2cdc74 | 47 | SMTC502AT *smtc502at1 = 0 ; |
Rhyme | 9:f958fa2cdc74 | 48 | LM75B *lm75b1 = 0 ; /* for temp4 */ |
Rhyme | 9:f958fa2cdc74 | 49 | AnalogIn *an2 = 0 ; /* for gas pressure */ |
Rhyme | 9:f958fa2cdc74 | 50 | PSE530 *pse530 = 0 ; /* gas pressure sensor */ |
Rhyme | 0:f0de320e23ac | 51 | |
Rhyme | 9:f958fa2cdc74 | 52 | static int loop_interval = 100 ; // 1000 ; |
Rhyme | 9:f958fa2cdc74 | 53 | static int accel_interval = 10 ; |
Rhyme | 9:f958fa2cdc74 | 54 | int first_loop = 1 ; |
Rhyme | 0:f0de320e23ac | 55 | |
Rhyme | 0:f0de320e23ac | 56 | int init_edge_attribute(void) |
Rhyme | 0:f0de320e23ac | 57 | { |
Rhyme | 0:f0de320e23ac | 58 | static int sensor_index = 0 ; |
Rhyme | 0:f0de320e23ac | 59 | if (first_loop) { |
Rhyme | 0:f0de320e23ac | 60 | enable_sensors() ; |
Rhyme | 0:f0de320e23ac | 61 | first_loop = 0 ; |
Rhyme | 0:f0de320e23ac | 62 | printf("Sensor loop started!\n") ; |
Rhyme | 3:cac964851bb6 | 63 | if (display) { |
Rhyme | 9:f958fa2cdc74 | 64 | display->cls() ; |
Rhyme | 3:cac964851bb6 | 65 | display->locate(0, 0) ; |
Rhyme | 3:cac964851bb6 | 66 | display->putStr("Sensor Loop") ; |
Rhyme | 7:aa858d789025 | 67 | display->locate(2, 1) ; |
Rhyme | 7:aa858d789025 | 68 | display->putStr("Started!") ; |
Rhyme | 3:cac964851bb6 | 69 | } |
Rhyme | 0:f0de320e23ac | 70 | } |
Rhyme | 0:f0de320e23ac | 71 | switch(sensor_index) { |
Rhyme | 0:f0de320e23ac | 72 | case 0: /* accel */ |
Rhyme | 0:f0de320e23ac | 73 | if (sensor[sensor_index]) { |
Rhyme | 0:f0de320e23ac | 74 | afero->setAttributeBool(ATTR_ACCEL_PRESENT, true) ; |
Rhyme | 0:f0de320e23ac | 75 | afero->setAttributeBool(ATTR_ACCEL_ENABLE, true) ; |
Rhyme | 0:f0de320e23ac | 76 | } else { |
Rhyme | 0:f0de320e23ac | 77 | afero->setAttributeBool(ATTR_ACCEL_PRESENT, false) ; |
Rhyme | 0:f0de320e23ac | 78 | } |
Rhyme | 0:f0de320e23ac | 79 | break ; |
Rhyme | 7:aa858d789025 | 80 | case 1: /* color0 */ |
Rhyme | 0:f0de320e23ac | 81 | if (sensor[sensor_index]) { |
Rhyme | 0:f0de320e23ac | 82 | afero->setAttributeBool(ATTR_COLOR0_PRESENT, true) ; |
Rhyme | 0:f0de320e23ac | 83 | afero->setAttributeBool(ATTR_COLOR0_ENABLE, true) ; |
Rhyme | 8:5590f55bdf41 | 84 | afero->getAttribute(ATTR_COLOR0_PWM_R) ; |
Rhyme | 8:5590f55bdf41 | 85 | afero->getAttribute(ATTR_COLOR0_PWM_G) ; |
Rhyme | 8:5590f55bdf41 | 86 | afero->getAttribute(ATTR_COLOR0_PWM_B) ; |
Rhyme | 0:f0de320e23ac | 87 | } else { |
Rhyme | 0:f0de320e23ac | 88 | afero->setAttributeBool(ATTR_COLOR0_PRESENT, false) ; |
Rhyme | 0:f0de320e23ac | 89 | } |
Rhyme | 0:f0de320e23ac | 90 | break ; |
Rhyme | 7:aa858d789025 | 91 | case 2: /* color1 */ |
Rhyme | 0:f0de320e23ac | 92 | if (sensor[sensor_index]) { |
Rhyme | 0:f0de320e23ac | 93 | afero->setAttributeBool(ATTR_COLOR1_PRESENT, true) ; |
Rhyme | 0:f0de320e23ac | 94 | afero->setAttributeBool(ATTR_COLOR1_ENABLE, true) ; |
Rhyme | 8:5590f55bdf41 | 95 | afero->getAttribute(ATTR_COLOR1_PWM_R) ; |
Rhyme | 8:5590f55bdf41 | 96 | afero->getAttribute(ATTR_COLOR1_PWM_G) ; |
Rhyme | 8:5590f55bdf41 | 97 | afero->getAttribute(ATTR_COLOR1_PWM_B) ; |
Rhyme | 0:f0de320e23ac | 98 | } else { |
Rhyme | 0:f0de320e23ac | 99 | afero->setAttributeBool(ATTR_COLOR1_PRESENT, false) ; |
Rhyme | 0:f0de320e23ac | 100 | } |
Rhyme | 0:f0de320e23ac | 101 | break ; |
Rhyme | 0:f0de320e23ac | 102 | case 3: /* temp */ |
Rhyme | 9:f958fa2cdc74 | 103 | if (lm75b0) { /* temp with color1 */ |
Rhyme | 0:f0de320e23ac | 104 | afero->setAttributeBool(ATTR_TEMP0_PRESENT, true) ; |
Rhyme | 0:f0de320e23ac | 105 | afero->setAttributeBool(ATTR_TEMP0_ENABLE, true) ; |
Rhyme | 0:f0de320e23ac | 106 | } else { |
Rhyme | 0:f0de320e23ac | 107 | afero->setAttributeBool(ATTR_TEMP0_PRESENT, false) ; |
Rhyme | 0:f0de320e23ac | 108 | } |
Rhyme | 9:f958fa2cdc74 | 109 | afero->setAttributeBool(ATTR_TEMP1_PRESENT, true) ; /* before */ |
Rhyme | 9:f958fa2cdc74 | 110 | afero->setAttributeBool(ATTR_TEMP2_PRESENT, true) ; /* after */ |
Rhyme | 7:aa858d789025 | 111 | |
Rhyme | 9:f958fa2cdc74 | 112 | if (lm75b1) { /* temp with color2 Note: Obsolete */ |
Rhyme | 0:f0de320e23ac | 113 | afero->setAttributeBool(ATTR_TEMP3_PRESENT, true) ; |
Rhyme | 0:f0de320e23ac | 114 | afero->setAttributeBool(ATTR_TEMP3_ENABLE, true) ; |
Rhyme | 0:f0de320e23ac | 115 | } else { |
Rhyme | 0:f0de320e23ac | 116 | afero->setAttributeBool(ATTR_TEMP3_PRESENT, false) ; |
Rhyme | 0:f0de320e23ac | 117 | } |
Rhyme | 7:aa858d789025 | 118 | |
Rhyme | 0:f0de320e23ac | 119 | break ; |
Rhyme | 0:f0de320e23ac | 120 | case 4: /* pressure */ |
Rhyme | 0:f0de320e23ac | 121 | if (sensor[sensor_index]) { |
Rhyme | 0:f0de320e23ac | 122 | afero->setAttributeBool(ATTR_GAS_PRESENT, true) ; |
Rhyme | 0:f0de320e23ac | 123 | afero->setAttributeBool(ATTR_GAS_ENABLE, true) ; |
Rhyme | 0:f0de320e23ac | 124 | } else { |
Rhyme | 0:f0de320e23ac | 125 | afero->setAttributeBool(ATTR_GAS_PRESENT, false) ; |
Rhyme | 0:f0de320e23ac | 126 | } |
Rhyme | 0:f0de320e23ac | 127 | break ; |
Rhyme | 0:f0de320e23ac | 128 | default: |
Rhyme | 0:f0de320e23ac | 129 | break ; |
Rhyme | 0:f0de320e23ac | 130 | } |
Rhyme | 0:f0de320e23ac | 131 | sensor_index++ ; |
Rhyme | 0:f0de320e23ac | 132 | return(sensor_index < NUM_MAX_SENSOR) ; |
Rhyme | 0:f0de320e23ac | 133 | } |
Rhyme | 0:f0de320e23ac | 134 | |
Rhyme | 0:f0de320e23ac | 135 | void edge_loop(uint32_t count_robin) |
Rhyme | 0:f0de320e23ac | 136 | { |
Rhyme | 9:f958fa2cdc74 | 137 | static int sensor_index = 0 ; |
Rhyme | 0:f0de320e23ac | 138 | if ((count_robin % accel_interval) == 0) { |
Rhyme | 0:f0de320e23ac | 139 | if (accel) { |
Rhyme | 0:f0de320e23ac | 140 | accel->accum() ; /* get and accum accel data */ |
Rhyme | 0:f0de320e23ac | 141 | } |
Rhyme | 0:f0de320e23ac | 142 | } |
Rhyme | 0:f0de320e23ac | 143 | |
Rhyme | 0:f0de320e23ac | 144 | if ((count_robin % loop_interval) == 0) { |
Rhyme | 0:f0de320e23ac | 145 | loop_interval = 1 ; |
Rhyme | 0:f0de320e23ac | 146 | if ((sensor[sensor_index])&&(sensor[sensor_index]->isEnabled())) { |
Rhyme | 0:f0de320e23ac | 147 | sensor[sensor_index]->runStateMachine() ; |
Rhyme | 0:f0de320e23ac | 148 | } |
Rhyme | 0:f0de320e23ac | 149 | sensor_index = (sensor_index + 1) % NUM_MAX_SENSOR ; |
Rhyme | 0:f0de320e23ac | 150 | } |
Rhyme | 0:f0de320e23ac | 151 | } |
Rhyme | 0:f0de320e23ac | 152 | |
Rhyme | 0:f0de320e23ac | 153 | int is_present(I2C *i2c, int address) |
Rhyme | 0:f0de320e23ac | 154 | { |
Rhyme | 0:f0de320e23ac | 155 | char t[1] = { 0 } ; |
Rhyme | 0:f0de320e23ac | 156 | char data[2] = { 0, 0 } ; |
Rhyme | 0:f0de320e23ac | 157 | int result ; |
Rhyme | 0:f0de320e23ac | 158 | address <<= 1 ; |
Rhyme | 0:f0de320e23ac | 159 | result = i2c->write(address, t, 1, true) ; |
Rhyme | 0:f0de320e23ac | 160 | if (result == 0) { |
Rhyme | 0:f0de320e23ac | 161 | result = i2c->read(address, data, 2) ; |
Rhyme | 0:f0de320e23ac | 162 | } |
Rhyme | 0:f0de320e23ac | 163 | return((result == 0)) ; |
Rhyme | 0:f0de320e23ac | 164 | } |
Rhyme | 0:f0de320e23ac | 165 | |
Rhyme | 0:f0de320e23ac | 166 | void init_sensors(void) |
Rhyme | 0:f0de320e23ac | 167 | { |
Rhyme | 0:f0de320e23ac | 168 | #if 0 |
Rhyme | 0:f0de320e23ac | 169 | I2C *edge_i2c0 = 0 ; |
Rhyme | 0:f0de320e23ac | 170 | I2C *edge_i2c1 = 0 ; |
Rhyme | 0:f0de320e23ac | 171 | MMA8451Q *mma8451q = 0 ; |
Rhyme | 0:f0de320e23ac | 172 | VEML6040 *veml6040[2] = { 0, 0 } ; |
Rhyme | 0:f0de320e23ac | 173 | LM75B *lm75b0 = 0 ; /* for temp1 */ |
Rhyme | 0:f0de320e23ac | 174 | AnalogIn *an0 = 0 ; /* for temp2 */ |
Rhyme | 0:f0de320e23ac | 175 | SMTC502AT *smtc502at0 = 0 ; |
Rhyme | 0:f0de320e23ac | 176 | AnalogIn *an1 = 0 ; /* for temp3 */ |
Rhyme | 0:f0de320e23ac | 177 | SMTC502AT *smtc502at1 = 0 ; |
Rhyme | 0:f0de320e23ac | 178 | LM75B *lm75b1 = 0 ; /* for temp4 */ |
Rhyme | 0:f0de320e23ac | 179 | AnalogIn *an2 = 0 ; /* for gas pressure */ |
Rhyme | 0:f0de320e23ac | 180 | PSE530 *pse530 = 0 ; |
Rhyme | 0:f0de320e23ac | 181 | #endif |
Rhyme | 0:f0de320e23ac | 182 | |
Rhyme | 0:f0de320e23ac | 183 | printf("=== Initializing Sensor(s) ===\n") ; |
Rhyme | 0:f0de320e23ac | 184 | edge_i2c0 = new I2C(PIN_I2C0_SDA, PIN_I2C0_SCL) ; |
Rhyme | 0:f0de320e23ac | 185 | edge_i2c1 = new I2C(PIN_I2C1_SDA, PIN_I2C1_SCL) ; |
Rhyme | 0:f0de320e23ac | 186 | |
Rhyme | 0:f0de320e23ac | 187 | if (is_present(edge_i2c0, SO1602A_I2C_ADDRESS)) { |
Rhyme | 0:f0de320e23ac | 188 | printf("SO1602A on I2C0 is present\n") ; |
Rhyme | 3:cac964851bb6 | 189 | display = new SO1602A(edge_i2c0, SO1602A_I2C_ADDRESS) ; |
Rhyme | 0:f0de320e23ac | 190 | } else if (is_present(edge_i2c1, SO1602A_I2C_ADDRESS)) { |
Rhyme | 0:f0de320e23ac | 191 | printf("SO1602A on I2C1 is present\n") ; |
Rhyme | 3:cac964851bb6 | 192 | display = new SO1602A(edge_i2c1, SO1602A_I2C_ADDRESS) ; |
Rhyme | 0:f0de320e23ac | 193 | } else { |
Rhyme | 0:f0de320e23ac | 194 | printf("SO1602A is absent\n") ; |
Rhyme | 0:f0de320e23ac | 195 | } |
Rhyme | 3:cac964851bb6 | 196 | if (display) { |
Rhyme | 9:f958fa2cdc74 | 197 | display->cls() ; |
Rhyme | 3:cac964851bb6 | 198 | display->locate(3, 0) ; |
Rhyme | 3:cac964851bb6 | 199 | display->putStr("Suntory") ; |
Rhyme | 3:cac964851bb6 | 200 | display->locate(0, 1) ; |
Rhyme | 3:cac964851bb6 | 201 | display->putStr("Server Monitor") ; |
Rhyme | 0:f0de320e23ac | 202 | } |
Rhyme | 0:f0de320e23ac | 203 | |
Rhyme | 0:f0de320e23ac | 204 | if (is_present(edge_i2c1, MMA8451Q_I2C_ADDRESS)) { |
Rhyme | 0:f0de320e23ac | 205 | printf("MMA8451Q on I2C1 is present\n") ; |
Rhyme | 0:f0de320e23ac | 206 | mma8451q = new MMA8451Q(edge_i2c1, MMA8451Q_I2C_ADDRESS) ; |
Rhyme | 0:f0de320e23ac | 207 | accel = new edge_accel(mma8451q) ; |
Rhyme | 0:f0de320e23ac | 208 | sensor[0] = accel ; |
Rhyme | 0:f0de320e23ac | 209 | num_sensor++ ; |
Rhyme | 0:f0de320e23ac | 210 | } else { |
Rhyme | 0:f0de320e23ac | 211 | sensor[0] = 0 ; |
Rhyme | 0:f0de320e23ac | 212 | printf("MMA8451Q is absent\n") ; |
Rhyme | 0:f0de320e23ac | 213 | } |
Rhyme | 0:f0de320e23ac | 214 | |
Rhyme | 0:f0de320e23ac | 215 | if (is_present(edge_i2c1, VEML6040_I2C_ADDRESS)) { |
Rhyme | 0:f0de320e23ac | 216 | printf("VEML6040 on I2C1 is present\n") ; |
Rhyme | 0:f0de320e23ac | 217 | veml6040[0] = new VEML6040(edge_i2c1, VEML6040_I2C_ADDRESS) ; |
Rhyme | 0:f0de320e23ac | 218 | led[0] = new PwmOut(PIN_LED_R) ; |
Rhyme | 0:f0de320e23ac | 219 | led[1] = new PwmOut(PIN_LED_G) ; |
Rhyme | 0:f0de320e23ac | 220 | led[2] = new PwmOut(PIN_LED_B) ; |
Rhyme | 0:f0de320e23ac | 221 | color[0] = new edge_color(veml6040[0], led, pwm) ; |
Rhyme | 0:f0de320e23ac | 222 | sensor[1] = color[0] ; |
Rhyme | 0:f0de320e23ac | 223 | num_sensor++ ; |
Rhyme | 0:f0de320e23ac | 224 | } else { |
Rhyme | 0:f0de320e23ac | 225 | sensor[1] = 0 ; |
Rhyme | 0:f0de320e23ac | 226 | printf("VEML6040 on I2C1 is absent\n") ; |
Rhyme | 0:f0de320e23ac | 227 | } |
Rhyme | 0:f0de320e23ac | 228 | |
Rhyme | 0:f0de320e23ac | 229 | if (is_present(edge_i2c0, VEML6040_I2C_ADDRESS)) { |
Rhyme | 0:f0de320e23ac | 230 | printf("VEML6040 on I2C0 is present\n") ; |
Rhyme | 0:f0de320e23ac | 231 | veml6040[1] = new VEML6040(edge_i2c0, VEML6040_I2C_ADDRESS) ; |
Rhyme | 0:f0de320e23ac | 232 | if (led[0] == 0) { |
Rhyme | 0:f0de320e23ac | 233 | led[0] = new PwmOut(PIN_LED_R) ; |
Rhyme | 0:f0de320e23ac | 234 | led[1] = new PwmOut(PIN_LED_G) ; |
Rhyme | 0:f0de320e23ac | 235 | led[2] = new PwmOut(PIN_LED_B) ; |
Rhyme | 0:f0de320e23ac | 236 | } |
Rhyme | 0:f0de320e23ac | 237 | color[1] = new edge_color(veml6040[1], led, pwm) ; |
Rhyme | 0:f0de320e23ac | 238 | sensor[2] = color[1] ; |
Rhyme | 0:f0de320e23ac | 239 | num_sensor++ ; |
Rhyme | 0:f0de320e23ac | 240 | } else { |
Rhyme | 0:f0de320e23ac | 241 | sensor[2] = 0 ; |
Rhyme | 0:f0de320e23ac | 242 | printf("VEML6040 on I2C0 is absent\n") ; |
Rhyme | 0:f0de320e23ac | 243 | } |
Rhyme | 0:f0de320e23ac | 244 | |
Rhyme | 0:f0de320e23ac | 245 | if (is_present(edge_i2c1, LM75B_I2C_ADDRESS)) { |
Rhyme | 0:f0de320e23ac | 246 | printf("LM75B on I2C1 is present\n") ; |
Rhyme | 0:f0de320e23ac | 247 | lm75b0 = new LM75B(edge_i2c1, LM75B_I2C_ADDRESS) ; |
Rhyme | 0:f0de320e23ac | 248 | } else { |
Rhyme | 0:f0de320e23ac | 249 | printf("LM75B on I2C1 is absent\n") ; |
Rhyme | 0:f0de320e23ac | 250 | } |
Rhyme | 7:aa858d789025 | 251 | #if 0 |
Rhyme | 0:f0de320e23ac | 252 | if (is_present(edge_i2c0, LM75B_I2C_ADDRESS)) { |
Rhyme | 0:f0de320e23ac | 253 | printf("LM75B on I2C0 is present\n") ; |
Rhyme | 0:f0de320e23ac | 254 | lm75b1 = new LM75B(edge_i2c0, LM75B_I2C_ADDRESS) ; |
Rhyme | 0:f0de320e23ac | 255 | } else { |
Rhyme | 0:f0de320e23ac | 256 | printf("LM75B on I2C0 is absent\n") ; |
Rhyme | 0:f0de320e23ac | 257 | } |
Rhyme | 7:aa858d789025 | 258 | #endif |
Rhyme | 9:f958fa2cdc74 | 259 | an0 = new AnalogIn(PIN_AN0) ; |
Rhyme | 0:f0de320e23ac | 260 | smtc502at0 = new SMTC502AT(an0) ; |
Rhyme | 9:f958fa2cdc74 | 261 | an1 = new AnalogIn(PIN_AN1) ; |
Rhyme | 0:f0de320e23ac | 262 | smtc502at1 = new SMTC502AT(an1) ; |
Rhyme | 9:f958fa2cdc74 | 263 | temp = new edge_temp(lm75b0, smtc502at0, smtc502at1, lm75b1) ; |
Rhyme | 9:f958fa2cdc74 | 264 | sensor[3] = temp ; |
Rhyme | 0:f0de320e23ac | 265 | num_sensor++ ; |
Rhyme | 0:f0de320e23ac | 266 | |
Rhyme | 9:f958fa2cdc74 | 267 | an2 = new AnalogIn(PIN_AN2) ; |
Rhyme | 9:f958fa2cdc74 | 268 | pse530 = new PSE530(an2) ; |
Rhyme | 9:f958fa2cdc74 | 269 | pressure = new edge_pressure(pse530) ; |
Rhyme | 9:f958fa2cdc74 | 270 | sensor[4] = pressure ; |
Rhyme | 0:f0de320e23ac | 271 | num_sensor++ ; |
Rhyme | 0:f0de320e23ac | 272 | |
Rhyme | 0:f0de320e23ac | 273 | #if 0 |
Rhyme | 0:f0de320e23ac | 274 | if (color[0]) { |
Rhyme | 0:f0de320e23ac | 275 | color[0]->calibrate(target, color0_pwm, 10) ; |
Rhyme | 0:f0de320e23ac | 276 | } |
Rhyme | 0:f0de320e23ac | 277 | if (color[1]) { |
Rhyme | 0:f0de320e23ac | 278 | color[1]->calibrate(target, color1_pwm, 10) ; |
Rhyme | 0:f0de320e23ac | 279 | } |
Rhyme | 0:f0de320e23ac | 280 | #endif |
Rhyme | 0:f0de320e23ac | 281 | if (num_sensor > 0) { |
Rhyme | 0:f0de320e23ac | 282 | printf("%d edge_sensor(s) registered\n", num_sensor) ; |
Rhyme | 3:cac964851bb6 | 283 | printf("Edge is waiting for ASR to link\n") ; |
Rhyme | 3:cac964851bb6 | 284 | if (display) { |
Rhyme | 9:f958fa2cdc74 | 285 | display->cls() ; |
Rhyme | 3:cac964851bb6 | 286 | display->locate(0, 0) ; |
Rhyme | 3:cac964851bb6 | 287 | display->putStr("Waiting for") ; |
Rhyme | 3:cac964851bb6 | 288 | display->locate(0, 1) ; |
Rhyme | 3:cac964851bb6 | 289 | display->putStr("ASR to Link") ; |
Rhyme | 3:cac964851bb6 | 290 | } |
Rhyme | 0:f0de320e23ac | 291 | } |
Rhyme | 0:f0de320e23ac | 292 | } |
Rhyme | 0:f0de320e23ac | 293 | |
Rhyme | 0:f0de320e23ac | 294 | void enable_sensors(void) |
Rhyme | 0:f0de320e23ac | 295 | { |
Rhyme | 0:f0de320e23ac | 296 | int i ; |
Rhyme | 0:f0de320e23ac | 297 | for (i = 0 ; i < NUM_MAX_SENSOR ; i++ ) { |
Rhyme | 0:f0de320e23ac | 298 | if (sensor[i]) { |
Rhyme | 0:f0de320e23ac | 299 | sensor[i]->enable() ; |
Rhyme | 0:f0de320e23ac | 300 | } |
Rhyme | 0:f0de320e23ac | 301 | } |
Rhyme | 0:f0de320e23ac | 302 | } |