[发明专利]岩土工程机械及其工作臂挠度补偿方法

权利要求书

1.一种岩土工程机械，其特征在于，包括：

车体；

工作臂，连接于所述车体且相对于所述车体具有多个运动自由度；

工作臂位姿检测系统，设置于所述工作臂上，被配置为获取用于反映所述工作臂在所述作业空间内的实时位置和实时姿态的工作臂实时位姿信息；和

工作臂挠度补偿系统，包括存储装置和控制装置，所述存储装置存储有试验或仿真得到的挠度补偿数据，所述控制装置与所述工作臂位姿检测系统和所述存储装置信号连接，被配置为根据所述工作臂实时位姿信息获取在不考虑所述工作臂的弯曲变形的状态下所述工作臂上给定点的理论坐标，并根据所述理论坐标和所述挠度补偿数据获取所述给定点的目标坐标，其中，所述目标坐标用于获取调节所述工作臂的位置和姿态所需的目标位置和目标姿态，以在考虑所述工作臂的弯曲变形的状态下，使所述给定点在所述作业空间内的坐标达到所述理论坐标。

2.根据权利要求1所述的岩土工程机械，其特征在于，所述工作臂包括第一臂节(311)和推进梁(331)，所述第一臂节(311)的第一端连接于所述车体且相对于所述车体具有多个运动自由度，所述推进梁(331)连接于所述第一臂节(311)的第二端且相对于所述第一臂节(311)具有多个运动自由度；

所述工作臂位姿检测系统包括第一臂节位姿检测装置和推进梁位姿检测装置，所述第一臂节位姿检测装置被配置为获取以下所述工作臂实时位姿信息至少之一作为第一臂节实时位姿信息：所述第一臂节(311)相对于所述车体的俯仰角的第一实际值α1、所述第一臂节(311)相对于所述车体的偏向角的第二实际值γ1和所述第一臂节(311)的长度方向的第一端相对于长度方向的第二端的位移的第三实际值v1，所述推进梁位姿检测装置被配置为获取以下所述工作臂实时位姿信息至少之一作为推进梁实时位姿信息：所述推进梁(331)相对于所述第一臂节(311)的俯仰角的第四实际值α2、所述推进梁(331)相对于所述第一臂节(311)的滚转角的第五实际值β2、所述推进梁(331)相对于所述第一臂节(311)的偏向角的第六实际值γ2和所述推进梁(331)的长度方向的第一端相对于长度方向的第二端的位移的第七实际值v2。

3.根据权利要求2所述的岩土工程机械，其特征在于，所述第一臂节位姿检测装置包括第一角度传感器(51)、第二角度传感器(52)和第一位移传感器(53)，所述第一角度传感器(51)被配置为检测所述第一实际值α1，所述第二角度传感器(52)被配置为检测所述第二实际值γ1，所述第一位移传感器(53)被配置为检测所述第三实际值v1。

4.根据权利要求2所述的岩土工程机械，其特征在于，所述推进梁位姿检测装置包括第三角度传感器(61)、第四角度传感器(62)、第五角度传感器(63)和第二位移传感器(64)，所述第三角度传感器(61)被配置为检测所述第四实际值α2，所述第四角度传感器(62)被配置为检测所述第五实际值β2，所述第五角度传感器(63)被配置为检测所述第六实际值γ2，所述第二位移传感器(64)被配置为检测所述第七实际值v2。

5.根据权利要求2所述的岩土工程机械，其特征在于，所述控制装置被进一步配置为：根据所述第一臂节实时位姿信息获取第一变换关系，根据所述推进梁实时位姿信息获取第二变换关系，并根据所述第一变换关系和/或所述第二变换关系获取所述理论坐标，其中，所述第一变换关系表示所述第一臂节和所述推进梁相对于所述车体的坐标变换关系，所述第二变换关系表示所述推进梁相对于所述第一臂节的坐标变换关系。

6.根据权利要求2所述的岩土工程机械，其特征在于，所述控制器被进一步配置为：根据所述第一臂节实时位姿信息，从所述挠度补偿数据中获取第一挠度补偿数据，根据所述第一臂节实时位姿信息和所述第一挠度补偿数据获取所述第一挠度补偿函数，并根据所述理论坐标和所述第一挠度补偿函数获取所述目标坐标，以在考虑所述第一臂节的弯曲变形且不考虑所述推进梁的弯曲变形的第一状态下，使所述给定点在所述作业空间内的坐标达到所述理论坐标。