最近几年国内机器人开始起步发展,很多高校、中小学都开始进行机器人技术教学。小型的机器人、模块化的机器人、组件式的机器人是教学机器人的首选。在这些机器人产品中,舵机是很关键,使用较多的部件。根据控制方式,舵机应该称为微型伺服马达。早期在模型上使用最多,主要用于控制模型的舵面,所以俗称舵机。舵机接受一个简单的控制指令就可以自动转动到一个比较精确的角度,所以非常适合在关节型机器人产品使用。 1.舵机的结构舵机简单的说就是集成了直流电机、电机控制器和减速器等,并封装在一个便于安装的外壳里的伺服单元。能够利用简单的输入信号比较精确的转动给定角度的电机系统。舵机安装了一个电位器(或其它角度传感器)检测输出轴转动角度,控制板根据电位器的信息能比较精确的控制和保持输出轴的角度。这样的直流电机控制方式叫闭环控制,所以舵机更准确的说是伺服马达,英文servo。 转速由舵机无负载的情况下转过60°角所需时间来衡量,常见舵机的速度一般在0.11s/60°-0.21s/60°之间。 - F( @0 L P {/ _) v3 t 舵机扭矩舵机扭矩的单位是KG·CM,这是一个扭矩单位。可以理解为在舵盘上距舵机轴中心水平距离1CM处,舵机能够带动的物体重量。 工作电压 厂商提供的速度、转矩数据和测试电压有关,在4.8V和6V两种测试电压下这两个参数有比较大的差别。如MG995在4.8V时速度为0.17秒,在6.0V时速度为0.13秒。舵机的工作电压对性能有重大的影响,舵机推荐的电压一般都是4.8V或6V。当然,有的舵机可以在7V以上工作,比如12V的舵机也不少。具体更加较高的电压可以提高电机的速度和扭矩。选择舵机还需要看我们的控制板所能提供的电压。 尺寸重量和材质舵机的功率(速度×转矩)和舵机的尺寸比值可以理解为该舵机的功率密度,一般同样品牌的舵机,功率密度大的价格高。塑料齿轮的舵机在超出极限负荷的条件下使用可能会崩齿,金属齿轮的舵机则可能会电机过热损毁或外壳变形。所以材质的选择并没有绝对的倾向,关键是将舵机使用在设计规格之内。用户一般都对金属制的物品比较信赖,齿轮箱期望选择全金属的,舵盘期望选择金属舵盘。但需要注意的是,金属齿轮箱在长时间过载下也不会损毁,最后却是电机过热损坏或外壳变形,而这样的损坏是致命的,不可修复的。塑料出轴的舵机如果使用金属舵盘是很危险的,舵盘和舵机轴在相互扭转过程中,金属舵盘不会磨损,舵机轴会在一段时间后变得光秃,导致舵机完全不能使用。综上,选择舵机需要在计算自己所需扭矩和速度,并确定使用电压的条件下,选择有150%左右甚至更大扭矩富余的舵机。 3.舵机的工作原理舵机是一个微型的伺服控制系统,具体的控制原理可以用下图表示: 舵机的控制一般需要一个20ms的时基脉冲,该脉冲的高电平部分一般为0.5ms~2.5ms范围内的角度控制脉冲部分。以180度角度舵机为例,那么对应的控制关系是这样的: 0.5ms--------------0度;6 q: j9 W7 B" u, v% u9 Q1.0ms------------45度; 1.5ms------------90度; 2.0ms-----------135度; 2.5ms-----------180度; 如下图所示: 需要解释的是舵机原来主要用在飞机、汽车、船只模型上,作为方向舵的调节和控制装置。所以,一般的转动范围是45°、60°或者90°,这时候脉冲宽变一般只有1ms-2ms之间(比如你做一个遥控小车,用舵机控制方向,那么舵机转的角度肯定不是180度,对吧。因为你见过你开的车方向能转180度吗?)。而后舵机开始在机器人上得到大幅度的运用,转动的角度也在根据机器人关节的需要增加到-90°至90°之间,甚至还有-135°至135°之间,脉冲宽度也随之有了变化。对于机器人控制而言,我们一般通过单片机产生PWM信号控制舵机。 4.STM32控制舵机代码0.5ms---------0度0.6ms---------9度: G8 k, f/ ]0 e$ g 0.7ms---------18度 0.8ms---------27度 0.9ms---------36度 1.0ms---------45度 1.1ms---------54度 1.2ms---------63度 1.3ms---------72度 1.4ms---------81度: y0 g) m% h# V' s5 \- B 1.5ms---------90度; g9 \! x- h& Z, S- S& m* H 1.6ms---------99度 1.7ms---------108度9 @. p: |! b0 r- u1 v5 ?4 I 1.8ms---------117度 1.9ms---------126度 2.0ms---------135度4 |9 I! p8 S/ ]( J( ^ 2.1ms---------144度+ q/ M B a; E2 y+ c5 z- ~9 _ 2.2ms---------153度 2.3ms---------162度' \8 o/ _- }: Q0 _% k) `5 t2 f, ^ 2.4ms---------171度2 n: S% G3 S5 R0 w 2.5ms---------180度 \ | / \---|---/ & d" q% W- M/ ], W) ?! t+ \ \ | / \ | /9 D+ h, I9 L! k( Z8 J( f" W \|/ --------------------------------------------------------------7 w4 r8 {3 ^% q% p; F8 O% \+ ]3 G 5 x0 C# ~. U8 F- P. k 20ms的时基脉冲,如果想让舵机转63度,就应该发生一个高电平为1.2ms,5 [/ ]/ F6 I; K% p" p% V. d# x 周期为20ms的方波,duty=1.2/20=6% ,而定时器自动重装载寄存器arr的值 为 1000 ,所以令duty=60,时占空比才为60/1000=6%. 20ms的时基脉冲,如果想让舵机转90度,就应该发生一个高电平为1.5ms,! u6 D6 n" n0 L4 ]3 _2 m7 Q 周期为20ms的方波,duty=1.5/20=7.5% ,而定时器自动重装载寄存器arr的值2 k' D# o. z# @) P! L2 o 为 1000 ,所以令duty=75,时占空比才为75/1000=7.5%. 20ms的时基脉冲,如果想让舵机转126度,就应该发生一个高电平为1.9ms, 周期为20ms的方波,duty=1.9/20=9.5% ,而定时器自动重装载寄存器arr的值/ C1 F# S! C) A 为 1000 ,所以令duty=95,时占空比才为95/1000=9.5%.# a. \- T2 {/ ?+ }6 R1 }9 @$ b -----------------------------------------------------------------* N7 E) {* i: G3 {0 h7 q void SERVO_Init(void) { GPIO_InitTypeDef GPIO_InitStruct; TIM_TimeBaseInitTypeDef TIM_TimeStructure;5 B U. n3 r5 ]# @1 o3 ~ h TIM_OCInitTypeDef TIM_OCInitStructure; RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3,ENABLE); * Q- w: W0 D) q5 |+ z8 S$ D RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA,ENABLE);1 z6 P# {& u) }) R7 p % A2 E" P- V. R o+ V GPIO_InitStruct.GPIO_Mode=GPIO_Mode_AF_PP;//配置为复用推挽输出 GPIO_InitStruct.GPIO_Pin=GPIO_Pin_7; GPIO_InitStruct.GPIO_Speed=GPIO_Speed_50MHz;1 ?+ n: m3 t. Q7 {. ]* d4 W( z GPIO_Init(GPIOA,&GPIO_InitStruct); * ~* k0 V8 U' K p! Y9 u) x TIM_TimeStructure.TIM_Period=1000;//1000 自动重装载寄存器的值,周期为50 000Hz/1000=50Hz,即输出PWM波形的频率为20ms。 TIM_TimeStructure.TIM_Prescaler=1440-1;;// 1400 时钟预分频系数为3600,72 000 000Hz/1400=50000Hz =50KHZ。 ( d; k: q! V0 g- D3 P' ~ TIM_TimeStructure.TIM_ClockDivision=TIM_CKD_DIV1; TIM_TimeStructure.TIM_CounterMode=TIM_CounterMode_Up; TIM_TimeStructure.TIM_RepetitionCounter=0; TIM_TimeBaseInit(TIM3,&TIM_TimeStructure); TIM_ARRPreloadConfig(TIM3,ENABLE); //使能ARR预装载寄存器(影子寄存器)9 L' T3 @' T7 ^ TIM_OCInitStructure.TIM_OCMode=TIM_OCMode_PWM1;3 A) Z. f2 B' a$ y$ T3 O$ ~ TIM_OCInitStructure.TIM_OutputState=TIM_OutputState_Enable;( \7 m: c9 U( H8 @8 {. l) G TIM_OCInitStructure.TIM_Pulse=0;//占空比大小8 _, [ o# _) s1 o: ]; h, ^ TIM_OCInitStructure.TIM_OCPolarity=TIM_OCPolarity_High;" a, n: L- O, ]' v4 a TIM_OC2Init(TIM3,&TIM_OCInitStructure);9 z$ r/ D' I6 _$ t TIM_OC2PreloadConfig(TIM3,TIM_OCPreload_Enable); & M; U& X0 V0 F3 |4 n: ~" b TIM_Cmd(TIM3,ENABLE);/ |, e- w/ V1 X$ ? TIM_CtrlPWMOutputs(TIM3,ENABLE); }7 C4 n$ A- [) ~7 X% k& r$ i' u; U //舵机角度控制6 |% f: V. G- u: z void SERVO_Angle_Control(uint16_t Compare2)2 C" x- l k; Y$ n: q { TIM_SetCompare2(TIM3,Compare2);//设置通道2为可变的pwm- {% @" F# u, X# K \ }1 N- n+ W) X1 F 配置号上面的程序,如果你想让舵机旋转90度,只需要在你程序的某个位置放上这句话就可以了 SERVO_Angle_Control(75);//舵机旋转90度原因就是20ms的时基脉冲,如果想让舵机转90度,就应该发生一个高电平为1.5ms,周期为20ms的方波,duty=1.5/20=7.5% ,而定时器自动重装载寄存器arr的值为 1000 ,所以令duty=75,时占空比才为75/1000=7.5%。以此类推,你想让舵机转多大的角度按照这个方法设置就行了。 |