Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: easy-connect-v16 Watchdog FP MQTTPacket RecordType-v-16 watersenor_and_temp_code
Sensor/ReadSensor.cpp@40:4356c209c58d, 2018-02-27 (annotated)
- Committer:
- DuyLionTran
- Date:
- Tue Feb 27 14:51:18 2018 +0000
- Revision:
- 40:4356c209c58d
- Parent:
- 39:a5ee98bd0050
- Child:
- 41:6aed398adcc4
* version 2.6.8 02-27-2017: developing DO calibration. DS18B20 temperature sensor is added
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| DuyLionTran | 32:8226837c56ae | 1 | #include "mbed.h" |
| DuyLionTran | 40:4356c209c58d | 2 | #include "DS1820.h" |
| DuyLionTran | 32:8226837c56ae | 3 | #include "ReadSensor.h" |
| DuyLionTran | 38:64e3e9acb49c | 4 | #include "flash_programming.h" |
| DuyLionTran | 32:8226837c56ae | 5 | |
| DuyLionTran | 36:d0b628087ac8 | 6 | const float SaturationValueTab[41] = { /* saturation dissolved oxygen concentrations at various temperatures */ |
| DuyLionTran | 32:8226837c56ae | 7 | 14.46, 14.22, 13.82, 13.44, 13.09, |
| DuyLionTran | 32:8226837c56ae | 8 | 12.74, 12.42, 12.11, 11.81, 11.53, |
| DuyLionTran | 32:8226837c56ae | 9 | 11.26, 11.01, 10.77, 10.53, 10.30, |
| DuyLionTran | 32:8226837c56ae | 10 | 10.08, 9.86, 9.66, 9.46, 9.27, |
| DuyLionTran | 32:8226837c56ae | 11 | 9.08, 8.90, 8.73, 8.57, 8.41, |
| DuyLionTran | 32:8226837c56ae | 12 | 8.25, 8.11, 7.96, 7.82, 7.69, |
| DuyLionTran | 32:8226837c56ae | 13 | 7.56, 7.43, 7.30, 7.18, 7.07, |
| DuyLionTran | 32:8226837c56ae | 14 | 6.95, 6.84, 6.73, 6.63, 6.53, |
| DuyLionTran | 32:8226837c56ae | 15 | 6.41, |
| DuyLionTran | 32:8226837c56ae | 16 | }; |
| DuyLionTran | 32:8226837c56ae | 17 | |
| DuyLionTran | 36:d0b628087ac8 | 18 | float doValue; /* current dissolved oxygen value, unit; mg/L */ |
| DuyLionTran | 36:d0b628087ac8 | 19 | float temperature = 25; /* default temperature is 25^C, you can use a temperature sensor to read it */ |
| DuyLionTran | 36:d0b628087ac8 | 20 | int analogBuffer[SCOUNT]; /* store the analog value in the array, readed from ADC */ |
| DuyLionTran | 36:d0b628087ac8 | 21 | int analogBufferTemp[SCOUNT]; |
| DuyLionTran | 36:d0b628087ac8 | 22 | int analogBufferIndex = 0; |
| DuyLionTran | 36:d0b628087ac8 | 23 | int copyIndex = 0; |
| DuyLionTran | 38:64e3e9acb49c | 24 | float SaturationDoVoltage; /* mV */ |
| DuyLionTran | 40:4356c209c58d | 25 | float SaturationDoTemperature = 27.0; /* ^C */ |
| DuyLionTran | 38:64e3e9acb49c | 26 | float averageVoltage; |
| DuyLionTran | 38:64e3e9acb49c | 27 | AnalogIn DOSensor(SENSOR_1_PIN); |
| DuyLionTran | 40:4356c209c58d | 28 | DS1820 probe(SENSOR_2_PIN); |
| DuyLionTran | 32:8226837c56ae | 29 | |
| DuyLionTran | 36:d0b628087ac8 | 30 | int getMedianNum(int bArray[], int iFilterLen) { |
| DuyLionTran | 36:d0b628087ac8 | 31 | int bTab[iFilterLen]; |
| DuyLionTran | 36:d0b628087ac8 | 32 | for (uint8_t i = 0; i < iFilterLen; i++) { |
| DuyLionTran | 36:d0b628087ac8 | 33 | bTab[i] = bArray[i]; |
| DuyLionTran | 36:d0b628087ac8 | 34 | } |
| DuyLionTran | 38:64e3e9acb49c | 35 | int i, j; |
| DuyLionTran | 38:64e3e9acb49c | 36 | int bTemp; |
| DuyLionTran | 36:d0b628087ac8 | 37 | for (j = 0; j < iFilterLen - 1; j++) { |
| DuyLionTran | 36:d0b628087ac8 | 38 | for (i = 0; i < iFilterLen - j - 1; i++) { |
| DuyLionTran | 36:d0b628087ac8 | 39 | if (bTab[i] > bTab[i + 1]) { |
| DuyLionTran | 36:d0b628087ac8 | 40 | bTemp = bTab[i]; |
| DuyLionTran | 36:d0b628087ac8 | 41 | bTab[i] = bTab[i + 1]; |
| DuyLionTran | 36:d0b628087ac8 | 42 | bTab[i + 1] = bTemp; |
| DuyLionTran | 36:d0b628087ac8 | 43 | } |
| DuyLionTran | 36:d0b628087ac8 | 44 | } |
| DuyLionTran | 36:d0b628087ac8 | 45 | } |
| DuyLionTran | 36:d0b628087ac8 | 46 | if ((iFilterLen & 1) > 0) { |
| DuyLionTran | 36:d0b628087ac8 | 47 | bTemp = bTab[(iFilterLen - 1) / 2]; |
| DuyLionTran | 36:d0b628087ac8 | 48 | } |
| DuyLionTran | 36:d0b628087ac8 | 49 | else { |
| DuyLionTran | 36:d0b628087ac8 | 50 | bTemp = (bTab[iFilterLen / 2] + bTab[iFilterLen / 2 - 1]) / 2; |
| DuyLionTran | 36:d0b628087ac8 | 51 | } |
| DuyLionTran | 36:d0b628087ac8 | 52 | return bTemp; |
| DuyLionTran | 36:d0b628087ac8 | 53 | } |
| DuyLionTran | 36:d0b628087ac8 | 54 | |
| DuyLionTran | 36:d0b628087ac8 | 55 | void SENSOR_AnalogRead() { |
| DuyLionTran | 38:64e3e9acb49c | 56 | float analogReadRaw = DOSensor.read(); |
| DuyLionTran | 38:64e3e9acb49c | 57 | float voltageRaw = analogReadRaw*3.3; |
| DuyLionTran | 38:64e3e9acb49c | 58 | analogBuffer[analogBufferIndex] = (int)((voltageRaw * 1023.0)/5.0); |
| DuyLionTran | 38:64e3e9acb49c | 59 | printf("Analog read %d %d\r\n", analogBufferIndex, analogBuffer[analogBufferIndex]); |
| DuyLionTran | 36:d0b628087ac8 | 60 | analogBufferIndex++; |
| DuyLionTran | 36:d0b628087ac8 | 61 | if(analogBufferIndex == SCOUNT) { |
| DuyLionTran | 36:d0b628087ac8 | 62 | analogBufferIndex = 0; |
| DuyLionTran | 36:d0b628087ac8 | 63 | } |
| DuyLionTran | 36:d0b628087ac8 | 64 | } |
| DuyLionTran | 36:d0b628087ac8 | 65 | |
| DuyLionTran | 36:d0b628087ac8 | 66 | void SENSOR_GetDOValue() { |
| DuyLionTran | 36:d0b628087ac8 | 67 | for(copyIndex = 0; copyIndex < SCOUNT; copyIndex++) { |
| DuyLionTran | 36:d0b628087ac8 | 68 | analogBufferTemp[copyIndex]= analogBuffer[copyIndex]; |
| DuyLionTran | 36:d0b628087ac8 | 69 | } |
| DuyLionTran | 36:d0b628087ac8 | 70 | /* read the value more stable by the median filtering algorithm */ |
| DuyLionTran | 38:64e3e9acb49c | 71 | averageVoltage = getMedianNum(analogBufferTemp, SCOUNT) * (float)VREF/1024.0; |
| DuyLionTran | 37:338e3bc04e57 | 72 | printf("Average voltage %.2f\r\n", averageVoltage); |
| DuyLionTran | 36:d0b628087ac8 | 73 | /* calculate the do value, doValue = Voltage / SaturationDoVoltage * SaturationDoValue(with temperature compensation) */ |
| DuyLionTran | 39:a5ee98bd0050 | 74 | doValue = (SaturationValueTab[(int)(SaturationDoTemperature + 0.5)] * averageVoltage) / (float)(SaturationDoVoltage); |
| DuyLionTran | 38:64e3e9acb49c | 75 | float a = 1; |
| DuyLionTran | 38:64e3e9acb49c | 76 | printf("SaturationDoVoltage %.2f; DO Value %.2f mg/L\r\n", SaturationDoVoltage, doValue/a); |
| DuyLionTran | 36:d0b628087ac8 | 77 | } |
| DuyLionTran | 32:8226837c56ae | 78 | |
| DuyLionTran | 39:a5ee98bd0050 | 79 | void SENSOR_DoCalibration() { |
| DuyLionTran | 32:8226837c56ae | 80 | |
| DuyLionTran | 38:64e3e9acb49c | 81 | } |
| DuyLionTran | 38:64e3e9acb49c | 82 | |
| DuyLionTran | 38:64e3e9acb49c | 83 | void SENSOR_ReadDoCharacteristicValues() { |
| DuyLionTran | 39:a5ee98bd0050 | 84 | FP_WriteConfigValues(1255); |
| DuyLionTran | 38:64e3e9acb49c | 85 | uint32_t int_SaturationDoVoltage = FP_ReadValue(SAT_DO_VOLT_ADDRESS); |
| DuyLionTran | 38:64e3e9acb49c | 86 | printf("Read SaturationDoVoltage %d\r\n", int_SaturationDoVoltage); |
| DuyLionTran | 38:64e3e9acb49c | 87 | SaturationDoVoltage = (float)int_SaturationDoVoltage; |
| DuyLionTran | 38:64e3e9acb49c | 88 | printf("SaturationDoVoltage %f\r\n", SaturationDoVoltage); |
| DuyLionTran | 38:64e3e9acb49c | 89 | if (FP_ReadValue(SAT_DO_VOLT_ADDRESS) == 0xFF) { |
| DuyLionTran | 38:64e3e9acb49c | 90 | /* default voltage: 1127V */ |
| DuyLionTran | 38:64e3e9acb49c | 91 | SaturationDoVoltage = 1127.6; |
| DuyLionTran | 38:64e3e9acb49c | 92 | int_SaturationDoVoltage = (uint32_t)SaturationDoVoltage; |
| DuyLionTran | 38:64e3e9acb49c | 93 | if ((SaturationDoVoltage - 0.5) >= (float)(int_SaturationDoVoltage)) { |
| DuyLionTran | 38:64e3e9acb49c | 94 | int_SaturationDoVoltage++; |
| DuyLionTran | 38:64e3e9acb49c | 95 | } |
| DuyLionTran | 38:64e3e9acb49c | 96 | printf("SaturationDoVoltage %d\r\n", (uint32_t)int_SaturationDoVoltage); |
| DuyLionTran | 38:64e3e9acb49c | 97 | FP_WriteConfigValues((uint32_t)(int_SaturationDoVoltage)); |
| DuyLionTran | 38:64e3e9acb49c | 98 | } |
| DuyLionTran | 18:5585365d6951 | 99 | } |