当前位置：文档视界 › 最简单的C程序(STM32版的helloworld)

最简单的C程序(STM32版的helloworld)

51单片机程序：按键控制舵机角度

#include "reg52.h" unsigned char count; //0.5ms次数标识 sbit pwm =P2^7 ; //PWM信号输出 sbit jia =P2^4; //角度增加按键检测IO口 sbit jan =P2^5; //角度减少按键检测IO口 unsigned char jd=5; //角度标识 void delay(unsigned char i)//延时 { unsigned char j,k; for(j=i;j>0;j--) for(k=125;k>0;k--); } void Time0_Init() //定时器初始化 { TMOD = 0x01; //定时器0工作在方式1 IE = 0x82; TH0 = 0xfe; TL0 = 0x33; //11.0592MZ晶振，0.5ms TR0=1; //定时器开始 } void Time0_Int() interrupt 1 //中断程序 { TH0 = 0xfe; //重新赋值 TL0 = 0x33; if(count< jd) //判断0.5ms次数是否小于角度标识 pwm=1; //确实小于，PWM输出高电平 else pwm=0; //大于则输出低电平 count=(count+1); //0.5ms次数加1 count=count%40; //次数始终保持为40 即保持周期为20ms } void keyscan() //按键扫描 { if(jia==0) //角度增加按键是否按下 { delay(10); //按下延时，消抖 if(jia==0) //确实按下 { jd++; //角度标识加1 count=0; //按键按下则20ms周期从新开始 if(jd==6) jd=5; //已经是180度，则保持 while(jia==0); //等待按键放开

舵机工作原理

控制思想该模块的程序框图如图4.5 所示。车模在行驶过程中不断采样赛道信息，并通过分析车模与赛道相对位置判断车模所处赛道路况，是弯道还是直道，弯道时是左转还是右转。直道时小车舵机状态保持不变，弯道时左转或右转，计算转弯半径。我们所用舵机的标准PWM 周期为20ms,转动角度最大为左右90度，PWM调制波如图7.2所示。

当给舵机输入脉宽为0.5ms，即占空比为0.5/20=2.5%的调制波时，舵机右转90度；当给舵机输入脉宽为1.5ms，即占空比为1.5/20=7.5%的调制波时，舵机静止不动；当给舵机输入脉宽为2.5ms，即占空比为2.5/20=12.5%的调制波时，舵机左转90度。可以推导出舵机转动角度与脉冲宽度的关系计算公式为：注：其中t为正脉冲宽度（ms）；θ为转动角度；当左转时取加法计算，右转时取减法计算结果。当我们根据赛道弯度计算出转动角度以后便可以根据舵机的参数计算出脉冲宽度，控制舵机转动，舵机转角与PWM脉宽关系如表4-1所示。

在具体操作中PWM调制波的周期可以设置在20ms左右一定范围内，比如设置为10ms 或是30ms均可以使舵机正常转动，但是设置周期较长时，系统延迟时间较多，舵机转向会出现滞后，导致赛车冲出跑道；设置周期如果过短，系统输出PWM 调制波不稳定，舵机转动也会受影响，不能实现赛车的精确转向。经过反复测试，最终把输出PWM 调制波周期设定为13ms (用计数器实现)。运行电机的转速以及舵机的转角，在软件上都是通过对PWM 波占空比进行设置来相应控制的。前面提到，舵机转角控制需要将两个

八位寄存器合成为一个十六位寄存器。程序中的舵机位置信号，当PWM调制波周期设为13ms时，因为总线频率为24MHz,用时钟SB，可计算得到16进制参数为9870H，舵机中间位置时占空比16进制参数为1680H，要分配给PWM6和7，分配时这2个端口的赋值必须是16进制，那么PWM模块初始化赋值为 PWMPER6= 0x98，PWMPER7= 0x70，PWMDTY6= 0x16，PWMDTY7= 0x80，因此这就牵涉到如何将1个十进制数分配为2个十六进制数问题。有2种方案，一种是除法取余，另一种是移位操作，前者编译生成的代码比后者要多，所以采用移位操作来实现，即取高位时与0xFF00先作“&”计算，然后将所得到的数向右移8位（>>8），即可取得高8位；同理，取低8位时只要与0x00FF作“&”计算即可（算法）。 2、结构和控制一般来讲，舵机主要由以下几个部分组成，舵盘、减速齿轮组、位置反馈电位计5k、直流电机、控制电路板等。工作原理：控制电路板接受来自信号线的控制信号（具体信号待会再讲），控制电机转动，电机带动一系列齿轮组，减速后传动至输出舵盘。舵机的输出轴和位置反馈电位计是相连的，舵盘转动的同时，带动位置反馈电位计，电位计将输出一个电压信号到控制电路板，进行反馈，然后控制电路板根据所在位置决定电机的转动方向和速度，从而达到目标停止。

