大季 矢花
/
MainBoard2019_LineHub11-7
aa
Diff: main.cpp
- Revision:
- 0:0311bb0b38f7
- Child:
- 1:fe3f80c4beeb
diff -r 000000000000 -r 0311bb0b38f7 main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Mon Sep 09 00:16:13 2019 +0000 @@ -0,0 +1,222 @@ +#include "mbed.h" +#include "RingBuffer.h" +#include "SO1602A.h" + +//********** pin define **********// +#define SELECT1_0 PB_4 +#define SELECT1_1 PB_5 +#define SELECT1_2 PB_3 +#define SELECT1_3 PB_1 +#define SELECT2_0 PF_0 +#define SELECT2_1 PF_1 +#define SELECT2_2 PA_8 +#define SELECT2_3 PA_11 +#define SELECT3_0 PA_4 +#define SELECT3_1 PA_5 +#define SELECT3_2 PA_7 +#define SELECT3_3 PA_6 +#define Z0 PA_0 +#define Z1 PA_1 +#define Z2 PA_3 +#define SDA PB_7 +#define SCL PB_6 +#define UART_SE PA_2 +#define UARTTX PA_9 +#define UARTRX PA_10 +//********** pin define **********// + +//********** pin select **********// +AnalogIn y1(Z0); +AnalogIn y2(Z1); +AnalogIn y3(Z2); + +DigitalOut select1[]= { + DigitalOut(SELECT1_0), + DigitalOut(SELECT1_1), + DigitalOut(SELECT1_2), + DigitalOut(SELECT1_3), +}; +DigitalOut select2[]= { + DigitalOut(SELECT2_0), + DigitalOut(SELECT2_1), + DigitalOut(SELECT2_2), + DigitalOut(SELECT2_3), +}; +DigitalOut select3[]= { + DigitalOut(SELECT3_0), + DigitalOut(SELECT3_1), + DigitalOut(SELECT3_2), + DigitalOut(SELECT3_3), +}; + +DigitalOut uartSE(UART_SE); + +DigitalOut LED(LED3); + +//Serial uart(USBTX,USBRX); +Serial uart(UARTTX,UARTRX); + +I2C i2c(SDA,SCL); +SO1602A oled(i2c,0x78); +//********** pin select **********// + +//********** define **********// +#define BUFFER_SIZE 10 +char RS485Data[BUFFER_SIZE]; +RINGBUFFER::RingBuffer RS485uart(RS485Data,BUFFER_SIZE); + +#define SENDDATA_SIZE 8 +#define SENSORDATA_SIZE 48 + +const int pinDef[48] = { 0, 1, 2, 3, 4, 5, + 12,13,14,15, 7, 6, + 22,23, 8, 9,10,11, + 16,17,18,19,20,21, + 27,26,25,24,40,41, + 28,29,30,31,38,39, + 32,33,34,35,36,37, + 42,43,44,45,36,47}; + +const int weight[6] = { 2, 1, 0, 0,-1,-2}; + +char send[SENDDATA_SIZE] = {60,77,80,55,65,68,90,87}; +bool line[SENSORDATA_SIZE] = {0}; + +void Transmit(); +void PinSelect(int pin); +void SendDataUpdate(char sendData[], int dataSize); +void LineDataRead(bool sensorData[], int dataSize); +void SendDataMake(bool sensorData[], char sendData[]); +//********** define **********// + +void InitiaLize(void) +{ + uartSE = 1; //送信固定 + + uart.baud(9600); + uart.attach(Transmit,Serial::TxIrq); +} + +int main(void) +{ + InitiaLize(); + + while(1) + { + LineDataRead(line,SENSORDATA_SIZE); + SendDataMake(line,send); + SendDataUpdate(send,SENDDATA_SIZE); + } +} + +void Transmit() { + __disable_irq(); + //uart.printf("%d\n\r",RS485uart.GetData()); + uart.putc(RS485uart.GetData()); + __enable_irq(); + +} + +void SendDataUpdate(char sendData[], int dataSize) { + __disable_irq(); + if(!RS485uart.InAnyData()) { + RS485uart.PutData('S'); + for(int i = 0; i < dataSize; i++) { + RS485uart.PutData(sendData[i]); + } + RS485uart.PutData('F'); + } + __enable_irq(); +} + +void PinSelect(int pin) { + bool selectnum[16][4]= { + {0,0,0,0}, + {0,0,0,1}, + {0,0,1,0}, + {0,0,1,1}, + {0,1,0,0}, + {0,1,0,1}, + {0,1,1,0}, + {0,1,1,1}, + {1,0,0,0}, + {1,0,0,1}, + {1,0,1,0}, + {1,0,1,1}, + {1,1,0,0}, + {1,1,0,1}, + {1,1,1,0}, + {1,1,1,1}, + }; + if(pin < 16) { + select1[0]=selectnum[pin][3]; + select1[1]=selectnum[pin][2]; + select1[2]=selectnum[pin][1]; + select1[3]=selectnum[pin][0]; + for(int i=0; i<=3; i++) { + select2[i]=0; + select3[i]=0; + } + } else if(pin < 32) { + select2[0]=selectnum[pin-16][3]; + select2[1]=selectnum[pin-16][2]; + select2[2]=selectnum[pin-16][1]; + select2[3]=selectnum[pin-16][0]; + for(int i=0; i<=3; i++) { + select1[i]=0; + select3[i]=0; + } + } else if(pin < 48) { + select3[0]=selectnum[pin-32][3]; + select3[1]=selectnum[pin-32][2]; + select3[2]=selectnum[pin-32][1]; + select3[3]=selectnum[pin-32][0]; + for(int i=0; i<=3; i++) { + select1[i]=0; + select2[i]=0; + } + } +} + +void LineDataRead(bool sensorData[], int dataSize) { + int pin; + int readData = 0; + for(int i = 0; i < dataSize; i++) { + pin = pinDef[i]; + PinSelect(pin); + if(pin<=15) { + readData = y1.read(); + } else if(pin<=31) { + readData = y2.read(); + } else if(pin<=47) { + readData = y3.read(); + } + if(readData < 0.8f) { + sensorData[i] = 0; + } else { + sensorData[i] = 1; + } + + } +} + +void SendDataMake(bool sensorData[], char sendData[]) { + int data = 0; + bool ACflag = true; + bool NCflag = true; + int count = 0; + for(int i = 0; i < 8; i++) { + NCflag = true; + ACflag = true; + data = 0; + for(int j = 0; j < 6; j++) { + data += (!sensorData[count]) * weight[j]; + if(sensorData[count] == 1) ACflag = false; + else if(sensorData[count] == 0) NCflag = false; + count++; + } + if(NCflag) sendData[i] = 'N'; + else if(ACflag) sendData[i] = 'A'; + else sendData[i] = data; + } +} \ No newline at end of file