The embodiment of the invention discloses a position and posture determination method and device of a vehicle train, electronic equipment and a storage medium, and the method comprises the steps: obtaining a model derivation position and posture of each axis at the next moment through a kinematic model, the control quantity of a tractor at the current moment and the initial position and posture of each axis at the current moment, determining the actual detection pose of each axis at the next moment according to effective data of a sensor of the tractor, so as to construct a model constraint residual error, a geometric constraint residual error and a detection residual error according to the model derivation pose, the target estimation pose and the actual detection pose at the next moment, and further obtain an accumulated residual error; according to the method, the minimum accumulated residual error is taken as a target for solving, the target estimation pose of each axis at the next moment is obtained, the target estimation pose is taken as the initial pose of the next moment, the optimization of the model derivation pose is realized by constructing three residual errors, the accumulated error in pose estimation is reduced, and the pose estimation cost is reduced.

    本公开实施例公开了一种汽车列车的位姿确定方法、装置、电子设备和存储介质,该方法包括:通过运动学模型、牵引车在当前时刻的控制量以及各轴心在当前时刻的初始位姿,得到各轴心在下一时刻的模型推导位姿,并根据牵引车的传感器有效数据确定各轴心在下一时刻的实际检测位姿,从而根据下一时刻的模型推导位姿、目标估计位姿以及实际检测位姿构建模型约束残差、几何约束残差以及检测残差,进而得到累计残差,以累计残差最小化为目标进行求解,得到各轴心在下一时刻的目标估计位姿,并将其作为下一时刻的初始位姿,该方法通过构建三种残差实现了对模型推导位姿的优化,减少了位姿估计中的累计误差,降低了位姿估计成本。


    Zugriff

    Download


    Exportieren, teilen und zitieren



    Titel :

    Method and device for determining position and posture of combination vehicle, electronic equipment and storage medium


    Weitere Titelangaben:

    汽车列车的位姿确定方法、装置、电子设备和存储介质


    Beteiligte:
    NIU BIBI (Autor:in) / LIU KAI (Autor:in) / CAO SHIZHUO (Autor:in) / ZHOU XIAOCHENG (Autor:in)

    Erscheinungsdatum :

    2023-11-24


    Medientyp :

    Patent


    Format :

    Elektronische Ressource


    Sprache :

    Chinesisch


    Klassifikation :

    IPC:    B60W CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION , Gemeinsame Steuerung oder Regelung von Fahrzeug-Unteraggregaten verschiedenen Typs oder verschiedener Funktion / G06F ELECTRIC DIGITAL DATA PROCESSING , Elektrische digitale Datenverarbeitung



    VEHICLE POSITION POSTURE CALCULATION DEVICE AND VEHICLE POSITION POSTURE CALCULATION PROGRAM

    TERASAWA HIDEKI | Europäisches Patentamt | 2017

    Freier Zugriff


    Vehicle body posture adjusting method and device, electronic equipment and readable storage medium

    WAN RENQUAN / LI MAOQING / WANG KAIRUI et al. | Europäisches Patentamt | 2024

    Freier Zugriff

    Elevator car position determining method and device, electronic equipment and storage medium

    PAN HAIHUA / YANG ZHIHUA / ZHANG MINHUA et al. | Europäisches Patentamt | 2024

    Freier Zugriff

    Vehicle position determination method and device, electronic equipment and storage medium

    CHU MINGYANG / HAO JIE / ZHU YANG et al. | Europäisches Patentamt | 2023

    Freier Zugriff