机械臂的控制方法、机械臂的路径规划方法和系统与流程
本技术涉及医疗器械控制,特别是涉及一种机械臂的控制方法、机械臂的路径规划方法和系统。
背景技术:
1、随着机器人行业的发展,机器人的用途也在不断地扩展,由于机器人的操作具有精准、安全等优点,机器人也常被用于神经外科手术中。神经外科手术中,医生会根据患者术前影像检查的结果确定靶点和入针点;基于医生确定的靶点和入针点,可以确定神外手术辅助机器人的机械臂的目标位姿;然后根据路径规划算法,规划出机器臂从当前位姿运动到目标位姿的路径。
2、对于多自由度的机器臂而言,其路径规划属于高维空间的规划问题,直接采用遍历或图搜索的方法计算量非常大,耗时非常久,不能满足实际应用需求。为了解决此问题,可以在路径规划中引入随机采样过程,以减小计算量。但是当环境中存在障碍物时,基于随机采样的路径规划算法规划的路径虽然可以避开障碍物,但是会在路径中引入一些多余的路径点,导致机器臂出现路径折返的问题,而路径折返一方面会导致机器臂的运动效率降低,另一方面当机器臂运动到多余的路径点处时,操作人员可能会认为机器臂的当前运动与预期运动存在一定偏差而误判机器臂运动出现了异常,从而引起操作人员的误操作,如误拍机器臂的急停按钮等。
技术实现思路
1、基于此,有必要针对上述技术问题,提供一种高效准确的机械臂的控制方法、机械臂的路径规划方法和系统。
2、第一方面,本技术提供了一种机械臂的控制方法,将机械臂的所有轴线相交于一点的轴关节作为第一类关节,将所述机械臂中除了所述第一类关节以外的轴关节作为第二类关节;所述方法包括:
3、调整机械臂的第二类关节,使得机械臂末端从当前操作点运动至中间过渡点;
4、调整机械臂的第一类关节,使得机械臂末端在中间过渡点处的姿态与机械臂末端在目标操作点处的姿态相同;
5、调整第二类关节,使得机械臂末端从中间过渡点运动至目标操作点。
6、在其中一个实施例中,方法还包括:获取机械臂与目标操作对象在术前扫描的三维医学影像之间的配准矩阵;根据配准矩阵,确定机械臂与机械臂的目标操作对象之间的相对位置关系;根据相对位置关系,确定中间过渡点。
7、在其中一个实施例中,方法还包括:获取机械臂与目标操作对象在术前扫描的三维医学影像之间的配准矩阵,以及针对三维医学影像制定的手术规划信息;根据配准矩阵和手术规划信息,确定目标操作点的目标位置以及当机械臂末端位于目标操作点时机械臂末端的目标姿态;根据目标操作点的目标位置和机械臂末端的目标姿态,基于逆运动学,确定当机械臂末端位于目标操作点时机械臂的第一类关节的第一目标关节角和第二类关节的第二目标关节角。
8、在其中一个实施例中,调整机械臂的第二类关节,使得机械臂末端从当前操作点运动至中间过渡点,包括:根据中间过渡点的位置,基于逆运动学,确定当机械臂末端位于中间过渡点时机械臂的第二类关节的中间关节角;将机械臂的第二类关节的关节角由第二当前关节角调整为中间关节角,第二当前关节角是指机械臂末端在当前操作点时第二类关节的关节角。
9、在其中一个实施例中,调整机械臂的第一类关节,使得机械臂末端在中间过渡点处的姿态与机械臂末端在目标操作点处的姿态相同,包括:将机械臂的第一类关节的关节角由第一当前关节角调整为第一类关节的第一目标关节角,第一当前关节角是指机械臂末端在当前操作点时第一类关节的关节角。
10、在其中一个实施例中,调整第二类关节,使得机械臂末端从中间过渡点运动至目标操作点,包括:将机械臂的第二类关节的关节角由第二类关节的中间关节角调整为第二类关节的目标关节角。
11、第二方面,本技术还提供一种机械臂的路径规划方法,将机械臂的所有轴线相交于一点的轴关节作为第一类关节,将机械臂中除了第一类关节以外的轴关节作为第二类关节;方法包括:确定当机械臂末端位于当前操作点时,机械臂的第一类关节的第一当前关节角和第二类关节的第二当前关节角,并组成当前关节角集合;确定当机械臂末端位于中间过渡点时,机械臂的第二类关节的中间关节角;以及确定当机械臂末端位于目标操作点时,机械臂的第一类关节的第一目标关节角和第二类关节的第二目标关节角并组成目标关节角集合;根据第二类关节的中间关节角和第一类关节的第一当前关节角,确定第一关节角集合;以及根据第二类关节的中间关节角和第一类关节的第一目标关节角,确定第二关节角集合;确定机械臂的关节角由当前关节角集合变换到第一关节角集合的第一路径、机械臂的关节角由第一关节角集合变换到第二关节角集合的第二路径、机械臂的关节角由第二关节角集合变换到目标关节角集合的第三路径。
12、第三方面,本技术还提供一种机械臂的控制系统,系统包括机械臂和控制器,机械臂包括第一类关节和第二类关节,第一类关节包括所有轴线相交于一点的轴关节,第二类关节是指机械臂中除了第一类关节以外的轴关节;控制器用于:调整机械臂的第二类关节,使得机械臂末端从当前操作点运动至中间过渡点;调整机械臂的第一类关节,使得机械臂末端在中间过渡点处的姿态与机械臂末端在目标操作点处的姿态相同;调整机械臂的第二类关节,使得机械臂末端从中间过渡点运动至目标操作点。
13、第四方面,本技术还提供一种机械臂的路径规划系统,系统包括机械臂和控制器,机械臂包括第一类关节和第二类关节,第一类关节包括所有轴线相交于一点的轴关节,第二类关节是指机械臂中除了第一类关节以外的轴关节;控制器用于:确定当机械臂末端位于当前操作点时,机械臂的第一类关节的第一当前关节角和第二类关节的第二当前关节角,并组成当前关节角集合;确定当机械臂末端位于中间过渡点时,机械臂的第二类关节的中间关节角;以及确定当机械臂末端位于目标操作点时,机械臂的第一类关节的第一目标关节角和第二类关节的第二目标关节角并组成目标关节角集合;根据第二类关节的中间关节角和第一类关节的第一当前关节角,确定第一关节角集合;以及根据第二类关节的中间关节角和第一类关节的第一目标关节角,确定第二关节角集合;确定机械臂的关节角由当前关节角集合变换到第一关节角集合的第一路径、机械臂的关节角由第一关节角集合变换到第二关节角集合的第二路径、机械臂的关节角由第二关节角集合变换到目标关节角集合的第三路径。
14、第五方面,本技术还提供了一种计算机设备。所述计算机设备包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现以下步骤:调整机械臂的第二类关节,使得机械臂末端从当前操作点运动至中间过渡点;调整机械臂的第一类关节,使得机械臂末端在中间过渡点处的姿态与机械臂末端在目标操作点处的姿态相同;调整第二类关节,使得机械臂末端从中间过渡点运动至目标操作点。
15、第六方面,本技术还提供了一种计算机可读存储介质。所述计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现以下步骤:调整机械臂的第二类关节,使得机械臂末端从当前操作点运动至中间过渡点;调整机械臂的第一类关节,使得机械臂末端在中间过渡点处的姿态与机械臂末端在目标操作点处的姿态相同;调整第二类关节,使得机械臂末端从中间过渡点运动至目标操作点。
16、第七方面,本技术还提供了一种计算机程序产品。所述计算机程序产品,包括计算机程序,该计算机程序被处理器执行时实现以下步骤:调整机械臂的第二类关节,使得机械臂末端从当前操作点运动至中间过渡点;调整机械臂的第一类关节,使得机械臂末端在中间过渡点处的姿态与机械臂末端在目标操作点处的姿态相同,第一类关节用于调整机械臂末端的姿态;调整第二类关节,使得机械臂末端从中间过渡点运动至目标操作点。
17、上述机械臂的控制方法、机械臂的路径规划方法和系统,调整机械臂的第二类关节,使得机械臂末端从当前操作点运动至中间过渡点;调整机械臂的第一类关节,使得机械臂末端在中间过渡点处的姿态与机械臂末端在目标操作点处的姿态相同;调整机械臂的第二类关节,使得机械臂末端从中间过渡点运动至目标操作点。本方法通过将机械臂的高维规划问题降为三维规划问题,能够有效解决机器人控制过程中机械臂路径折返问题,提高机械臂的控制效率。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com