久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 1026|回復(fù): 0
打印 上一主題 下一主題
收起左側(cè)

51單片機(jī)循跡小車代碼部分

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
ID:1128116 發(fā)表于 2024-7-4 13:23 | 只看該作者 回帖獎(jiǎng)勵(lì) |倒序?yàn)g覽 |閱讀模式
主邏輯需要自己改寫
#include <reg52.h>
#include <intrins.h>
typedef unsigned int u16;
typedef unsigned char u8;
int  a=0;
sbit ENA = P1^6;
sbit IN1 = P1^0;
sbit IN2 = P1^1;
sbit IN3 = P1^2;
sbit IN4 = P1^3;
sbit ENB = P1^4;

void Timer0Init();
void XunJi();
void delay(unsigned int t);
sbit zuo1 = P0^0;
sbit zuo2 = P0^1;
sbit zhong = P0^2;
sbit you1 = P0^3;
sbit you2 = P0^4;



u8 PWMCnt1 = 0;
u8 PWMCnt2 = 0;
u8 cntPWM1 = 0;
u8 cntPWM2 = 0;



void main()
{
        Timer0Init();
        while(1)
        {
                XunJi();
        }        
}

void Timer0Init()
{
        TH0 = 0xFF;
        TL0 = 0xA3;
        TMOD &= 0xF0;
        TMOD |= 0x01;
        EA = 1;
        ET0 = 1;
        TR0 = 1;
}
void TurnRight1()     
{
        IN1 = 0;  
        IN2 = 1;
        
        IN3 = 0;   
        IN4 = 1;
        cntPWM1 = 70;
        cntPWM2        = 55;
}

void TurnRight2()   
{
        IN1 = 0;  
        IN2 = 1;

        IN3 = 0;  
        IN4 = 1;
        cntPWM1 = 50;
        cntPWM2        = 40;
}

void TurnLeft1()   
{
        IN1 = 1;
        IN2 = 0;   

        IN3 = 1;
        IN4 = 0;   
        cntPWM1 = 55;
        cntPWM2        = 70;
}                                 

void TurnLeft2()   
{
        IN1 = 1;
        IN2 = 0;

        IN3 = 1;
        IN4 = 0;  
        cntPWM1 = 40;
        cntPWM2        = 50;
}        
        
void Forward()   
{
        IN1 = 1;
        IN2 = 0;

        IN3 = 0;  
        IN4 = 1;

        cntPWM1 = 42;
        cntPWM2        = 54;
}

void Backward()
{
        IN1 = 0;        
        IN2 = 1;

        IN3 = 1;  
        IN4 = 0;        
        cntPWM1 = 30;
        cntPWM2        = 30;
}

void Stop()   
{
        IN1 = 0;
        IN2 = 0;
        IN3 = 0;
        IN4 = 0;
}
void XunJi()

