1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
|
#include "ArduinoRobot.h"
void RobotControl::drawBase(){
Arduino_LCD::drawCircle(64,80,50,foreGround);
Arduino_LCD::drawLine(64,30,64,20,foreGround);
}
void RobotControl::drawDire(int16_t dire){
static uint8_t x_old;
static uint8_t y_old;
static uint8_t x_t_old;
static uint8_t y_t_old;
uint8_t x=60*sin(dire/360.0*6.28)+64;
uint8_t x_t=40*sin(dire/360.0*6.28)+64;
uint8_t y=60*cos(dire/360.0*6.28)+80;
uint8_t y_t=40*cos(dire/360.0*6.28)+80;
Arduino_LCD::drawLine(x_t_old,y_t_old,x_old,y_old,backGround);
Arduino_LCD::drawLine(x_t,y_t,x,y,RED);
x_old=x;
y_old=y;
x_t_old=x_t;
y_t_old=y_t;
}
void RobotControl::drawCompass(uint16_t value){
drawBase();
drawDire(value);
debugPrint(value,57,76);
}
//display logos
void RobotControl::displayLogos(){
_drawBMP("lg0.bmp",0,0);
delay(2000);
_drawBMP("lg1.bmp",0,0);
delay(2000);
clearScreen();
}
//wait for a button to be pressed
void RobotControl::waitContinue(uint8_t key){
while(!(Robot.keyboardRead()==key));
}
|
