CN106826872B - 一种舞蹈机器人控制方法及系统 - Google Patents

一种舞蹈机器人控制方法及系统 Download PDF

Info

Publication number
CN106826872B
CN106826872B CN201710245877.0A CN201710245877A CN106826872B CN 106826872 B CN106826872 B CN 106826872B CN 201710245877 A CN201710245877 A CN 201710245877A CN 106826872 B CN106826872 B CN 106826872B
Authority
CN
China
Prior art keywords
robot
main controller
module
servo
laser radar
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
CN201710245877.0A
Other languages
English (en)
Other versions
CN106826872A (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.)
Qingyan Huayu Intelligent Robot Tianjin Co ltd
Original Assignee
Qingyan Huayu Intelligent Robot Tianjin Co ltd
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 Qingyan Huayu Intelligent Robot Tianjin Co ltd filed Critical Qingyan Huayu Intelligent Robot Tianjin Co ltd
Priority to CN201710245877.0A priority Critical patent/CN106826872B/zh
Publication of CN106826872A publication Critical patent/CN106826872A/zh
Application granted granted Critical
Publication of CN106826872B publication Critical patent/CN106826872B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00—Manipulators not otherwise provided for
    • B25J11/003—Manipulators for entertainment
    • B25J11/0035—Dancing, executing a choreography
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02—Sensing devices
    • B25J19/021—Optical sensing devices
    • B25J19/022—Optical sensing devices using lasers
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/06—Safety devices
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00—Road transport of goods or passengers
    • Y02T10/60—Other road transportation technologies with climate change mitigation effect
    • Y02T10/72—Electric energy management in electromobility

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Optics & Photonics (AREA)
  • Manipulator (AREA)
  • Toys (AREA)

Abstract

本发明提供了一种舞蹈机器人控制方法及系统，包括主控制器和激光雷达模块、六维力传感器模块、触摸模块、伺服模块、供电模块，所述激光雷达模块包括激光雷达测距装置，所述激光雷达测距装置连接主控制器，所述六维力传感器模块连接主控制器，所述触摸模块包括多个压力传感器，所述压力传感器都连接主控制器，所述伺服模块包括多个伺服电机，所述伺服电机通过伺服驱动器连接主控制器。本发明所述的舞蹈机器人跳舞时，机器人通过判断与人体接触位置和机器人六维受力方向与大小，做出不同运动，防止使人受伤。

Description

