CN109732613A - 机械手臂达到特定状态效果评估系统 - Google Patents

机械手臂达到特定状态效果评估系统 Download PDF

Info

Publication number
CN109732613A
CN109732613A CN201910190832.7A CN201910190832A CN109732613A CN 109732613 A CN109732613 A CN 109732613A CN 201910190832 A CN201910190832 A CN 201910190832A CN 109732613 A CN109732613 A CN 109732613A
Authority
CN
China
Prior art keywords
state
arm
unit
specific action
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.)
Granted
Application number
CN201910190832.7A
Other languages
English (en)
Other versions
CN109732613B (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.)
Harbin Weichenxing Intellectual Property Legal Service Co ltd
Original Assignee
Harbin Ruobots Robot 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 Harbin Ruobots Robot Co Ltd filed Critical Harbin Ruobots Robot Co Ltd
Priority to CN201910190832.7A priority Critical patent/CN109732613B/zh
Publication of CN109732613A publication Critical patent/CN109732613A/zh
Application granted granted Critical
Publication of CN109732613B publication Critical patent/CN109732613B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)
  • Management, Administration, Business Operations System, And Electronic Commerce (AREA)
  • Manipulator (AREA)

Abstract

机械手臂达到特定状态效果评估系统,由机械手臂、手臂状态测量单元、手臂状态融合和处理单元、手臂特定动作状态给定单元、手臂特定动作状态模板存储单元、手臂特定状态与测量状态比较评估单元、手臂特定状态与测量状态接近度计分单元和状态控制处理单元组成;状态控制处理单元控制手臂状态测量单元、手臂状态融合和处理单元、手臂特定动作状态给定单元、特定动作模板存储单元、手臂特定状态与测量状态比较评估单元和评估计分单元完成各单元的功能。

Description

