[发明专利]一种无人车通用目标方向寻优方法

摘要

本发明公开了一种无人车通用目标方向寻优方法，无人车上设有一个高精度定位RTK，该方法包括：获取无人车在初始时刻RTK的初始位置，计算RTK在初始位置时距离目标点的初始距离；获取无人车在绕其中心点以任意速度旋转任意时刻t后RTK的当前位置，计算RTK在当前位置距离目标点的当前距离；计算当前距离关于时间t的一阶微分及二阶微分；根据一阶微分及二阶微分判断无人车的方向是否为朝向目标点的最优方向。本发明仅只使用一个RTK设备就可使无车人精准的朝向目标点，提高了可靠性，同时有效降低了RTK设备的成本，采用RTK设备进行定位，不会受到磁场的干扰。