CN106217374B - 一种智能机械臂的控制方法、装置及系统 - Google Patents
一种智能机械臂的控制方法、装置及系统 Download PDFInfo
- Publication number
- CN106217374B CN106217374B CN201610658777.6A CN201610658777A CN106217374B CN 106217374 B CN106217374 B CN 106217374B CN 201610658777 A CN201610658777 A CN 201610658777A CN 106217374 B CN106217374 B CN 106217374B
- Authority
- CN
- China
- Prior art keywords
- arm
- angle
- mechanical arm
- steering engine
- eulerian angles
- 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
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种智能机械臂的控制方法、装置及系统,该方法包括通过MCU控制器根据人的手背、前臂和上臂上方安装的对应传感器所测量的数据得到对应的欧拉角,然后PC端根据上述欧拉角计算得到对应的机械臂的运动轨迹的数据信号并发送给机械臂控制器,以使得机械臂控制器根据该数据信号生成对应的PWM信号,从而控制机械臂运动。本发明解决了传统机械臂驱动方案不灵活的同时,还比目前复杂传感器套装和摄像头姿态捕获的方案更加节省成本和计算量,提高了通用性。
Description
技术领域
本发明涉及机器人领域,尤其涉及一种机器人的智能机械臂的控制方法、装置及系统。
背景技术
智能机械臂是目前机器人技术领域中得到最广泛实际应用的自动化机械装置,其应用于于工业制造、医学治疗、娱乐服务、军事、半导制造等等领域。其基本的工作原理就是能够接收治疗,进行相关作业。
然而目前对机械臂的控制主要通过程序来直接驱动,或者通过传感器、连杆等物理遥控器进行控制。通过人体姿态来对机械臂进行控制的主要是通过摄像头或者复杂的传感器套装进行姿态捕获和换算。而传统编程控制方式不够灵活,不同的动作设定需要编写不同的程序进行驱动,而物理遥控的方式不能很直观地反映相关的姿态动作,另外,新的人体姿态转换方式,要么采用摄像头,要么采用较复杂的传感器,导致成本较高,同时过于依赖硬件环境,计算量也很大。
另外,如图1所示为六自由度机械臂的结构示意简图,其至少包括底座1、第一臂2、第二臂3、手腕4和爪子5,底座1与第一臂2、第一臂2与第二臂3、第二臂3与手腕4之间均通过可转动装置连接,也即是第一臂2、第二臂3、手腕4可根据控制信号向一定的方向上转动,从而可以使得爪子能够抓到物品。也即是,只要能够得到第一臂2、第二臂3和手腕4的转动角度,就可以将该其对应的转动角度的数据转换为控制信号,通过对应的舵机就可以控制第一臂2、第二臂3和手腕4的转动角度。
发明内容
为了克服现有技术的不足,本发明的目的之一在于提供一种智能机械臂的控制方法,其能够解决使用人体姿态转换方式来控制机械臂时,成本高、结构复杂、计算量等问题。
本发明的目的之一采用以下技术方案实现:
本发明提供了一种智能机械臂的控制方法,包括以下步骤:
S1:获取第一欧拉角、第二欧拉角和第三欧拉角,并分别存储于对应的缓存空间;所述第一欧拉角是第一MCU控制器根据安装于人手的手背上的第一传感器所测量的数据计算得到;所述第二欧拉角是第二MCU控制器根据安装于人的前臂上方的第二传感器所测量的数据计算得到;所述第三欧拉角是第三MCU控制器根据安装于人的上臂上方的第三传感器所测量的数据计算得到;
S2:根据所述第二欧拉角的方位角计算得出机械臂底盘的方位舵机角度;
S3:根据所述第二欧拉角和第三欧拉角的俯仰角计算得出手臂的垂直平面坐标,并换算为机械舵机的垂直平面坐标,并依据机械臂舵机的垂直平面坐标以及机械臂的两条臂的长度计算得出机械臂的第一臂的水平俯仰角和第二臂的水平俯仰角,以及机械臂第一臂的舵机角度和机械臂第二臂的舵机角度;
S4:根据人手的垂直平面坐标和机械臂的垂直平面坐标的映射关系,根据第一欧拉角的俯仰角和侧倾角得到机械臂手腕的俯仰角和侧倾角,并结合所述第一臂的水平俯仰角和第二臂的水平俯仰角,计算得出机械臂手腕的俯仰舵机角度;
S5:根据第一欧拉角的侧倾角得到机械臂手腕的侧倾舵机角度;
S6:根据五个舵机角度向机械臂控制器发送驱动舵机转动的数据信号,从而使得机械臂控制器根据该数据信号生成PWM信号给机械臂,以控制机械臂对应的部位运动;所述五个舵机角度包括所述机械臂底盘的方位舵机角度、机械臂第一臂的舵机角度、机械臂第二臂的舵机角度、机械臂手腕的俯仰舵机角度和机械臂手腕的侧倾舵机角度。
优选地,所述第一传感器为六轴传感器,第二传感器和第三传感器为九轴传感器。
优选地,步骤S1和步骤S2之间还包括S11:判断所述第二欧拉角和第一欧拉角是否合法,若合法,则执行S2,若不合法,则执行S1。
优选地,步骤S3还包括当所述根据第二欧拉角和第三欧拉角的俯仰角计算得出手臂的垂直坐标平面,并换算为机械臂舵机的垂直平面坐标时,判断机械臂是否能够达到机械臂的垂直坐标平面的对应坐标点,若不能,则PC端采用原有的数据作为机械臂第一臂的舵机角度和第二臂的舵机角度值,继续执行S4;所述原有的数据为智能机械臂前一次运动时计算得到的机械臂第一臂的舵机角度和第二臂的舵机角度值。
为了克服现有技术的不足,本发明的目的之二在于提供一种智能机械臂的控制装置,其能够解决使用人体姿态转换方式来控制机械臂时,成本高、结构复杂、计算量等问题。
本发明的目的之二采用以下技术方案实现:
本发明提供了一种智能机械臂的控制装置,包括:
获取欧拉角模块,用于获取第一欧拉角、第二欧拉角和第三欧拉角并分别存储于对应的缓存空间;所述第一欧拉角是第一MCU控制器根据安装于人手的手背上的第一传感器所测量的数据计算得到;所述第二欧拉角是第二MCU控制器根据安装于人的前臂上方的第二传感器所测量的数据计算得到;所述第三欧拉角是第三MCU控制器根据安装于人手的上臂上方的第三传感器所测量的数据计算得到;
获取第一舵机角度模块,用于根据第二欧拉角的方位角计算得出机械臂底盘的方位舵机角度;
获取第二和第三舵机角度模块,用于根据第二欧拉角和第三欧拉角的俯仰角计算得出手臂的垂直平面坐标,并换算为机械臂舵机的垂直平面坐标,根据坐标数据以及机械臂的两条臂长的条件计算得出机械臂的第一臂的水平俯仰角和第二臂的水平俯仰角,以及机械臂第一臂的舵机角度和机械臂第二臂的舵机角度;
获取第四舵机角度模块,用于根据人手的垂直坐标平面和机械臂的垂直坐标平面的映射关系,根据第一欧拉角的俯仰角和侧倾角得到机械臂手腕的俯仰角和侧倾角,并结合所述第一臂的水平俯仰角和第二臂的水平俯仰角,计算得出机械臂手腕的俯仰舵机角度;
获取第五舵机角度模块,用于根据第一欧拉角的侧倾角得到机械臂手腕的侧倾舵机角度;
控制机械臂工作模块,用于根据五个舵机角度向机械臂控制器发送驱动舵机转动角度的信号,从而使得机械臂控制器根据该信号发送一PWM信号控制机械臂相对应的部位运动;所述五个舵机角度包括机械臂底盘的方位舵机角度、机械臂第一臂的舵机角度、机械臂第二臂的舵机角度、机械臂手腕的俯仰舵机角度和机械臂手腕的侧倾舵机角度。
优选地,所述第一传感器为六轴传感器,第二传感器和第三传感器为九轴传感器。
为了克服现有技术的不足,本发明的目的之三在于提供一种智能机械臂的控制系统,其能够解决使用人体姿态转换方式来控制机械臂时,成本高、结构复杂、计算量等问题。
本发明的目的之三采用以下技术方案实现:
本发明提供了一种智能机械臂的控制系统,包括安装于手背上的第一传感器、安装于前臂上方的第二传感器、安装于上臂上方的第三轴传感器以及MCU控制器,所述MCU控制器有三个,分别记为第一MCU控制器、第二MCU控制器和第三MCU控制器;所述第一传感器与所述第一MCU控制器,所述第二传感器与所述第二MCU控制器电性连接,所述第三传感器与所述第三MCU控制器电性连接;第一MCU控制器用于获取第一传感器所发送的数据,以及根据所述第一传感器所发送的数据计算得到第一欧拉角;第二MCU控制器用于获取第二传感器所发送的数据,以及根据所述第二传感器所发送的数据计算得到第二欧拉角;第三MCU控制器用于获取第三传感器所发送的数据,以及根据所述第三传感器所发送的数据计算得到第三欧拉角;
还包括PC端、机械臂控制器和机械臂,所述第一MCU控制器、第二MCU控制器、第三MCU控制器分别与所述PC端连接,所述机械臂控制器与所述PC端电性连接,所述机械臂控制器与机械臂电性连接;
PC端用于接收来自第一MCU控制器、第二MCU控制器和第三MCU控制器发送的第一欧拉角、第二欧拉角和第三欧拉角,并分别存储于对应的缓存空间中,以及用于根据所述第一欧拉角、第二欧拉角和第三欧拉角生成使得机械臂运动的数据信号并发送给机械臂控制器;所述机械臂控制器用于根据所述数据信号生成PWM信号给机械臂,并控制机械臂对应的部位工作。
优选地,所述第一传感器为六轴传感器,第二传感器和第三传感器为九轴传感器。
优选地,所述第一MCU控制器、第二MCU控制器、第三MCU控制器分别与所述PC端通过串口通信连接。
优选地,所述机械臂控制器与PC端通过I2C数据总线连接。
相比现有技术,本发明的有益效果在于:本发明仅需通过三个固定的上臂上方、前臂上方和手背的加速度、陀螺仪、磁场传感器即可进行相关的姿态捕捉,通过传统的计算机即可进入换算和驱动。本发明解决了传统机械臂驱动方案不灵活的同时,还比目前复杂传感器套装和摄像头姿态捕获的方案更加节省成本和计算量,提高了通用性。
附图说明
图1为本发明提供的六自由度机械臂的结构示意简图;
图2为本发明提供智能机械臂的控制系统的结构模块图;
图3为本发明提供智能机械臂的控制方法流程图;
图4为本发明提供智能机械臂的控制装置结构模块图。
具体实施方式
下面,结合附图以及具体实施方式,对本发明做进一步描述:
如图2所示,本发明提供的实施例一是一种智能机械臂的控制系统,其包括一安装于手背上的第一传感器、安装于前臂上方的第二传感器、安装于上臂上方的第三传感器以及MCU控制器,所述MCU控制器有三个,分别记为第一MCU控制器、第二MCU控制器和第三MCU控制器,这三个MCU控制器之间没有任何关联。所述第一传感器与第一MCU控制器电性连接,所述第二传感器与所述第二MCU控制器电性连接,所述第三传感器与所述第三MCU控制器电性连接。第一MCU控制器用于获取第一传感器所发送的数据,第二MCU控制器用于获取第二传感器所发送的数据,第三MCU控制器用于获取第三传感器所发送的数据。其中第一传感器为六轴传感器,第二传感器和第三传感器均为九轴传感器。另外,由于六轴传感器以及九轴传感器是姿态传感器,比如六轴传感器是由三轴加速度和三轴陀螺仪传感器组成的,可利用基于四元数的三维算法和特殊数据融合计数,实时输出以四元数、欧拉角表示的零漂移三维姿态方位数据,也即是通过上述过程,MCU控制器可根据六轴传感器测量的数据得到本发明中所提到的第一欧拉角。该计算方法已经是比较常见的方法,是本领域的技术人员所熟知的技术。
还包括PC端、机械臂控制器和机械臂,其中,该机械臂为六自由度机械臂。所述第一MCU控制器、第二MCU控制器、第三MCU控制器分别通过串口通信与PC端通信,所述机械臂控制器与PC端电性连接,所述机械臂控制器与机械臂电性连接。PC端用于接收来自第一MCU控制器、第二MCU控制器和第三MCU控制器发送的数据并分别存储于相对应的缓存空间中,以及用于根据所述第一MCU控制器、第二MCU控制器和第三MCU控制器发送的数据生成使得机械臂运动的动作数据并发送给机械臂控制器。也即是通过检测人手的动作数据(也即是人手的运动轨迹),然后通过PC端将该人手的动作数据转换为相对应的机械臂的动作数据(也即是机械臂的运动轨迹),从而将机械臂的动作数据转换为控制机械臂运动的电信号,实现了通过人体姿态来控制机械臂的运动轨迹。机械臂包括手腕、爪子、第一臂、第二臂以及底座。因此,可通过测量人的手以及手臂的运动数据,在通过PC端的处理计算得到机械臂的各个部件的运动数据,从而得到控制机械臂运动轨迹的控制信号,从而使得机械臂根据该控制信号运动。
如图3所示,本发明还提供了一种智能机械臂的控制方法包括以下步骤:
S1:获取第一欧拉角、第二欧拉角和第三欧拉角,并分别存储于对应的缓存空间。所述第一欧拉角是由第一MCU控制器根据获取的第一传感器所测量的数据计算得到;所述第二欧拉角是由第二MCU控制器根据获取的第二传感器所测量的数据计算得到;所述第三欧拉角是由第三MCU控制器根据获取的第三传感器所测量的数据计算得到。其中第一传感器为六轴传感器,第二传感器和第三传感器均为九轴传感器。
首先,将六轴传感器安装在人手的手背上,用于检测人手的手背转动时的角度等数据,第一MCU控制器根据六轴传感器所检测的数据然后计算得到手背的第一欧拉角,同理可得到前臂和上臂的第二欧拉角和第三欧拉角。三个MCU控制器分别通过串口通信与PC端连接,用于将第一欧拉角、第二欧拉角以及第三欧拉角通过串口通信发送到PC端。而PC端获取到所述第一欧拉角、第二欧拉角和第三欧拉角后,分别将其存储于不同的缓存空间内。
还包括S2:判断第二欧拉角、第三欧拉角是否合法,若合法,则执行S3。
当接收到三个MCU控制器发送的数据后,首先判定第二欧拉角和第三欧拉角是否合法,因为机械臂的运动轨迹有一定的规则,因为当人们操作机械臂时,也是遵循一定的规则,而不是根据人的爱好随意控制的,因此首先判断人体前臂和手臂所对应的第二欧拉角和第三欧拉角是否合法,比如机械臂的第一臂和第二臂只能向特定方向上移动,而不是360度方向移动(并不像人类手臂一样可以自由旋转),因此可能导致测量的数据不合法,则就需要重新获取;或者是在接收数据时,由于网络或者其它原因导致数据的不合法,若不合法,则需重新获取,若合法,则继续下一步操作。
S3:根据第二欧拉角的方位角计算得出机械臂底盘的方位舵机角度。
根据安装在前臂上方的第二传感器所检测的数据计算得到的第二欧拉角中的方位角计算得出机械臂底盘的左右运动方位,也即是机械臂底盘的舵机方位,其用于控制机械臂底盘的舵机运动的方位。另外,舵机是一种位置(角度)伺服的驱动器,适用于那些需要角度不断变化并可以保持的控制系统,一般都是在机械臂中安装的。
S4:根据第二欧拉角和第三欧拉角的俯仰角计算得出手臂的垂直平面坐标,并换算为机械臂舵机的垂直平面坐标,并依据机械臂舵机的垂直平面坐标以及机械臂的两条臂的长度计算得出机械臂的第一臂的水平俯仰角和第二臂的水平俯仰角,以及机械臂第一臂的舵机角度和机械臂第二臂的舵机角度。
其中,首先根据第二欧拉角和第三欧拉角计算得出一人手的垂直坐标平面中手腕的坐标,而该垂直平面以相关手臂为原点,水平为X轴、垂直为Y轴。根据上述人手的垂直坐标平面换算为机械臂的垂直坐标平面,该机械臂的垂直坐标平面是以机械臂根部为原点。
由于机械臂的两条臂长是一定的,根据机械臂的两条臂的长度(包括第一臂和第二臂)并结合机械臂的垂直平面坐标,从而得到机械臂第一臂的水平俯仰角和机械臂第二臂的水平俯仰角,以及机械臂第一臂的舵机角度和机械臂第二臂的舵机角度。
S5:根据人手的垂直平面坐标和机械臂的垂直平面坐标的映射关系,根据第一欧拉角的俯仰角和侧倾角得到机械臂手腕的俯仰角和侧倾角,并结合所述第一臂的水平俯仰角和第二臂的水平俯仰角,计算得出机械臂手腕的俯仰舵机角度。
首先根据上述人手的垂直坐标平面和机械臂的垂直坐标平面的映射关系,可根据第一欧拉角的俯仰角和侧倾角得到机械臂手腕的俯仰角和侧倾角,然后结合所述第一臂的水平俯仰角和第二臂的水平俯仰角,计算得出机械臂手腕的俯仰舵机角度。
S6:根据第一欧拉角的侧倾角得到机械臂手腕的侧倾舵机角度。
S7:根据五个舵机角度向机械臂控制器发送驱动舵机转动角度的信号,从而使得机械臂控制器根据该信号发送一PWM信号控制机械臂相对应的部位运动;所述五个舵机角度包括所述机械臂底盘的方位舵机角度、机械臂第一臂的舵机角度、机械臂第二臂的舵机角度、机械臂手腕的俯仰舵机角度和机械臂手腕的侧倾舵机角度。
上述五个舵机角度的数据,PC端通过串口数据线将其传输给机械臂控制器,该机械臂控制器实时将上述五个舵机角度的数据转换为对应舵机的PWM控制信号,以使得对应舵机根据相对应的PWM信号工作,从而完成了机械臂的控制。
其中所述步骤S3、步骤S4和S5、步骤S6之间没有执行的先后顺序。
优选地,所述步骤S3还包括,当所述根据第二欧拉角和第三欧拉角的俯仰角计算得出手臂的垂直坐标平面,并换算为机械臂舵机的垂直平面坐标时,判断机械臂是否能够达到机械臂的垂直坐标平面的对应坐标点,若不能,则PC端采用原有的数据作为机械臂第一臂的舵机角度和第二臂的舵机角度值,继续执行S5;所述原有的数据为智能机械臂前一次运动时计算得到的机械臂第一臂的舵机角度和第二臂的舵机角度值。
如图4所示,本发明还提供了与一种智能机械臂的控制方法相对应的智能机械臂的控制装置,其包括:
获取欧拉角模块,用于获取第一欧拉角、第二欧拉角和第三欧拉角并分别存储于对应的缓存空间;所述第一欧拉角是第一MCU控制器根据安装于人手的手背上的第一传感器所测量的数据计算得到;所述第二欧拉角是第二MCU控制器根据安装于人的前臂上方的第二传感器所测量的数据计算得到;所述第三欧拉角是第三MCU控制器根据安装于人手的上臂上方的第三传感器所测量的数据计算得到;
获取第一舵机角度模块,用于根据第二欧拉角的方位角计算得出机械臂底盘的方位舵机角度;
获取第二和第三舵机角度模块,用于根据第二欧拉角和第三欧拉角的俯仰角计算得出手臂的垂直平面坐标,并换算为机械臂舵机的垂直平面坐标,根据坐标数据以及机械臂的两条臂长的条件计算得出机械臂的第一臂的水平俯仰角和第二臂的水平俯仰角,以及机械臂第一臂的舵机角度和机械臂第二臂的舵机角度;
获取第四舵机角度模块,用于根据人手的垂直坐标平面和机械臂的垂直坐标平面的映射关系,根据第一欧拉角的俯仰角和侧倾角得到机械臂手腕的俯仰角和侧倾角,并结合所述第一臂的水平俯仰角和第二臂的水平俯仰角,计算得出机械臂手腕的俯仰舵机角度;
获取第五舵机角度模块,用于根据第一欧拉角的侧倾角得到机械臂手腕的侧倾舵机角度;
控制机械臂工作模块,用于根据五个舵机角度向机械臂控制器发送驱动舵机转动角度的信号,从而使得机械臂控制器根据该信号发送一PWM信号控制机械臂相对应的部位运动;所述五个舵机角度包括机械臂底盘的方位舵机角度、机械臂第一臂的舵机角度、机械臂第二臂的舵机角度、机械臂手腕的俯仰舵机角度和机械臂手腕的侧倾舵机角度。
优选地,所述第一传感器为六轴传感器,第二传感器和第三传感器为九轴传感器。
对本领域的技术人员来说,可根据以上描述的技术方案以及构思,做出其它各种相应的改变以及形变,而所有的这些改变以及形变都应该属于本发明权利要求的保护范围之内。
Claims (9)
1.一种智能机械臂的控制方法,其特征在于,包括以下步骤:
S1:获取第一欧拉角、第二欧拉角和第三欧拉角,并分别存储于对应的缓存空间;所述第一欧拉角是第一MCU控制器根据安装于人手的手背上的第一传感器所测量的数据计算得到;所述第二欧拉角是第二MCU控制器根据安装于人的上臂上方的第二传感器所测量的数据计算得到;所述第三欧拉角是第三MCU控制器根据安装于人的前臂上方的第三传感器所测量的数据计算得到;
S2:根据所述第二欧拉角的方位角计算得出机械臂底盘的方位舵机角度;
S3:根据所述第二欧拉角和第三欧拉角的俯仰角计算得出手臂的垂直平面坐标,并换算为机械舵机的垂直平面坐标,并依据机械臂舵机的垂直平面坐标以及机械臂的两条臂的长度计算得出机械臂的第一臂的水平俯仰角和第二臂的水平俯仰角,以及机械臂第一臂的舵机角度和机械臂第二臂的舵机角度;
S4:根据人手的垂直平面坐标和机械臂的垂直平面坐标的映射关系,根据第一欧拉角的俯仰角和侧倾角得到机械臂手腕的俯仰角和侧倾角,并结合所述第一臂的水平俯仰角和第二臂的水平俯仰角,计算得出机械臂手腕的俯仰舵机角度;
S5:根据第一欧拉角的侧倾角得到机械臂手腕的侧倾舵机角度;
S6:根据五个舵机角度向机械臂控制器发送驱动舵机转动的数据信号,从而使得机械臂控制器根据该数据信号生成PWM信号给机械臂,以控制机械臂对应的部位运动;所述五个舵机角度包括所述机械臂底盘的方位舵机角度、机械臂第一臂的舵机角度、机械臂第二臂的舵机角度、机械臂手腕的俯仰舵机角度和机械臂手腕的侧倾舵机角度;步骤S3还包括当所述根据第二欧拉角和第三欧拉角的俯仰角计算得出手臂的垂直坐标平面,并换算为机械臂舵机的垂直平面坐标时,判断机械臂是否能够达到机械臂的垂直坐标平面的对应坐标点,若不能,则PC端采用原有的数据作为机械臂第一臂的舵机角度和第二臂的舵机角度值,继续执行S4;所述原有的数据为智能机械臂前一次运动时计算得到的机械臂第一臂的舵机角度和第二臂的舵机角度值。
2.如权利要求1所述智能机械臂的控制方法,其特征在于,所述第一传感器为六轴传感器,第二传感器和第三传感器为九轴传感器。
3.如权利要求1所述智能机械臂的控制方法,其特征在于,步骤S1和步骤S2之间还包括S11:判断所述第二欧拉角和第一欧拉角是否合法,若合法,则执行S2,若不合法,则执行S1。
4.一种智能机械臂的控制装置,其特征在于,包括:
获取欧拉角模块,用于获取第一欧拉角、第二欧拉角和第三欧拉角并分别存储于对应的缓存空间;所述第一欧拉角是第一MCU控制器根据安装于人手的手背上的第一传感器所测量的数据计算得到;所述第二欧拉角是第二MCU控制器根据安装于人的前臂上方的第二传感器所测量的数据计算得到;所述第三欧拉角是第三MCU控制器根据安装于人手的上臂上方的第三传感器所测量的数据计算得到;
获取第一舵机角度模块,用于根据第二欧拉角的方位角计算得出机械臂底盘的方位舵机角度;
获取第二和第三舵机角度模块,用于根据第二欧拉角和第三欧拉角的俯仰角计算得出手臂的垂直平面坐标,并换算为机械臂舵机的垂直平面坐标,根据坐标数据以及机械臂的两条臂长的条件计算得出机械臂的第一臂的水平俯仰角和第二臂的水平俯仰角,以及机械臂第一臂的舵机角度和机械臂第二臂的舵机角度;并且,当所述根据第二欧拉角和第三欧拉角的俯仰角计算得出手臂的垂直坐标平面,并换算为机械臂舵机的垂直平面坐标时,判断机械臂是否能够达到机械臂的垂直坐标平面的对应坐标点,若不能,则PC端采用原有的数据作为机械臂第一臂的舵机角度和第二臂的舵机角度值,继续执行获取第四舵机角度模块;所述原有的数据为智能机械臂前一次运动时计算得到的机械臂第一臂的舵机角度和第二臂的舵机角度值;
获取第四舵机角度模块,用于根据人手的垂直坐标平面和机械臂的垂直坐标平面的映射关系,根据第一欧拉角的俯仰角和侧倾角得到机械臂手腕的俯仰角和侧倾角,并结合所述第一臂的水平俯仰角和第二臂的水平俯仰角,计算得出机械臂手腕的俯仰舵机角度;
获取第五舵机角度模块,用于根据第一欧拉角的侧倾角得到机械臂手腕的侧倾舵机角度;
控制机械臂工作模块,用于根据五个舵机角度向机械臂控制器发送驱动舵机转动角度的信号,从而使得机械臂控制器根据该信号发送一PWM信号控制机械臂相对应的部位运动;所述五个舵机角度包括机械臂底盘的方位舵机角度、机械臂第一臂的舵机角度、机械臂第二臂的舵机角度、机械臂手腕的俯仰舵机角度和机械臂手腕的侧倾舵机角度。
5.如权利要求4所述智能机械臂的控制装置,其特征在于,所述第一传感器为六轴传感器,第二传感器和第三传感器为九轴传感器。
6.一种智能机械臂的控制系统,其特征在于,包括安装于手背上的第一传感器、安装于前臂上方的第二传感器、安装于上臂上方的第三传感器以及MCU控制器,所述MCU控制器有三个,分别记为第一MCU控制器、第二MCU控制器和第三MCU控制器;所述第一传感器与所述第一MCU控制器电性连接,所述第二传感器与所述第二MCU控制器电性连接,所述第三传感器与所述第三MCU控制器电性连接;第一MCU控制器用于获取第一传感器所发送的数据,以及根据所述第一传感器所发送的数据计算得到第一欧拉角;第二MCU控制器用于获取第二传感器所发送的数据,以及根据所述第二传感器所发送的数据计算得到第二欧拉角;第三MCU控制器用于获取第三传感器所发送的数据,以及根据所述第三传感器所发送的数据计算得到第三欧拉角;
还包括PC端、机械臂控制器和机械臂,所述第一MCU控制器、第二MCU控制器、第三MCU控制器分别与所述PC端连接,所述机械臂控制器与所述PC端电性连接,所述机械臂控制器与机械臂电性连接;
PC端用于接收来自第一MCU控制器、第二MCU控制器和第三MCU控制器发送的第一欧拉角、第二欧拉角和第三欧拉角,并分别存储于对应的缓存空间中,以及用于根据所述第一欧拉角、第二欧拉角和第三欧拉角以及如权利要求1中的步骤S2、S3、S4以及S5生成五个舵机角度,并根据五个舵机角度向机械臂控制器发送驱动舵机转动的数据信号;所述机械臂控制器用于根据所述数据信号生成PWM信号给机械臂,并控制机械臂对应的部位工作。
7.如权利要求6所述智能机械臂的控制系统,其特征在于,所述第一传感器为六轴传感器,第二传感器和第三传感器为九轴传感器。
8.如权利要求6所述智能机械臂的控制系统,其特征在于,所述第一MCU控制器、第二MCU控制器、第三MCU控制器分别与所述PC端通过串口通信连接。
9.如权利要求6所述智能机械臂的控制系统,其特征在于,所述机械臂控制器与PC端通过I2C数据总线连接。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610658777.6A CN106217374B (zh) | 2016-08-11 | 2016-08-11 | 一种智能机械臂的控制方法、装置及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610658777.6A CN106217374B (zh) | 2016-08-11 | 2016-08-11 | 一种智能机械臂的控制方法、装置及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106217374A CN106217374A (zh) | 2016-12-14 |
CN106217374B true CN106217374B (zh) | 2019-01-11 |
Family
ID=57548552
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610658777.6A Active CN106217374B (zh) | 2016-08-11 | 2016-08-11 | 一种智能机械臂的控制方法、装置及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106217374B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108748162B (zh) * | 2018-07-09 | 2021-05-25 | 五邑大学 | 一种机器人实验教学用基于最小二乘法的机械臂控制方法 |
WO2020151044A1 (zh) * | 2019-01-24 | 2020-07-30 | 深圳市工匠社科技有限公司 | 机器人控制系统及相关产品 |
CN110779554B (zh) * | 2019-12-05 | 2024-06-04 | 上海钛米机器人科技有限公司 | 一种机械臂、基于imu的初始位姿的校准系统与方法 |
CN111590563A (zh) * | 2020-05-07 | 2020-08-28 | 广州幻境科技有限公司 | 机械臂系统及其控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101239469A (zh) * | 2007-02-05 | 2008-08-13 | 发那科株式会社 | 机器人机构的校准装置及方法 |
CN103240750A (zh) * | 2012-02-06 | 2013-08-14 | 宗鹏 | 基于同步传感的机械臂控制方法 |
CN103895022A (zh) * | 2014-03-17 | 2014-07-02 | 东南大学 | 穿戴式体感控制机械手 |
CN103942427A (zh) * | 2014-04-11 | 2014-07-23 | 哈尔滨工程大学 | 一类六自由度机械臂运动学逆解的快速简便求法 |
CN104182614A (zh) * | 2014-07-25 | 2014-12-03 | 山东建筑大学 | 六自由度机械臂姿态监测系统及方法 |
CN106112505A (zh) * | 2016-07-04 | 2016-11-16 | 清华大学 | 双轴孔装配系统及其控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2774729A4 (en) * | 2011-09-15 | 2016-05-18 | Yaskawa Denki Seisakusho Kk | ROBOTIC SYSTEM AND ROBOT CONTROL |
-
2016
- 2016-08-11 CN CN201610658777.6A patent/CN106217374B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101239469A (zh) * | 2007-02-05 | 2008-08-13 | 发那科株式会社 | 机器人机构的校准装置及方法 |
CN103240750A (zh) * | 2012-02-06 | 2013-08-14 | 宗鹏 | 基于同步传感的机械臂控制方法 |
CN103895022A (zh) * | 2014-03-17 | 2014-07-02 | 东南大学 | 穿戴式体感控制机械手 |
CN103942427A (zh) * | 2014-04-11 | 2014-07-23 | 哈尔滨工程大学 | 一类六自由度机械臂运动学逆解的快速简便求法 |
CN104182614A (zh) * | 2014-07-25 | 2014-12-03 | 山东建筑大学 | 六自由度机械臂姿态监测系统及方法 |
CN106112505A (zh) * | 2016-07-04 | 2016-11-16 | 清华大学 | 双轴孔装配系统及其控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106217374A (zh) | 2016-12-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106217374B (zh) | 一种智能机械臂的控制方法、装置及系统 | |
CN107168186B (zh) | 基于六轴组合传感器的四点自动调平系统及其工作方法 | |
CN106064377B (zh) | 一种空间机器人动力学参数辨识的激励轨迹优化方法 | |
CN107116540B (zh) | 一种基于scs包围结构的机器人碰撞检测方法 | |
CN204997657U (zh) | 一种具有模仿功能的仿生机械手 | |
CN104772756A (zh) | 基于惯性测量单元的机械臂及其控制方法 | |
CN206170098U (zh) | 一种可室内跟随目标的自动取物机器人 | |
CN106313049A (zh) | 一种仿人机械臂体感控制系统及控制方法 | |
CN103640022A (zh) | 航天器机械臂柔性随动控制方法 | |
CN104385283A (zh) | 一种六自由度机械臂奇异位形的快速判断方法 | |
CN109262652A (zh) | 一种用于多杆件多关节机构的干涉检测预警方法 | |
Han et al. | Grasping control method of manipulator based on binocular vision combining target detection and trajectory planning | |
CN113070877B (zh) | 一种面向七轴机械臂视觉示教的可变姿态映射方法 | |
CN105818145A (zh) | 仿人机器人的分布式控制系统及方法 | |
CN207044177U (zh) | 一种精密机器人控制系统 | |
CN206683651U (zh) | 工业机器人末端位姿快速测量装置 | |
CN109693235A (zh) | 一种仿人眼视觉跟踪装置及其控制方法 | |
CN204525481U (zh) | 一种无动力关节臂式示教器 | |
CN114800523B (zh) | 机械臂轨迹修正方法、系统、计算机及可读存储介质 | |
CN207326366U (zh) | 一种狭窄空间螺栓定位安装机器人 | |
CN114714358A (zh) | 基于手势协议遥操作机械臂方法及系统 | |
CN104760044A (zh) | 一种无动力关节臂式示教器及其在工业机器人中的应用 | |
CN107247424A (zh) | 一种基于激光距离传感器的ar虚拟开关及其方法 | |
Chen et al. | Robotic arm calibration and teaching method based on binocular vision | |
CN205651353U (zh) | 仿人机器人的分布式控制系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | 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 | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20191008 Address after: 2-1f, Kaide Science Park complex building, No. 3, Zhenhua Road, Nanning City, 530000 Guangxi Zhuang Autonomous Region Patentee after: Guangxi send Technology Co., Ltd. Address before: 510000, room 5, 463 Dongming Avenue, Huangcun village, Guangzhou, Guangdong, Tianhe District Patentee before: GUANGZHOU INTELLIGENT WAVE CO., LTD. |