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