舵机控制程序

舵机控制程序 Final revision on November 26, 2020

在机器人机电控制系统中，舵机控制效果是性能的重要影响因素。舵机可以在微机电系统和航模中作为基本的输出执行机构，其简单的控制和输出使得单片机系统非常容易与之接口。舵机是一种位置伺服的驱动器，适用于那些需要角度不断变化并可以保持的控制系统。其工作原理是：控制信号由接收机的通道进入信号调制芯片，

获得直流偏置电压。它内部有一个基准电路，产生周期为20ms，宽度为的基准信号，将获得的直流偏置电压与电位器的电压比较，获得电压差输出。最后，电压差的正负输出到电机驱动芯片决定电机的正反转。当电机转速一定时，通过级联减速齿轮带动电位器旋转，使得电压差为0，电机停止转动。舵机的控制信号是PWM信

号，利用占空比的变化改变舵机的位置。一般舵机的控制要求如图1所示。图1 舵机的控制要求单片机实现舵机转角控制可以使用FPGA、模拟电路、单片机来产生舵机的控制信号，但FPGA成本高且电路复杂。对于脉宽调制信号的脉宽变换，常用的一种方法是采用调制信号获取有源滤波后的直流电压，但是需要50Hz(周期是20ms)的信号，这对运放器件的选择有较高要求，从电路体积和功耗考虑也不易采用。5mV 以上的控制电压的变化就会引起舵机的抖动，对于机载的测控系统而言，电源和其他器件的信号噪声都

远大于5mV，所以滤波电路的精度难以达到舵机的控制精度要求。也可以用单片机作为舵机的控制单元，使PWM信号的脉冲宽度实现微秒级的变化，从而提高舵机的转角精度。单片机完成控制算法，再将计算结果转化为PWM信号输出到舵机，由于单片机系统是一个数字系统，其控制信号的变化完全依靠硬件计数，所以受外界干扰较小，整个系统工作可靠。单片机系统实现对舵机输出转角的控制，必须首先完成两个任务：首先是产生基本的PWM周期信号，本设计是产生20ms的周期信号；其次是脉宽的调整，即单片机模拟PWM信号的输出，并且调整占空比。当系统中只需要实现一个舵机的控制，采用的控制方式是改变单片机的一个定时器中断的初值，将20ms分为两次中断执行，一次短定时中断和一次长定时中断。这样既节省了硬件电路，也减少了软件开销，控制系统工作效率和控制精度都很高。具体的设计过程：例如想让舵机转向左极限的角度，它的正脉冲为2ms，则负脉冲为20ms- 2ms=18ms，所以开始时在控制口发送高电平，然后

单片机程序按键控制舵机角度

TH0 = 0xfe; //重新赋值 TL0 = 0x33; if(count< jd) //判断0.5ms次数是否小于角度标识 pwm=1; //确实小于，PWM输出高电平 else pwm=0; //大于则输出低电平 count=(count+1); //0.5ms次数加1 count=count%40; //次数始终保持为40 即保持周期为20ms } void keyscan() //按键扫描 { if(jia==0) //角度增加按键是否按下 { delay(10); //按下延时，消抖 if(jia==0) //确实按下 { jd++; //角度标识加1 count=0; //按键按下则20ms周期从新开始 if(jd==6) jd=5; //已经是180度，则保持 while(jia==0); //等待按键放开 }

舵机控制程序

获得直流偏置电压。它内部有一个基准电路，产生周期为20ms，宽度为1.5ms的基准信号，将获得的直流偏置电压与电位器的电压比较，获得电压差输出。最后，电压差的正负输出到电机驱动芯片决定电机的正反转。当电机转速一定时，通过级联减速齿轮带动电位器旋转，使得电压差为0，电机停止转动。舵机的控制信号是PWM信号，利用占