一种舞蹈机器人控制方法及系统
技术领域
本发明属于智能机器人技术领域，尤其是涉及一种舞蹈机器人控制方法及系统。
背景技术
随着科技水平的不断进步，服务类机器人种类逐渐增多，例如咨询类机器人、娱乐机器人，机器人的功能也逐渐增多。
但是现有的跳舞机器人，大多功能较为单一，只能实现简单的摆动，完成小幅度的舞动动作，智能化的程度较低。
发明内容
有鉴于此，本发明旨在提出一种舞蹈机器人控制方法及系统，以解决目前舞蹈机器人功能单一，智能化程度较低的情况。
为达到上述目的，本发明的技术方案是这样实现的：
一种舞蹈机器人控制方法，包括激光雷达模块检测与周围障碍物的距离，根据与周围障碍物的距离，控制器时时作出判断；六维力传感器模块和触摸模块检测机器人的受力情况，控制器做出判断及时调整机器人与人受力方向，防止人受伤。
进一步的，所述激光雷达模块的执行方法和主控制器的控制方法，具体如下：
S101、机器人运行后，激光雷达模块检测机器人与周围障碍物之间的距离信息，并将信息发送至主控制器；
S102、主控制器通过处理、运算，计算出机器人与周围障碍物之间的距离；
S103、当主控制器测量的机器人与周围障碍物的距离小于0.5米时，主控制器控制伺服模块驱动机器人远离障碍物；
S104、当主控制器测量的机器人与周围障碍物的距离在0.5米以上时，返回执行步骤S101。
进一步的，所述六维力传感器模块是在与人体互动，人体用力较大，机器人整体发生形变时才向主控制器发送信息，六维力传感器的执行方法和主控制器的控制执行方法，具体如下：
S201、当机器人与人互动，用力较大时，机器人会向某个方向发生形变；
S202、六维力传感器根据形变，计算出三个力分量和三个力矩分量信息，并将信息发送至主控制器；
S203、主控制器根据受力的方向，控制伺服模块驱动机器人沿受力方向运行，并且形变越大运行越快。
进一步的，所述触摸模块包括多个压力传感器，所述触摸模块的执行方法和主控制器控制方法，具体如下：
S301、当机器人与人互动时，机器人与人接触，接触部位的压力传感器向主控制器发送信息；
S302、主控制器处理压力传感器反馈的压力大小、方向信息；
S303、主控制器向伺服模块发送控制指令，控制伺服模块驱动机器人沿受力方向运行，并且受力越大运行越快。
一种舞蹈机器人控制系统，包括主控制器和激光雷达模块、六维力传感器模块、触摸模块、伺服模块、供电模块；所述激光雷达模块包括激光雷达测距装置，所述激光雷达测距装置连接主控制器；所述六维力传感器模块连接主控制器；所述触摸模块包括多个压力传感器，所述压力传感器都连接主控制器；所述伺服模块包括多个伺服电机，所述伺服电机通过伺服驱动器连接主控制器。
进一步的，所述供电模块为锂电池，所述供电模块通过DC/DC电源模块为控制系统供电。
进一步的，所述触摸模块包括分别安装在头部、左臂、右臂、左肩膀、右肩膀、前胸、后背、前腰、后腰、前腿部和后腿部的11路压力传感器。
进一步的，所述压力传感器的型号为FSR406。
进一步的，所述伺服模块包括3个伺服电机，每个伺服电机连接一个全向轮，所述全向轮安装在机器人底部。
进一步的，所述主控制器为ARM控制器。
相对于现有技术，本发明所述的舞蹈机器人控制方法及系统具有以下优势：
本发明所述的舞蹈机器人可以实现与人协作，判断人与机器人位置关系、接触位置、机器人本身受力情况，并做出运动，可以自动躲避障碍物；跳舞时，机器人通过判断与人体接触位置和机器人六维受力方向与大小，驱动机器人顺着人的用力方向运行，并且可以根据人的用力大小，调整运行速度的快慢，防止使人受伤。
附图说明
构成本发明的一部分的附图用来提供对本发明的进一步理解，本发明的示意性实施例及其说明用于解释本发明，并不构成对本发明的不当限定。在附图中：
图1为本发明实施例所述的舞蹈机器人控制系统原理示意图；
图2为本发明实施例所述的舞蹈机器人控制系统供电装置原理图；
图3为本发明实施例所述的舞蹈机器人触摸模块原理图；
图4为本发明实施例所述的舞蹈机器人两种舞蹈模式流程图。
具体实施方式
需要说明的是，在不冲突的情况下，本发明中的实施例及实施例中的特征可以相互组合。
在本发明的描述中，需要理解的是，术语“中心”、“纵向”、“横向”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系，仅是为了便于描述本发明和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本发明的限制。此外，术语“第一”、“第二”等仅用于描述目的，而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此，限定有“第一”、“第二”等的特征可以明示或者隐含地包括一个或者更多个该特征。在本发明的描述中，除非另有说明，“多个”的含义是两个或两个以上。
在本发明的描述中，需要说明的是，除非另有明确的规定和限定，术语“安装”、“相连”、“连接”应做广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体地连接；可以是机械连接，也可以是电连接；可以是直接相连，也可以通过中间媒介间接相连，可以是两个元件内部的连通。对于本领域的普通技术人员而言，可以通过具体情况理解上述术语在本发明中的具体含义。
下面将参考附图并结合实施例来详细说明本发明。
如图1至图4所示，一种舞蹈机器人控制方法，包括激光雷达模块检测与周围障碍物的距离，根据与周围障碍物的距离，控制器时时作出判断；六维力传感器模块和触摸模块检测机器人的受力情况，控制器做出判断及时调整机器人与人受力方向，防止人受伤。
所述舞蹈机器人包括两种跳舞模式，一种是单独跳舞，另一种是教人跳舞；单独跳舞时，只需要判断与周围障碍物之间的距离；教人跳舞时，既需要判断与周围障碍物以及与人的距离，也需要跟根据检测到的受力情况，调整机器人的运行方向。
其中，所述激光雷达模块的执行方法和主控制器的控制方法，具体如下：
S101、机器人运行后，激光雷达模块检测机器人与周围障碍物之间的距离信息，并将信息发送至主控制器；
S102、主控制器通过处理、运算，计算出机器人与周围障碍物之间的距离；
S103、当主控制器测量的机器人与周围障碍物的距离小于0.5米时，主控制器控制伺服模块驱动机器人远离障碍物；
S104、当主控制器测量的机器人与周围障碍物的距离在0.5米以上时，返回执行步骤S101。
其中，所述六维力传感器模块是在与人体互动，人体用力较大，机器人整体发生形变时才向主控制器发送信息，六维力传感器的执行方法和主控制器的控制执行方法，具体如下：
S201、当机器人与人互动，用力较大时，机器人会向某个方向发生形变；
S202、六维力传感器根据形变，计算出三个力分量和三个力矩分量信息，并将信息发送至主控制器；
S203、主控制器根据受力的方向，控制伺服模块驱动机器人沿受力方向运行，并且形变越大运行越快。
其中，所述触摸模块包括多个压力传感器，所述触摸模块的执行方法和主控制器控制方法，具体如下：
S301、当机器人与人互动时，机器人与人接触，接触部位的压力传感器向主控制器发送信息；
S302、主控制器处理压力传感器反馈的压力大小、方向信息；
S303、主控制器向伺服模块发送控制指令，控制伺服模块驱动机器人沿受力方向运行，并且受力越大运行越快。
如图1至图3所示，一种舞蹈机器人控制系统，包括主控制器和激光雷达模块、六维力传感器模块、触摸模块、伺服模块、供电模块；所述激光雷达模块包括激光雷达测距装置，所述激光雷达测距装置连接主控制器，防止在教人跳舞时机器人与人或者物体发生碰撞，有效的保护机器人与人的安全；所述六维力传感器模块连接主控制器，所述触摸模块包括多个压力传感器，所述压力传感器都连接主控制器，所述伺服模块包括多个伺服电机，所述伺服电机通过伺服驱动器连接主控制器。
其中，所述供电模块为锂电池，所述供电模块通过DC/DC电源模块为控制系统供电。
其中，所述触摸模块包括分别安装在头部、左臂、右臂、左肩膀、右肩膀、前胸、后背、前腰、后腰、前腿部和后腿部的11路压力传感器。安装多个压力传感器，可以全方位的检测机器人的受力情况，防止出现受力盲点，更好的服务于人。
其中，所述压力传感器的型号为FSR406。
其中，所述伺服模块包括安装在机器人底部的3个伺服电机。通过控制伺服电机和全向轮可以控制机器人与人的距离，机器人的运行方向，避免过力接触，达到教人跳舞，与人互动的目的。
其中，所述主控制器为ARM控制器。
以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (1)

