#include "U8glib.h"
#include <Servo.h>
Servo myservo;
U8GLIB_SSD1306_128X64 u8g(U8G_I2C_OPT_NONE | U8G_I2C_OPT_DEV_0); // I2C / TWI
#define word1W 16 //定義第一個漢字的寬度
#define word1H 16 //定義第一個漢字的高度
#define word2W 16 //定義第二個漢字的寬度
#define word2H 16 //定義第二個漢字的高度
const int TrigPin = 2;
const int EchoPin = 3;
int a = 5;
int b = 6;
int c = 9;
int d = 10;
float cm;
//第一個漢字的編碼
static unsigned char word1[] U8G_PROGMEM = {
0x00, 0x00, 0xBE, 0x7F, 0xA2, 0x00, 0xA2, 0x00, 0xA2, 0x00, 0xBE, 0x3F, 0x88, 0x20, 0x88, 0x20,
0xBA, 0x20, 0x8A, 0x20, 0x8A, 0x3F, 0x8A, 0x00, 0xBA, 0x00, 0x87, 0x00, 0x80, 0x7F, 0x00, 0x00
};
//第二個漢字的編碼
static unsigned char word2[] U8G_PROGMEM = {
0x40, 0x00, 0x80, 0x00, 0xFF, 0x7F, 0x00, 0x00, 0x28, 0x0A, 0xC8, 0x09, 0x28, 0x0A, 0xF8, 0x0F,
0x80, 0x00, 0xFE, 0x3F, 0x42, 0x20, 0x22, 0x22, 0xF2, 0x27, 0x22, 0x24, 0x02, 0x28, 0x02, 0x10
};
//繪畫第一個漢字的子程序
void word1draw(void)
{
u8g.drawXBMP( 0, 0, word1W, word1H, word1); //x坐標0，y坐標0,寬度，高度，編碼word1
}
//繪畫第二個漢字的子程序
void word2draw(void)
{
u8g.drawXBMP( 18, 0, word2W, word2H, word2); //x坐標18，y坐標0,寬度，高度，編碼word2
}
void chao(){
digitalWrite(TrigPin, LOW); //低高低電平發(fā)一個短時間脈沖去TrigPin
delayMicroseconds(2); // delayMicroseconds在更小的時間內(nèi)延時準確
digitalWrite(TrigPin, HIGH);
delayMicroseconds(10);
digitalWrite(TrigPin, LOW); //通過這里控制超聲波的發(fā)射
cm = pulseIn(EchoPin, HIGH) / 58.0; //將回波時間換算成cm
cm = (int(cm * 100.0)) / 100.0; //保留兩位小數(shù)
Serial.print("Distance:");
Serial.print(cm);
Serial.print("cm");
Serial.println();
delay(50); }
void qian() {
Serial.write("qian");
digitalWrite(a, HIGH );
digitalWrite(b, LOW);
digitalWrite(c, HIGH);
digitalWrite(d, LOW);
}
void qianzuo() {
Serial.write("qianzuo");
digitalWrite(a, LOW );
digitalWrite(b, LOW);
digitalWrite(c, HIGH);
digitalWrite(d, LOW);
}
void qianyou() {
Serial.write("QIANyou");
digitalWrite(a, HIGH );
digitalWrite(b, LOW);
digitalWrite(c, LOW);
digitalWrite(d, LOW);
}
void ting() {
Serial.println("BT is ready!");
// 返回到手機調(diào)試程序上
Serial.write("TING");
digitalWrite(a, LOW);
digitalWrite(b, LOW);
digitalWrite(c, LOW);
digitalWrite(d, LOW);
}
void hou() {
Serial.write("hou");
analogWrite(a, 0);
analogWrite(b, 120);
analogWrite(c, 0);
analogWrite(d, 120);
}
void houzuo() {
Serial.write("houzuo");
analogWrite(a, 80);
analogWrite(b, 150);
analogWrite(c, 0);
analogWrite(d, 150);
}
void houyou() {
Serial.write("houyou");
analogWrite(a, 0 );
analogWrite(b, 150);
analogWrite(c, 80);
analogWrite(d, 150);
}
void xian(){
u8g.firstPage();
do
{chao();
word1draw();//調(diào)用繪畫第一個漢字的子程序顯示漢字
word2draw();//調(diào)用繪畫第二個漢字的子程序顯示漢字
u8g.setFont(u8g_font_fub30);//設(shè)置字體和自號，目前測試字號有fub14,17,20,30,49n
u8g.setPrintPos(0, 50); //顯示的位置
u8g.print(cm);//顯,k示變量val的值
u8g.setFont(u8g_font_fub14);//設(shè)置字體和自號，目前測試字號有fub14,17,20,30
u8g.setPrintPos(95, 50); //顯示的位置
u8g.print("cm");//顯示單位
}
while ( u8g.nextPage() );
delay(50);
}
void setup(void)
{ Serial.begin(38400);
pinMode(TrigPin, OUTPUT);
pinMode(EchoPin, INPUT);
pinMode(a, OUTPUT);
pinMode(b, OUTPUT);
pinMode(c, OUTPUT);
pinMode(d, OUTPUT);
myservo.attach(11);
}
void zhuan()//原地轉(zhuǎn)彎
{ analogWrite(a, 120);
analogWrite(b, 0);
analogWrite(c, 0);
analogWrite(d, 120);
}
void bizhang() {
digitalWrite(a, LOW);
digitalWrite(b, HIGH);
digitalWrite(c, LOW);
digitalWrite(d, HIGH);
delay(200);
digitalWrite(a, LOW);
digitalWrite(b, LOW);
digitalWrite(c, LOW);
digitalWrite(d, LOW);
return;
}
void loop(void)
{ chao();
xian();
int x;
int dis[3];
qian();
myservo.write(90);
dis[1] =cm;
if (dis[1] < 30)
{ ting();
for (x = 90; x <= 180; x += 1)
{
myservo.write(x);
delay(15);}
chao();
xian();
dis[2] =cm;
for (x = 180; x >= 0; x -= 1)
{
myservo.write(x);
delay(15);
if (x == 90)
dis[1] =cm;
}
chao();
xian();
dis[0] =cm;
for (x = 0; x <= 90; x += 1)
{ myservo.write(x);
delay(15);
}
if (dis[0] <dis[2])
{qianzuo();
delay(250);}
if (dis[0] >= dis[2])
{qianyou();
delay(250);}
}
}
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
