zhaoxin5002 发表于 2013-7-18 18:37:40

舵机驱动控制的问题





很奇怪,无法驱动,求大家帮忙看看程序哪有问题

舵机型号:辉盛sg90
接线情况:
信号线---P00
5V--外部稳压电源
GND--外部稳压电源




谢谢大家了。程序挺简单的。在线等
/*-----------------------------------------------
名称:舵机控制       
内容:舵机进行循环左右摇臂动作 20ms周期,高电平时间从0.5ms~2.5ms,最大范围,根据不同舵机调整
------------------------------------------------*/
#include<reg52.h>
#include "delay.h"

sbit OUT = P0^0;//接信号线

unsigned char TH_H,TL_H,TH_L,TL_L;//

/*------------------------------------------------
                  定时器初始化子程序
------------------------------------------------*/
void Init_Timer0(void)
{
TMOD |= 0x01;          //使用模式1,16位定时器,使用"|"符号可以在使用多个定时器时不受影响        TOMD = TOMD | 0X01             
TH0=0x00;              //给定初值,这里使用定时器最大值从0开始计数一直到65535溢出
TL0=0x00;
EA=1;            //总中断打开
ET0=1;         //定时器中断打开
TR0=1;         //定时器开关打开
}
/*------------------------------------------------
               数据处理
------------------------------------------------*/
void DataPro(unsigned int temp)
{
       TH_H=(65536-temp)/256;
   TL_H=(65536-temp)%256;
       TH_L=(46536+temp)/256;
       TL_L=(46536+temp)%256;
}
/*------------------------------------------------
               主程序
------------------------------------------------*/
main()
{
unsigned inttemp=1500;
bit flag=0;
Init_Timer0();
DataPro(temp);

while(1)
   {
   while(!flag){
       if(temp<2300)
      temp+=10;
   else
          flag=1;
       DelayMs(3);
       DataPro(temp);
                  }
       while(flag)
           {
   if(temp>700)
      temp-=10;
   else
      flag=0;
       DelayMs(3);
       DataPro(temp);
                }
   
       }
}

/*------------------------------------------------
               定时器中断子程序
------------------------------------------------*/
void Timer0_isr(void) interrupt 1
{
if(OUT)
{
TH0=TH_L;                  //重新赋值
TL0=TL_L;
}
else
{
TH0=TH_H;                  //重新赋值
TL0=TL_H;
}
OUT=!OUT;
}


zhaoxin5002 发表于 2013-7-18 19:05:47

解决了~~~    供电不足,换1A外部电源就好了
页: [1]
查看完整版本: 舵机驱动控制的问题