机械臂组的控制方法、控制装置、工程机械及存储介质与流程
本公开涉及工程机械控制领域,特别涉及一种机械臂组的控制方法、控制装置、工程机械及存储介质。
背景技术:
1、在地震废墟救援、道路应急抢通、市政工程施工等复杂作业场景中,需要同时完成抓取、剪切、挖掘、支护、立杆等多种不同类型的作业任务。而传统的单机械臂作业装备(例如,单臂挖掘机、单臂救援机器人等)仅具备单一作业功能,面对需要多工种配合的复杂场景时,必须依赖多台设备或多个操作人员协同作业,存在设备占用空间大、人员协调难度高、作业效率低等问题。随着机器人技术的发展,多机械臂系统逐渐成为研究热点。
技术实现思路
1、根据本公开一些实施例的第一个方面,提供一种机械臂组的控制方法,其中,所述机械臂组包括多个机械臂,所述控制方法包括:接收任务级指令;确定协同作业模式;对所述任务级指令进行语义解析,得到多个子任务,其中,所述多个子任务与多个机械臂一一对应;根据所述多个机械臂的参考位姿、所述多个子任务和预设约束条件,确定所述多个机械臂的运动轨迹,其中,所述参考位姿为机械臂在当前时刻的位姿或者安全位姿,所述预设约束条件包括协同约束条件,所述协同约束条件根据所述协同作业模式确定;根据所述多个机械臂中每个机械臂的运动轨迹,控制所述每个机械臂运动,以完成所述任务级指令所指示的目标作业任务。
2、在一些实施例中,所述任务级指令包括目标作业任务类型、目标区域、作业对象类型中的至少一项。
3、在一些实施例中,所述协同作业模式根据用户输入确定、或者根据所述任务级指令确定。
4、在一些实施例中,针对每个机械臂,利用所述机械臂在当前时刻的倾角偏差和位置偏差,对所述机械臂的第一测量位姿进行修正,得到所述机械臂在当前时刻的位姿,其中,所述机械臂的第一测量位姿是利用关节传感器得到的。
5、在一些实施例中,利用倾角传感器检测所述机械臂相对于水平面的第一倾角;根据所述机械臂的第一测量位姿,确定所述机械臂相对于所述水平面的第二倾角;根据所述第一倾角和所述第二倾角,确定所述倾角偏差。
6、在一些实施例中,利用视觉传感器采集所述机械臂的点云数据;根据所述机械臂的点云数据,确定所述机械臂的第二测量位姿;根据所述机械臂的第一测量位姿和所述机械臂的第二测量位姿,确定所述位置偏差。
7、在一些实施例中,每个机械臂的子任务包括所述机械臂的末端目标位姿。
8、在一些实施例中,所述确定所述多个机械臂的运动轨迹包括:针对每个机械臂,根据所述机械臂的末端目标位姿和所述机械臂的参考位姿,确定所述机械臂的目标位姿;根据所述多个机械臂的参考位姿、所述多个机械臂的目标位姿和所述预设约束条件,确定所述多个机械臂的运动轨迹。
9、在一些实施例中,所述根据所述机械臂的末端目标位姿和所述机械臂的参考位姿,确定所述机械臂的目标位姿包括:根据所述机械臂的末端目标位姿,确定多个候选位姿,其中,所述多个候选位姿为满足预设动力学条件的位姿,所述预设动力学条件为在所述机械臂处于候选位姿的情况下,所述机械臂的末端处于所述末端目标位姿;从所述多个候选位姿中选择与所述参考位姿之间的偏差最小的候选位姿,作为所述机械臂的目标位姿。
10、在一些实施例中,每个机械臂的子任务包括所述机械臂的末端期望接触力。
11、在一些实施例中,所述每个机械臂包括多个关节;所述每个机械臂的运动轨迹包括所述机械臂的每个关节在每个时刻的预设关节位置。
12、在一些实施例中,所述控制所述每个机械臂运动包括:针对每个机械臂的每个关节,根据所述关节的位置偏差、速度偏差、力矩偏差中的至少一项,对所述关节的初始力矩进行修正,得到所述关节的控制力矩;利用所述每个关节的控制力矩,控制每个关节进行运动。
13、在一些实施例中,所述关节的位置偏差根据所述关节在当前时刻的预设关节位置和实际关节位置确定;所述关节的速度偏差根据所述关节在当前时刻的预设速度和实际速度确定;所述关节的力矩偏差根据所述关节在当前时刻的期望力矩和实际力矩确定,所述期望力矩是根据所述机械臂的末端期望接触力确定的。
14、在一些实施例中,针对每个机械臂,根据所述机械臂的运动偏差,确定所述机械臂的偏差类型和偏差原因,其中,所述运动偏差包括末端位置偏差、末端接触力偏差中的至少一项。
15、在一些实施例中,所述确定所述机械臂的偏差类型和偏差原因包括:响应于所述末端位置偏差大于最大末端位置偏差、且所述末端接触力偏差不大于最大末端接触力偏差,确定所述偏差类型为轨迹跟踪误差,所述偏差原因包括关节摩擦、传动间隙、负载变化中的至少一项;响应于所述末端位置偏差不大于所述最大末端位置偏差、且所述末端接触力偏差大于所述最大末端接触力偏差,确定所述偏差类型为接触力异常,所述偏差原因包括作业对象材质变化、遇到障碍物、抓取滑脱中的至少一项;响应于所述末端位置偏差大于所述最大末端位置偏差、且所述末端接触力偏差大于所述最大末端接触力偏差,确定所述偏差类型为综合异常,所述偏差原因包括碰撞、结构变形、传感器故障中的至少一项。
16、在一些实施例中,针对每个机械臂,根据所述机械臂的运动偏差,确定是否修正所述机械臂的运动轨迹,其中,所述运动偏差包括末端位置偏差、末端接触力偏差中的至少一项。
17、在一些实施例中,所述确定是否修正所述机械臂的运动轨迹包括:响应于所述运动偏差处于预设允许范围,对所述机械臂的每个关节的控制力矩进行比例积分微分pid补偿;响应于所述运动偏差超出所述预设允许范围、且未处于预设警示范围,重新规划所述机械臂的运动轨迹;响应于所述运动偏差处于所述预设警示范围,控制所述机械臂组停止运动、或者控制所述机械臂组运动至安全位姿。
18、在一些实施例中,所述协同作业模式为第一作业模式,所述机械臂组中的第一机械臂的第一末端执行器为抓斗、用于夹持作业对象,所述机械臂组中的第二机械臂的第二末端执行器为液压剪、用于对所述作业对象进行剪切。
19、在一些实施例中,所述协同约束条件包括第一相对位置约束条件、第一力约束条件和第一姿态约束条件;所述第一相对位置约束条件包括:第一相对位置矢量按照预设参数、从第一预设值变化至第二预设值,所述第一相对位置矢量用于指示所述第二末端执行器与所述第一末端执行器之间的相对位置;所述第一力约束条件包括:所述第一末端执行器的夹持力根据所述第二末端执行器的剪切力确定;所述第一姿态约束条件包括:所述第二末端执行器的剪切平面与所述作业对象的轴线保持垂直。
20、在一些实施例中,所述夹持力根据初始夹持力、力耦合系数以及所述剪切力确定。
21、在一些实施例中,所述协同作业模式为第二作业模式,所述机械臂组中的第一机械臂的第一末端执行器为挖斗、用于挖掘坑洞和回填坑洞,所述机械臂组中的第二机械臂的第二末端执行器为抓斗、用于夹持作业对象并将所述作业对象放置于所述坑洞中。
22、在一些实施例中,所述协同约束条件包括时序约束条件和第二姿态约束条件;所述时序约束条件包括:响应于所述第一机械臂完成挖掘工序,所述第二机械臂开始执行立杆工序;所述第二姿态约束条件包括:在立杆工序中,第二机械臂的目标位姿根据所述坑洞的轴线确定,使得在所述第二机械臂运动至所述目标位姿的情况下、所述作业对象的轴线与所述坑洞的轴线之间的偏差小于预设值。
23、在一些实施例中,所述协同作业模式为第三作业模式,所述机械臂组中的第一机械臂的第一末端执行器为支撑装置、用于支撑目标结构,所述机械臂组中的第二机械臂的第二末端执行器为破拆装置、用于执行破拆作业任务。
24、在一些实施例中,所述协同约束条件包括第二力约束条件和作业空间约束条件;所述第二力约束条件包括:所述第一末端执行器的支撑力大于第二阈值,所述第二阈值根据所述第二末端执行器的作业频率确定;所述作业空间约束条件包括:所述第二机械臂的作业空间根据所述第一机械臂的位姿和支撑范围确定。
25、在一些实施例中,所述第二阈值根据所述目标结构的质量、最大允许振动加速度、振动阻尼系数、以及所述作业频率确定。
26、在一些实施例中,响应于所述第一末端执行器的位移量大于第三阈值,所述第二机械臂停止运动。
27、在一些实施例中,所述协同作业模式为第四作业模式,所述机械臂组中的第一机械臂的第一末端执行器为抓斗、用于夹持作业对象的第一端,所述机械臂组中的第二机械臂的第二末端执行器也为抓斗、用于夹持所述作业对象的第二端。
28、在一些实施例中,所述协同约束条件包括第二相对位置约束、同步运动约束条件和第三力约束条件;所述第二相对位置约束包括:第二相对位置矢量与所述作业对象的轴线平行,所述第二相对位置矢量用于指示所述第二末端执行器与所述第一末端执行器之间的相对位置;以及所述第一机械臂与所述轴线之间的夹角与所述第二机械臂与所述轴线之间的夹角相同;所述同步运动约束条件包括:所述第一末端执行器的高度和所述第二末端执行器的高度相同;以及所述第一末端执行器的第一起吊速度和所述第二末端执行器的第二起吊速度根据所述作业对象的倾角确定;所述第三力约束条件包括:所述第一末端执行器的第一夹持力根据所述第一末端执行器与所述作业对象之间的静摩擦系数、所述作业对象的质量、所述第一末端执行器与所述作业对象之间的接触点的数量确定,所述第二末端执行器的第二夹持力根据所述第二末端执行器与所述作业对象之间的静摩擦系数、所述作业对象的质量、所述第二末端执行器与所述作业对象之间的接触点的数量确定。
29、在一些实施例中,所述协同作业模式为第五作业模式,所述机械臂组中的第一机械臂的第一末端执行器和第二机械臂的第二末端执行器相同、且用于协同抓取所述作业对象,所述作业对象为大直径物体。
30、在一些实施例中,所述协同约束条件包括环抱角度约束条件;所述环抱角度约束条件包括:环抱角度根据机械臂基座间距和所述作业对象的外径确定,所述环抱角度为所述第一末端执行器与所述作业对象的中心的连线与所述第二末端执行器与所述作业对象的中心的连线之间的夹角,所述作业对象的外径根据视觉传感器采集的数据确定。
31、在一些实施例中,针对所述多个机械臂中的至少一个机械臂,对所述至少一个机械臂在当前时刻的位姿进行可视化显示。
32、在一些实施例中,针对每个机械臂,根据所述机械臂与作业对象之间的距离,确定力控制权重和位置控制权重;利用所述力控制权重和位置控制权重,控制所述机械臂运动。
33、在一些实施例中,根据第一机械臂的末端接触力和第二机械臂的末端接触力确定均衡度;响应于均衡度大于最大均衡度、且第一机械臂的末端接触力大于第二机械臂的末端接触力,增加所述第一机械臂的力臂、或者减小所述第二机械臂的力臂。
34、在一些实施例中,实时检测所述作业对象的位置变化量;利用所述位置变化量,对每个机械臂的末端目标位姿进行修正。
35、根据本公开一些实施例的第二个方面,提供一种控制装置,包括:存储器;处理器,耦合到存储器,处理器被配置为基于存储器存储的指令执行前述任意一种机械臂组的控制方法。
36、根据本公开一些实施例的第三个方面,提供一种工程机械,包括:前述任意一种控制装置;机械臂组,被配置为执行目标作业任务,所述机械臂组包括多个机械臂。
37、根据本公开一些实施例的第四个方面,提供一种计算机可读存储介质,其上存储有计算机程序,其中,该程序被处理器执行时实现前述任意一种机械臂组的控制方法。
38、根据本公开一些实施例的第五个方面,提供一种计算机程序产品,包括计算机指令,其中所述计算机指令被处理器执行时实现前述任意一种机械臂组的控制方法。
39、通过以下参照附图对本公开的示例性实施例的详细描述,本公开的其它特征及其优点将会变得清楚。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com