1.一种舞蹈机器人控制方法，其特征在于：包括当机器人跳舞时，激光雷达模块检测与周围障碍物的距离，根据与周围障碍物的距离，主控制器作出实时判断；当机器人教人跳舞时，六维力传感器模块和触摸模块检测机器人的受力情况，主控制器做出判断及时调整机器人与人受力方向，防止人受伤；
所述激光雷达模块的执行方法和主控制器的控制方法，具体如下：
S101、机器人运行后，激光雷达模块检测机器人与周围障碍物之间的距离信息，并将信息发送至主控制器；
S102、主控制器通过处理、运算，计算出机器人与周围障碍物之间的距离；
S103、当主控制器测量的机器人与周围障碍物的距离小于0.5米时，主控制器控制伺服模块驱动机器人远离障碍物；
S104、当主控制器测量的机器人与周围障碍物的距离在0.5米以上时，返回执行步骤S101；
所述六维力传感器模块是在与人体互动，人体用力较大，机器人整体发生形变时才向主控制器发送信息，六维力传感器的执行方法和主控制器的控制执行方法，具体如下：
S201、当机器人与人互动，用力较大时，机器人会向某个方向发生形变；
S202、六维力传感器根据形变，计算出三个力分量和三个力矩分量信息，并将信息发送至主控制器；
S203、主控制器根据受力的方向，控制伺服模块驱动机器人沿受力方向运行，并且形变越大运行越快；
所述触摸模块包括多个压力传感器，所述触摸模块的执行方法和主控制器控制方法，具体如下：
S301、当机器人与人互动时，机器人与人接触，接触部位的压力传感器向主控制器发送信息；
S302、主控制器处理压力传感器反馈的压力大小、方向信息；
S303、主控制器向伺服模块发送控制指令，控制伺服模块驱动机器人沿受力方向运行，并且受力越大运行越快；
包括主控制器和激光雷达模块、六维力传感器模块、触摸模块、伺服模块、供电模块；所述激光雷达模块包括激光雷达测距装置，所述激光雷达测距装置连接主控制器；所述六维力传感器模块连接主控制器；所述触摸模块包括多个压力传感器，所述压力传感器都连接主控制器；所述伺服模块包括多个伺服电机，所述伺服电机通过伺服驱动器连接主控制器；
所述供电模块为锂电池，所述供电模块通过DC/DC电源模块为控制系统供电；
所述触摸模块包括分别安装在头部、左臂、右臂、左肩膀、右肩膀、前胸、后背、前腰、后腰、前腿部和后腿部的11路压力传感器；
所述压力传感器的型号为FSR406；
所述伺服模块包括3个伺服电机，每个伺服电机连接一个全向轮，所述全向轮安装在机器人底部；
所述主控制器为ARM控制器。
CN201710245877.0A 2017-04-14 2017-04-14 一种舞蹈机器人控制方法及系统 Active CN106826872B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710245877.0A CN106826872B (zh) 2017-04-14 2017-04-14 一种舞蹈机器人控制方法及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710245877.0A CN106826872B (zh) 2017-04-14 2017-04-14 一种舞蹈机器人控制方法及系统

