valve measurement board
Dependencies: mbed ads1115_test SDFileSystem
main.cpp@40:d02e4dac4bf3, 2021-03-08 (annotated)
- Committer:
- Yamasaki Taro
- Date:
- Mon Mar 08 20:12:40 2021 +0900
- Branch:
- UplinkEnabled
- Revision:
- 40:d02e4dac4bf3
- Parent:
- 39:e5b10a982174
- Child:
- 41:27ebbf39de28
Bug fix (wireless)
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
tanahashi | 0:cb9da8306a40 | 1 | #include "mbed.h" |
Yamasaki Taro | 1:655abe8ab309 | 2 | |
tanahashi | 0:cb9da8306a40 | 3 | #include "SDFileSystem.h" |
tanahashi | 0:cb9da8306a40 | 4 | |
tanahashi | 0:cb9da8306a40 | 5 | #include "Adafruit_ADS1015.h" |
tanahashi | 0:cb9da8306a40 | 6 | |
tanahashi | 0:cb9da8306a40 | 7 | #define ADS1115_ADDR 0b1001000 |
tanahashi | 0:cb9da8306a40 | 8 | |
tanahashi | 0:cb9da8306a40 | 9 | #define TEMP_LSB 0.0625f |
tanahashi | 0:cb9da8306a40 | 10 | |
Yamasaki Taro | 10:de2a9468b344 | 11 | Serial pc(USBTX, USBRX, 115200); |
Yamasaki Taro | 34:8162968f404f | 12 | |
Yamasaki Taro | 2:824e174ef9ea | 13 | Serial wireless(p28,p27); |
tanahashi | 0:cb9da8306a40 | 14 | |
tanahashi | 0:cb9da8306a40 | 15 | I2C i2c(p9, p10); |
tanahashi | 0:cb9da8306a40 | 16 | |
tanahashi | 0:cb9da8306a40 | 17 | Adafruit_ADS1115 ads1115(&i2c, ADS1115_ADDR); |
tanahashi | 0:cb9da8306a40 | 18 | |
tanahashi | 0:cb9da8306a40 | 19 | SDFileSystem sd(p5, p6, p7, p8, "sd"); |
tanahashi | 0:cb9da8306a40 | 20 | |
tanahashi | 0:cb9da8306a40 | 21 | SPI TempK(p5, p6, p7); |
tanahashi | 0:cb9da8306a40 | 22 | |
Yamasaki Taro | 12:8a4212e2642a | 23 | const int Threshold = 114514;//この値は適当。よく考えて決めること!! |
Yamasaki Taro | 12:8a4212e2642a | 24 | |
Yamasaki Taro | 30:cf909d4c6710 | 25 | DigitalInOut valve_controler1(p18, PIN_OUTPUT, OpenDrain, 0); |
Yamasaki Taro | 30:cf909d4c6710 | 26 | DigitalInOut valve_controler2(p19, PIN_OUTPUT, OpenDrain, 0); |
Yamasaki Taro | 12:8a4212e2642a | 27 | |
tanahashi | 0:cb9da8306a40 | 28 | DigitalOut led1(LED1); |
tanahashi | 0:cb9da8306a40 | 29 | |
tanahashi | 0:cb9da8306a40 | 30 | DigitalOut ss1(p19); |
tanahashi | 0:cb9da8306a40 | 31 | DigitalOut ss2(p20); |
tanahashi | 0:cb9da8306a40 | 32 | |
tanahashi | 0:cb9da8306a40 | 33 | Timer timer; |
tanahashi | 0:cb9da8306a40 | 34 | Timer sd_timer; |
tanahashi | 0:cb9da8306a40 | 35 | |
tanahashi | 0:cb9da8306a40 | 36 | FILE *fp; |
tanahashi | 0:cb9da8306a40 | 37 | |
tanahashi | 0:cb9da8306a40 | 38 | char file_name[64]; |
tanahashi | 0:cb9da8306a40 | 39 | |
tanahashi | 0:cb9da8306a40 | 40 | int press_bit1, press_bit2; |
tanahashi | 0:cb9da8306a40 | 41 | float temp1, temp2; |
tanahashi | 0:cb9da8306a40 | 42 | |
Yamasaki Taro | 17:528afcef65e8 | 43 | bool ConfigFlag = false; // for debug |
Yamasaki Taro | 17:528afcef65e8 | 44 | |
Yamasaki Taro | 35:c6457c5ce996 | 45 | bool APLFlug = true; // for valve controler |
Yamasaki Taro | 35:c6457c5ce996 | 46 | |
Yamasaki Taro | 36:a2eadc00dbf8 | 47 | void ValveOC(); // Wireless interruption for open/close valve |
Yamasaki Taro | 36:a2eadc00dbf8 | 48 | |
tanahashi | 0:cb9da8306a40 | 49 | int main() |
tanahashi | 0:cb9da8306a40 | 50 | { |
Yamasaki Taro | 25:389d96280bcf | 51 | timer.start(); |
Yamasaki Taro | 25:389d96280bcf | 52 | wireless.baud(115200); |
Yamasaki Taro | 31:22dcdffbe5c2 | 53 | wireless.attach(ValveOC,Serial::RxIrq); |
Yamasaki Taro | 1:655abe8ab309 | 54 | |
Yamasaki Taro | 25:389d96280bcf | 55 | uint16_t data[2]; |
Yamasaki Taro | 25:389d96280bcf | 56 | ads1115.setGain(GAIN_TWOTHIRDS); |
Yamasaki Taro | 25:389d96280bcf | 57 | TempK.format(16, 0); |
Yamasaki Taro | 25:389d96280bcf | 58 | TempK.frequency(5000000); |
tanahashi | 0:cb9da8306a40 | 59 | |
Yamasaki Taro | 25:389d96280bcf | 60 | char file_name_format[] = "/sd/IZU2020_VALVE_MEASUREMENT_%d.dat"; |
Yamasaki Taro | 25:389d96280bcf | 61 | int file_number = 1; |
Yamasaki Taro | 25:389d96280bcf | 62 | while(1) { |
Yamasaki Taro | 25:389d96280bcf | 63 | sprintf(file_name, file_name_format, file_number); |
Yamasaki Taro | 25:389d96280bcf | 64 | fp = fopen(file_name, "r"); |
Yamasaki Taro | 25:389d96280bcf | 65 | if(fp != NULL) { |
Yamasaki Taro | 25:389d96280bcf | 66 | fclose(fp); |
Yamasaki Taro | 25:389d96280bcf | 67 | file_number++; |
Yamasaki Taro | 25:389d96280bcf | 68 | } else { |
Yamasaki Taro | 25:389d96280bcf | 69 | sprintf(file_name, file_name_format, file_number); |
Yamasaki Taro | 25:389d96280bcf | 70 | break; |
Yamasaki Taro | 25:389d96280bcf | 71 | } |
Yamasaki Taro | 25:389d96280bcf | 72 | } |
Yamasaki Taro | 25:389d96280bcf | 73 | fp = fopen(file_name, "w"); |
Yamasaki Taro | 25:389d96280bcf | 74 | sd_timer.start(); |
tanahashi | 0:cb9da8306a40 | 75 | |
Yamasaki Taro | 25:389d96280bcf | 76 | int dt = 0; |
Yamasaki Taro | 25:389d96280bcf | 77 | while(1) { |
tanahashi | 0:cb9da8306a40 | 78 | |
Yamasaki Taro | 25:389d96280bcf | 79 | press_bit1 = ads1115.readADC_SingleEnded(1); |
Yamasaki Taro | 25:389d96280bcf | 80 | press_bit2 = ads1115.readADC_SingleEnded(3); |
tanahashi | 0:cb9da8306a40 | 81 | |
Yamasaki Taro | 25:389d96280bcf | 82 | ss1 = 0; |
Yamasaki Taro | 25:389d96280bcf | 83 | data[0] = TempK.write(0x00); |
Yamasaki Taro | 25:389d96280bcf | 84 | data[1] = TempK.write(0x00); |
Yamasaki Taro | 25:389d96280bcf | 85 | ss1 = 1; |
Yamasaki Taro | 25:389d96280bcf | 86 | data[0] &= 0xfffc; |
Yamasaki Taro | 25:389d96280bcf | 87 | temp1 = (float)((int16_t)data[0]) * TEMP_LSB; |
tanahashi | 0:cb9da8306a40 | 88 | |
Yamasaki Taro | 25:389d96280bcf | 89 | ss2 = 0; |
Yamasaki Taro | 25:389d96280bcf | 90 | data[0] = TempK.write(0x00); |
Yamasaki Taro | 25:389d96280bcf | 91 | data[1] = TempK.write(0x00); |
Yamasaki Taro | 25:389d96280bcf | 92 | ss2 = 1; |
Yamasaki Taro | 25:389d96280bcf | 93 | data[0] &= 0xfffc; |
Yamasaki Taro | 25:389d96280bcf | 94 | temp2 = (float)((int16_t)data[0]) * TEMP_LSB; |
Yamasaki Taro | 25:389d96280bcf | 95 | |
Yamasaki Taro | 25:389d96280bcf | 96 | // Debug and Config section----------------------------------------------------------------- |
Yamasaki Taro | 38:67754c11cf6f | 97 | if (pc.readable() > 0) |
Yamasaki Taro | 38:67754c11cf6f | 98 | { |
Yamasaki Taro | 25:389d96280bcf | 99 | wireless.putc(pc.getc()); |
Yamasaki Taro | 38:67754c11cf6f | 100 | if(!ConfigFlag) |
Yamasaki Taro | 38:67754c11cf6f | 101 | { |
Yamasaki Taro | 33:427d1bcfea60 | 102 | ConfigFlag = true; |
Yamasaki Taro | 33:427d1bcfea60 | 103 | } |
Yamasaki Taro | 25:389d96280bcf | 104 | } |
Yamasaki Taro | 38:67754c11cf6f | 105 | if(ConfigFlag) |
Yamasaki Taro | 38:67754c11cf6f | 106 | { |
Yamasaki Taro | 38:67754c11cf6f | 107 | while (wireless.readable() > 0) |
Yamasaki Taro | 38:67754c11cf6f | 108 | { |
Yamasaki Taro | 31:22dcdffbe5c2 | 109 | pc.putc(wireless.getc()); |
Yamasaki Taro | 31:22dcdffbe5c2 | 110 | } |
Yamasaki Taro | 25:389d96280bcf | 111 | continue; |
Yamasaki Taro | 13:19fb33032ebb | 112 | } |
Yamasaki Taro | 13:19fb33032ebb | 113 | // ----------------------------------------------------------------------------------------- |
Yamasaki Taro | 25:389d96280bcf | 114 | |
Yamasaki Taro | 25:389d96280bcf | 115 | int time = timer.read_ms(); |
Yamasaki Taro | 38:67754c11cf6f | 116 | if(time - dt >= 100) |
Yamasaki Taro | 38:67754c11cf6f | 117 | { |
Yamasaki Taro | 25:389d96280bcf | 118 | // Debug and Config section----------------------------------------------------------------- |
Yamasaki Taro | 38:67754c11cf6f | 119 | if (pc.readable() == 0 && wireless.readable() == 0) |
Yamasaki Taro | 38:67754c11cf6f | 120 | { |
Yamasaki Taro | 25:389d96280bcf | 121 | pc.printf("%d\t%d\t%d\t%f\t%f\r\n", timer.read_ms(), press_bit1, press_bit2, temp1, temp2); |
Yamasaki Taro | 25:389d96280bcf | 122 | } |
Yamasaki Taro | 25:389d96280bcf | 123 | // ----------------------------------------------------------------------------------------- |
Yamasaki Taro | 25:389d96280bcf | 124 | |
Yamasaki Taro | 40:d02e4dac4bf3 | 125 | wireless.printf("Tank Pressure is %d now.\r\n", press_bit1); |
Yamasaki Taro | 25:389d96280bcf | 126 | dt = time; |
Yamasaki Taro | 25:389d96280bcf | 127 | } |
Yamasaki Taro | 35:c6457c5ce996 | 128 | //valvcontroler auto pressure limitation---------------------------------------------------- |
Yamasaki Taro | 38:67754c11cf6f | 129 | if(APLFlug) |
Yamasaki Taro | 38:67754c11cf6f | 130 | { |
Yamasaki Taro | 38:67754c11cf6f | 131 | if(press_bit1 > Threshold) |
Yamasaki Taro | 38:67754c11cf6f | 132 | { |
Yamasaki Taro | 35:c6457c5ce996 | 133 | valve_controler1 = 1; |
Yamasaki Taro | 35:c6457c5ce996 | 134 | valve_controler2 = 1; |
Yamasaki Taro | 35:c6457c5ce996 | 135 | } |
Yamasaki Taro | 35:c6457c5ce996 | 136 | else{ |
Yamasaki Taro | 35:c6457c5ce996 | 137 | valve_controler1 = 0; |
Yamasaki Taro | 35:c6457c5ce996 | 138 | valve_controler2 = 0; |
Yamasaki Taro | 35:c6457c5ce996 | 139 | } |
Yamasaki Taro | 29:30fdcbbbe79a | 140 | } |
Yamasaki Taro | 38:67754c11cf6f | 141 | else if(!APLFlug) |
Yamasaki Taro | 38:67754c11cf6f | 142 | { |
Yamasaki Taro | 40:d02e4dac4bf3 | 143 | wireless.printf("Auto Pressure Limitation is Disabled.\r\n"); |
Yamasaki Taro | 37:69eaa67338a9 | 144 | } |
Yamasaki Taro | 31:22dcdffbe5c2 | 145 | //------------------------------------------------------------------------------------------ |
Yamasaki Taro | 25:389d96280bcf | 146 | fprintf(fp, "%d\t%d\t%d\t%f\t%f\r\n", time, press_bit1, press_bit2, temp1, temp2); |
Yamasaki Taro | 25:389d96280bcf | 147 | |
Yamasaki Taro | 25:389d96280bcf | 148 | if(sd_timer.read_ms() > 20*1000) { |
Yamasaki Taro | 25:389d96280bcf | 149 | if(fp) { |
Yamasaki Taro | 25:389d96280bcf | 150 | fclose(fp); |
Yamasaki Taro | 25:389d96280bcf | 151 | fp = fopen(file_name, "a"); |
Yamasaki Taro | 25:389d96280bcf | 152 | } |
Yamasaki Taro | 25:389d96280bcf | 153 | } |
Yamasaki Taro | 4:83855f14a087 | 154 | } |
Yamasaki Taro | 1:655abe8ab309 | 155 | } |
Yamasaki Taro | 31:22dcdffbe5c2 | 156 | |
Yamasaki Taro | 31:22dcdffbe5c2 | 157 | void ValveOC() |
Yamasaki Taro | 31:22dcdffbe5c2 | 158 | { |
Yamasaki Taro | 31:22dcdffbe5c2 | 159 | char message = wireless.getc(); |
Yamasaki Taro | 31:22dcdffbe5c2 | 160 | if (message == 'o') |
Yamasaki Taro | 31:22dcdffbe5c2 | 161 | { |
Yamasaki Taro | 31:22dcdffbe5c2 | 162 | valve_controler1 = 1; |
Yamasaki Taro | 31:22dcdffbe5c2 | 163 | valve_controler2 = 1; |
Yamasaki Taro | 35:c6457c5ce996 | 164 | APLFlug = false; |
Yamasaki Taro | 31:22dcdffbe5c2 | 165 | } |
Yamasaki Taro | 31:22dcdffbe5c2 | 166 | else if (message == 'c') |
Yamasaki Taro | 31:22dcdffbe5c2 | 167 | { |
Yamasaki Taro | 31:22dcdffbe5c2 | 168 | valve_controler1 = 0; |
Yamasaki Taro | 31:22dcdffbe5c2 | 169 | valve_controler2 = 0; |
Yamasaki Taro | 35:c6457c5ce996 | 170 | APLFlug = false; |
Yamasaki Taro | 31:22dcdffbe5c2 | 171 | } |
Yamasaki Taro | 38:67754c11cf6f | 172 | else |
Yamasaki Taro | 38:67754c11cf6f | 173 | { |
Yamasaki Taro | 40:d02e4dac4bf3 | 174 | wireless.printf("You send invaild command\r\n"); |
Yamasaki Taro | 38:67754c11cf6f | 175 | } |
Yamasaki Taro | 31:22dcdffbe5c2 | 176 | } |