亚洲春色中文字幕久久久-三上亚,一吻二脱三床四吻胸,国产真实伦对白视频全集,在线毛片观看,精品成品入口黄网,国产毛aⅴ片久久久,亚洲AV色香蕉一区二区三区老师,萧皇后A级艳片,色情日本视频更新,99久久亚洲精品日本无码
標(biāo)題:
單片機(jī)WiFi小車(chē)源程序
[打印本頁(yè)]
作者:
wangchunpo
時(shí)間:
2017-4-25 10:37
標(biāo)題:
單片機(jī)WiFi小車(chē)源程序
單片機(jī)WiFi小車(chē)源程序
0.png
(53.95 KB, 下載次數(shù): 70)
下載附件
2017-4-26 03:25 上傳
#include<reg52.h>
#include<math.h>
#include<intrins.h>
#define uchar unsigned char
#define uint unsigned int
P0M1=0X00;
P0M0=0XFF;//設(shè)置P0 為強(qiáng)推挽輸出
uchar Buffer =0; //從串口接收的數(shù)據(jù)
uint URTAReceivedCount=0,n=1;
uchar data Tempdatatable[5],CommandDatatable[5];//數(shù)據(jù)包
uchar serVal[2];
uint pwm[]={1120,1190,1382,1382,1382,1382,1382,500}; //初始90度,(實(shí)際是1382.4,取整得1382)
uchar pwm_flag=0;
uint code ms0_5Con=461; //0.5ms計(jì)數(shù) (實(shí)際是460.8,取整得461)461
uint code ms2_5Con=2304; //2.5ms計(jì)數(shù)2304
bit key_stime_ok;
sbit StatusLight=P2^0; //狀態(tài)燈
sbit MainLight=P2^1; //主大燈
sbit servo0=P0^0; //舵機(jī)控制
sbit servo1=P0^1;
sbit servo2=P0^2;
sbit servo3=P0^3;
sbit servo4=P0^4;
sbit servo5=P0^5;
sbit servo6=P0^6;
sbit servo7=P0^7;
sbit P1_0=P1^0;
sbit P1_1=P1^1;
sbit P1_2=P1^2;
sbit P1_3=P1^3;
/********************************************************************
* 名稱(chēng) : Delay_1ms()
* 功能 : 延時(shí)子程序,延時(shí)時(shí)間為 1ms * x
* 輸入 : x (延時(shí)一毫秒的個(gè)數(shù))
* 輸出 : 無(wú)
***********************************************************************/
void Delay_1ms(uint i)//1ms延時(shí)
{
uint x,j;//uchar x,j;
for(j=0;j<i;j++)
for(x=0;x<=148;x++);
}
void TurnOnStatusLight()
{
StatusLight=0;
}
/********************************************************************
* 名稱(chēng) : Send_Data()
* 功能 : 向上位機(jī)傳送字符
* 輸入 : 無(wú)
* 輸出 : 無(wú)
***********************************************************************/
void Send_Data(uchar type,uchar cmd,uchar dat)
{
uchar data Buffer[5];//構(gòu)建數(shù)據(jù)包
uchar *p;
uint Send_Count=0;
p = Buffer;
Buffer[0]=0XFF;
Buffer[1]=type;
Buffer[2]=cmd;
Buffer[3]=dat;
Buffer[4]=0XFF;
while(1)
{
if(*p==0XFF)
{
Send_Count++; //0XFF標(biāo)志統(tǒng)計(jì)位
}
SBUF = *p; //發(fā)送
while(!TI) //如果發(fā)送完畢,硬件會(huì)置位TI,等待發(fā)送完畢
{
_nop_();
}
p++;
TI = 0;
if(Send_Count == 2) //當(dāng)統(tǒng)計(jì)到兩次出現(xiàn)0XFF,則認(rèn)為一個(gè)數(shù)據(jù)包發(fā)送完畢,跳出循環(huán)
{
TI = 0;
break;
}
}
}
/********************************************************************
協(xié)議規(guī)定:
包頭 類(lèi)型位 數(shù)據(jù)位 數(shù)據(jù)位 結(jié)束位
0XFF 0X** OX** 0X** 0XFF
各命令說(shuō)明:
類(lèi)型位 數(shù)據(jù)位 數(shù)據(jù)位 功能
0X00 0X02 0X00 前進(jìn)
0X00 0X01 0X00 后退
0X00 0X03 0X00 左轉(zhuǎn)
0X00 0X04 0X00 右轉(zhuǎn)
0X00 0X00 0X00 停止
0X01 0X01 角度 舵機(jī)1
0X01 0X02 . 舵機(jī)2
0X01 0X01 . 舵機(jī)3
0X01 0X02 . 舵機(jī)4
0X01 0X01 . 舵機(jī)5
0X01 0X02 . 舵機(jī)6
0X01 0X01 . 舵機(jī)7
0X01 0X02 數(shù)據(jù) 舵機(jī)8
0X02 0X01 車(chē)燈亮
0X02 0X02 車(chē)燈滅
0X03 雷達(dá)數(shù)據(jù) 發(fā)送雷達(dá)數(shù)據(jù)
***********************************************************************/
/********************************************************************
* 名稱(chēng) : Com_Int()
* 功能 : 串口中斷子函數(shù)
***********************************************************************/
void Com_Int(void) interrupt 4
{
uchar temp;
ES=0; //關(guān)串口中斷
RI=0; //軟件清除接收中斷
temp=SBUF;
if(temp==0XFF && URTAReceivedCount<3)
{
Tempdatatable[0]==0XFF; //包頭
URTAReceivedCount++;
}
else
{
Tempdatatable[n]=temp;
n++;
if(URTAReceivedCount==0&&n==2)
n=1;
}
if(URTAReceivedCount==2)//包尾
{
Tempdatatable[0]=0XFF;
Tempdatatable[4]=0XFF;
n=1;
URTAReceivedCount=0; //組包完畢
temp="";
// Send_Data(Tempdatatable[1],Tempdatatable[2],Tempdatatable[3]); //發(fā)送組成的數(shù)據(jù)包回去
}
CommandDatatable[0]=Tempdatatable[0];
CommandDatatable[1]=Tempdatatable[1];
CommandDatatable[2]=Tempdatatable[2];
CommandDatatable[3]=Tempdatatable[3];
CommandDatatable[4]=Tempdatatable[4];
ES=1;//開(kāi)串口中斷
}
/********************************************************************
* 名稱(chēng) : Com_Init()
* 功能 : 串口初始化,晶振11.0592,波特率9600,使能了串口中斷
***********************************************************************/
void Com_Init(void)
{
TMOD = 0x21;
PCON = 0x00;
SCON = 0x50;
TH1 = 0xFd; //設(shè)置波特率 9600
TL1 = 0xFd;
TR1 = 1; //啟動(dòng)定時(shí)器1
ES = 1; //開(kāi)串口中斷
EA = 1; //開(kāi)總中斷
IT0=0;
EX0=1;
}
/********************************************************************
* 名稱(chēng) :Moto_Forward()
* 功能 : 電機(jī)1、2啟動(dòng),都是前進(jìn),整車(chē)表現(xiàn)為前進(jìn)。
***********************************************************************/
void Moto_Forward()
{
P1_0=0;
P1_1=1;
P1_2=1;
P1_3=0;
Delay_1ms(100);
}
/********************************************************************
* 名稱(chēng) :Moto_Backward()
* 功能 : 電機(jī)1、2啟動(dòng),都是后退,整車(chē)表現(xiàn)為后退。
***********************************************************************/
void Moto_Backward()
{
P1_0=1;
P1_1=0;
P1_2=0;
P1_3=1;
Delay_1ms(100);
}
/********************************************************************
* 名稱(chēng) :Moto_TurnLeft()
* 功能 : 前輪左轉(zhuǎn),后輪停止,整車(chē)表現(xiàn)為左轉(zhuǎn)。
***********************************************************************/
void Moto_TurnLeft()
{
P1_0=1;
P1_1=0;
P1_2=1;
P1_3=0;
Delay_1ms(100);
}
/********************************************************************
* 名稱(chēng) :Moto_TurnRight()
* 功能 : 前輪右轉(zhuǎn),后輪停止,整車(chē)表現(xiàn)為右轉(zhuǎn)。
***********************************************************************/
void Moto_TurnRight()
{
P1_0=0;
P1_1=1;
P1_2=0;
P1_3=1;
Delay_1ms(100);
}
/********************************************************************
* 名稱(chēng) :Moto_L_F()
* 功能 : 前輪左轉(zhuǎn),后輪前進(jìn),整車(chē)表現(xiàn)為左前。
***********************************************************************/
void Moto_L_F()
{
P1_0=0;
P1_1=1;
Delay_1ms(100);
}
/********************************************************************
* 名稱(chēng) :Moto_R_F()
* 功能 : 前輪右轉(zhuǎn),后輪前進(jìn),整車(chē)右前
***********************************************************************/
void Moto_R_F()
{
P1_2=1;
P1_3=0;
Delay_1ms(100);
}
/********************************************************************
* 名稱(chēng) :Moto_L_B()
* 功能 :前輪左轉(zhuǎn),后輪后退,整車(chē)左后
***********************************************************************/
void Moto_L_B()
{
P1_0=1;
P1_1=0;
Delay_1ms(100);
}
/********************************************************************
* 名稱(chēng) :Moto_R_B()
* 功能 : 前輪右轉(zhuǎn),后輪后退,整車(chē)右后
***********************************************************************/
void Moto_R_B()
{
P1_2=0;
P1_3=1;
Delay_1ms(100);
}
/********************************************************************
* 名稱(chēng) :Moto_Stop()
* 功能 : 電機(jī)1停止,電機(jī)2停止,整車(chē)表現(xiàn)為停止。
***********************************************************************/
void Moto_Stop()
{
P1_0=1;
P1_1=1;
P1_2=1;
P1_3=1;
Delay_1ms(100);
}
/********************************************************************
* 功能 : 舵機(jī)PWM中斷初始化
***********************************************************************/
void Timer0Init()
{
/*0度=0.5ms, 45度=1ms, 90度=1.5ms, 135度=2ms, 180度=2.5ms
/.5 ms初始值 F700, (12n/11059200=2.5/1000, n=2304, X=65536-2304=63232 > F700)*/
TMOD |= 0x01; //使用模式1,16位定時(shí)器,使用"|"符號(hào)可以在使用多個(gè)定時(shí)器時(shí)不受影響
TH0=-ms2_5Con>>8; //給定初值,17ms中斷
TL0=-ms2_5Con;
EA=1; //總中斷打開(kāi)
ET0=1; //定時(shí)器0中斷打開(kāi)
TR0=1; //定時(shí)器0開(kāi)關(guān)打開(kāi)
}
/********************************************************************
* 功能 : 舵機(jī)PWM中斷, //舵機(jī)控制函數(shù) 周期為20ms 一個(gè)循環(huán)20MS = 8*2.5ms
***********************************************************************/
void SteeringGear() interrupt 1
{
switch(pwm_flag)
{
case 1: servo0=1; TH0=-pwm[0]>>8; TL0=-pwm[0]; break;
case 2: servo0=0; TH0=-(ms2_5Con-pwm[0])>>8; TL0=-(ms2_5Con-pwm[0]); break;
case 3: servo1=1; TH0=-pwm[1]>>8; TL0=-pwm[1]; break;
case 4: servo1=0; TH0=-(ms2_5Con-pwm[1])>>8; TL0=-(ms2_5Con-pwm[1]); break;
case 5: servo2=1; TH0=-pwm[2]>>8; TL0=-pwm[2]; break;
case 6: servo2=0; TH0=-(ms2_5Con-pwm[2])>>8; TL0=-(ms2_5Con-pwm[2]); break;
case 7: servo3=1; TH0=-pwm[3]>>8; TL0=-pwm[3]; break;
case 8: servo3=0; TH0=-(ms2_5Con-pwm[3])>>8; TL0=-(ms2_5Con-pwm[3]); break;
case 9: servo4=1; TH0=-pwm[4]>>8; TL0=-pwm[4]; break;
case 10: servo4=0; TH0=-(ms2_5Con-pwm[4])>>8; TL0=-(ms2_5Con-pwm[4]); break;
case 11: servo5=1; TH0=-pwm[5]>>8; TL0=-pwm[5]; break;
case 12: servo5=0; TH0=-(ms2_5Con-pwm[5])>>8; TL0=-(ms2_5Con-pwm[5]); break;
case 13: servo6=1;TH0=-pwm[6]>>8; TL0=-pwm[6]; break;
case 14: servo6=0;TH0=-(ms2_5Con-pwm[6])>>8; TL0=-(ms2_5Con-pwm[6]); break;
case 15: servo7=1;TH0=-pwm[7]>>8; TL0=-pwm[7]; break;
case 16: servo7=0;TH0=-(ms2_5Con-pwm[7])>>8; TL0=-(ms2_5Con-pwm[7]); break;
default: TH0=0xff; TL0=0x80; pwm_flag=0;
}
pwm_flag++;
}
void SetSteeringGear(uchar i, uchar val)
{
uint a = (val+46)*10;
if(a<ms0_5Con)
a=ms0_5Con;
if(a>ms2_5Con)
a=ms2_5Con;
pwm[i]=a;
CommandDatatable[2]=0xff; //清除緩存
}
/********************************************************************
* 功能 : 串口中斷接收數(shù)據(jù)
***********************************************************************/
/*********************************************************************************
** 函數(shù)功能 : 主函數(shù)
*********************************************************************************/
void main()
{
MainLight=0;
Delay_1ms(6000);
Com_Init();//串口初始化
Timer0Init();//舵機(jī)PWM中斷初始化
while(1)
{
if(CommandDatatable[0]==0XFF && CommandDatatable[4]==0XFF)
{
switch (CommandDatatable[1]) //根據(jù)鍵值不同,執(zhí)行不同的內(nèi)容
{
case 0X00: //類(lèi)型位0X00,表明是控制數(shù)據(jù)包,進(jìn)入控制數(shù)據(jù)case
switch(CommandDatatable[2]) //根據(jù)數(shù)據(jù)位的值來(lái)進(jìn)行選擇執(zhí)行不同的動(dòng)作
{
case 0X00:Moto_Stop();break;
case 0X01:Moto_Forward();break;
case 0X02:Moto_Backward();break;
case 0X03:Moto_TurnLeft();break;
case 0X04:Moto_TurnRight();break;
case 0X05:Moto_R_F();break;
case 0X06:Moto_L_F();break;
case 0X07:Moto_R_B();break;
case 0X08:M0to_L_B();break;
default : break;
}
break;
case 0X01: //類(lèi)型位0X01,表明是舵機(jī)數(shù)據(jù)包,進(jìn)入舵機(jī)case
switch(CommandDatatable[2])
{
case 0x01:SetSteeringGear(0,CommandDatatable[3]);break;
case 0x02:SetSteeringGear(1,CommandDatatable[3]);break;
case 0x03:SetSteeringGear(2,CommandDatatable[3]);break;
case 0x04:SetSteeringGear(3,CommandDatatable[3]);break;
case 0x05:SetSteeringGear(4,CommandDatatable[3]);break;
case 0x06:SetSteeringGear(5,CommandDatatable[3]);break;
case 0x07:SetSteeringGear(6,CommandDatatable[3]);break;
case 0x08:SetSteeringGear(7,CommandDatatable[3]);break;
default : break;
}
break;
case 0X02: //類(lèi)型位0X02,表明是大燈數(shù)據(jù)包,進(jìn)入大燈case
switch(CommandDatatable[2])
…………限于本文篇幅 余下代碼請(qǐng)從51黑下載附件…………
復(fù)制代碼
下載:
51版wifi小車(chē)程序.rar
(3.46 KB, 下載次數(shù): 44)
2017-4-25 10:36 上傳
點(diǎn)擊文件名下載附件
下載積分: 黑幣 -5
作者:
gjf
時(shí)間:
2019-3-25 21:47
謝謝分享
歡迎光臨 (http://www.denmoz.com/bbs/)
Powered by Discuz! X3.1