舵机驱动代码及舵机控制原理（详解）-葡萄牙世界杯冠军-世界杯几年一次_1994年美国世界杯

一、什么是舵机

我们常说的舵机，它的学名叫做伺服电机，它是一种带有输出轴的小装置。该轴可以通过发送伺服编码信号定位到特定的位置，也就是可以定义角度。只要编码信号存在，伺服电机就会一直保持轴的角度位置。随着编码信号的改变，轴的角度位置也随之改变。实际上，伺服系统在无线电控制的飞机上被用来控制尾舵和船舵。它们也用于无线电控制的汽车、航模等，当然还有机器人。

二、舵机的原理

** 1，标准的舵机有3条导线，分别是：电源线（红色）、地线（黑色或棕色）、控制线（黄色）； 2，其工作原理：PWM信号由接收通道进入信号解调电路进行解调，获得一个直流偏置电压。直流偏置电压与电位器的电压比较，获得电压差并输出。该输出送入电机驱动集成电路以驱动电机正反转。当电机转动时，通过级联减速齿轮带动电位器旋转，直到电压差为O，电机停止转动。舵机的控制信号是PWM信号，利用占空比的变化，改变舵机的位置。 3.舵机的伺服系统由可变宽度的脉冲来进行控制，控制线是用来传送脉冲的。脉冲的参数有最小值，最大值，和频率。一般而言，舵机的基准信号都是周期为20ms，宽度为1.5ms。这个基准信号定义的位置为中间位置。舵机有最大转动角度，中间位置的定义就是从这个位置到最大角度与最小角度的量完全一样。最重要的一点是，不同舵机的最大转动角度可能不相同，但是其中间位置的脉冲宽度是一定的，那就是1.5ms。如下图：角度是由来自控制线的持续的脉冲所产生。这种控制方法叫做脉冲调制。脉冲的长短决定舵机转动多大角度。例如：1.5毫秒脉冲会到转动到中间位置（对于180°舵机来说，就是90°位置）。当控制系统发出指令，让舵机移动到某一位置，并让他保持这个角度，这时外力的影响不会让他角度产生变化，但是这个是由上限的，上限就是他的最大扭力。除非控制系统不停的发出脉冲稳定舵机的角度，舵机的角度不会一直不变。

当舵机接收到一个小于1.5ms的脉冲，输出轴会以中间位置为标准，逆时针旋转一定角度。接收到的脉冲大于1.5ms情况相反。不同品牌，甚至同一品牌的不同舵机，都会有不同的最大值和最小值。一般而言，最小脉冲为1ms，最大脉冲为2ms。如下图： **

三、如何对舵机进行控制

**舵机一般用单片机或者数字电路控制。舵机工作主要跟控制线的高电平持续时间有关系，一般按0.5ms（毫秒）划分，如果持续时间为0.5ms，1ms，1.5ms，2ms，2.5ms时，舵机会转过不同的角度。

舵机的控制一般需要一个20ms左右的时基脉冲，该脉冲的高电平部分一般为0.5ms~2.5ms范围内的角度控制脉冲部分。以180度角度伺服为例，那么对应的控制关系是为：脉冲设置为 0.5ms旋转角度为0度；脉冲设置为 1.0ms旋转角度为45度；脉冲设置为 1.5ms旋转角度为90度；脉冲设置为 2.0ms旋转角度为135度；脉冲设置为 2.5ms旋转角度为180度。舵机的控制一般需要一个20ms左右的时基脉冲，该脉冲的高电平部分一般为0.5ms-2.5ms范围内的角度控制脉冲部分，总间隔为2ms。以180度角度伺服为例，那么对应的控制关系是这样的：

0.5ms--------------0度；

1.0ms------------45度；

1.5ms------------90度；

2.0ms-----------135度；

2.5ms-----------180度；

舵机的追随特性

假设现在舵机稳定在A点，这时候CPU发出一个PWM信号，舵机全速由A点转向B点，在这个过程中需要一段时间，舵机才能运动到B点。

保持时间为Tｗ

当Tｗ≥△T时，舵机能够到达目标，并有剩余时间；

当Tｗ≤△T时，舵机不能到达目标；

理论上：当Tｗ=△T时，系统最连贯，而且舵机运动的最快。

实际过程中ｗ不尽相同，连贯运动时的极限△T比较难以计算出来。

当PWM信号以最小变化量即（1DIV=8us）依次变化时，舵机的分辨率最高，但是速度会减慢。

四、相关舵机的说明

1、 2、 3、SG90舵机 **

五、驱动代码

1、32单片机驱动单个舵机源码

单片机：STM32F103RCT6/STM32F103C8T6 倍频 72M 8路舵机控制

舵机IO PA0~PA3 PB3~PB6

