找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 3301|回复: 0
打印 上一主题 下一主题
收起左侧

根据转速大小来改变舵机转多少度,求老铁帮助

[复制链接]
跳转到指定楼层
楼主
ID:191403 发表于 2017-8-2 15:45 | 只看该作者 回帖奖励 |正序浏览 |阅读模式
#include <reg51.H>
#include <intrins.h>
#define uint unsigned int
#define uchar unsigned char         //宏定义
/*-----------------------端口命名------------------------*/
sbit rs=P1^2;       //LCD的数据/命令选择端
sbit rw=P1^1;       //LCD的读写选择端
sbit e=P1^0;      //LCD的使能信号端  
sbit c=P3^2;       //c测速电机信号端
//舵机参数
unsigned char count,count1;
sbit pwm=P3^0;
sbit jia =P3^7;           //角度增加按键检测IO口
sbit jan =P3^6;           //角度减少按键检测IO口
uchar jd;
/*-------------------------------------------------------*/
/*-----------------------定义参数------------------------*/
uint i,z,zhuan,msec;     //定义参数
uchar display[]={" speed=    r/min "};     //定义显示参数
/*-------------------------------------------------------*/
/*-----------------------毫秒延时------------------------*/
void delay(uint ms)
{  
uint i,j;      //为延时引入i,j两参数  
for (j=0;j<ms;j++)     //延时第一循环   
for (i=0;i<120;i++);    //延时第二循环  
}
/*-------------------------------------------------------*/
/*--------------------向LCD1602写命令--------------------*/
void write_command(uchar command)
{
rs=0;       //数据、命令选择端0为命令
rw=0;       //读、写选择端0为写
P2=command;      //向LCD写命令
delay(5);      //稍做延迟,代替检测忙状态  
e=1;      //信号使能端高电平
delay(5);      //稍做延迟,代替检测忙状态  
e=0;      //信号使能端低电平
}
/*-------------------------------------------------------*/
/*--------------------向LCD1602写数据--------------------*/
void write_data(uchar data0)
{
rs=1;       //数据、命令选择端 1为数据
rw=0;       //读、写选择端0为写
P2=data0;      //向LCD写数据
delay(5);      //稍做延迟,代替检测忙状态
e=1;      //信号使能端高电平
delay(5);     //稍做延迟,代替检测忙状态
e=0;      //信号使能端低电平
}
/*-------------------------------------------------------*/
/*-------------------外部中断0计数程序-------------------*/
void counter(void) interrupt 0
{   
EX1=0;       //关外部中断1  
count1++;  
if(count1==2)      //2次循环为发动机转一圈  
{   
count1=1;     //初始化计数   
     z++;      //转圈计数加1
  }      //计数+1  
  EX1=1;       //开外部中断1  
     return;
}
/*-------------------------------------------------------*/
/*------------------------LCD显示------------------------*/
void displaytolcd()
{  
  write_command(0x80);     //向LCD1602写命令80H  
  for (i=0;i<sizeof(display)-1;i++)   //循环要传输的字符个数次,每一次传一个字符  
{   
    write_data(display[i]);   
      delay(5);  
  }
} /*-------------------------------------------------------*/  
/*-----------------内部中断0计时计数程序-----------------*/
void Timer_0(void) interrupt 1
{  
   TH0=0x65;      //50ms定时  
   TL0=0xF3;  
   msec++;  
   if(msec==20)      //50*20=1S  
{   
     displaytolcd();   
     msec=0;   
     zhuan=30*z;   
     z=0;  
}
}
/*-------------------------------------------------------*/
/*----------------------端口初始化-----------------------*/
void int_all()
{  
z=0;       //初始化z的值  
count=0;      //初始化count的值
count1=0;
zhuan=0;      //初始化转的值  
rw=0;       //选择LCD写数据指令  
delay(15);      //延时15ms  
write_command(0x38);     //向LCD1602写命令38H  
delay(5);      //延时5ms  
write_command(0x0e);     //向LCD1602写命令0EH  
delay(5);      //延时5ms  
write_command(0x06);     //向LCD1602写命令06H
TMOD=0x11;      //内部中断定时器选择  
TH0=0x66;      //50ms定时  
TL0=0x50;
TH1=0xfc;
TL1=0x99;   
EA=1;       //开中断总开关  
ET0=1;       //开内部中断0
TR0=1;       //计时器0开始工作
ET1=1;       //开内部中断1
TR1=1;       //计时器1开始工作
IT0=1;       //外部中断0为下降沿触发  
EX0=1;       //开外部中断0
}
/*-------------------------------------------------------*/
/*-----------------------数据处理------------------------*/
void  disp_count()
{  
display[7]=(zhuan/1000+'0');    //转换转速的千位  
display[8]=(zhuan/100%10+'0');    //转换转速的百位  
display[9]=(zhuan/10%10+'0');    //转换转速的十位   
display[10]=(zhuan%10+'0');    //转换转速的个位
}
void Time1_Int() interrupt 3
{
        TH1=0xfe;
        TL1=0x33;
        if(count<jd)
                pwm=1;
        else
        pwm=0;
        count=(count+1);
        count=count%40;
}
void keyscan()              //按键扫描
{
if(zhuan>1500)
   {jia=0;  
      jd++;                 //角度标识加1
      count=0;              //按键按下 则20ms周期从新开始
      if(jd==6)jd=5; //已经是180度,则保持
     // while(jia==0);        //等待按键放开
     }

else if(zhuan<1000)
  {
      jan=0;  
      jd--;                 //角度标识减1
      count=0;
      if(jd==0)jd=1;  //已经是0度,则保持
     // while(jan==0);
     }

}
/*-------------------------------------------------------*/
/*------------------------主函数-------------------------*/
void main()
{  
       
   int_all();     //全局初始化  

   while(1)  
  {
   keyscan();
   disp_count();     //数据处理
   displaytolcd();     //LCD显示  

  }
}

当转速大于1500,舵机左转90度;转速在1000-1500之间,舵机归中;当转速小于1000,舵机右转90度
分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏 分享淘帖 顶 踩
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表