舵机工作原理详解及智能车单片机(飞思卡尔)控制的实现(程序)
stm32控制舵机程序

stm32控制舵机程序章节标题:基于STM32的舵机控制程序设计第一章:引言(约250字)1.1 研究背景控制舵机是机器人、无人机、航空模型等众多领域的关键技术之一。
而STM32系列的微控制器以其高性能、低功耗和丰富的外设资源被广泛应用于嵌入式控制系统。
本章主要介绍了舵机的作用及其在控制系统中的重要性,同时说明了选择STM32微控制器作为控制舵机的硬件平台的原因。
第二章:控制理论(约250字)2.1 舵机原理舵机是一种能够根据外部输入信号控制角度的电动执行器。
其通过接收PWM信号来确定输出位置和角度,通常在0至180度之间运动。
本章介绍了舵机的工作原理,包括PWM控制信号的作用、舵机内部的反馈控制电路等内容。
2.2 PID控制理论PID控制是一种常用的闭环控制方法,能够根据反馈信号调整输出信号,通过比较实际输出与期望输出的差异来实现控制。
本章详细介绍了PID控制的原理和算法,并提出了使用PID控制舵机的基本思路。
第三章:硬件设计(约250字)3.1 系统框架在舵机控制系统中,使用STM32微控制器作为控制芯片,通过引脚与舵机进行连接,实现对舵机的控制。
本章主要介绍了硬件设计的系统框架,包括STM32微控制器的选择、电源设计、信号输入输出设计等。
3.2 电路原理图本章详细描述了电路原理图设计,包括电源管理模块、驱动电路等详细设计内容。
同时对于舵机的接线方式和引脚定义进行了说明。
第四章:软件设计(约250字)4.1 程序流程本章介绍了在STM32上开发舵机控制程序的流程,包括初始化舵机控制模块、设置PWM输出引脚、编写控制算法等。
4.2 PID算法实现详细描述了如何在STM32上实现PID控制算法,包括参数调整、误差计算、控制输出计算等步骤。
同时,结合实际舵机控制需求,对PID控制算法进行优化。
4.3 实验验证通过实验验证了基于STM32的舵机控制程序的有效性和性能优势。
通过与传统控制方法进行对比,并分析实验数据,评估了该程序的稳定性和响应速度。
飞思卡尔单片机LED控制例程详解-推荐下载

