舵机控制流程图

  • 格式:doc
  • 大小:162.50 KB
  • 文档页数:7

__________________________________________________

__________________________________________________ 常规舵机控制流程图

(无脉冲输入时默认1.5ms脉宽)

舵机电路方框图

MOS MOS

DC马达 通电复位

比较是否一致

输出控制检测检测不一致 一致

MCU

5V稳压IC INPUT 0.5—2.5ms

DC6V

GND 5K电位器

M 电位器减速后

带动电位器柄旋转 __________________________________________________

__________________________________________________

舵机说明

1,电机经过变速(减速)后连接到电位器柄旋转

2,输入脉冲宽度为0.5—2.5ms,周期为 3ms—20ms

(数字舵机的脉冲周期因不同的客户使用的周期不同,常用为10ms;

模拟舵机周期为20ms.)

3,脉冲宽度,表示电位器转动的角度不同(即舵臂角度不同)

4,电机转速为14000/分钟,减速比为250:1,要求舵角转速为0.10-0.2S/60度(此部份与电机转速有关,程序方面需注意及时扫描电位器角度而给电机改变不同供电方式),扫描不及时易出现舵臂回抖现象.

5,脉冲宽度不变的情况下,能锁住电机.

6,堵转4秒钟后,电机进入低压供电(或PWM少占空比)工作模式,堵转一旦去除,电机供电进入正常模式.

程序其它要求(因客户要求不同,需做不同类型的舵机)

1,马达供电PWM(周期或占空比可调)

2,电位器角度识别精度可调(1023分,255分,511分..)

3,舵转动角度可调(-90 +90度)

__________________________________________________

__________________________________________________ 参考电路图:

12344321TitleNumberRevisionSizeBDate:7-Jun-2012 Sheet of

File:E:\TCH WORK\PCB板\舵机.DDBDrawn By:VR15KR1220C4104123J1CON3VDDS11G12S23G24D25D26D17D18U1UD4606GS11G12S23G24D25D26D17D18U2UD4606GVDDVDDVSS1P3.0/SCL2SDA/P3.13VPP/P3.24ADC8/P005ADC9/P016ADC10/P027ADC11/P038ADC12/P049ADC13/P0510ADC14/P0611ADC0/P1012ADC1/P1113ADC2/P1214ADC3/P1315ADC4/P1416ADC5/P1517ADC6/P1618ADC7/P1719VDD20U3SC51P5708SN+C210uin3G1out2U4XC6206-33+C310USinSin3.3V3.3VR3220KR4220KA-+MG1MOTOR SERVOR21KC1104out1out2out3out4out1out2out3out4moter正转10100101反转10101111STOPSTOP0000STOP电机正转电机反转

__________________________________________________

__________________________________________________ 舵机角度及脉冲宽度关系:

__________________________________________________

__________________________________________________ 不良舵机现象:

1,堵转保护

人为堵转电机时,约3秒后电机进入低电流(即低压,占空比少)供电方式,用以降低电机损耗而保护舵机.堵转一旦去除,电机需立即进入正常供电方式.

不良现象:

A,无保护功能

B,堵转去除后电机不能马上进入正常状态

2,马达抖动

轻微外力作用舵臂时,因电位器角度有此而有细微变化(如:0.02度)下,马达转动以校正角度差.

不良现象:

A,马达校正时力度过大在,是出现抖动现象.(如角度差与电机供电时间或PWM没有建立关系;全压供电方式)

__________________________________________________

__________________________________________________

堵转保护流程图

电机供电检测

过载点电压<0.1VDD

计时,A>3秒钟 过载点电压>0.1VDD

更改电机供电PWM占空比为10% 是 常规供电

计时A清零 __________________________________________________

__________________________________________________ 无刷舵机控制流程图

通电

电位器柄角度 SIN1脉宽检测(要求转向角度A SIN2电平检测 电位器柄角度(实际角度)B

0

180度模式 对比要求角度与实际角度,设差值为C=A-B

1 假设角度全值为B(180度)

C>0||C<10,反转,转速PWM 20%

C>10||C<180,反转,转速PWM 100%(全速)

C<0||C>-10,正转,转速PWM 20%

C<-10||C>-180,正转,转速PWM 100%(全速)

360度模式 过载检测

过载计时

t>3S,pwm = 20% 无过载

定义1.5ms脉宽为D , 差值E=A-D

E>0,反转,转速PWM 占空比= E/D*100%,

E<0,正转,转速PWM 占空比= E/D*100%

E=0, 电机停止