mirror of
https://github.com/esp8266/Arduino.git
synced 2025-06-20 21:01:25 +03:00
Robot Control library to format 1.5 rev.2
This commit is contained in:
45
libraries/Robot_Control/src/helper.cpp
Normal file
45
libraries/Robot_Control/src/helper.cpp
Normal file
@ -0,0 +1,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));
|
||||
}
|
Reference in New Issue
Block a user