机械手臂达到特定状态效果评估系统
技术领域
本发明属于机器人控制技术,涉及机械手臂从其他状态到特定状态的到达效果的评估方法与系统。
背景技术
在机器人技术与设备中,机械手臂是一项作为执行设备的重要的部件。机械手臂的特点是有可运动的通过关节连接的多个机械臂和机械手,因而可以被控制实现各种动作。不同的动作对应不同的状态。因而存在机械手臂从其他状态到特定状态的情况。为了测定机械手臂从其他状态到特定状态的偏差、速度、准确度和稳定度等转移效果,提出机械手臂达到特定状态效果评估系统,可用于评分操作机器人达到一个状态的好坏,作为娱乐之用。
发明内容
所发明的机械手臂达到特定状态效果评估系统,由机械手臂、手臂状态测量单元、手臂状态融合和处理单元、手臂特定动作状态给定单元、手臂特定动作状态模板存储单元、手臂特定状态与测量状态比较评估单元、手臂特定状态与测量状态接近度计分单元和状态控制处理单元组成;手臂状态测量单元用来测量从其它状态到特定状态的机械手臂的动作姿态和动作速度;手臂状态融合和处理单元将手臂状态测量单元得到的手臂实际动作状态信息进行处理和转换;手臂特定动作状态给定单元将操作者设定的标准的特定动作状态输入进系统;手臂特定动作状态模板存储单元将输入的标准的特定动作状态存储起来;手臂特定状态与测量状态比较评估单元将手臂状态测量单元得到的手臂实际状态信息和手臂特定动作模板存储单元存储的特定动作状态信息进行比较评估;手臂特定状态与测量状态接近度计分单元根据手臂特定状态与测量状态比较评估单元的结果进行转换和计分,评价机械手臂从其它状态到特定状态的接近效果,接近中偏差越小、越接近特定动作状态、接近特定动作状态的动作速度越快和动作时间越短越好;状态控制处理单元控制手臂状态测量单元、手臂状态融合和处理单元、手臂特定动作状态给定单元、特定动作模板存储单元、手臂特定状态与测量状态比较评估单元和评估计分单元完成各单元的功能。
基于前述的机械手臂达到特定状态效果评估系统,还包括状态和接近度分数显示单元;状态和接近度分数显示单元用来显示状态信息与计分信息,由状态控制处理单元控制。
基于前述的机械手臂达到特定状态效果评估系统,还包括状态信息与计分信息通信单元;状态信息与计分信息通信单元传出状态信息与计分信息,接收控制信息;状态信息与计分信息通信单元由状态控制处理单元控制。
基于前述的机械手臂达到特定状态效果评估系统,还包括机械手臂随机任意状态产生单元:随机任意状态存储单元产生随机的机械手臂任意状态,并使机械手臂处于这个任意状态;这个任意状态作为机械手臂达到特定状态之前的初始状态;在一个以特定动作状态为目标的操作运行中,机械手臂以随机任意状态存储单元产生随机的任意状态为初始状态,然后达到特定动作状态。
基于前述的机械手臂达到特定状态效果评估系统,其状态控制处理单元的工作原理是:首先使机械手臂处于不是机械手臂特定状态的一个初始状态,然后通过手臂特定动作状态给定单元输入要求机械手臂达到的特定动作状态信息,将得到的特定动作状态信息存入手臂特定动作状态模板存储单元,用手臂状态测量单元测量机械手臂的实际状态,将机械手臂的实际状态存入手臂状态融合和处理单元,将手臂特定动作状态模板存储单元的特定状态信息和手臂状态融合和处理单元存储的实际状态信息送入手臂特定状态与测量状态比较评估单元进行比较,再将比较结果送入评估计分单元转换为表征效果的分值。
基于前述的机械手臂达到特定状态效果评估系统,手臂状态融合和处理单元、手臂特定动作状态模板存储单元、手臂特定状态与测量状态比较评估单元、评估计分单元和状态控制处理单元由微处理器系统实现;微处理器系统接收来自手臂状态测量单元和手臂特定动作状态给定单元的信息,对手臂状态测量单元得到的信息进行处理和转换,存储特定动作状态给定信息、根据状态测量信息和特定动作状态给定信息进行融合比较和评估计分。
基于前述的机械手臂达到特定状态效果评估系统,手臂状态测量单元由加速度传感器或陀螺仪实现;所述的加速度传感器或陀螺仪与微处理器系统相连;加速度传感器或陀螺仪得到的信息进一步处理为机械手臂的姿态信息和姿态变化信息。
基于前述的机械手臂达到特定状态效果评估系统,手臂特定动作状态给定单元由键盘、体感单元、语音单元或遥控接收单元实现;所述的键盘、语音单元或遥控接收单元与微处理器系统相连。
基于前述的机械手臂达到特定状态效果评估系统,状态和接近度分数显示单元由数码管、液晶屏、触摸屏或语音输出单元实现;所述的数码管、液晶屏、触摸屏或语音输出单元与微处理器系统相连。
基于前述的机械手臂达到特定状态效果评估系统,状态信息与计分信息通信单元由WIFI通信单元实现;所述的WIFI通信单元与微处理器系统相连。
所发明的机械手臂达到特定状态效果评估系统的优点是:专门应用于机械手臂特定动作状态的接近情况判断,可扩展为根据操作机械手臂达到某一动作的情况而计算得分情况的娱乐系统,可用微处理器系统实现。
附图说明
附图1是本发明所述的机械手臂达到特定状态效果评估系统一个具体结构的示意图。
具体实施方式
实施方式一
参照附图1说明本实施方式,所发明的机械手臂达到特定状态效果评估系统,由机械手臂1、手臂状态测量单元2、手臂状态融合和处理单元3、手臂特定动作状态给定单元4、手臂特定动作状态模板存储单元5、手臂特定状态与测量状态比较评估单元6、手臂特定状态与测量状态接近度计分单元7、状态和接近度分数显示单元8、状态信息与计分信息通信单元9、机械手臂随机任意状态产生单元10、状态控制处理单元11、机械手臂状态控制单元12和机械手臂驱动单元13组成;
手臂状态融合和处理单元3、手臂特定动作状态模板存储单元5、手臂特定状态与测量状态比较评估单元6、手臂特定状态与测量状态接近度计分单元7、状态控制处理单元11和机械手臂状态控制单元12由微处理器系统实现;手臂状态测量单元2由加速度传感器实现;手臂特定动作状态给定单元4由遥控接收单元或WIFI通信单元实现;状态和接近度分数显示单元8由液晶屏实现;状态信息与计分信息通信单元9由WIFI通信单元;
微处理器系统采用STM32F407;加速度传感器采用MPU6050;遥控接收单元采用WIFI通信单元;加速度传感器采用MPU6050经总线与微处理器系统STM32F407相连,遥控接收单元连接到微处理器系统STM32F407的串口上,液晶屏连接到STM32F407上,WIFI通信单元连接到微处理器系统STM32F407的串口上,加速度传感器MPU6050安放到机械手臂的每个独立活动部分;
其程序流程是:首先通过机械手臂状态控制单元12控制机械手臂驱动单元13使机械手臂处于不是机械手臂特定状态的一个初始状态,这个状态是由WIFI通信单元接收到的,或者是机械手臂随机任意状态产生单元10产生的;然后通过遥控接收单元输入要求机械手臂达到的特定动作状态信息;将得到的特定动作状态信息存入手臂特定动作状态模板存储单元5;控制机械手臂驱动单元12使机械手臂运动,用加速度传感器MPU6050测量机械手臂的实时状态;将机械手臂的实际状态存入手臂状态融合和处理单元3,将手臂特定动作状态模板存储单元5的特定状态信息和手臂状态融合和处理单元存储3的实际状态信息送入手臂特定状态与测量状态比较评估单元6进行比较;再将比较结果送入手臂特定状态与测量状态接近度计分单元7转换为表征效果的分值;再将这个分值送到液晶屏上显示;通过WIFI通信单元传递相关信息。
本实施方式可做成一个机器人娱乐系统:在给定要求机械手臂达到的特定动作状态条件下,不同的人操作同一个系统,或是操作同类的系统,以得到的分数来决定输赢和娱乐。

