Chi Chung Chan / Mbed 2 deprecated LCD_test

Dependencies:   TextLCD mbed

main.cpp

Committer:
cc061495
Date:
2017-05-25
Revision:
1:91fa4b9c427d
Parent:
0:26dc9db5d170
Child:
2:3d6046fdc6b7

File content as of revision 1:91fa4b9c427d:

#include "mbed.h"
#include "TextLCD.h"

TextLCD lcd(PA_0,PA_1,PA_4,PB_0,PC_1,PC_0); // RS, E, D4-D7
Serial pc(PA_9,PA_10);

DigitalOut myled(LED1);
char data[2];
char data1[2];
char data2[2];
char data3[2];
char data4[2];
char data5[2];
char data6[2];
char data7[2];
char data8[2];

int angleCal(char highc, char lowc);
 
int main() {
    pc.baud(115200);
    pc.format(8,SerialBase::None,1);
    //pc.attach(&interrupt,Serial::RxIrq);
    
    
    while(1) {
        if (pc.readable()) {
            pc.gets(data,2);
            
            if(data[0] == 170){
                pc.gets(data1,2); //0xAA
                pc.gets(data2,2);
                pc.gets(data3,2);
                pc.gets(data4,2);
                pc.gets(data5,2);
                pc.gets(data6,2);
                pc.gets(data7,2);
                pc.gets(data8,2); //0x55
                lcd.printf("%d,%d,%d",angleCal(data2[0],data3[0]), angleCal(data4[0],data5[0]), angleCal(data6[0],data7[0]));
            }
        }
        wait(0.5);
        lcd.cls();
    }
}

int angleCal(char highc, char lowc)
{
    int high = highc << 8;
    int low = lowc; 
    int angle = (high + low)/100;
    if(angle > 475)
        angle = 180 + (angle - 476);
    return angle;
}