#include "stm32f10x_conf.h"

#define tb_interrupt_open() {__enable_irq();} //总中断打开

void rcc_init(void); //主频设置

void delay_ms(unsigned int t); //毫秒级别延时

void dj_io_init(void); //舵机 IO 口初始化

void dj_io_set(u8 index, u8 level); //舵机 IO 口高低电平设置

void TIM2_Int_Init(u16 arr,u16 psc);//舵机定时器初始化

void gpioA_pin_set(unsigned char pin, unsigned char level);

void gpioB_pin_set(unsigned char pin, unsigned char level);

//舵机脉冲数组

int duoji_pulse[8] = {1500,1500,1500,1500,1500,1500,1500,1500} , i;

int main(void) {

rcc_init();

dj_io_init();

TIM2_Int_Init(20000,71);

tb_interrupt_open();

while(1) {

for(i=0;i<8;i++) {

duoji_pulse[i] = 1000;//循环把8个舵机位置设定到1000

}

delay_ms(1000);

for(i=0;i<8;i++) {

duoji_pulse[i] = 2000;//循环把8个舵机位置设定到2000

}

delay_ms(1000);

}

void rcc_init(void) {

ErrorStatus HSEStartUpStatus;

RCC_DeInit();

RCC_HSEConfig(RCC_HSE_ON);

HSEStartUpStatus = RCC_WaitForHSEStartUp();

while(HSEStartUpStatus == ERROR);

RCC_HCLKConfig(RCC_SYSCLK_Div1);//SYSCLK

RCC_PCLK1Config(RCC_HCLK_Div2);//APB1 MAX = 36M

RCC_PCLK2Config(RCC_HCLK_Div1);//APB2 MAX = 72M

RCC_PLLConfig(RCC_PLLSource_HSE_Div1, RCC_PLLMul_9);

RCC_PLLCmd(ENABLE);

while(RCC_GetFlagStatus(RCC_FLAG_PLLRDY) == RESET);

RCC_SYSCLKConfig(RCC_SYSCLKSource_PLLCLK);

while(RCC_GetSYSCLKSource() != 0x08);

}

void delay_ms(unsigned int t) {

int t1;

while(t--) {

t1 = 7200;

while(t1--);

}

void dj_io_init(void) {

GPIO_InitTypeDef GPIO_InitStructure;

RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA|RCC_APB2Periph_GPIOB, ENABLE);

GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0|GPIO_Pin_1|GPIO_Pin_2|GPIO_Pin_3;

GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;

GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;

GPIO_Init(GPIOA, &GPIO_InitStructure);

GPIO_InitStructure.GPIO_Pin = GPIO_Pin_3|GPIO_Pin_4|GPIO_Pin_5|GPIO_Pin_6 | GPIO_Pin_14;

GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;

GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;

GPIO_Init(GPIOB, &GPIO_InitStructure);

}

void dj_io_set(u8 index, u8 level) {

switch(index) {

case 0:gpioA_pin_set(0, level);break;

case 1:gpioA_pin_set(1, level);break;

case 2:gpioA_pin_set(2, level);break;

case 3:gpioA_pin_set(3, level);break;

case 4:gpioB_pin_set(3, level);break;

case 5:gpioB_pin_set(4, level);break;

case 6:gpioB_pin_set(5, level);break;

case 7:gpioB_pin_set(6, level);break;

default:break;

}

void gpioA_pin_set(unsigned char pin, unsigned char level) {

if(level) {

GPIO_SetBits(GPIOA,1 << pin);

} else {

GPIO_ResetBits(GPIOA,1 << pin);

}

void gpioB_pin_set(unsigned char pin, unsigned char level) {

if(level) {

GPIO_SetBits(GPIOB,1 << pin);

} else {

GPIO_ResetBits(GPIOB,1 << pin);

}

void TIM2_Int_Init(u16 arr,u16 psc) {

TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;

NVIC_InitTypeDef NVIC_InitStructure;

RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE); //①时钟 TIM2 使能

//定时器 TIM2 初始化

TIM_TimeBaseStructure.TIM_Period = arr; //设置自动重装载寄存器周期的值

TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置时钟频率除数的预分频值

TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1; //设置时钟分割

TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //TIM 向上计数

TIM_TimeBaseInit(TIM2, &TIM_TimeBaseStructure); //②初始化 TIM2

TIM_ARRPreloadConfig(TIM2, DISABLE);

TIM_ITConfig(TIM2,TIM_IT_Update,ENABLE ); //③允许更新中断

//中断优先级 NVIC 设置

NVIC_InitStructure.NVIC_IRQChannel = TIM2_IRQn; //TIM2 中断

//NVIC_SetVectorTable(NVIC_VectTab_FLASH,0x0000);

NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1; //先占优先级 0 级

NVIC_InitStructure.NVIC_IRQChannelSubPriority = 2; //从优先级 2 级

NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ 通道被使能

NVIC_Init(&NVIC_InitStructure); //④初始化 NVIC 寄存器

TIM_Cmd(TIM2, ENABLE); //⑤使能 TIM2

}

void TIM2_IRQHandler(void) {

static u8 flag = 0;

static u8 duoji_index1 = 0;

int temp;

if (TIM_GetITStatus(TIM2, TIM_IT_Update) != RESET) //检查 TIM2 更新中断发生与否

{

TIM_ClearITPendingBit(TIM2, TIM_IT_Update ); //清除 TIM2 更新中断标志

if(duoji_index1 == 8) {

duoji_index1 = 0;

}

if(!flag) {

TIM2->ARR = ((unsigned int)(duoji_pulse[duoji_index1]));

dj_io_set(duoji_index1, 1);

} else {

temp = 2500 - (unsigned int)(duoji_pulse[duoji_index1]);

if(temp < 20)temp = 20;

TIM2->ARR = temp;

dj_io_set(duoji_index1, 0);

duoji_index1 ++;

}

flag = !flag;

}

2、51单片机单个舵机控制

注：若学者用的是STC89C51、STC89C52单片机，可以以下面的代码作为参考，通过修改头文件等方式，依然适用

单片机：STC15W4K61S4/IAP15W4K61S4 内部晶振：22.1184

#include "stc15.h"

//舵机 IO 口定义用P0的8个IO测试

sbit dj0 = P0^0;

sbit dj1 = P0^1;

sbit dj2 = P0^2;

sbit dj3 = P0^3;

sbit dj4 = P0^4;

sbit dj5 = P0^5;

sbit dj6 = P0^6;

sbit dj7 = P0^7;

void delay_ms(unsigned int t); //简单的延时

void dj_io_init(void); //舵机 IO 初始化

void dj_io_set(u8 index, u8 level); //舵机 IO 电平设置

void timer1_init(void); //舵机定时器初始化

void timer1_reset(int t_us); //舵机定时器初值重装

//舵机脉冲数组

int duoji_pulse[8] = {1500,1500,1500,1500,1500,1500,1500,1500} , i;

void main(void) {

//IO初始化

dj_io_init();

//舵机定时器初始化

timer1_init();

while (1) {

for(i=0;i<8;i++) {

duoji_pulse[i] = 1000;//循环把8个舵机位置设定到1000

}

delay_ms(1000);

for(i=0;i<8;i++) {

duoji_pulse[i] = 2000;//循环把8个舵机位置设定到2000

}

delay_ms(1000);

}

void dj_io_init(void) {

//设置标准IO

P0M1=0x00;

P0M0=0x00;

}

void dj_io_set(u8 index, u8 level) {

switch(index) {

case 0:dj0 = level;break;

case 1:dj1 = level;break;

case 2:dj2 = level;break;

case 3:dj3 = level;break;

case 4:dj4 = level;break;

case 5:dj5 = level;break;

case 6:dj6 = level;break;

case 7:dj7 = level;break;

default:break;

}

void delay_ms(unsigned int t) {

int t1;

while(t--) {

t1 = 3000;

while(t1--);

}

void timer1_init(void) {

AUXR |= 0x40; //定时器时钟1T模式

TMOD &= 0x0F; //设置定时器模式

TMOD |= 0x10; //设置定时器模式

TL1 = 0x00; //设置定时初值

TH1 = 0x28; //设置定时初值

TF1 = 0; //清除TF1标志

TR1 = 1; //定时器1开始计时

ET1 = 1; //定时器0开始计时

EA = 1; //总开关

}

void timer1_reset(int t_us) {

//本来应该x22.1184 但由于单片机用的内部晶振，有一定误差，调整到下面这个值频率差不多50HZ

TL1 = (int)(65536-20.4184*t_us);

TH1 = (int)(65536-20.4184*t_us) >> 8;

}

void T1_IRQ(void) interrupt 3 {

static volatile u8 flag = 0;

static volatile u8 duoji_index1 = 0;

int temp;

if(duoji_index1 == 8) {

duoji_index1 = 0;

}

if(!flag) {

timer1_reset((unsigned int)(duoji_pulse[duoji_index1]));

dj_io_set(duoji_index1, 1);

} else {

temp = 2500 - (unsigned int)(duoji_pulse[duoji_index1]);

if(temp < 20)temp = 20;

timer1_reset(temp);

dj_io_set(duoji_index1, 0);

duoji_index1 ++;

}

flag = !flag;

}

3、arduino单个舵机控制源码

/*----------------------------------------------------------------------------