准备工作: 硬件:Freescale MC9S08JM60 型单片机一块; 软件:集成开发环境 codewarrior IDE; 开发板上有两个 LED 灯,如下图所示:
实验步骤: 1. 首先,确保单片机集成开发环境及 USBDM 驱动正确安装。其中 USBDM 的安装步骤如下: 假设之前安装过单片机的集成开发环境 6.3 版本:CW_MCU_V6_3_SE; 运行 USBDM_4_7_0i_Win,这个程序会在 c 盘的程序文件夹下增加一个目录 C:\Program
对全部高中资料试卷电气设备,在安装过程中以及安装结束后进行高中资料试卷调整试验;通电检查所有设备高中资料电试力卷保相护互装作置用调与试相技互术通关,1系电过,力管根保线据护敷生高设产中技工资术艺料0不高试仅中卷可资配以料置解试技决卷术吊要是顶求指层,机配对组置电在不气进规设行范备继高进电中行保资空护料载高试与中卷带资问负料题荷试2下卷2,高总而中体且资配可料置保试时障卷,各调需类控要管试在路验最习;大题对限到设度位备内。进来在行确管调保路整机敷使组设其高过在中程正资1常料中工试,况卷要下安加与全强过,看度并22工且22作尽22下可22都能22可地护以缩1关正小于常故管工障路作高高;中中对资资于料料继试试电卷卷保破连护坏接进范管行围口整,处核或理对者高定对中值某资,些料审异试核常卷与高弯校中扁对资度图料固纸试定,卷盒编工位写况置复进.杂行保设自护备动层与处防装理腐置,跨高尤接中其地资要线料避弯试免曲卷错半调误径试高标方中高案资等,料,编试要5写、卷求重电保技要气护术设设装交备备置底4高调、动。中试电作管资高气,线料中课并敷3试资件且、设卷料中拒管技试试调绝路术验卷试动敷中方技作设包案术,技含以来术线及避槽系免、统不管启必架动要等方高多案中项;资方对料式整试,套卷为启突解动然决过停高程机中中。语高因文中此电资,气料电课试力件卷高中电中管气资壁设料薄备试、进卷接行保口调护不试装严工置等作调问并试题且技,进术合行,理过要利关求用运电管行力线高保敷中护设资装技料置术试做。卷到线技准缆术确敷指灵设导活原。。则对对:于于在调差分试动线过保盒程护处中装,高置当中高不资中同料资电试料压卷试回技卷路术调交问试叉题技时,术,作是应为指采调发用试电金人机属员一隔,变板需压进要器行在组隔事在开前发处掌生理握内;图部同纸故一资障线料时槽、,内设需,备要强制进电造行回厂外路家部须出电同具源时高高切中中断资资习料料题试试电卷卷源试切,验除线报从缆告而敷与采设相用完关高毕技中,术资要资料进料试行,卷检并主查且要和了保检解护测现装处场置理设。备高中资料试卷布置情况与有关高中资料试卷电气系统接线等情况,然后根据规范与规程规定,制定设备调试高中资料试卷方案。
飞思卡尔智能车 电磁组 技术报告

//#define K10
//#define Kp 1;//PID的//#define Kd 1;
#include <hidef.h>
#include <stdio.h>
#include <math.h>
#include <MC9S12XS128.h>
3.1.3
考虑到适当增加力臂来提高舵机的灵敏度和为了赛车布局的的紧凑,采取了如图3.2所示的安装方法。
图3.2舵机安装结构
3.1.4
采用接插件与焊接结合的方式连接传感器、主控板、编码器、电机驱动电路、电机、赛道起始检测等单元,既考虑可靠性,又兼顾结构调整与安装的便利性。具体安装结构如图3.3所示,
图3.3主控板安装结构
[6]卓晴.基于磁场检测的寻线小车传感器布局研究[J].清华大学.2009
[7]杨延玲.载流直导线的电磁场特性分析[J].山东师范大学.2007
[8]王毅敏.马丽英等.一种改进的数字PID控制算法及其在励磁系统中的应用电网技术[J].1998
[9]高金源,夏洁.计算机控制系统[M].清华大学出版社.2007
本校积极组队参加第六届“飞思卡尔”杯全国大学生智能汽车竞赛。从2010年底着手准备,历时半年多,经过不断试验设计,最终设计出较为完整的智能赛车。在赛区比赛中获得了较好的综合性能和成绩。
在本次比赛中,采用大赛组委会统一提供的竞赛车模,采用飞思卡尔16位微控制器MC9S12XS128作为核心控制单元,构思控制方案及系统设计,进行包括机械结构的调整与优化,硬件的设计与组装、软件控制算法的编写与改进等过程(小车上的具体方案模块有传感器信号采集处理、控制算法及执行、动力电机驱动、转向舵机控制等)从而实现小车智能化的识别道路,最终实现智能化竞速。
飞思卡尔单片机快速上手指南说明书

