[发明专利]登高平台消防车工作平台的定位导航装置、消防车和方法

摘要

本发明公开了一种登高平台消防车工作平台的定位导航装置、消防车和方法，显示装置和臂架检测装置都与控制器电连接，显示装置将输入的目标点信息发送到控制器，臂架检测装置将获取的登高平台消防车的臂架的状态信息实时发送到控制器，控制器实时计算工作平台移动到目标点的导航信息，并将此导航信息发送到显示装置中进行显示。本发明的定位导航装置、登高平台消防车和方法，可以实时根据臂架当前状态对目标点进行路径规划，保证能以最优方式到达目标点；采用的导航策略仅对操作者进行路径引导，并不对实际的操作过程进行干预，有效避免臂架运动过程中碰触到障碍物等危险工况出现，提高登高消防车安全工作系数以及救援效率。

主权项

一种登高平台消防车工作平台的定位导航装置，其特征在于，包括：控制器、臂架检测装置和显示装置；所述显示装置和所述臂架检测装置都与所述控制器电连接；所述显示装置将输入的目标点信息发送到所述控制器；所述臂架检测装置将获取的登高平台消防车的臂架的状态信息实时发送到所述控制器；所述控制器根据所述目标点信息和所述臂架的状态信息，实时计算工作平台移动到目标点的导航信息，并将此导航信息发送到所述显示装置中进行显示；其中，所述目标点信息包括：目标点的水平距离、高度、旋转角度；所述控制器判断输入目标点的有效性，如果目标点位置可达，所述控制器实时计算主臂能够到达目标点的最大有效区域范围，并根据检测到的当前主臂角度，计算当前需要推荐的主臂导航角度；根据确定的主臂导航角度以及检测到的曲臂角度、主臂长度信息，计算曲臂导航角度，计算完成后继续监测当前的臂架运动状态。