CN102126220A - 一种基于现场总线仿人机器人六自由机械臂的控制*** - Google Patents
一种基于现场总线仿人机器人六自由机械臂的控制*** Download PDFInfo
- Publication number
- CN102126220A CN102126220A CN2010100324534A CN201010032453A CN102126220A CN 102126220 A CN102126220 A CN 102126220A CN 2010100324534 A CN2010100324534 A CN 2010100324534A CN 201010032453 A CN201010032453 A CN 201010032453A CN 102126220 A CN102126220 A CN 102126220A
- Authority
- CN
- China
- Prior art keywords
- chip
- pin
- resistance
- bus
- mechanical arm
- 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
Images
Landscapes
- Manipulator (AREA)
Abstract
一种仿人机器人机械臂的控制***,属于机器人技术和自动化领域,具体涉及一种基于现场总线仿人机器人六自由机械臂的控制***,它的目的是为了仿人机器人机械臂动作和姿态准确控制。本发明包括主计算机(1)、现场总线(2)和伺服单元(3)三部分。主计算机(1)完成运动规划算法,同时主计算机(1)还将通过现场总线(2)与各伺服单元(3)通信,各伺服单元(3)驱动仿人机器人机械臂1-3各关节1-2的协调运动,达到预期的姿态。本发明控制实时性能好、运动控制准确、电路简单高效、抗干扰能力强、电缆线少、便于应用、成本低。
Description
所属技术领域
本发明属于机器人技术和自动化领域,涉及机器人机械臂的控制***,特别涉及一种基于现场总线仿人机器人六自由度机械臂的控制方法及***。
背景技术
仿人机器人是与人类最接近的一种机器人,它与传统履带机器人或者轮式机器人相比,更能适应人类日常环境,同时更便于使用为人类发明设计的各种工具,模仿人类各种行为动作,因此,仿人机器人具有广阔的发展前景。
目前,人们对于仿人机器人的研究仍然主要集中在探索更加有效、可靠的稳定性控制方法,在这些研究中,仿人机器人的臂部和手部作为机器人行动过程中动作协调性和外界接触受力的部位,就成为解决仿人机器人的行动过程中动作协调性和动作稳定性的关键所在。在一些复杂的动作中,比如武术的刀术、剑术、太极推手、舞蹈表演、跑步时,其臂部姿态就特别重要,六自由度机械臂能满足人类臂部的基本动作和姿态,六自由为肩部2个、肘部1个、腕部3个。
以往仿人机器人机械臂的控制方法采用集中控制方法。目前,仿人机器人机械臂的控制方法根据仿人机器人大小采用集中或者分布式控制方法,由于选用控制方法和***存在差异,其效果也不同。
发明内容
在解决大型仿人机器人机械臂完成复杂的动作中,为了***高度实时性、容错性、可靠性、扩充性,本发明提出一种基于现场总线仿人机器人六自由机械臂的控制***1-1,所述技术方案如下:
一种基于现场总线仿人机器人六自由机械臂的控制***1-1,所述***包括:主计算机(1)、现场总线(2)、伺服单元(3)。
所述主计算机(1)完成运动规划算法,同时主计算机(1)还将通过现场总线(2)与各伺服单元(3)通信,各伺服单元(3)驱动仿人机器人机械臂1-3各关节1-2的协调运动。所述现场总线(2)选用CAN现场总线(2),CAN总线是一种现场总线(fieldbus),直接通信距离最远可达10km,速率5Kbps以下,通信速率最高可达1MbPs,此时通信距离最长为40m,节点目前可达110个,通信介质可为双绞线、同轴电缆或光纤,CAN现场总线(2)完成主计算机(1)与各伺服单元(3)通信。所述伺服单元驱动机械臂1-3各关节1-2运动。
所述伺服单元包括控制器2-1、驱动器2-2、电机2-3、检测与反馈电路2-4、减速器2-5组成。驱动器2-2选用TITECH的JW-144-2,电机2-3肩部和肘部选用的是瑞士MAXON公司的RE系列石墨电刷直流电机,型号为RE3024V 60W,腕部选用的也是瑞士MAXON公司的RE系列石墨电刷直流电机,型号为RE3024V 20W,从电机2-3轴检测与反馈器件选用的是光电轴角编码器,从减速器2-5检测与反馈器件选用的是电位器,减速器2-5选用的是谐波减速器。
所述控制器2-1包括CAN总线电路3-1、单片机3-2、D/A转换电路3-3。单片机3-2选用的是AT89C51CC01,AT89C51CC01本身自有CAN总线控制器,故不需要外加CAN总线控制器,D/A转换电路3-3选用D/A转换器是DAC7621。
所述CAN总线电路3-1包括光电耦合器4-1、CAN总线收发器4-2、防雷击管4-3、电阻R1、电阻R2、电阻R3、电阻R4、电容C1、电容C2。光电耦合器4-1选用高速光耦隔离6N137芯片,在此用2片6N137芯片,单片机3-2的TXDC引脚通过电阻R1和一片6N137芯片IN引脚连接,单片机3-2的RXDC引脚和另一片6N137芯片OUT引脚连接,CAN总线收发器4-2选用TJA1050芯片,一片6N137芯片OUT引脚连接TJA1050芯片引脚TXD,另一片6N137芯片IN引脚通过电阻R2连接TJA1050芯片引脚RXD,TJA1050芯片的CANH引脚通过电阻R3、电容C1、防雷击管4-3与CAN总线节点相连,TJA1050芯片的CANL引脚通过电阻R4、电容C2、防雷击管4-3与CAN总线节点相连。
本发明的有益效果是:
1.控制实时性能好,运动控制准确。
2.电路简单高效,抗干扰能力强。
3.电缆线少,便于应用,成本低。
附图说明
图1为本发明***及工作过程示意图。
图2为本发明伺服单元结构示意图。
图3为本发明控制器结构示意图。
图4为本发明CAN总线电路结构图。
具体实施方式
下面结合附图和具体实施对本发明进一步详细说明。
第一步:如图1所示,当仿人机器人机械臂1-3需要做出某种姿态时,主计算机(1)根据当前的各关节1-2的姿态以及下一步各关节1-2的姿态完成运动规划算法,主计算机(1)通过现场总线(2)把运动规划算法的结果传送到相应各伺服单元(3)。
第二步:如图2所示,相应各伺服单元(3)的控制器2-1根据运动规划算法的结果和检测与反馈电路2-4的结果经过一定的控制算法控制器2-1输出电压信号,输出的电压信号控制驱动器2-2的输出,驱动器2-2的输出控制电机2-3转动,电机2-3的转动驱动减速器2-5转动,减速器2-5的转动驱动关节3转动,在驱动器2-2控制电机2-3转动、电机2-3驱动减速器2-5转、减速器2-5驱动关节3转动的同时,从电机2-3轴光电轴角编码器检测的信号以及从减速器2-5电位器检测的信号反馈到控制器2-1,再重复上述过程,直至关节1-2达到预期的位置,机械臂1-3需要做出预期的姿态。
第三步:如图1所示,相应各伺服单元(3)的控制器2-1把各关节1-2的姿态位置发送到主计算机(1),同时准备机械臂1-3下一个姿态。
Claims (4)
1.一种基于现场总线仿人机器人六自由机械臂的控制***1-1,其特征在于:包括主计算机(1)、现场总线(2)和伺服单元(3)三部分。主计算机(1)完成运动规划算法,同时主计算机(1)还将通过现场总线(2)与各伺服单元(3)通信,各伺服单元(3)驱动仿人机器人机械臂1-3各关节1-2的协调运动。
2.如权利要求1所述的基于现场总线仿人机器人机械臂的控制方法及***,,其特征在于:所述伺服单元(3)包括控制器2-1、驱动器2-2、电机2-3、检测与反馈电路2-4、减速器2-5组成。驱动器2-2选用TITECH的JW-144-2,电机2-3肩部和肘部选用的是瑞士MAXON公司的RE系列石墨电刷直流电机,型号为RE3024V 60W,腕部选用的也是瑞士MAXON公司的RE系列石墨电刷直流电机,型号为RE3024V 20W,从电机2-3轴检测与反馈器件选用的是光电轴角编码器,从减速器2-5检测与反馈器件选用的是电位器,减速器2-5选用的是谐波减速器。
3.如权利要求2所述的伺服单元(3),其特征在于:所述伺服单元(3)的控制器2-1包括CAN总线电路3-1、单片机3-2、D/A转换电路3-3。单片机3-2选用的是AT89C51CC01,AT89C51CC01本身自有CAN总线控制器,故不需要外加CAN总线控制器,D/A转换电路3-3选用D/A转换器是DAC7621。
4.如权利要求3所述的控制器2-1,其特征在于:所述控制器2-1的CAN总线电路3-1包括包括光电耦合器4-1、CAN总线收发器4-2、防雷击管4-3、电阻R1、电阻R2、电阻R3、电阻R4、电容C1、电容C2。光电耦合器4-1选用高速光耦隔离6N137芯片,在此用2片6N137芯片,单片机3-2的TXDC引脚通过电阻R1和一片6N137芯片IN引脚连接,单片机3-2的RXDC引脚和另一片6N137芯片OUT引脚连接,CAN总线收发器4-2选用TJA1050芯片,一片6N137芯片OUT引脚连接TJA1050芯片引脚TXD,另一片6N137芯片IN引脚通过电阻R2连接TJA1050芯片引脚RXD,TJA1050芯片的CANH引脚通过电阻R3、电容C1、防雷击管4-3与CAN总线节点相连,TJA1050芯片的CANL引脚通过电阻R4、电容C2、防雷击管4-3与CAN总线节点相连。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010100324534A CN102126220A (zh) | 2010-01-12 | 2010-01-12 | 一种基于现场总线仿人机器人六自由机械臂的控制*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010100324534A CN102126220A (zh) | 2010-01-12 | 2010-01-12 | 一种基于现场总线仿人机器人六自由机械臂的控制*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN102126220A true CN102126220A (zh) | 2011-07-20 |
Family
ID=44264635
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010100324534A Pending CN102126220A (zh) | 2010-01-12 | 2010-01-12 | 一种基于现场总线仿人机器人六自由机械臂的控制*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102126220A (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103231373A (zh) * | 2013-03-26 | 2013-08-07 | 东南大学 | 外骨骼硬件控制平台 |
CN103522290A (zh) * | 2013-10-14 | 2014-01-22 | 上海胖熊信息技术有限公司 | 基于现场总线的分布式机器人控制*** |
CN103786155A (zh) * | 2014-01-21 | 2014-05-14 | 成都广泰实业有限公司 | 六轴串联机器人运动轨迹编程和控制方法 |
CN106073896A (zh) * | 2016-06-15 | 2016-11-09 | 重庆金山科技(集团)有限公司 | 一种用于手术机器人的电机控制网络及方法 |
CN109048914A (zh) * | 2018-09-07 | 2018-12-21 | 天津福云天翼科技有限公司 | 一种机器人关节伺服控制*** |
-
2010
- 2010-01-12 CN CN2010100324534A patent/CN102126220A/zh active Pending
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103231373A (zh) * | 2013-03-26 | 2013-08-07 | 东南大学 | 外骨骼硬件控制平台 |
CN103522290A (zh) * | 2013-10-14 | 2014-01-22 | 上海胖熊信息技术有限公司 | 基于现场总线的分布式机器人控制*** |
CN103522290B (zh) * | 2013-10-14 | 2015-12-02 | 上海司塔珂机器人技术有限公司 | 基于现场总线的分布式机器人控制*** |
CN103786155A (zh) * | 2014-01-21 | 2014-05-14 | 成都广泰实业有限公司 | 六轴串联机器人运动轨迹编程和控制方法 |
CN106073896A (zh) * | 2016-06-15 | 2016-11-09 | 重庆金山科技(集团)有限公司 | 一种用于手术机器人的电机控制网络及方法 |
CN109048914A (zh) * | 2018-09-07 | 2018-12-21 | 天津福云天翼科技有限公司 | 一种机器人关节伺服控制*** |
CN109048914B (zh) * | 2018-09-07 | 2024-03-29 | 天津福云天翼科技有限公司 | 一种机器人关节伺服控制*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102179815B (zh) | 基于CANopen的分布式模块化机械臂*** | |
CN101817182B (zh) | 一种智能移动机械臂控制*** | |
CN109032138A (zh) | 基于一致性算法的多机器人编队控制***及方法 | |
CN104589367B (zh) | 基于EtherCAT的模块化机器人驱动器和控制方法 | |
CN105700465A (zh) | 基于EtherCAT总线的机器人柔顺控制***和方法 | |
CN203366073U (zh) | 一种带电作业双臂机器人运动控制*** | |
CN101045297A (zh) | 一种分布式多自由度机器人控制*** | |
CN202878325U (zh) | 小型模块化机械手臂 | |
CN102126220A (zh) | 一种基于现场总线仿人机器人六自由机械臂的控制*** | |
CN103744376B (zh) | 一种伺服驱动器及使用该伺服驱动器的多轴控制*** | |
CN102248536B (zh) | 一种用于可拓展模块化的移动机械臂控制*** | |
CN108214445A (zh) | 一种基于ros的主从异构遥操作控制*** | |
CN108262742A (zh) | 一种模块化结构的机器人及其控制方法 | |
CN103056883B (zh) | 一种双机械臂协调控制***及控制方法 | |
CN201625982U (zh) | 智能移动机械臂控制*** | |
CN201525026U (zh) | 模块化的灾害救援机器人 | |
CN107662210A (zh) | 一种耐辐照动力机械手控制*** | |
CN114714327A (zh) | 一种机械臂与灵巧手的融合***及运动控制方法 | |
CN111497964B (zh) | 一种电驱动四足机器人分布式控制*** | |
CN101973034A (zh) | 一种机器人控制电路 | |
CN215903514U (zh) | 一种带电作业机械臂及带电作业机器人 | |
CN212683969U (zh) | 一种果园多机器人物理模型 | |
CN105364925B (zh) | 基于舵机驱动的高压输电巡线及作业机器人手臂 | |
CN105373109B (zh) | 一种Delta机器人驱控*** | |
CN213471194U (zh) | 一种新型多功能类人机器人平台及其控制*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20110720 |