{
        unsigned char flag = 0;


        if((zuo1 == 0)&&(zuo2 == 0)&&(zhong == 1)&&(you2 == 0)&&(you1 == 0))   //0 0 1 0 0
                flag = 0;
if((zuo1 == 0)&&(zuo2 == 0)&&(zhong == 0)&&(you2 == 0)&&(you1 == 0))   //0 0 0 0 0
                flag = 6;

//        if((zuo1 == 0)&&(zuo2 == 1)&&(zhong == 1)&&(you2 == 1)&&(you1 == 0))   //0 1 1 1 0
//                flag = 0;
//
////        if((zuo1== 1)&&(zuo2 == 1)&&(zhong == 1)&&(you2 == 1)&&(you1 == 1))    //1 1 1 1 1
////        {a=a+1;}
////        if(zuo1== 1)
////        {a=0;}
//
//        if((zuo1 == 1)&&(zuo2 == 1)&&(zhong == 1)&&(you2 == 0)&&(you1 == 0))   //1 1 1 0 0
//                flag = 1;
//
//        if((zuo1 == 0)&&(zuo2 == 0)&&(zhong == 1)&&(you2 == 1)&&(you1 == 0))   //0 0 1 1 0
//                flag = 2;
//
//        if((zuo1 == 0)&&(zuo2 == 0)&&(zhong == 1)&&(you2 == 0)&&(you1 == 1))   //0 0 1 0 1
//                flag = 2;
//
//        if((zuo1 == 0)&&(zuo2 == 1)&&(zhong == 1)&&(you2 == 1)&&(you1 == 1))   //0 1 1 1 1
//                flag = 3;
//        
//        if((zuo1 == 0)&&(zuo2 == 0)&&(zhong == 1)&&(you2 == 1)&&(you1 == 1))    //0 0 1 1 1
//                flag = 3;
//        
//        if((zuo1 == 0)&&(zuo2 == 1)&&(zhong == 1)&&(you2 == 0)&&(you1 == 0))   //0 1 1 0 0
//                flag = 4;
//        
//        if((zuo1 == 1)&&(zuo2 == 0)&&(zhong == 1)&&(you2 == 0)&&(you1 == 0))   //1 0 1 0 0
//                flag = 4;
//        
//        if((zuo1 == 0)&&(zuo2 == 0)&&(zhong == 0)&&(you2 == 0)&&(you1 == 0))   //1 0 1 0 1
//                flag = 0 ;
//        
//        if((zuo1 == 1)&&(zuo2 == 1)&&(zhong == 1)&&(you2 == 0)&&(you1 == 1))   //1 1 1 0 1
//                flag = 1;
//        
//        if((zuo1 == 1)&&(zuo2 == 0)&&(zhong == 1)&&(you2 == 1)&&(you1 == 1))   //1 0 1 1 1
//                flag = 3;

//        if((zuo1 == 1)&&(zuo2 == 1)&&(zhong == 0)&&(you2 == 0)&&(you1 == 0))   //1 1 0 0 0
//                flag = 2;
//
//        if((zuo1 == 0)&&(zuo2 == 0)&&(zhong == 0)&&(you2 == 1)&&(you1 == 1))   //0 0 0 1 1
//                flag = 4;
//        
//        if((zuo1 == 0)&&(zuo2 == 0)&&(zhong == 0)&&(you2 == 0)&&(you1 == 0))   //0 0 0 0 0
//                flag = 5;
        
        switch(flag)
        
{while(1)
                case 0:Forward();break;//Ö±ÐÐ
                case 1:TurnLeft1();break;//×ó¿ì
                case 2:TurnLeft2();break;//×óÂý
                case 3:TurnRight1();break;//ÓÒ¿ì
                case 4:TurnRight2();break;//ÓÒÂý
                case 5:Backward();break;//»ØÍË
                case 6:Stop();break;
                default:Stop();break;
        }
}


void delay(unsigned int t)//ÑÓ
        {
    while(t--);
}

void InterruptTime0() interrupt 1
{
        PWMCnt1++;
        PWMCnt2++;
        
        if(PWMCnt1  >= 200)
        {
                PWMCnt1 = 0;
        }
        if(PWMCnt1 <= cntPWM1)
        {
                ENA = 1;
        }
        else
        {
                ENA = 0;
        }

        if(PWMCnt2 >= 200)
        {
                PWMCnt2 = 0;
        }
        if(PWMCnt2 <= cntPWM2)
        {
                ENB = 1;
        }
        else
        {
                ENB = 0;
        }

        TH0 = (65536 - 50)/256;
        TL0 = (65536 - 50)%256;
}


分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏 分享淘帖 頂頂 踩踩
回復(fù)

使用道具 舉報(bào)

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規(guī)則

手機(jī)版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術(shù)交流QQ群281945664

Powered by 單片機(jī)教程網(wǎng)

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板： 午夜精品久久 | 蜜桃精品视频在线 | 99国内精品久久久久久久 | 97精品国产 | 成人亚洲 | 蜜桃在线一区二区三区 | 99视频在线免费观看 | 国产精品入口麻豆www | 国产精品一区二区无线 | av永久免费| 啪啪免费网 | 国产欧美一区二区精品久导航 | 亚洲国产精品第一区二区 | 暖暖成人免费视频 | 亚洲精品888| 精品国产欧美 | 在线观看国产 | 日韩欧美国产一区二区三区 | 一区二区三区精品视频 | 在线免费黄色小视频 | 亚洲精品国产电影 | 精品成人69xx.xyz| 久久久久久女 | 色噜噜狠狠色综合中国 | 国产乱码精品一品二品 | 国产精品一区二区在线 | 岛国二区 | 国产精品永久久久久 | 国产精品视频网站 | 爱综合| 中文字幕一区在线观看视频 | 在线观看深夜视频 | 一区免费| av网站在线播放 | 一级毛片,一级毛片 | 最新免费av网站 | 国产精品久久久久久久久久三级 | 日日日干干干 | 久热久热| 欧美日韩在线一区二区三区 | 99精品久久久|