Publications (2)

Publication Number Publication Date
CN106826872A CN106826872A (zh) 2017-06-13
CN106826872B true CN106826872B (zh) 2023-07-18

Family

ID=59146706

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710245877.0A Active CN106826872B (zh) 2017-04-14 2017-04-14 一种舞蹈机器人控制方法及系统

Country Status (1)

Country Link
CN (1) CN106826872B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108908378A (zh) * 2018-05-14 2018-11-30 莱茵检测认证服务（中国）有限公司 一种人与机器人接触过程中接触压强的测试方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100688225B1 (ko) * 2006-04-04 2007-03-02 삼성전자주식회사 센서 내장 신발과 휴대용 무선 단말기를 이용한 댄스 강습방법 및 시스템
CN105596018A (zh) * 2016-03-25 2016-05-25 上海电气集团股份有限公司 基于力传感器的人体运动趋势检测装置及检测方法
CN105676845A (zh) * 2016-01-19 2016-06-15 中国人民解放军国防科学技术大学 一种智能安保服务机器人复杂环境避障方法及安保服务机器人
CN105904460A (zh) * 2016-07-11 2016-08-31 吉林大学 一种实时仿人舞蹈机器人控制系统
CN206869894U (zh) * 2017-04-14 2018-01-12 清研华宇智能机器人（天津）有限责任公司 一种舞蹈机器人控制系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100688225B1 (ko) * 2006-04-04 2007-03-02 삼성전자주식회사 센서 내장 신발과 휴대용 무선 단말기를 이용한 댄스 강습방법 및 시스템
CN105676845A (zh) * 2016-01-19 2016-06-15 中国人民解放军国防科学技术大学 一种智能安保服务机器人复杂环境避障方法及安保服务机器人
CN105596018A (zh) * 2016-03-25 2016-05-25 上海电气集团股份有限公司 基于力传感器的人体运动趋势检测装置及检测方法
CN105904460A (zh) * 2016-07-11 2016-08-31 吉林大学 一种实时仿人舞蹈机器人控制系统
CN206869894U (zh) * 2017-04-14 2018-01-12 清研华宇智能机器人（天津）有限责任公司 一种舞蹈机器人控制系统

Also Published As

Publication number Publication date
CN106826872A (zh) 2017-06-13

Similar Documents

Publication Publication Date Title
KR101986919B1 (ko) 충돌 회피 및 궤도 복원 기능을 가진 휴머노이드 로봇
US9669548B2 (en) Mobile collaborative robot
US9278451B2 (en) Robot system and method for controlling robot system
EP1746478A2 (en) Moving object capable of recognizing image and moving-object directing system equipped with the same
JP2015526309A (ja) 安全ロボット動作のためのシステムおよび方法
EP3398020B1 (en) Docking system and method for charging a mobile robot
CN103260834A (zh) 用于操纵机构尤其工业机器人的安全装置和运行安全装置的方法
US20190064838A1 (en) Moving body
CN104471827A (zh) 自优化电力传输
CN105629969A (zh) 一种餐厅服务机器人
US20130024065A1 (en) Autonomous Electronic Device and Method of Controlling Motion of the Autonomous Electronic Device Thereof
CN111113377B (zh) 具有姿态校准系统的人形机器人及其控制方法
CN106826872B (zh) 一种舞蹈机器人控制方法及系统
CN113021359B (zh) 机械臂控制方法、装置、设备、系统、存储介质及机械臂
CN106774318A (zh) 多智能体交互式环境感知与路径规划运动系统
CN102806556A (zh) 机器人设备及其控制方法
CN109520509A (zh) 一种充电机器人定位方法
KR100555990B1 (ko) 공압 분산 제어형 보행 보조 로봇
JP2013188815A (ja) 制御装置及び制御方法、並びにコンピューター・プログラム
CN103777634A (zh) 大尺寸球形机器人控制系统
CN206869894U (zh) 一种舞蹈机器人控制系统
CN114851207B (zh) 一种双机器人的防碰撞控制方法、系统和多机器人系统
CN208358860U (zh) 机器人的障碍探测装置及机器人
CN114310905A (zh) 一种基于vr技术的工业机器人控制系统
CN211061899U (zh) 一种自主定位导航机器人

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant