51單片機舵機驅動程序

ID:334683 · 發表于 2018-5-21 10:17

51單片機舵機驅動。測試可用

單片機源程序如下:

#include<reg52.h>
#define uchar unsigned char
#define uint unsigned int
sbit pwm=P1^1; //pwm信號輸出
sbit K1=P1^3; //模式一按鍵
sbit K2=P1^4; //模式二按鍵
sbit K3=P1^5; //模式三按鍵
sbit K4=P1^6; //模式四按鍵
sbit LEDx1=P2^0;
sbit LEDx2=P2^1;
sbit LEDx3=P2^2;
sbit LEDx4=P2^3;
sbit LEDx5=P2^4;
sbit LEDx6=P2^5;
sbit LEDx7=P2^6;
sbit LEDx8=P2^7;
sbit LEDx9=P3^1;
sbit LEDx10=P3^2;
sbit LEDx11=P3^3;
sbit LEDx12=P3^4;
sbit LEDx13=P3^5;
sbit LEDx14=P3^6;
sbit LEDx15=P3^7;
uchar count=0; //次數標識
uchar jd=120; //角度標識
/*=========
ms延時函數
===========*/
void delay(uint x)
{
uchar i,j;
for(i=x;i>0;i--)
for(j=115;j>0;j--);
}
/*==============
定時器初始化函數
================*/
void Timer0_init()
{
TMOD |= 0X01; //定時器工作方式1
TH0=(65536-10)/256; //裝初值
TL0=(65536-10)%256;
EA=1; //開總中斷
ET0=1; //開定時器0中斷
TR0=1; //啟動定時器
}
/*======
中斷函數
========*/
void Timer0() interrupt 1
{
TH0=(65536-10)/256; //初值
TL0=(65536-10)%256;
if(count<jd) //判斷次數是否小于角度標識
pwm=1; //是，pwm輸出高電平
else
pwm=0; //否，pwm輸出低電平
count++; //次數加1
}
/*===========
紅外掃描函數
=============*/
void LEDscan()
{
//======== X軸為1 ============
if(LEDx1==0)
{
jd=200;
delay(10);
//jd=120;
//delay(5);
}
//======== X軸為2 ============
if(LEDx2==0)
{
jd=189;
delay(5);
}
//======== X軸為3 ============
if(LEDx3==0)
{
jd=177;
delay(5);
}
//======== X軸為4 ============
if(LEDx4==0)
{
jd=166;
delay(5);
}
//======== X軸為5 ============
if(LEDx5==0)
{
jd=154;
delay(5);
}
//======== X軸為6 ============
if(LEDx6==0)
{
jd=143;
delay(5);
}
//======== X軸為7 ============
if(LEDx7==0)
{
jd=131;
delay(5);
}
//======== X軸為8 ============
if(LEDx8==0)
{
jd=120;
delay(5);
}
//======== X軸為9 ============
if(LEDx9==0)
{
jd=110;
delay(5);
}
//======== X軸為10 ============
if(LEDx10==0)
{
jd=100;
delay(5);
}
//======== X軸為11 ============
if(LEDx11==0)
{
jd=90;
delay(5);
}
//======== X軸為12 ============
if(LEDx12==0)
{
jd=80;
delay(5);
}
//======== X軸為13 ============
if(LEDx13==0)
{
jd=70;
delay(1);
}
//======== X軸為14 ============
if(LEDx14==0)
{
jd=60;
delay(1);
}
//======== X軸為15 ============
if(LEDx15==0)
{
jd=50;
delay(1);
}
}
/*===========
按鍵掃描函數
=============*/
void KEYscan()
{
if(K1==0)
{
delay(10);
LEDscan();
delay(10);
jd=60;
delay(5);
if(LEDx1==0)
{
jd=50;
delay(5);
}
if(LEDx2==0)
{
jd=70;
delay(5);
}
if(LEDx3==0)
{
jd=120;
delay(5);
}
if(LEDx4==0)
{
jd=100;
delay(5);
}
if(LEDx5==0)
{
jd=90;
delay(5);
}
if(LEDx6==0)
{
jd=80;
delay(5);
}
if(LEDx7==0)
{
jd=70;
delay(5);
}
while(LEDx3==0 && LEDx2==1 && LEDx4==1);
delay(1000);
}
if(K2==0)
{
jd=200;
LEDscan();
}
if(K3==0)
{
jd=200;
delay(1);
if(LEDx2==0)
{
jd=165;
delay(5);
}
if(LEDx3==0)
{
jd=154;
delay(5);
}
if(LEDx4==0)
{
jd=143;
delay(5);
}
if(LEDx5==0)
{
jd=135;
delay(5);
}
if(LEDx6==0)
{
jd=110;
delay(5);
}
if(LEDx7==0)
{
jd=131;
delay(5);
}
if(LEDx8==0)
{
jd=120;
delay(5);
}
if(LEDx9==0)
{
jd=112;
delay(5);
}
if(LEDx10==0)
{
jd=103;
delay(5);
}
if(LEDx11==0)
{
jd=95;
delay(5);
}
if(LEDx12==0)
{
jd=85;
delay(5);
}
while(LEDx8==0 && LEDx7==1 && LEDx9==1);
delay(3000);
LEDscan();
}
if(K4==0)
{
jd=200;
delay(5);
LEDscan();
delay(100);
jd=200;
delay(5);
if(LEDx9==0)
{
jd=80;
delay(5);
}
if(LEDx10==0)
{
jd=110;
delay(5);
}
if(LEDx11==0)
{
jd=133;
delay(5);
}
if(LEDx12==0)
{
jd=130;
delay(5);
}
if(LEDx13==0)
{
jd=120;
delay(5);
}
if(LEDx14==0)
{
jd=100;
delay(5);
}
if(LEDx15==0)
{
jd=80;
delay(5);
}
while(LEDx13==0&& LEDx14==1 && LEDx12==1);
delay(1000);
}
}
/*=====
主函數
=======*/
void main()
{
Timer0_init();
while(1)
{
LEDscan();
KEYscan();
}
}

復制代碼

所有資料51hei提供下載:

舵機1.zip (32.87 KB, 下載次數: 23)

ID:335855 · 發表于 2018-5-22 18:33

請問這個舵機控制電路是啥啊

帳號		自動登錄	找回密碼
密碼			立即注冊

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

51單片機舵機驅動程序