本发明专利技术公开一种机械臂三维姿态的检测方法和检测系统，公开的检测方法包括下述步骤：A)实时检测机械臂的加速度和角速度；B)对加速度和角速度进行数据处理；C)通过处理后的加速度和角速度计算获得机械臂的三维姿态。该检测方法通过检测机械臂的加速度和角速度，即机械臂动态和静态测量结合，实现动静相互补偿，从而提高不同工况下机械臂三维姿态的检测精度。而且该种方法和系统不仅反映出机械臂线性位移对机械臂空间姿态的影响，同时考虑了旋转运动对空间姿态的影响，因此，可以较为准确地反映机械臂的三维姿态。本发明专利技术还公开一种控制机械臂运行的系统。
【技术实现步骤摘要】
本专利技术涉及工程机械
，特别涉及一种机械臂三维姿态的检测方法和检测系统。本专利技术还涉及一种根据机械臂三维姿态控制机械臂运行的系统。
技术介绍
工程机械设备上，机械臂为较为常见且较为关键的部件，比如混凝土泵车的布料臂架、起重机的伸缩式臂架、大型机械手等。具有机械臂的工程机械的正常工作，有赖于机械臂的精准操作，以使机械臂达到预定位置、实施预定动作。为了保证工程机械设备正常完成施工工作，必须对机械臂实现精确的控制。操作人员控制机械臂操作或控制器自动控制时，均需要根据机械臂的实际姿态并结合操作目标控制机械臂的运行。因此，机械臂的实际运行姿态为机械臂精准控制的重要参考因素。目前对机械臂姿态的获取限于二维空间和静态测量，获得的机械臂姿态存在不精确的问题， 导致机械臂的控制难以满足实际需求。有鉴于此，如何精确地获取机械臂的姿态信息，是本领域技术人员需要解决的技术问题。
技术实现思路
本专利技术的核心为提供一种机械臂三维姿态的检测方法和系统，该方法和系统通过检测机械臂的角速度和加速度，即机械臂动态和静态测量结合，实现动静相互补偿，从而提高不同工况下机械臂姿态的测量精度。本专利技术的另一目的是提供一种根据机械臂三维姿态控制机械臂运行的系统。为达到上述目的，本专利技术提供一种机械臂三维姿态的检测方法，包括下述步骤A)通过加速度检测元件和角速度检测元件实时检测机械臂的加速度和角速度；B)对加速度和角速度进行数据处理；C)通过处理后的加速度和角速度计算获得机械臂的三维姿态。优选地，步骤A)中还实时检测加速度检测元件和角速度检测元件的温度；且步骤B)中，通过检测的温度对加速度和角速度进行校正补偿。优选地，步骤B)中，采用二次曲线拟合的方式校正补偿检测的加速度和角速度。优选地，步骤B)中，校正补偿之前，对检测的加速度、角速度、温度进行滤波处理。优选地，步骤B)中，通过卡尔曼滤波算法对检测的加速度、角速度、温度进行滤波处理。优选地，步骤A)中，建立g = f(t) Xgx函数关系式，由实时检测的角速度获取不同时刻的旋转角度，由旋转角度和矩阵函数f(t)的对应关系，获取f(t)，根据f(t)和&获取g ;步骤C)中，按照下述公式V (k+1) = V (k) +T /2 ；P (k+1) = P (k) +T/2 ;计算获得机械臂的空间位置，以获取机械臂的三维姿态；其中，g为实际加速度、gx为检测加速度、f (t)为随时间更新的空间位置的转换矩阵函数、T为相邻两次检测的间隔时间、V (k+1)和v(k)为相邻两次检测的机械臂的速度、 P (k+1)和p(k)为相邻两次检测的机械臂的空间位置、g(k+l)和g(k)为相邻两次检测机械臂的加速度。本专利技术还提供一种机械臂三维姿态的检测系统，包括加速度检测元件，用以实时检测机械臂的加速度；角速度检测元件，用以实时检测机械臂的角速度；处理单元，用于对加速度和角速度进行数据处理；计算单元，通过处理后的加速度和角速度计算获得机械臂的三维姿态。优选地，所述角速度检测元件为三轴陀螺仪。优选地，还包括实时检测加速度检测元件和角速度检测元件温度的温度传感器； 处理单元通过检测的温度对加速度和角速度进行校正补偿。优选地，处理单元采用二次曲线拟合的方式校正补偿检测的加速度和角速度。优选地，处理单元在校正补偿之前，对检测的加速度、角速度、温度进行滤波处理。优选地，处理单元通过卡尔曼滤波算法对检测的加速度、角速度、温度进行滤波处理。优选地，计算单元建立g = f (t) Xgx函数关系式，并根据三轴陀螺仪检测的角速度获取不同时刻的旋转角度，由旋转角度和矩阵函数f(t)的对应关系，获取f(t)，根据 f(t)和gx获取g ;并按照下述公式 V (k+1) = v(k) +T /2 ；p (k+1) = p (k) +T/2 ;计算获得机械臂的空间位置，以获取机械臂的三维姿态；其中，g为实际加速度、gx为检测加速度、f(t)为实时更新的矩阵函数、T为相邻两次检测的间隔时间、v(k+l)和v(k)为相邻两次检测的机械臂的速度、P (k+1)和p(k)为相邻两次检测的机械臂的空间位置、g(k+l)和g(k)为相邻两次检测机械臂的加速度。该专利技术提供的机械臂三维姿态的检测方法和检测系统，通过检测机械臂的加速度和角速度，即机械臂动态和静态测量结合，实现动静相互补偿，从而提高不同工况下机械臂三维姿态的检测精度。而且该种方法和系统不仅反映出机械臂线性位移对机械臂空间姿态的影响，同时考虑了旋转运动对空间姿态的影响，因此，可以较为准确地反映机械臂的三维姿态。本专利技术还提供一种控制机械臂运行的系统，包括机械臂三维姿态的检测系统，该检测系统为上述任一项所述的检测系统，还包括人机界面和/或控制机械臂运行的控制器，检测系统将检测的机械臂三维姿态信息发送至人机界面和/或控制机械臂运行的控制器。由于上述检测系统具有上述技术效果，具有该检测系统的控制机械臂运行的系统也具有相同的技术效果。附图说明图I为本专利技术所提供机械臂三维姿态检测方法一种具体实施方式的流程图；图2为本专利技术所提供机械臂三维姿态检测系统一种具体实施方式的结构原理图；图3为本专利技术所提供控制机械臂运行的系统一种具体实施方式的结构原理图。具体实施例方式本专利技术的核心为提供一种机械臂三维姿态的检测方法和系统，该方法和系统通过检测机械臂的角速度和加速度，即机械臂动态和静态测量结合，实现动静相互补偿，从而提高不同工况下机械臂姿态的测量精度。本专利技术的另一核心是提供一种根据机械臂三维姿态控制机械臂运行的系统。为了使本领域的技术人员更好地理解本专利技术的技术方案，下面结合附图和具体实施例对本专利技术作进一步的详细说明。为便于理解和简洁描述，下述内容结合机械臂三维姿态的检测方法和系统进行说明，有益效果不再重复论述。请参考图I和图2，图I为本专利技术所提供机械臂三维姿态检测方法一种具体实施方式的流程图；图2为本专利技术所提供机械臂三维姿态检测系统一种具体实施方式的结构原理图。该具体实施方式中机械臂三维姿态的检测方法，包括下述步骤SI)通过加速度检测元件和角速度检测元件分别实时检测机械臂的加速度和角速度；加速度检测元件可以是常用的加速度传感器，角速度检测元件可以是三轴陀螺仪。在实际应用中，将加速度传感器和三轴陀螺仪固定于机械臂上，当应用于具有多级臂架场合时，可以在各级臂架上均安装检测加速度和角速度的检测装置，即可静态测量出机械臂的加速度、动态测量出机械臂的角速度。S2)对加速度和角速度进行数据处理；设置处理单元，处理单元与上述加速度检测元件和角速度元件连接，比如与加速度传感器和三轴陀螺仪连接，则处理单元可以将采集的加速度和角速度模拟信号转换为数据信号，以便于后续处理。S3)通过处理后的加速度和角速度计算获得机械臂的三维姿态。设置与处理单元连接的计算单元，计算单元可以对处理后的加速度和角速度进行计算，根据加速度和位移的计算公式，可以计算出机械臂的实时线性位移；根据旋转角度和角速度的计算公式，可以获得机械臂的实时旋转角度，进而获得机械臂的姿态角。机械臂的实时线性位移和姿态角完整地反映出了机械臂的三维姿态。该实施例中，通过检测机械臂的加速度和角速度，即机械臂动态和静态测量结合， 实现动静相互补偿，从而提高不同工况下机械臂本文档来自技高网...
【技术保护点】
【技术特征摘要】
【专利技术属性】
技术研发人员：李明，杨栋，罗家豪，
申请(专利权)人：三一重工股份有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。