Claims (10)

1.机械手臂达到特定状态效果评估系统,其特征在于:由机械手臂、手臂状态测量单元、手臂状态融合和处理单元、手臂特定动作状态给定单元、手臂特定动作状态模板存储单元、手臂特定状态与测量状态比较评估单元、手臂特定状态与测量状态接近度计分单元和状态控制处理单元组成;手臂状态测量单元用来测量从其它状态到特定状态的机械手臂的动作姿态和动作速度;手臂状态融合和处理单元将手臂状态测量单元得到的手臂实际动作状态信息进行处理和转换;手臂特定动作状态给定单元将操作者设定的标准的特定动作状态输入进系统;手臂特定动作状态模板存储单元将输入的标准的特定动作状态存储起来;手臂特定状态与测量状态比较评估单元将手臂状态测量单元得到的手臂实际状态信息和手臂特定动作模板存储单元存储的特定动作状态信息进行比较评估;手臂特定状态与测量状态接近度计分单元根据手臂特定状态与测量状态比较评估单元的结果进行转换和计分,评价机械手臂从其它状态到特定状态的接近效果,接近中偏差越小、越接近特定动作状态、接近特定动作状态的动作速度越快和动作时间越短越好;状态控制处理单元控制手臂状态测量单元、手臂状态融合和处理单元、手臂特定动作状态给定单元、特定动作模板存储单元、手臂特定状态与测量状态比较评估单元和评估计分单元完成各单元的功能。
2.根据权利要求1所述的机械手臂达到特定状态效果评估系统,其特征在于:还包括状态和接近度分数显示单元;状态和接近度分数显示单元用来显示状态信息与计分信息,由状态控制处理单元控制。
3.根据权利要求2所述的机械手臂达到特定状态效果评估系统,其特征在于:还包括状态信息与计分信息通信单元;状态信息与计分信息通信单元传出状态信息与计分信息,接收控制信息;状态信息与计分信息通信单元由状态控制处理单元控制。
4.根据权利要求3所述的机械手臂达到特定状态效果评估系统,其特征在于:还包括机械手臂随机任意状态产生单元;随机任意状态存储单元产生随机的机械手臂任意状态,并使机械手臂处于这个任意状态;这个任意状态作为机械手臂达到特定状态之前的初始状态;在一个以特定动作状态为目标的操作运行中,机械手臂以随机任意状态存储单元产生随机的任意状态为初始状态,然后达到特定动作状态。
5.根据权利要求1或权利要求4所述的机械手臂达到特定状态效果评估系统,其特征在于:其状态控制处理单元的工作原理是,首先使机械手臂处于不是机械手臂特定状态的一个初始状态,然后通过手臂特定动作状态给定单元输入要求机械手臂达到的特定动作状态信息,将得到的特定动作状态信息存入手臂特定动作状态模板存储单元,用手臂状态测量单元测量机械手臂的实际状态,将手臂特定动作状态模板存储单元的特定状态信息和手臂状态测量单元的实际状态信息送入手臂特定状态与测量状态比较评估单元进行比较,再将比较结果送入评估计分单元转换为表征效果的分值。
6.根据权利要求4或权利要求5所述的机械手臂达到特定状态效果评估系统,其特征在于:手臂状态融合和处理单元、手臂特定动作状态模板存储单元、手臂特定状态与测量状态比较评估单元、评估计分单元和状态控制处理单元由微处理器系统实现;微处理器系统接收来自手臂状态测量单元和手臂特定动作状态给定单元的信息,对手臂状态测量单元得到的信息进行处理和转换,存储特定动作状态给定信息、根据状态测量信息和特定动作状态给定信息进行融合比较和评估计分。
7.根据权利要求6所述的机械手臂达到特定状态效果评估系统,其特征在于:手臂状态测量单元由加速度传感器或陀螺仪实现;所述的加速度传感器或陀螺仪与微处理器系统相连;加速度传感器或陀螺仪得到的信息进一步处理为机械手臂的姿态信息和姿态变化信息。
8.根据权利要求6所述的机械手臂达到特定状态效果评估系统,其特征在于:手臂特定动作状态给定单元由键盘、体感单元、语音单元或遥控接收单元实现;所述的键盘、语音单元或遥控接收单元与微处理器系统相连。
9.根据权利要求6所述的机械手臂达到特定状态效果评估系统,其特征在于:状态和接近度分数显示单元由数码管、液晶屏、触摸屏或语音输出单元实现;所述的数码管、液晶屏、触摸屏或语音输出单元与微处理器系统相连。
10.根据权利要求6所述的机械手臂达到特定状态效果评估系统,其特征在于:状态信息与计分信息通信单元由WIFI通信单元实现;所述的WIFI通信单元与微处理器系统相连。
CN201910190832.7A 2019-03-13 2019-03-13 机械手臂达到特定状态效果评估系统 Active CN109732613B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910190832.7A CN109732613B (zh) 2019-03-13 2019-03-13 机械手臂达到特定状态效果评估系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910190832.7A CN109732613B (zh) 2019-03-13 2019-03-13 机械手臂达到特定状态效果评估系统