Freescale Semiconductor, Inc.Document Number: 用户指南 Rev. 0, 09/2014Confidentiality statement, as appropriate to document/part status.___________________________________________________________________飞思卡尔单片机快速上手指南作者:飞思卡尔半导体IMM FAE 团队飞思卡尔半导体是全球领先的单片机供应商,其单片机产品包含多种内核,有数百个系列。
为支持用户使用这些产品,飞思卡尔提供了丰富的网站资源、文档及软硬件工具,另外,我们还有众多的第三方合作伙伴及公共平台的支持。
对于不熟悉飞思卡尔产品和网站的初学者来说,了解和使用这些资源这无疑是一个令人望而生畏的浩瀚工程。
本指南的目的,就是给初学者提供一个指导,让他们不被这些海量信息淹没;用户根据本指导提供的操作步骤,能迅速找到所需的资源,了解如何使用相关的工具。
在本指南中,我们以飞思卡尔的新一代Kinetis 单片机K22系列为例,介绍了如何获取与之相关的资源,如何对其进行软硬件设计和开发。
实际上,这些方法也适用于其它的单片机系列。
当然,对于其它有较多不同之处的产品,我们也会继续推出相应的文档,供广大用户参考。
目录1 如何获取技术资料与支持 ..........................................................2 2 如何选择产品、申请样片及购买少量芯片和开发工具 ........... 93 飞思卡尔单片机的开发环境、开发工具和生态系统 ............. 224 如何阅读飞思卡尔的技术文档 ................................................ 45 5 飞思卡尔单片机硬件设计指南 ................................................ 55 6飞思卡尔单片机软件开发指南 (67)飞思卡尔单片机快速上手指南, Rev. 1, 09/20142Freescale Semiconductor, Inc.1 如何获取技术资料与支持1.1 概述当用户使用飞思卡尔单片机芯片时,如何获取芯片的数据手册(Datasheet )、参考设计(Reference Manual )和官方例程等资源呢?另外当用户遇到了技术问题该如何获得帮助和解答呢?这里以Kinetis 的K22系列芯片为例为大家介绍如何解决这些问题。
飞思卡尔智能车信息采集

飞思卡尔智能车信息采集摘要本文首先对智能车的硬件进行设计,达到了低重心、大前瞻、高稳定性。
其次对系统的软件部分进行设计,利用阀值对赛道进行判断,从而得到智能车的偏航角。
综合偏航角控制量实现舵机控制,入弯道切内道,大大提高了智能车的弯道运行速度。
用光电编码盘检测智能车的运行速度,再根据赛道信息给定智能车的运行速度,运用一些算法调节驱动电机转速,实现了电机的快速响应。
经过大量测试,最终确定系统结构和各项控制参数。
关键词:单片机;舵机控制;速度控制【中图分类号】u293.2+50 引言智能车有着极为广泛的应用前景。
结合传感器技术和自动驾驶技术可以实现汽车的自适巡航并把车开得开得又快又稳、安全可靠;汽车夜间行驶时,如果装上红外摄像头,就能实现夜晚汽车的安全辅助驾驶;他也可以工作在仓库、码头、工厂或危险、有毒、有害的工作环境里,此外他还能担当起无人值守的巡逻监视、物料的运输、消防灭火等任务。
在普通家庭轿车消费中,智能车的研发也是有价值的,比如雾天能见度差,人工驾驶经常发生碰撞,如果用上这种设备,激光雷达会自动探测前方的障碍物,电脑会控制车辆自动停下来撞车就不会发生了。
提高安全性和系统效率。
这种新型车辆控制方法的核心,就是实现车辆的智能化。
1 智能车机械结构设计机械结构是控制算法和软件程序的执行机构,对机械结构性能的了解和改造有利于对控制算法和软件程序的实现。
因此对车体机械结构的调整是非常必要的。
1.1 车体机械参数调整前轮参数的调整包括前轮主销后倾角,主销内倾角,前轮外倾角,前轮前束。
这几个参数对车体直线行驶的平稳性和转弯的灵活性有很重要的影响[1]。
1.2 舵机的安装舵机转向是整个控制系统中延迟较大的一个环节,在相同的舵机转向条件下,转向连杆在舵机一端的连接点离舵机轴心距离越远,转向轮转向变化越快。
这样安装的优点是:改变了舵机的力臂,使转向更灵敏;舵机安装在正中央,使左右的转向基本一致;重心相对来说靠后,减轻舵机的负载[2]。
MG996R舵机控制

