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.
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;
}