空比的变化改变舵机的位置。一般舵机的控制要求如图1所示。图1 舵机的控制要求单片机实现舵机转角控制可以使用FPGA、模拟电路、单片机来产生舵机的控制信号，但FPGA成本高且电路复杂。对于脉宽调制信号的脉宽变换，常用的一种方法是采用调制信号获取有源滤波后的直流电压，但是需要50Hz(周期是20ms)的信号，这对运放器件的选择有较高要求，从电路体积和功耗考虑也不易采用。5mV 以上的控制电压的变化就会引起舵机的抖动，对于机载的测控系统而言，电源和其他器件的信号噪声都远大于5mV，所以滤波

电路的精度难以达到舵机的控制精度要求。也可以用单片机作为舵机的控制单元，使PWM信号的脉冲宽度实现微秒级的变化，从而提高舵机的转角精度。单片机完成控制算法，再将计算结果转化为PWM信号输出到舵机，由于单片机系统是一个数字系统，其控制信号的变化完全依靠硬件计数，所以受外界干扰较小，整个系统工作可靠。单片机系统实现对舵机输出转角的控制，必须首先完成两个任务：首先是产生基本的PWM周期信号，本设计是产生20ms的周期信号；其次是脉宽的调整，即单片机模拟PWM信号的输出，并且调整占空比。当系统中只需要实现一个舵机的控制，采用的控制方式是改变单片机的一个定时器中断的初值，将20ms分为两次中断执行，一次短定时中断和一次长定时中断。这样既节省了硬件电路，也减少了软件开销，控制系统工作效率和控制精度都很高。具体的设计过程：例如想让舵机转向左极限的角度，它的正脉冲为2ms，则负脉冲为 20ms-2ms=18ms，所以开始时在控制口发送高电平，然后设置定时器在

51控制舵机程序大全

#include void InitTimer0(void) { TMOD = 0x01; TH0 = 0x0B1; TL0 = 0x0E0; EA = 1; ET0 = 1; TR0 = 1; }void delay(1)(void) { unsigned char a,b,c; for(c=1;c>0;c--) for(b=142;b>0;b--) for(a=2;a>0;a--); } void main(void) { InitTimer0(); P1_2=0; while(1); } void Timer0Interrupt(void) interrupt 1 { //20ms中断 TH0 = 0x0B1; TL0 = 0x0E0; P1_2=1; delay(1); P1_2=0; }

#include #include #include #define uchar unsigned char #define uint unsigned int sbit IN1=P0^0; sbit IN2=P0^1; sbit EA1=P0^5; sbitdj=P0^7; //舵机口 uint t=0;//中断次数 ucharzk;//高电平中断次数uchar p=0;//定义pwm占空比void delay(uint z) { uinti,j; for(i=0;i>8;//100us一次中断TL0=-100%256; if(t==0)zk=p; if(t=zk) dj=0; t++; if(t>=200) t=0;//20mspwm周期 } void turn_left() { IN1=1;IN2=0;EA1=1;//电机工作p=5;//0.5ms delay(600); } void turn_right() { IN1=1;IN2=0;EA1=1;//电机工作p=25;//2.5ms delay(600);

舵机控制C程序

舵机控制C程序 #include #defineucharunsignedchar #defineuintunsignedint /* 变量定义 */ ucharkey_stime_counter,hight_votage=15,timeT_counter; bitkey_stime_ok; /* 引脚定义 */ sbitcontrol_signal=P0^0; sbitturn_left=P3^4; sbitturn_right=P3^5; /***************************************************************** 名称：定时器0初始化功能：20ms定时,11.0592M晶振初值20ms 初值0.1ms *****************************************************************/ voidTimerInit() { control_signal=0; TMOD=0x01;//设置定时器0为工作方式1 EA=1;//开总中断 ET0=1;//定时器0中断允许 TH0=0xFF;//定时器装初值 TL0=0xA3; TR0=1;//启动定时器0 } /********************************************** 定时器0中断服务函数 ***********************************************/ voidtimer0(void)interrupt1using0 { TH0=0xFF; TL0=0xA3;//定时器0重新装入数值