MG996R舵机控制方法红:+5v,棕:GND,黄:信号基于单片机的舵机控制方法具有简单、精度高、成本低、体积小的特点,并可根据不同的舵机数量加以灵活应用在机器人机电控制系统中,舵机控制效果是性能的重要影响因素。
舵机可以在微机电系统和航模中作为基本的输出执行机构,其简单的控制和输出使得单片机系统非常容易与之接口。
舵机是一种位置伺服的驱动器,适用于那些需要角度不断变化并可以保持的控制系统。
其工作原理是:控制信号由接收机的通道进入信号调制芯片,获得直流偏置电压。
它内部有一个基准电路,产生周期为20ms,宽度为1.5ms 的基准信号,将获得的直流偏置电压与电位器的电压比较,获得电压差输出。
最后,电压差的正负输出到电机驱动芯片决定电机的正反转。
当电机转速一定时,通过级联减速齿轮带动电位器旋转,使得电压差为0,电机停止转动。
图1 舵机的控制要求舵机的控制信号是PWM信号,利用占空比的变化改变舵机的位置。
一般舵机的控制要求如图1 所示。
单片机实现舵机转角控制可以使用FPGA、模拟电路、单片机来产生舵机的控制信号,但FPGA成本高且电路复杂。
对于脉宽调制信号的脉宽变换,常用的一种方法是采用调制信号获取有源滤波后的直流电压,但是需要50Hz(周期是20ms)的信号,这对运放器件的选择有较高要求,从电路体积和功耗考虑也不易采用。
5mV以上的控制电压的变化就会引起舵机的抖动,对于机载的测控系统而言,电源和其他器件的信号噪声都远大于5mV,所以滤波电路的精度难以达到舵机的控制精度要求。
也可以用单片机作为舵机的控制单元,使PWM信号的脉冲宽度实现微秒级的变化,从而提高舵机的转角精度。
单片机完成控制算法,再将计算结果转化为PWM信号输出到舵机,由于单片机系统是一个数字系统,其控制信号的变化完全依靠硬件计数,所以受外界干扰较小,整个系统工作可靠。
单片机系统实现对舵机输出转角的控制,必须首先完成两个任务:首先是产生基本的PWM周期信号,本设计是产生20ms的周期信号;其次是脉宽的调整,即单片机模拟PWM信号的输出,并且调整占空比。
飞思卡尔MC9S12单片机实验程序
PORTB=0xff; //led灯全暗
TIOS=0x00; //设置定时器通道0为输入捕捉
TSCR1=0x80; //定时器使能
TSCR2=0x01; //设置自由计数器2分频,且禁止定时器溢出中断
TCTL4=0x02; //捕捉器仅下降沿捕捉
TIE=0x01; //允许定时器通道0的中断
}
}
void main(void) {
DDRB=0xff;
PORTB=0x00;
for(;;)
{
fun();
}
}
SCI
#include <hidef.h>
#include <mc9s12db128.h>
#pragma LINK_INFO DERIVATIVE "mc9s12db128b"
unsigned char pp=0xf0; //欲发送的数字
/*********串口初始化*********/
void init() {
DDRB=0xff;
PORTB=0xff; //开始led灯暗,即数据尚未接收
SCI0BD=52; //初始化波特率为9600
SCI0CR1=0x00; //八位无奇偶校验模式
SCI0CR2=0x2c; //接收中断允许
}
/**************写数据***********/
void interrupt 20 funck() {
unsigned char k;
k=read();
PORTB=~k;
}
SPI
不会,以后补充。
LED
#include <hidef.h> /* common defines and macros */
飞思卡尔智能车总结范文(2篇)
飞思卡尔智能车总结范文先静下心来看几篇技术报告,可以是几个人一起看,边看边讨论,大致了解智能车制作的过程及所要完成的任务。
看完报告之后,对智能车也有了大概的了解,其实总结起来,要完成的任务也很简单,即输入模块-控制-输出。
(1)输入模块。
各种传感器(光电,电磁,摄像头),原理不同,但功能都一样,都是用来采集赛道的信息。
这里面就包含各种传感器的原理,选用,传感器电路的连接,还有传感器的____、传感器的抗干扰等等需要大家去解决的问题。
(2)控制模块。
传感器得到了我们想要的信息,进行相应的ad转换后,就把它输入到单片机中,单片机负责对信息的处理,如除噪,筛选合适的点等等,然后对不同的赛道信息做出相应的控制,这也是智能车制作过程中最为艰难的过程,要想出一个可行而又高效的算法,确实不是一件容易的事。
这里面就涉及到单片机的知识、c语言知识和一定的控制算法,有时为了更直观地动态控制,还得加入串口发送和接收程序等等。
(3)输出模块。
好的算法,只有通过实验证明才能算是真正的好算法。
经过分析控制,单片机做出了相应的判断,就得把控制信号输出给电机(控制速度)和舵机(控制方向),所以就得对电机和舵机模块进行学习和掌握,还有实现精确有效地控制,又得加入闭环控制,pid算法。
明确了任务后,也有了较为清晰的控制思路,接下来就着手弄懂每一个模块。
虽然看似简单,但实现起来非常得不容易,这里面要求掌握电路的知识,基本的机械硬件结构知识和单片机、编程等计算机知识。
最最困难的是,在做的过程中会遇到很多想得到以及想不到的事情发生,一定得细心地发现问题,并想办法解决这些问题。
兴趣是首要的,除此之外,一定要花充足的时间和精力在上面,毕竟,有付出就会有收获,最后要明确分工和规划好进度。
飞思卡尔智能车总结范文(二)飞思卡尔智能车是一种基于飞思卡尔开发的智能车模型,它通过搭载了各种传感器和处理器,可以实现自主感知、决策和行动的能力。
在设计和制造过程中,我们充分发挥了团队的协作能力和创新思维,取得了令人满意的成果。
舵机及转向控制原理之欧阳家百创编
舵机及转向控制原理欧阳家百(2021.03.07)1、概述2、舵机的组成3、舵机工作原理4、舵机选购5、舵机使用中应注意的事项6、辉盛S90舵机简介7、如何利用程序实现转向8、51单片机舵机测试程序1、概述舵机也叫伺服电机,最早用于船舶上实现其转向功能,由于可以通过程序连续控制其转角,因而被广泛应用智能小车以实现转向以及机器人各类关节运动中,如图1 、图2 所示。
图1 舵机用于机器人图2 舵机用于智能小车中舵机是小车转向的控制机构,具有体积小、力矩大、外部机械设计简单、稳定性高等特点,无论是在硬件设计还是软件设计,舵机设计是小车控制部分重要的组成部分,图3为舵机的外形图。
图3 舵机外形图2、舵机的组成一般来讲,舵机主要由以下几个部分组成,舵盘、减速齿轮组、位置反馈电位计、直流电机、控制电路等,如图4、图5所示。
图4 舵机的组成示意图图5 舵机组成舵机的输入线共有三条,如图6所示,红色中间,是电源线,一边黑色的是地线,这辆根线给舵机提供最基本的能源保证,主要是电机的转动消耗。
电源有两种规格,一是4.8V,一是6.0V,分别对应不同的转矩标准,即输出力矩不同,6.0V对应的要大一些,具体看应用条件;另外一根线是控制信号线,Futaba的一般为白色,JR的一般为桔黄色。
另外要注意一点,SANWA的某些型号的舵机引线电源线在边上而不是中间,需要辨认。
但记住红色为电源,黑色为地线,一般不会搞错。
图6 舵机的输出线3、舵机工作原理控制电路板接受来自信号线的控制信号,控制电机转动,电机带动一系列齿轮组,减速后传动至输出舵盘。
舵机的输出轴和位置反馈电位计是相连的,舵盘转动的同时,带动位置反馈电位计,电位计将输出一个电压信号到控制电路板,进行反馈,然后控制电路板根据所在位置决定电机转动的方向和速度,从而达到目标停止。
其工作流程为:控制信号→控制电路板→电机转动→齿轮组减速→舵盘转动→位置反馈电位计→控制电路板反馈。
基于单片机智能小车ppt课件
关键技术与挑战
关键技术
包括传感器技术、控制算法、导航定位技术、通信技术、电源管理技术等。
挑战
在实现智能小车自主导航、环境感知、动态决策等功能时,需要解决传感器精 度与稳定性问题、复杂环境下的导航定位问题、多智能小车协同控制问题等。
02
单片机原理及选型
单片机工作原理
01
02
03
04
05
中央处理器( CPU)
编程语言选择
C语言或汇编语言,推荐使用C语言进行开发,可读性和可移植性更好
主程序流程图设计思路
初始化
包括单片机、传感器、电机等模块的 初始化
循环检测
不断检测传感器输入信号,判断小车 当前状态
控制算法
根据传感器输入信号,通过控制算法 计算出控制量
输出控制
将控制量输出到电机驱动模块,控制 小车运动
关键算法实现方法探讨
常见单片机类型及特点
8051系列
经典的单片机系列,具有简单 的结构和丰富的外设接口,适
合初学者使用。
AVR系列
高性能、低功耗的单片机,具 有快速的执行速度和丰富的外 设接口,适用于高端应用。
PIC系列
精简指令集(RISC)单片机, 具有高性能、低功耗和易于编 程的特点,广泛应用于各种领 域。
ARM系列
测试智能小车的避障、防撞等安全功 能,确保其能够在复杂环境下安全运 行。
性能优化方向和建议
算法优化
优化控制算法,提高智能小车的运动精度和稳定性。例如,采用更先 进的控制算法,如模糊控制、神经网络控制等。
硬件升级
升级硬件设备,提高智能小车的性能。例如,采用更高性能的电机、 更精确的传感器等。
系统集成
32位高性能单片机,具有强大 的处理能力和丰富的外设接口
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
舵机工作原理详解及单片机(飞思卡尔和51)控制的实现(程序) 1、概述 舵机最早出现在航模运动中。在航空模型中,飞行机的飞行姿态是通过调节发动机和各个控制舵面来实现的。举个简单的四通飞机来说,飞机上有以下几个地方需要控制: 1.发动机进气量,来控制发动机的拉力(或推力); 2.副翼舵面(安装在飞机机翼后缘),用来控制飞机的横滚运动; 3.水平尾舵面,用来控制飞机的俯仰角; 4.垂直尾舵面,用来控制飞机的偏航角; 遥控器有四个通道,分别对应四个舵机,而舵机又通过连杆等传动元件带动舵面的转动,从而改变飞机的运动状态。舵机因此得名:控制舵面的伺服电机。 不仅在航模飞机中,在其他的模型运动中都可以看到它的应用:船模上用来控制尾舵,车模中用来转向等等。由此可见,凡是需要操作性动作时都可以用舵机来实现。
2、结构和控制 一般来讲,舵机主要由以下几个部分组成,舵盘、减速齿轮组、位置反馈电位
计5k、直流电机、控制电路板等。
工作原理:控制电路板接受来自信号线的控制信号(具体信号待会再讲),控制电机转
动,电机带动一系列齿轮组,减速后传动至输出舵盘。舵机的输出轴和位置反馈电位计是相连的,舵盘转动的同时,带动位置反馈电位计,电位计将输出一个电压信号到控制电路板,进行反馈,然后控制电路板根据所在位置决定电机的转动方向和速度,从而达到目标停止。 舵机的基本结构是这样,但实现起来有很多种。例如电机就有有刷和无刷之分,齿轮有塑料和金属之分,输出轴有滑动和滚动之分,壳体有塑料和铝合金之分,速度有快速和慢速之分,体积有大中小三种之分等等,组合不同,价格也千差万别。例如,其中小舵机一般称作微舵,同种材料的条件下是中型的一倍多,金属齿轮是塑料齿轮的一倍多。需要根据需要选用不同类型。 舵机的输入线共有三条,红色中间,是电源线,一边黑色的是地线,这辆根线给舵机提供最基本的能源保证,主要是电机的转动消耗。电源有两种规格,一是4.8V,一是6.0V,分别对应不同的转矩标准,即输出力矩不同,6.0V对应的要大一些,具体看应用
条件;另外一根线是控制信号线,Futaba的一般为白色,JR的一般为桔黄色。另外要注意一点,SANWA的某些型号的舵机引线电源线在边上而不是中间,需要辨认。但记住红色为电源,黑色为地线,一般不会搞错。
舵机的控制信号为周期是20ms的脉宽调制(PWM)信号,其中脉
冲宽度从0.5ms-2.5ms,相对应舵盘的位置为0-180度,呈线性变化。也就是说,给它提供一定的脉宽,它的输出轴就会保持在一个相对应的角度上,无论外界转矩怎样改变,直到给它提供一个另外宽度的脉冲信号,它才会
改变输出角度到新的对应的位置上。舵机内部有一个基准电路,产生周期的20ms,宽度1.5ms的基准信号,有一个比较器,将外加信号与基准信号相比较,判断出方向和大小,从而产生电机的转动信号。由此可见,
舵机是一种位置伺服的驱动器,转动范围不能超过180度,适用于那些
需要角度不断变化并可以保持的驱动当中。比方说机器人的关节、飞机的舵面等。 常见的舵机厂家有:日本的Futaba、JR、SANWA等,国产的有北京的新幻想、吉林的振华等。现举Futaba S3003来介绍相关参数,以供大家设计时选用。之所以用3003是因为这个型号是市场上最常见的,也是价格相对较便宜的一种(以下数据摘自Futaba产品手册)。 尺寸(Dimensions): 40.4×19.8×36.0 mm 重量(Weight): 37.2 g 工作速度(Operating speed):0.23 sec/60°(4.8V) 0.19 sec/60°(6.0V) 输出力矩(Output torque):3.2 kg.cm (4.8V) 4.1 kg.cm (6.0V) 由此可见,舵机特点: >体积紧凑,便于安装; >输出力矩大,稳定性好; >控制简单,便于和数字系统接口; 正是因为舵机有很多优点,所以,现在不仅仅应用在航模运动中,已经扩展到各种机电产品中来,在机器人控制中应用也越来越广泛。
3、用单片机来控制
正是舵机的控制信号是一个脉宽调制信号,所以很方便和数字系统进行接口。只要能产生标准的控制信号的数字设备都可以用来控制舵机,
比方PLC、单片机等。这里介绍利用51系列单片机产生舵机的控制信号来进行控制的方法,编程语言为C51。之所以介绍这种方法只是因为笔者用2051实现过,本着负责的态度,所以敢在这里写出来。程序用的是我的四足步行机器人,有删改。单片机并不是控制舵机的最好的方法,希望在此能起到抛砖引玉的作用。 2051有两个16位的内部计数器,我们就用它来产生周期20 ms的脉冲信号,根据需要,改变输出脉宽。基本思路如下(请对照下面的程序): 我用的晶振频率为12M,2051一个时钟周期为12个晶振周期,正好是1/1000 ms,计数器每隔1/1000 ms计一次数。以计数器1为例,先设定脉宽的初始值,程序中初始为1.5ms,在for循环中可以随时通过改变a值来改变,然后设定计数器计数初始值为a,并置输出p12为高位。当计数结束时,触发计数器溢出中断函数,就是void timer0(void) interrupt 1 using1 ,在子函数中,改变输出p12为反相(此时跳为低位),在用20000(代表20ms周期)减去高位用的时间a,就是本周期中低位的时间,c=20000-a,并设定此时的计数器初值为c,直到定时器再次产生溢出中断,重复上一过程。
# include #define uchar unsigned char #define uint unsigned int
uinta,b,c,d; /*a为舵机1的脉冲宽度,b为舵机2的脉冲宽度,单位1/1000 ms */ /*c、d为中间变量*/
/*以下定义输出管脚*/ sbit p12=P1^2; sbit p13=p1^3; sbit p37=P3^7;
/*以下两个函数为定时器中断函数*/ /*定时器1,控制舵机1,输出引脚为P12,可自定义*/ void timer0(void) interrupt 1 using 1 {p12=!p12; /*输出取反*/ c=20000-c; /*20000代表20 ms,为一个周期的时间*/ TH0=-(c/256); TL0=-(c%256); /*重新定义计数初值*/ if(c>=500&&c<=2500)c=a; else c="20000-a"; /*判断脉宽是否在正常范围之内*/ } /*定时器2,控制舵机2,输出引脚为P13,可自定义*/ void timer1(void) interrupt 3 using 1 {p13=!p13; d=20000-d; TH1=-(d/256); TL1=-(d%256); if(d>=500&&d<=2500)d=b; else d="20000-b"; }
/*主程序*/ void main(void) {TMOD=0x11; /*设初值*/ p12=1; p13=1; a=1500; b=1500; /*数值1500即对应1.5ms,为舵机的中间90度的位置*/ c=a;d=b; TH0=-(a/256); TL0=-(a%256); TH1=-(b/256); TL1=-(b%256); /*设定定时器初始计数值*/ EA=1; ET0=1; TR0=1;EX0=1;EX1=1; ET1=1; TR1=1; PX0=0;PX1=0;PT1=1;PT0=1;/*设定中断优先级*/ for(;;) { /*在这个for循环中,可以根据程序需要 在任何时间改变a、b值来改变脉宽的输 出时间,从而控制舵机*/
因为在脉冲信号的输出是靠定时器的溢出中断函数来处理,时间很短,
因此在精度要求不高的场合可以忽略。因此如果忽略中断时间,从另一个角度
来讲就是主程序和脉冲输出是并行的,因此,只需要在主程序中按你的要求改变a值,例如让a从500变化到2500,就可以让舵机从0度变化到180度。另外
要记住一点,舵机的转动需要时间的,因此,程序中a值的变化不能太快,不然舵机跟不上程序。根据需要,选择合适的延时,用一个a递增循环,可以让舵机很流畅的转动,而不会产生像步进电机一样的脉动。这些还需要实践中具体体会。
舵机的速度决定于你给它的信号脉宽的变化速度。举个例子,t=0试,脉宽为0.5ms,t=1s时,脉宽为1.0ms,那么,舵机就会从0.5ms对应的位置转到1.0ms对应的位置,那么转动速度如何呢?一般来讲,3003的最大转动速度在4.8V时
为0.23s/60度,也就是说,如果你要求的速度比这个快的话,舵机就反
应不过来了;如果要求速度比这个慢,可以将脉宽变化值线性到你要求的时间
内,做一个循环,一点一点的增加脉宽值,就可以控制舵机的速度了。当然,具体这一点一点到底是多少,就需要做试验了,不然的话,不合适的话,舵机就会向步进电机一样一跳一跳的转动了,尝试改变这“一点”,使你的舵机运动更平滑。还有一点很重要,就是舵机在每一次脉宽值改变的
时候总会有一个转速由零增加再减速为零的过程,这就是舵机会产生像步进电机一样运动的原因