一种实时层次化滤波方法

    公开(公告)号:CN114186588B

    公开(公告)日:2024-10-18

    申请号:CN202111493587.0

    申请日:2021-12-08

    摘要: 本发明公开一种实时层次化滤波方法,包括采集激光雷达输出数据;进行条件滤波,将点云划分为近地点Gg0和非近地点Gu1;运用随机采样一致性算法将近地点划分为符合平面模型的地面点Gg和非地面点Gu2;合并Gu1和Gu2,采用曲面体素对合并点云进行快速粗滤波;对粗滤波后的点云进行选择性降采样处理和主成分分析选择性降维处理;确定DBSCAN算法参数Eps和Nmin;多线程并行执行DBSCAN算法进行精滤波,得到有效点云GE;步骤8:合并有效点云GE和地面点Gg,结束滤波。本发明解决激光雷达数据滤波过程中参数设置困难以及速度和精度难以兼顾的问题,降低算法复杂度,保证算法实时性,实现基于点云分布特点的实时层次化滤波,达到实时高精度点云滤波的目的。

    一种面向于弱机动海洋机器人改进引力型LOS路径跟踪方法、程序、设备及存储介质

    公开(公告)号:CN118210310A

    公开(公告)日:2024-06-18

    申请号:CN202410314007.4

    申请日:2024-03-19

    IPC分类号: G05D1/43

    摘要: 本发明属于海洋机器人路径跟踪技术领域,具体涉及一种面向于弱机动海洋机器人改进引力型LOS路径跟踪方法、程序、设备及存储介质。本发明在期望路径的几个特殊位置处设置引力向量,用于指引期望路径终点方向,缩小横向跟踪误差以及克服海流影响带来的稳态误差;将期望艏向设置为几个引力的合力方向,同时设定了横向误差判断器以及根据是否发生超调采取不同的期望艏向角计算公式,使得既可以准确的跟踪期望路径,又可以在大偏移下返回目标路径点附近,继续完成路径跟踪任务。本发明相比于传统的LOS制导策略可以良好的解决由于海流影响带来的稳态误差问题,同时也解决了传统的AFLOS算法可能导致的超调过程大,调节时间长的问题。

    一种海洋机器人的动态补偿型自抗扰艏向控制方法

    公开(公告)号:CN116736709A

    公开(公告)日:2023-09-12

    申请号:CN202310686509.5

    申请日:2023-06-09

    IPC分类号: G05B13/04

    摘要: 一种海洋机器人的动态补偿型自抗扰艏向控制方法,涉及机器人运动控制领域。本发明是为了解决现有艏向控制方法不能在不同航速下保证稳定的艏向控制性能,导致航艏控制准确性差的问题及航艏控制参数求解复杂的问题。本发明包括:将海洋机器人期望艏向角ψd输入跟踪微分器,获得跟踪微分器为ψd安排的过渡过程v1;将海洋机器人实际艏向角ψ、控制舵角δ及实际航速U输入线性扩张状态观测器,获得扰动补偿参数b、潜体艏向z1、转向加速度z2、潜体艏摇系统的扰动z3;将z1、z2、z3、b、v1输入自适应状态误差反馈,获得所需控制舵角δ';将δ'下发至舵机,获得ψ',若ψ'与ψd的误差不在预设误差内则重新输入线性扩张状态观测器,直至ψ'与ψd的误差在预设误差内。本发明用于海洋机器人的航艏控制。

    一种海洋机器人的动态补偿型自抗扰艏向控制方法

    公开(公告)号:CN116736709B

    公开(公告)日:2024-07-16

    申请号:CN202310686509.5

    申请日:2023-06-09

    IPC分类号: G05B13/04

    摘要: 一种海洋机器人的动态补偿型自抗扰艏向控制方法,涉及机器人运动控制领域。本发明是为了解决现有艏向控制方法不能在不同航速下保证稳定的艏向控制性能,导致航艏控制准确性差的问题及航艏控制参数求解复杂的问题。本发明包括:将海洋机器人期望艏向角ψd输入跟踪微分器,获得跟踪微分器为ψd安排的过渡过程v1;将海洋机器人实际艏向角ψ、控制舵角δ及实际航速U输入线性扩张状态观测器,获得扰动补偿参数b、潜体艏向z1、转向加速度z2、潜体艏摇系统的扰动z3;将z1、z2、z3、b、v1输入自适应状态误差反馈,获得所需控制舵角δ';将δ'下发至舵机,获得ψ',若ψ'与ψd的误差不在预设误差内则重新输入线性扩张状态观测器,直至ψ'与ψd的误差在预设误差内。本发明用于海洋机器人的航艏控制。

    海洋能驱动机器人节能避障方法
    7.
    发明公开

    公开(公告)号:CN116578095A

    公开(公告)日:2023-08-11

    申请号:CN202310681658.2

    申请日:2023-06-09

    IPC分类号: G05D1/02

    摘要: 海洋能驱动机器人节能避障方法,解决了如何提高海洋能驱动机器人的续航力的问题,属于海洋机器人技术领域。本发明包括:确定海洋能驱动机器人在海洋环境下的状态空间S、趋近目标奖励函数、避障奖励函数和节能奖励函数;利用确定的奖励函数对海洋能驱动机器人避障网络进行训练,得到训练完成的海洋能驱动机器人避障网络;获取海洋能驱动机器人初始点、目标点和障碍物的位置信息,采用训练好的海洋能驱动机器人避障网络完成海洋能驱动机器人节能避障任务。本发明根据海洋能驱动机器人的能源消耗和海洋能捕获,依据海洋环境因素设计出奖励函数,对海洋能驱动机器人路径规划进行网络训练,规划出安全、可行、节能的避障路径。

    一种实时层次化滤波方法

    公开(公告)号:CN114186588A

    公开(公告)日:2022-03-15

    申请号:CN202111493587.0

    申请日:2021-12-08

    IPC分类号: G06K9/00 G06K9/62

    摘要: 本发明公开一种实时层次化滤波方法,包括采集激光雷达输出数据;进行条件滤波,将点云划分为近地点Gg0和非近地点Gu1;运用随机采样一致性算法将近地点划分为符合平面模型的地面点Gg和非地面点Gu2;合并Gu1和Gu2,采用曲面体素对合并点云进行快速粗滤波;对粗滤波后的点云进行选择性降采样处理和主成分分析选择性降维处理;确定DBSCAN算法参数Eps和Nmin;多线程并行执行DBSCAN算法进行精滤波,得到有效点云GE;步骤8:合并有效点云GE和地面点Gg,结束滤波。本发明解决激光雷达数据滤波过程中参数设置困难以及速度和精度难以兼顾的问题,降低算法复杂度,保证算法实时性,实现基于点云分布特点的实时层次化滤波,达到实时高精度点云滤波的目的。