基于激光里程计和标签融合算法的定位追踪方法及系统

    公开(公告)号:CN114563795A

    公开(公告)日:2022-05-31

    申请号:CN202210176224.2

    申请日:2022-02-25

    Abstract: 本发明公开了一种基于激光里程计和标签融合算法的定位追踪方法及系统,包括:步骤1,里程计初步定位;步骤2,通过预先在待定位场景中布置不同的两个标签,获取激光雷达的精确位姿,其具体包括:步骤21,通过激光雷达扫描获取标签所在区域的点云,获取两个标签在局部坐标系中的相对坐标;步骤22,根据两个标签的绝对坐标,在每一个标签的相对坐标附近搜索距离最近的绝对坐标,进行匹配;步骤23,将两个标签与激光雷达组成三角形,获取激光雷达位姿变换矩阵;步骤24,使用激光雷达位姿变换矩阵,对激光雷达的初步位姿进行变换,得到激光雷达的精确位姿。本发明可应用无GNSS信号、存在较多干扰、结构不断变化地复杂场景,为车辆提供精确的定位。

    一种基于多状态参数协同估计的横向控制方法及系统

    公开(公告)号:CN113341997B

    公开(公告)日:2022-04-05

    申请号:CN202110718424.1

    申请日:2021-06-28

    Abstract: 本发明公开了一种基于多状态参数协同估计的横向控制方法,该方法包括:步骤1,设置与车轴所受的垂向力相关的第一观测量、第一预测量、基于车辆质心纵向位置的状态向量,估计车辆的质心纵向位置;步骤2,设置与车辆运动信息相关的第二观测量、第二预测量、基于轮胎侧偏刚度的状态向量、与轮胎侧偏刚度的状态向量对应的第三预测量、第三预测量、基于路面附着系数的状态量,将轮胎侧偏刚度与路面附着系数进行解耦,估计轮胎侧偏刚度和轮胎路面附着系数;步骤3,设置与纵向加速度相关的第四观测量、第四预测量、基于轮胎垂向力的状态向量,估计轮胎垂向力;步骤4,根据估计得到的质心纵向位置与车辆运动信息、轮胎侧偏刚度和轮胎路面附着系数、以及轮胎垂向力,对车辆进行横向控制。本发明能够进行车辆与路面多参数解耦联合估计的同时结合横向动力学控制提升车辆控制精度与横向稳定性。

    一种目标形状及航向估计方法及系统

    公开(公告)号:CN113807442A

    公开(公告)日:2021-12-17

    申请号:CN202111097076.7

    申请日:2021-09-18

    Abstract: 本发明公开了一种目标形状及航向估计方法及系统,该方法包括:步骤S1,获取原始的目标点云数据,并聚类;步骤S2,通过三维边界框描述聚类点云数据;步骤S3,将点云的x与y坐标沿一设定方向旋转预设步长;步骤S4,以三维边界框对应在xoy平面的平面矩形框的中心为原点,建立二维直角坐标系,根据点云特征点所处的象限和聚类点云数据中点云分布呈现的形状,计算目标函数值;步骤S5,判断当前航向角度是否处于设定遍历角度范围内,如果是,则返回步骤S3;反之,则进入步骤S6;步骤S6,选择最大的目标函数值对应的航向角为最优航向角;步骤S7,根据最优航向角对应的平面矩形框的中心在激光雷达坐标系下的位置,确定目标的最优三维边界框的位置、尺寸及姿态。

    一种基于多状态参数协同估计的横向控制方法及系统

    公开(公告)号:CN113341997A

    公开(公告)日:2021-09-03

    申请号:CN202110718424.1

    申请日:2021-06-28

    Abstract: 本发明公开了一种基于多状态参数协同估计的横向控制方法,该方法包括:步骤1,设置与车轴所受的垂向力相关的第一观测量、第一预测量、基于车辆质心纵向位置的状态向量,估计车辆的质心纵向位置;步骤2,设置与车辆运动信息相关的第二观测量、第二预测量、基于轮胎侧偏刚度的状态向量、与轮胎侧偏刚度的状态向量对应的第三预测量、第三预测量、基于路面附着系数的状态量,将轮胎侧偏刚度与路面附着系数进行解耦,估计轮胎侧偏刚度和轮胎路面附着系数;步骤3,设置与纵向加速度相关的第四观测量、第四预测量、基于轮胎垂向力的状态向量,估计轮胎垂向力;步骤4,根据估计得到的质心纵向位置与车辆运动信息、轮胎侧偏刚度和轮胎路面附着系数、以及轮胎垂向力,对车辆进行横向控制。本发明能够进行车辆与路面多参数解耦联合估计的同时结合横向动力学控制提升车辆控制精度与横向稳定性。

    用于四轮独立转向构型车辆的路径规划方法、装置及存储介质

    公开(公告)号:CN118031966A

    公开(公告)日:2024-05-14

    申请号:CN202410169292.5

    申请日:2024-02-06

    Abstract: 本发明涉及自动驾驶技术领域,具体公开了一种用于四轮独立转向构型车辆的路径规划方法、装置及存储介质,包括:获取四轮独立转向构型车辆的当前位姿信息和所在环境的障碍物信息;根据当前位姿信息和所在环境的障碍物信息构建四轮独立转向构型车辆的多个转向运动学模型;对四轮独立转向构型车辆的多个转向运动学模型进行整合,获得综合运动模式模型;根据地图信息以及目标泊车信息构建泊车约束模型;根据泊车约束模型对所述综合运动模式模型进行求解获得泊车最优路径规划信息。本发明提供的用于四轮独立转向构型车辆的路径规划方法能够充分利用4WIS构型车辆的多型转向模式以提升车辆高灵活性和高通过性。

Patent Agency Ranking