CN103941732A - 仿生双足机器人控制系统 - Google Patents
仿生双足机器人控制系统 Download PDFInfo
- Publication number
- CN103941732A CN103941732A CN201410159147.5A CN201410159147A CN103941732A CN 103941732 A CN103941732 A CN 103941732A CN 201410159147 A CN201410159147 A CN 201410159147A CN 103941732 A CN103941732 A CN 103941732A
- Authority
- CN
- China
- Prior art keywords
- driver
- control system
- servomotor
- servo motor
- interface
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Landscapes
- Manipulator (AREA)
Abstract
本发明涉及一种控制系统,尤其是一种仿生双足机器人控制系统,属于双足机器人控制的技术领域。按照本发明提供的技术方案,所述仿生双足机器人控制系统,包括用于驱动双足机器人行走的伺服电机、用于检测所述伺服电机工作状态信息的编码器以及用于检测所述伺服电机转速的霍尔传感器,所述编码器及霍尔传感器均与驱动器连接,驱动器的输出端与伺服电机连接,驱动器通过JMACH接口与PMAC驱动板连接。本发明通过编码器及霍尔传感器实现对伺服电机的运动过程的参数反馈,驱动器采用PID控制方法实现对伺服电机的有效运动控制,结构简单,适应范围广,成本低,安全可靠。
Description
技术领域
本发明涉及一种控制系统,尤其是一种仿生双足机器人控制系统,属于双足机器人控制的技术领域。
背景技术
仿人机器人集机械、电子、材料、计算机、自动化等多门学科于一体,技术含量高、研究和开发难度大,已成为一个国家高技术实力和发展水平的重要标志,许多科学家都在仿人机器人研究与开发方面做了大量工作,取得了突破性进展,仿人机器人已经对人类社会产生了巨大的影响。
国外发展状况主要介绍几个在双足机器人领域取得许多成果的国家所研制的机器人,仿人机器人的研究具有重要的科学意义和应用前景,步行系统本身具有非常丰富的动力学和运动学特性。仿人机器人有许多优越性。它具有灵活的行走机构,可以随时走到需要的地方,包括一些普通人不易到达的地方,完成人指定或预先设置的工作。与工业机器人相比,其优越性体现在广阔的活动空间和工作空间。仿人机器人的研究具有潜在的应用前景。双足行走是生物界难度最大的步行动作,但其步行性能却是其它步行结构所无法比拟的。人类步行运动与其他机构运动相比具有优越的移动性能和环境适应能力。但目前仿生双足机器人的控制系统结构复杂,成本高,难以满足机器人的行走要求。
发明内容
本发明的目的是克服现有技术中存在的不足,提供一种仿生双足机器人控制系统,其结构简单,能对双足机器人的行走进行有效控制,适应范围广,成本低,安全可靠。
按照本发明提供的技术方案,所述仿生双足机器人控制系统,包括用于驱动双足机器人行走的伺服电机、用于检测所述伺服电机工作状态信息的编码器以及用于检测所述伺服电机转速的霍尔传感器,所述编码器及霍尔传感器均与驱动器连接,驱动器的输出端与伺服电机连接,驱动器通过JMACH接口与PMAC驱动板连接。
所述驱动器通过串口与控制计算机连接。所述串口为USB串口。
所述驱动器根据霍尔传感器及编码器的检测信号采用PID方法控制伺服电机。
本发明的优点:通过编码器及霍尔传感器实现对伺服电机的运动过程的参数反馈,驱动器采用PID控制方法实现对伺服电机的有效运动控制,结构简单,适应范围广,成本低,安全可靠。
附图说明
图1为本发明的结构框图。
附图标记说明:1-控制计算机、2-PMAC驱动板、3-JMACH接口、4-串口、5-驱动器、6-编码器、7-霍尔传感器及8-伺服电机。
具体实施方式
下面结合具体附图和实施例对本发明作进一步说明。
如图1所示:为了能对双足机器人的行走进行有效控制,本发明包括用于驱动双足机器人行走的伺服电机8、用于检测所述伺服电机8工作状态信息的编码器6以及用于检测所述伺服电机8转速的霍尔传感器7,所述编码器6及霍尔传感器7均与驱动器5连接,驱动器5的输出端与伺服电机8连接,驱动器5通过JMACH接口3与PMAC驱动板2连接。
具体地,通过伺服电机8用于驱动双足机器人的行走动作,通过编码器6用于检测伺服电机8的电机轴的位置、转速以及扭矩信息,通过霍尔传感器7用于检测伺服电机8的转速,驱动器5可以采用ARM芯片。本发明实施例中,驱动器5内设有接口J1、接口J2、接口J3、接口J4以及接口J5,所述接口J1为CAN总线接口,接口J2为电机电源接口,接口J3为驱动器电源接口,接口J4为反馈信号接口,接口J5为控制反馈信号接口;编码器6及霍尔传感器7与驱动器5的接口J4连接,伺服电机8与驱动器5的接口J2连接,JMACH接口3与驱动器5的接口J5连接。所述PMAC(programmable multi-axes controller)驱动板2采用现有的驱动板,PMAC驱动板2与驱动器5配合,共同实现对双足机器人的运动控制。
所述驱动器5通过串口4与控制计算机1连接,控制计算机1还与PMAC驱动板2连接。所述串口4为USB串口。所述驱动器5根据霍尔传感器7及编码器6的检测信号采用PID方法控制伺服电机8。
在具体实施时,采用PID算法,优化驱动器5对伺服电机8的控制,达到迅速精准跟动的效果。通过调整PID参数,使得伺服电机8能够迅速跟踪阶跃响应,经过调整,系统的响应时间、超调量以及静态误差都达到预定指标。
本发明实施例中,在对双足机器人进行运动控制时,运用逐点插补法。所谓逐点比较法插补,就是刀具或绘图笔每走一步都要和给定轨迹上的坐标值进行比较,看这点在给定轨迹的上方还是下方,或是给定轨迹的里面和外面,从而决定下一步的进给方向。如果原来在给定轨迹的下方,下一步就向给定轨迹的上方走,如果原来在给定轨迹的里面,下一步就向给定轨迹的外面走。如此,走一步,看一次,比较一次,决定下一步走向,以便逼近给定轨迹,即形成逐点比较插补。逐点比较法是以阶梯折线来逼近直线或圆弧等曲线的,它与规定的加工直线或圆弧之间的最大误差为一个脉冲当量,因此只要把脉冲当量(每走一步的距离即步长)取得足够小,就可以达到加工精度的要求。在具体实施时,可以采用直线插补、圆弧插补或其他的插补方式实现对双足机器人的运动精确控制。
具体地,控制系统是根据编码器6的返回值来执行下一步动作,而编码器6的刻度值为2000,即是伺服电机8最小控制单位为1/2000转,使用插补算法,可以有效利用电极每步的每一步动作,最大化发挥系统的优越性,从而迅速、准确地实现电机响应。
本发明通过编码器6及霍尔传感器7实现对伺服电机8的运动过程的参数反馈,驱动器5采用PID控制方法实现对伺服电机8的有效运动控制,结构简单,适应范围广,成本低,安全可靠。
Claims (4)
1. 一种仿生双足机器人控制系统,其特征是:包括用于驱动双足机器人行走的伺服电机(8)、用于检测所述伺服电机(8)工作状态信息的编码器(6)以及用于检测所述伺服电机(8)转速的霍尔传感器(7),所述编码器(6)及霍尔传感器(7)均与驱动器(5)连接,驱动器(5)的输出端与伺服电机(8)连接,驱动器(5)通过JMACH接口(3)与PMAC驱动板(2)连接。
2.根据权利要求1所述的仿生双足机器人控制系统,其特征是:所述驱动器(5)通过串口(4)与控制计算机(1)连接。
3.根据权利要求2所述的仿生双足机器人控制系统,其特征是:所述串口(4)为USB串口。
4.根据权利要求1所述的仿生双足机器人控制系统,其特征是:所述驱动器(5)根据霍尔传感器(7)及编码器(6)的检测信号采用PID方法控制伺服电机(8)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410159147.5A CN103941732A (zh) | 2014-04-18 | 2014-04-18 | 仿生双足机器人控制系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410159147.5A CN103941732A (zh) | 2014-04-18 | 2014-04-18 | 仿生双足机器人控制系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103941732A true CN103941732A (zh) | 2014-07-23 |
Family
ID=51189439
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410159147.5A Pending CN103941732A (zh) | 2014-04-18 | 2014-04-18 | 仿生双足机器人控制系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103941732A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104527832A (zh) * | 2014-12-26 | 2015-04-22 | 浙江工业大学 | 双足狭窄足机器人 |
WO2016016685A1 (en) * | 2014-07-29 | 2016-02-04 | Face Moore International Ltd | Drive for home appliance |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH02202607A (ja) * | 1989-01-31 | 1990-08-10 | Okuma Mach Works Ltd | サーボモータの制御方法及び装置 |
JPH06187032A (ja) * | 1992-12-16 | 1994-07-08 | Yaskawa Electric Corp | 移動ロボット用マーカ、情報検出装置と走行制御装置 |
JP2002323925A (ja) * | 2001-04-26 | 2002-11-08 | Matsushita Electric Ind Co Ltd | 移動作業ロボット |
CN102650885A (zh) * | 2012-04-18 | 2012-08-29 | 西北农林科技大学 | 一种具有远程预警功能的机器人行走监控系统 |
CN102830700A (zh) * | 2011-06-17 | 2012-12-19 | 泰怡凯电器(苏州)有限公司 | 擦玻璃机器人的直角区域移动控制系统及其控制方法 |
CN102854879A (zh) * | 2012-09-19 | 2013-01-02 | 保定天威集团有限公司 | 一种仓库无线智能巡检方法及专用机器人 |
CN103217977A (zh) * | 2012-01-20 | 2013-07-24 | 苏州宝时得电动工具有限公司 | 自动工作设备的控制方法 |
-
2014
- 2014-04-18 CN CN201410159147.5A patent/CN103941732A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH02202607A (ja) * | 1989-01-31 | 1990-08-10 | Okuma Mach Works Ltd | サーボモータの制御方法及び装置 |
JPH06187032A (ja) * | 1992-12-16 | 1994-07-08 | Yaskawa Electric Corp | 移動ロボット用マーカ、情報検出装置と走行制御装置 |
JP2002323925A (ja) * | 2001-04-26 | 2002-11-08 | Matsushita Electric Ind Co Ltd | 移動作業ロボット |
CN102830700A (zh) * | 2011-06-17 | 2012-12-19 | 泰怡凯电器(苏州)有限公司 | 擦玻璃机器人的直角区域移动控制系统及其控制方法 |
CN103217977A (zh) * | 2012-01-20 | 2013-07-24 | 苏州宝时得电动工具有限公司 | 自动工作设备的控制方法 |
CN102650885A (zh) * | 2012-04-18 | 2012-08-29 | 西北农林科技大学 | 一种具有远程预警功能的机器人行走监控系统 |
CN102854879A (zh) * | 2012-09-19 | 2013-01-02 | 保定天威集团有限公司 | 一种仓库无线智能巡检方法及专用机器人 |
Non-Patent Citations (1)
Title |
---|
何锋: "双足步行机器人步态规划与控制系统研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》, no. 6, 15 June 2010 (2010-06-15), pages 32 - 50 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2016016685A1 (en) * | 2014-07-29 | 2016-02-04 | Face Moore International Ltd | Drive for home appliance |
CN104527832A (zh) * | 2014-12-26 | 2015-04-22 | 浙江工业大学 | 双足狭窄足机器人 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105033996B (zh) | 基于手推示教式五轴水平关节机器人的控制系统 | |
CN203566700U (zh) | 一种水平四自由度工业机器人 | |
CN102699221A (zh) | 一种上下料机械手 | |
CN204366962U (zh) | 六轴重载机器人控制系统 | |
CN102059691A (zh) | 一种主从式喷塑机器人 | |
CN105921558A (zh) | 一种机器人伺服折弯系统 | |
CN203003897U (zh) | 一种车轮轮辐三轴数控码料机械手 | |
CN103941732A (zh) | 仿生双足机器人控制系统 | |
CN103143863B (zh) | 一种双层伸缩型焊接机器人系统 | |
CN103737603B (zh) | 一种流水线上机械臂精确控制系统及控制方法 | |
CN203091997U (zh) | 一种双层伸缩型焊接机器人系统 | |
EP3304228B1 (en) | Robot system for synchronizing the movement of the robot arm | |
CN201654531U (zh) | 基于工控机的机器人伺服控制系统 | |
CN203109954U (zh) | 机械手运行末端最小振幅控制装置 | |
CN204772522U (zh) | 一种仿生写字机械手 | |
CN104625836A (zh) | 数控龙门机床 | |
CN104834321A (zh) | 高加速气悬浮系统的精确定位控制器及其控制方法 | |
CN206011116U (zh) | 一种输入输出全闭环控制的精密机器人 | |
Li et al. | Design of spot welding robot | |
CN204759207U (zh) | 高加速气悬浮系统的精确定位控制器 | |
CN102799141B (zh) | 折剪机床多功能数控系统 | |
CN2715901Y (zh) | 一种数控电火花加工装置 | |
CN203210367U (zh) | 机械手 | |
CN205763101U (zh) | 一种机器人伺服折弯系统 | |
Wang et al. | Design of automatic guided vehicles based on computer control |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20140723 |