Publications (2)

Publication Number Publication Date
CN109732613A true CN109732613A (zh) 2019-05-10
CN109732613B CN109732613B (zh) 2023-08-18

Family

ID=66370398

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910190832.7A Active CN109732613B (zh) 2019-03-13 2019-03-13 机械手臂达到特定状态效果评估系统

Country Status (1)

Country Link
CN (1) CN109732613B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111024379A (zh) * 2019-12-17 2020-04-17 福建工程学院 一种线性作动器动态性能观测检测系统

Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5293461A (en) * 1991-11-20 1994-03-08 The University Of British Columbia System for determining manipulator coordinates
CN1392950A (zh) * 2000-08-18 2003-01-22 学校法人中央大学 移动装置的位置误差评价方法和根据其评价结果改善移动精度的方法
JP2003305678A (ja) * 2002-04-11 2003-10-28 Ricoh Co Ltd ロボット及びロボットの制御方法
CN101774065A (zh) * 2010-03-17 2010-07-14 昆山工研院工业机器人研究所有限公司 机器人焊缝跟踪偏差补偿方法
CN105479483A (zh) * 2016-01-19 2016-04-13 哈尔滨若朋机器人有限责任公司 用于机器人的摆动式关节及其组成的关节组件
CN107220713A (zh) * 2017-06-06 2017-09-29 上海理工大学 基于健康状态的机器人手臂实时保养方法
CN107553499A (zh) * 2017-10-23 2018-01-09 上海交通大学 一种多轴机械臂的自然手势运动控制系统和方法
CN108393888A (zh) * 2017-02-06 2018-08-14 精工爱普生株式会社 控制装置、机器人以及机器人系统
CN108555907A (zh) * 2018-04-12 2018-09-21 宁波市智能制造产业研究院 机器人运行状况评价方法
CN108646680A (zh) * 2018-05-10 2018-10-12 广东赛诺梵信息技术有限公司 一种工业机器人关键数据应用系统
US20180370029A1 (en) * 2017-06-23 2018-12-27 Accenture Global Solutions Limited Self-learning robotic process automation
CN109093650A (zh) * 2018-09-25 2018-12-28 上海大学 一种机器人动态特性测定方法及系统、装置

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5293461A (en) * 1991-11-20 1994-03-08 The University Of British Columbia System for determining manipulator coordinates
CN1392950A (zh) * 2000-08-18 2003-01-22 学校法人中央大学 移动装置的位置误差评价方法和根据其评价结果改善移动精度的方法
JP2003305678A (ja) * 2002-04-11 2003-10-28 Ricoh Co Ltd ロボット及びロボットの制御方法
CN101774065A (zh) * 2010-03-17 2010-07-14 昆山工研院工业机器人研究所有限公司 机器人焊缝跟踪偏差补偿方法
CN105479483A (zh) * 2016-01-19 2016-04-13 哈尔滨若朋机器人有限责任公司 用于机器人的摆动式关节及其组成的关节组件
CN108393888A (zh) * 2017-02-06 2018-08-14 精工爱普生株式会社 控制装置、机器人以及机器人系统
CN107220713A (zh) * 2017-06-06 2017-09-29 上海理工大学 基于健康状态的机器人手臂实时保养方法
US20180370029A1 (en) * 2017-06-23 2018-12-27 Accenture Global Solutions Limited Self-learning robotic process automation
CN107553499A (zh) * 2017-10-23 2018-01-09 上海交通大学 一种多轴机械臂的自然手势运动控制系统和方法
CN108555907A (zh) * 2018-04-12 2018-09-21 宁波市智能制造产业研究院 机器人运行状况评价方法
CN108646680A (zh) * 2018-05-10 2018-10-12 广东赛诺梵信息技术有限公司 一种工业机器人关键数据应用系统
CN109093650A (zh) * 2018-09-25 2018-12-28 上海大学 一种机器人动态特性测定方法及系统、装置

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
卢浩: "下肢康复机器人主动训练研究与实现", 《下肢康复机器人主动训练研究与实现 *
廖常浩: "工业机器人急停装置的安全评估" *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111024379A (zh) * 2019-12-17 2020-04-17 福建工程学院 一种线性作动器动态性能观测检测系统

