CN103192390B - 拟人机器人控制系统 - Google Patents

拟人机器人控制系统 Download PDF

Info

Publication number
CN103192390B
CN103192390B CN201310129482.6A CN201310129482A CN103192390B CN 103192390 B CN103192390 B CN 103192390B CN 201310129482 A CN201310129482 A CN 201310129482A CN 103192390 B CN103192390 B CN 103192390B
Authority
CN
China
Prior art keywords
control
controller
digital rudder
robot
steering wheel
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.)
Active
Application number
CN201310129482.6A
Other languages
English (en)
Other versions
CN103192390A (zh
Inventor
张磊
仇哲
李元
黎明
张声远
冯晓凯
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
QINGDAO HAIYI AUTOMATION TECHNOLOGY Co Ltd
Ocean University of China
Original Assignee
QINGDAO HAIYI AUTOMATION TECHNOLOGY Co Ltd
Ocean University of China
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by QINGDAO HAIYI AUTOMATION TECHNOLOGY Co Ltd, Ocean University of China filed Critical QINGDAO HAIYI AUTOMATION TECHNOLOGY Co Ltd
Priority to CN201310129482.6A priority Critical patent/CN103192390B/zh
Publication of CN103192390A publication Critical patent/CN103192390A/zh
Application granted granted Critical
Publication of CN103192390B publication Critical patent/CN103192390B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

本发明涉及一种拟人机器人控制系统,该控制系统为集散式控制系统,包括通过蓝牙模块实现数据无线通信的上位机和下位机、通过通信电路连接的关节自由度控制器,其中所述上位机主要由以SBC-FITPC2i为核心的单板电脑构成,所述下位机主要由以STM32F103RB芯片为核心的ARM7控制器构成;所述关节自由度控制器为数字舵机。所述蓝牙模块与所述下位机的ARM控制器连接。本发明功能设计齐全,结构布局合理,系统功耗低,集控制、传感、通信于一体,控制系统升级成本低,可用于机器人系统的进一步移植和开发,减少再次开发的费用。

Description

拟人机器人控制系统
技术领域
[0001] 本发明属于机器人技术领域,具体地说,涉及一种拟人机器人控制系统。
背景技术
[0002] 拟人形机器人,简称拟人机器人,其“拟人”的本质在于此类高级机器人具有类人的感知、决策、行为和交互能力,即它不仅需要具有类人的形体和外观、类人的知觉和感官功能、类人的大脑思维与控制能力,更需要具备类人的行为特征,这一特征的基本体现为类人双足运动平衡与控制能力的实现。
[0003] 与其他工业和特种移动机器人(轮式、履带式、多足式等)相比,拟人机器人在移动过程中与地面的接触为双足在相对狭小空间内的一系列可选择离散支撑点,因而拟人步行机器人具有高度的适应性与灵活性,它既能在平地上行走,也能在凹凸不平、狭窄空间、台阶和斜坡以及空间障碍等复杂非结构化环境中实现各种形式的运动和动作。
[0004] 拟人机器人是类人仿生运动与智能在形式与功能上同一的仿生机电自动化系统再创造。其发展过程中面临着许多难题:实现各种类人动作与功能的多样性;人类社会环境在空间、时间和对象上的高维性;自身机构实现在空间上的自由度边拓扑结构特点;行走与动作控制的多输入多输出非线性、变参数、多驱动协调特性等。
[0005]目前,拟人机器人的控制系统功能设计较为简单、功能模块选型较为单一、系统功耗较高、扩展性不足、控制系统升级较为困难、开发成本较高,并没有体现出拟人机器人控制的灵活性和开放性,增加了拟人机器人研究和控制的复杂性。
发明内容
[0006] 为解决上述技术问题,本发明提出了一种结构布局合理,系统功耗低,集控制、传感、通信于一体的拟人机器人控制系统。
[0007] 本发明的技术方案是:一种拟人机器人控制系统,该控制系统为集散式控制系统,包括通过蓝牙模块实现数据无线通信的上位机和下位机、通过通信电路连接的关节自由度控制器,其中所述上位机主要由以SBC_FITPC2i为核心的单板电脑构成,所述下位机主要由以STM32F103RB芯片为核心的ARM7控制器构成;所述关节自由度控制器为数字舵机。
[0008] 所述蓝牙模块与所述下位机的ARM控制器连接。
[0009] 所述上位机还包括USB接口、串行COM 口和数据存储器。
[0010] 所述下位机还包括分别与所述ARM控制器连接的稳压电路、复位电路、姿态传感器、LED报警灯、蜂鸣器、功能按键、无线通信控制电路、电源切换电路、USB转UART电路、电压检测电路、JTAG和ISP下载电路、预留串口和其他标准接口。
[0011 ] 所述下位机还包括数字舵机电源控制电路,数字舵机通信电路和数字舵机储能电路。
[0012] 本发明的有益效果在于:本发明功能设计齐全,功能模块选型新颖实用,结构布局合理,系统功耗低,控制系统升级较容易,升级成本低,集控制、传感、通信于一体,可用于机器人系统的进一步移植和开发,减少再次开发的费用。本控制系统不仅可以用于拟人机器人控制系统的研发,还可以作为多足机器人、仿生蛇形机器人、竞赛舞蹈机器人等多种机器人的控制平台进行开发和使用,具有很高的教学和竞赛价值。
附图说明
[0013] 图1是本发明的整体结构示意图;
[0014] 图2是本发明中下位机硬件的原理框图;
[0015] 图3是本发明的控制流程图。
具体实施方式
[0016] 以下结合附图和实施例具体说明本发明。
[0017] 实施例1
[0018] 如图1和图3所示,本发明是一种基于SBC-FITPC2i的单板电脑与ARM控制器的拟人机器人控制系统,本系统由上位机和下位机组成,上位机由以SBC-FITPC2i为核心的单板电脑构成(由功能需求不同可自由选择安装连接),下位机由以STM32F103RBT为核心的ARM控制器构成,本系统中,ARM控制器为拟人机器人关节控制器,上位机和下位机之间通过蓝牙模块实现数据的无线通信,并通过蓝牙来接收、发送信息,降低了通信的复杂性,同时也降低了成本;蓝牙模块与下位机接口处还设计了开关电路,用户可根据需求开启无线通信模块,这样降低了系统的功耗。下位机还连接有外部姿态传感器,并从姿态传感器实时获取机器人的姿态信息,如:三轴角速度、三轴线加速度、三维姿态角等,结合相应的控制算法对机器人的姿态进行控制,更好的完成机器人运动控制指令。另外,本系统预留了其他GP1 口和标准总线接口,用户可根据需求自行配置其他类型传感器和功能模块进行机器人的研究和开发。
[0019] 如图1所示,本发明中,采用了一种新型数字舵机作为机器人关节自由度控制器,与传统拟人机器人采用电机、减速器、光电编码器联合作为机器人关节控制器相比,该数字舵机具有较大的齿轮比,较高的分辨率(0.29 ),强大的输出转矩,高速的通信速率,标准的半双工异步通信协议,同时舵机内置电位计,温度传感器等一系列传感器,能够反馈舵机的位置、温度、负载大小、输入电压等信息,下位机能够根据数字舵机实时反馈的状态信息更好地控制舵机完成机器人的运动控制。
[0020] 如图1所示,本发明中,数字舵机通信电路将UART信号传输方式转换为半双工传输方式,利用多降法使得下位机能够在单一节点连接控制多个数字舵机,从而实现机器人多自由度控制,具体实现如图1所示,该机器人控制系统通过数字舵机接口电路连接5组数字舵机,5组数字舵机分别代表拟人机器人的左肢(I组)、右肢(2组)、左臂(3组)、右臂(4组)、头颈(5组)的关节控制器,这5组数字舵机全部连接到同一条总线进行通信,通信协议为半双工异步通信(8位数据,I位停止,无校验)。数字舵机通信电路输出电平为TTL电平,TTL电平保证了数字舵机高速的通信速率。数字舵机通信电路附近设计了数字舵机通信防干扰电路,下位机收发的数据经过数字舵机通信防干扰电路的保护,大大提高了通信的准确性。另外,在舵机接口电路附近设计了舵机供电储能电路。由于拟人机器人关节自由度较多,在对拟人机器人进行快速复杂运动控制时,可能由于拟人机器人驱动负载过大,导致数字舵机两端压降较大,使得数字舵机工作性能不稳定,通过设计舵机储能电路,利用大容量电解电容的放电特性,弥补数字舵机两端的压降,使得舵机工作状态趋于稳定,保证控制系统对数字舵机的控制精度。
[0021] 如图2所示,下位机以STM32F103RBT为核心并集成了拟人机器人控制系统所必须的丰富的外围资源,包括:电压检测电路,USB转UART电路,无线通信电路,JTAG和ISP下载电路,舵机电源控制电路、报警电路,稳压电路,电源切换电路,复位电路等。下位机通过舵机通信控制电路和舵机接口电路与数字舵机相连,下位机ARM控制器将接收到的舵机控制命令和控制参数,按照舵机通讯协议的格式转换为相应的指令包由舵机通信控制电路传输到数字舵机,用于数字舵机的控制;舵机接收到指令包后会自动返回一个包含舵机错误信息的状态包,用于反馈舵机的实时状态。此外,下位机可随时发送指令查询数字舵机当前状态信息,如:位置、速度、温度、负载、输入电压等,提高了下位机对数字舵机控制的准确性和可靠性。上位机发出的机器人控制命令,经蓝牙模块的无线传输,由下位机上的蓝牙从机模块接收,通过UART2 (串口 2)传输至MCU (从控制器),MCU获取机器人控制命令后,结合相应的控制算法以及传感器的姿态信息对控制命令进行相应解析和处理后,由UARTl (串口I)传输至舵机通信电路,经过舵机通信电路的电平转换,再传输到数字舵机通信总线,数字舵机接收到控制命令后执行相应的机器人动作。另外,上位机可以随时发送查看机器人当前运动状态,具体操作与上述过程类似。
[0022] 本发明在无线通信中采用蓝牙技术,蓝牙技术较其他无线通信方式具有功耗低,成本低,通讯可靠的特点,蓝牙模块可与带有蓝牙适配器的上位机进行配对通信。
[0023] 本发明在程序下载方面提供两种下载方式,JTAG和ISP下载,方便用户根据资源和需求选择下载方式。
[0024] 本发明在设计上还预留了串行接口及其他标准总线接口,用户可根据需求和现有资源进行自行开发。
[0025] 虽然本发明是一种应用于拟人机器人的控制系统,但该控制系统不仅适用于拟人机器人,还可应用于多足机器人、仿生蛇形机器人、竞赛舞蹈机器人等多种机器人控制系统,二次开发容易,成本低,可移植性好。
[0026] 实施例2
[0027] 除以下区别外,其他同实施例1。
[0028] 如图2所示,本发明还设计了一个传感器接口电路,可与串口收发模式的姿态传感器进行硬件连接,下位机可以实时获取来自姿态传感器的数据信息,如:三轴角速度、三轴线加速度、三维姿态角等,根据获取的数据信息对机器人姿态进行分析,结合相应的控制算法对机器人的姿态进行控制,更好的完成机器人运动控制指令。
[0029] 实施例3
[0030] 除以下区别外,其他同实施例1。
[0031] 如图2所示,本发明还设计了一个电源切换电路。由于拟人机器人关节自由度较多,驱动负载较大,进行调试和开发时,如果仅用锂电池供电,锂电池的电量很快就耗尽,这就需要反复拆装锂电池进行充电,不利于机器人的调试和开发。通过电源切换电路,机器人控制系统可以实现锂电池和适配器切换供电,当只接入锂电池时,由锂电池对机器人供电,拟人机器人完成一系列完整动作;当只接入适配器时,由适配器对机器人供电,拟人机器人完成一系列上位机调试及数据处理的工作;当同时接入适配器和锂电池时,电源切换电路可自动选择适配器为控制系统供电,同时适配器可以给锂电池充电,这样用户可以根据需求选择供电方式,大大提高了控制系统的可操作性。
[0032] 实施例4
[0033] 除以下区别外,其他同实施例1。
[0034] 如图2所示,本发明还设计了电压检测电路对电源电压进行实时监控,当检测到电源电量不足时,会触发报警信号,提醒操作者更换电源或对电源进行充电,保证机器人正常工作以免损坏。
[0035] 实施例5
[0036] 除以下区别外,其他同实施例1。
[0037] 如图2所示,本发明还设计了数字舵机电源控制电路和多种报警电路,当下位机检测到数字舵机反馈的输入电压超过设定的限制值时,由软件控制数字舵机电源控制电路切断数字舵机的供电从而保护机器人。多种报警电路包括蜂鸣器报警、LED报警、复位电路,下位机可根据机器人出现不同程度的错误做出相应的报警处理。
[0038] 实施例6
[0039] 除以下区别外,其他同实施例1。
[0040] 如图2所示,本发明还设计了 USB转UART电路,为上位机提供了一个串口,可以实现下位机与上位机之间的通信。

Claims (3)

1.一种拟人机器人控制系统,其特征在于,该控制系统为集散式控制系统,包括通过蓝牙模块实现数据无线通信的上位机和下位机、通过通信电路连接的关节自由度控制器,其中所述上位机主要由以SBC-FITPC2i为核心的单板电脑构成,所述下位机主要由以STM32F103RB芯片为核心的ARM7控制器构成;所述关节自由度控制器为数字舵机,所述数字舵机为5组,分别用作拟人机器人的左肢、右肢、左臂、右臂和头颈的关节控制器; 数字舵机通信电路利用多降法使得下位机能够在单一节点连接控制多个数字舵机,控制系统通过数字舵机接口电路连接5组数字舵机,5组数字舵机分别代表拟人机器人的左肢、右肢、左臂、右臂、头颈的关节控制器,这5组数字舵机全部连接到同一条总线进行通信,通信协议为半双工异步通信,数字舵机通信电路附近设计了数字舵机通信防干扰电路,下位机收发的数据传递到数字舵机通信防干扰电路;在舵机接口电路附近增加舵机供电储能电路; 下位机通过数字舵机通信电路和舵机接口电路与数字舵机相连,下位机ARM7控制器将接收到的舵机控制命令和控制参数,按照舵机通讯协议的格式转换为相应的指令包由舵机通信控制电路传输到数字舵机;舵机接收到指令包后会自动返回一个包含舵机错误信息的状态包;上位机发出的机器人控制命令,经蓝牙模块的无线传输,由下位机上的蓝牙从机模块接收,通过UART2传输至MCU,MCU获取机器人控制命令后,结合相应的控制算法以及传感器的姿态信息对控制命令进行相应解析和处理后,由UARTl传输至舵机通信电路,经过舵机通信电路的电平转换,再传输到数字舵机通信总线,数字舵机接收到控制命令后执行相应的机器人动作。
2.根据权利要求1所述的拟人机器人控制系统,其特征在于,所述蓝牙模块与所述下位机的ARM7控制器连接。
3.根据权利要求1所述的拟人机器人控制系统,其特征在于,所述上位机还包括USB接口、串行COM 口和数据存储器。
CN201310129482.6A 2013-04-15 2013-04-15 拟人机器人控制系统 Active CN103192390B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310129482.6A CN103192390B (zh) 2013-04-15 2013-04-15 拟人机器人控制系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310129482.6A CN103192390B (zh) 2013-04-15 2013-04-15 拟人机器人控制系统

Publications (2)

Publication Number Publication Date
CN103192390A CN103192390A (zh) 2013-07-10
CN103192390B true CN103192390B (zh) 2015-12-02

Family

ID=48715297

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310129482.6A Active CN103192390B (zh) 2013-04-15 2013-04-15 拟人机器人控制系统

Country Status (1)

Country Link
CN (1) CN103192390B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104889996B (zh) * 2015-05-12 2017-01-04 卓翔 一种替身机器人的替身实现方法
CN105100233A (zh) * 2015-07-14 2015-11-25 上海智臻智能网络科技股份有限公司 一种扫地机器人的唤醒方法及系统
CN106217376A (zh) * 2016-08-27 2016-12-14 广东奥讯智能设备技术有限公司 一种基于串行通信协议的机器人控制系统及控制方法
CN108247632A (zh) * 2017-12-28 2018-07-06 哈尔滨工业大学深圳研究生院 一种基于ros的协作机器人控制系统
CN108536052A (zh) * 2018-03-08 2018-09-14 西安缔造者机器人有限责任公司 一种基于运动关节的机器人控制器
CN109036046A (zh) * 2018-09-05 2018-12-18 南京阿波罗机器人科技有限公司 一种stem触屏可编程电子积木控制器
CN110069029A (zh) * 2019-04-15 2019-07-30 广州市威控机器人有限公司 一种基于总线舵机的足式机器人控制系统及其控制方法
CN112025704B (zh) * 2020-08-25 2021-10-01 杭州湖西云百生科技有限公司 基于内存型数据库的实时分布式机器人控制方法及系统
CN113183167A (zh) * 2021-04-30 2021-07-30 智能移动机器人(中山)研究院 一种足式机器人的运动控制系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101947788A (zh) * 2010-06-23 2011-01-19 焦利民 一种智能机器人
CN201974998U (zh) * 2011-01-07 2011-09-14 华中科技大学 多足教育机器人
CN102699917A (zh) * 2012-06-08 2012-10-03 北京工业大学 一种基于智能手机的解魔方机器人
CN102962844A (zh) * 2012-11-09 2013-03-13 沈阳工业大学 一种由机械操纵的皮影表演装置控制系统
CN203185348U (zh) * 2013-04-15 2013-09-11 青岛海艺自动化技术有限公司 拟人机器人控制系统

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
AT12208U3 (de) * 2011-09-06 2013-07-15 Keba Ag Verfahren, steuerungssystem und bewegungsvorgabemittel zum programmieren oder vorgeben von bewegungen oder abläufen eines industrieroboters

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101947788A (zh) * 2010-06-23 2011-01-19 焦利民 一种智能机器人
CN201974998U (zh) * 2011-01-07 2011-09-14 华中科技大学 多足教育机器人
CN102699917A (zh) * 2012-06-08 2012-10-03 北京工业大学 一种基于智能手机的解魔方机器人
CN102962844A (zh) * 2012-11-09 2013-03-13 沈阳工业大学 一种由机械操纵的皮影表演装置控制系统
CN203185348U (zh) * 2013-04-15 2013-09-11 青岛海艺自动化技术有限公司 拟人机器人控制系统

Also Published As

Publication number Publication date
CN103192390A (zh) 2013-07-10

Similar Documents

Publication Publication Date Title
CN103192390B (zh) 拟人机器人控制系统
Rubenstein et al. Kilobot: A low cost scalable robot system for collective behaviors
CN101817182B (zh) 一种智能移动机械臂控制系统
CN103862457A (zh) 一种带视觉系统的服务机器人
CN101373380B (zh) 一种仿人机器人控制系统及机器人操纵方法
CN101216711A (zh) 两栖机械螃蟹的分级控制装置及控制方法
CN103901889A (zh) 一种基于蓝牙通信的多机器人编队控制路径跟踪方法
CN104175308A (zh) 自主服务机器人
CN203185348U (zh) 拟人机器人控制系统
CN105573198A (zh) 一种基于ucosii的矿井搜救系统及搜救方法
CN105824292A (zh) 一种机器人分布式控制器及控制方法
CN202257212U (zh) 仿人机器人控制系统
CN201625982U (zh) 智能移动机械臂控制系统
CN205884910U (zh) 基于ZigBee的智能跟踪行李箱
CN204209679U (zh) 自主服务机器人
CN204883256U (zh) 一种机器人高实时控制系统架构
CN105528883A (zh) 一种风速风向无线采集系统及方法
CN105068534A (zh) 基于Zigbee的智能物流机器人
CN102722174B (zh) 基于总线控制方式的agv控制系统
CN102360190A (zh) 一种仿人机器人控制系统
CN204536903U (zh) 一种多功能智能化平衡机器人
CN103273980A (zh) 可自组装为多足轮腿式机器人的模块机器人
CN203294226U (zh) 可自组装为多足轮腿式机器人的模块机器人
CN111497964A (zh) 一种电驱动四足机器人分布式控制系统
CN207182044U (zh) 一种基于状态控制的智能舵机控制器

Legal Events

Date Code Title Description
PB01 Publication
C06 Publication
SE01 Entry into force of request for substantive examination
C10 Entry into substantive examination
GR01 Patent grant
C14 Grant of patent or utility model