Also Published As

Publication number Publication date
CN109732613B (zh) 2023-08-18

Similar Documents

Publication Publication Date Title
US11220002B2 (en) Robot simulation device
EP3342565B1 (en) Robot system
US9427873B2 (en) Robot controller, simple installation-type robot, and method of controlling simple installation-type robot
US10166673B2 (en) Portable apparatus for controlling robot and method thereof
US10384347B2 (en) Robot control device, robot, and simulation device
CN106181964B (zh) 机器人程序生成装置
JP6073893B2 (ja) 工業用ロボットの運動および/またはプロシージャをプログラミングまたは設定する方法、制御システムおよび運動設定手段
EP2055446A1 (en) A portable robot control apparatus and a method for controlling a movement of a robot
JP6450737B2 (ja) ロボットシステム
CN107539887B (zh) 建筑施工塔吊机群防碰撞预警辅助系统
JP7281349B2 (ja) 遠隔操作システム
US10603788B2 (en) Robot simulation apparatus
JP2017525000A5 (zh)
Dombrowski et al. Simulation of human-robot collaboration by means of power and force limiting
CN109732613A (zh) 机械手臂达到特定状态效果评估系统
KR102518766B1 (ko) 데이터 생성 장치, 데이터 생성 방법, 데이터 생성 프로그램 및 원격 조작 시스템
US20180015615A1 (en) Method and apparatus for controlling a robot movement of a robot on the basis of a second trajectory
CN111665011A (zh) 一种碰撞检测方法及装置
WO2000015395A1 (fr) Procede d'apprentissage d'un robot a axe de translation hors ligne
CN116921951A (zh) 一种基于三维视觉的焊接机器人的控制方法
CN112118940A (zh) 机械手的直接教示装置以及直接教示方法
KR20190048663A (ko) 로봇의 안전성 평가 방법
JP7054014B2 (ja) スイング測定装置、スイング測定方法およびスイング測定プログラム
KR20160020140A (ko) 3차원 스캐너용 제어 장치
JP6338268B2 (ja) 電子測角器及び測角プログラム

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
TA01 Transfer of patent application right

Effective date of registration: 20230717

Address after: Room 501-A03, No. 6, Floor 5, No. 67, Nantong Street, Nangang District, Harbin City, Heilongjiang Province, 150000

Applicant after: Harbin Weichenxing Intellectual Property Legal Service Co.,Ltd.

Address before: Room 501, unit 1, building 9, Heida family District, 74 Xuefu Road, Harbin City, Heilongjiang Province, 150080

Applicant before: HARBIN RUOBOTS ROBOT Co.,Ltd.

TA01 Transfer of patent application right
GR01 Patent grant
GR01 Patent grant