[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

CN110703749B - 一种控制车辆运动的方法及装置 - Google Patents

一种控制车辆运动的方法及装置 Download PDF

Info

Publication number
CN110703749B
CN110703749B CN201910964146.0A CN201910964146A CN110703749B CN 110703749 B CN110703749 B CN 110703749B CN 201910964146 A CN201910964146 A CN 201910964146A CN 110703749 B CN110703749 B CN 110703749B
Authority
CN
China
Prior art keywords
coordinate
actual position
vehicle
vehicle motion
coordinates
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201910964146.0A
Other languages
English (en)
Other versions
CN110703749A (zh
Inventor
陈亦彪
项宇
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhejiang Huaray Technology Co Ltd
Original Assignee
Zhejiang Huaray Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Zhejiang Huaray Technology Co Ltd filed Critical Zhejiang Huaray Technology Co Ltd
Priority to CN201910964146.0A priority Critical patent/CN110703749B/zh
Publication of CN110703749A publication Critical patent/CN110703749A/zh
Application granted granted Critical
Publication of CN110703749B publication Critical patent/CN110703749B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Electromagnetism (AREA)
  • Navigation (AREA)

Abstract

本申请公开了一种控制车辆运动的方法及装置，该方法包括：采用艾尔米特Hermite插值法计算得到的车辆运动轨迹曲线，获取当前车辆的实际位置的坐标，并根据所述实际位置的坐标和车辆运动的终点的坐标，确定出位于车辆运动轨迹曲线上与所述实际位置对应的目标位置的坐标；根据所述实际位置的坐标和所述目标位置的坐标，计算实际位置和目标位置之间的位置偏移量，并根据所述位置偏移量确定当前所述车辆运动的角速度的补偿量，基于所述角速度的补偿量调整所述车辆运动的角速度，直到检测到所述车辆运动到所述终点位置为止。解决了现有技术的适用性较差的技术问题。

Description

一种控制车辆运动的方法及装置
技术领域
本申请涉及智能汽车技术领域，尤其涉及一种控制车辆运动的方法及装置。
背景技术
近年来，随着自动驾驶技术的不断发展，将二维码技术应用到自动导引车导航技术（AGV Navigation Technology ，AGV），即将包含坐标信息的二维码间隔一定距离粘贴到对应的位置，然后，车辆在运行过程中通过车载相机捕捉二维码图像，返回二维码包含的AGV位置坐标并提取二维码特征点在图像坐标系中的坐标，通过坐标转换得到AGV位置偏差和角度偏差，进而对AGV两轮速度进行调整以实现纠偏，以使得在车体结构不对称、运动场地不平整等因素的影响 下，车辆也能够到达目标位置。
目前，在二维码导航技术中控制车辆到达目标位置的方法主要是根据起点和终点的位置在起点和终点之间规划一条圆弧轨迹，并通过比例-积分-微分PID算法对车辆的运动进行纠偏，以使得车辆沿着规划的轨迹进行运动，从而到达终点。但是，该方法不适用起点和终点不在圆弧上的情况，导致不能适合起点和终点在自由曲线上的情况，适用性较差。
发明内容
本申请提供一种控制车辆运动的方法及装置，用以解决现有技术的适用性较差的技术问题。
第一方面，本申请实施例提供一种控制车辆运动的方法，该方法包括：
获取当前车辆的实际位置的坐标，并根据所述实际位置的坐标和车辆运动的终点的坐标，确定出位于车辆运动轨迹曲线上与所述实际位置对应的目标位置的坐标；其中，所述车辆运动轨迹曲线是在第一坐标系下根据车辆运动的起点的位置参数和终点的位置参数，采用艾尔米特Hermite插值法计算得到的；所述第一坐标系是指以所述终点为坐标原点，所述起点指向所述终点的方向表示横轴正方向的坐标系，所述位置参数包括坐标和斜率；
根据所述实际位置的坐标和所述目标位置的坐标，计算实际位置和目标位置之间的位置偏移量，并根据所述位置偏移量确定当前所述车辆运动的角速度的补偿量，基于所述角速度的补偿量调整所述车辆运动的角速度，直到检测到所述车辆运动到所述终点位置为止。
本申请实施例提供的方案中，通过Hermite插值法计算车辆运动轨迹曲线，并根据车辆的实际位置和车辆运动轨迹曲线上与实际位置对应的目标位置之间的位置偏移量，来确定车辆运动的角速度的补偿量，基于所述补偿量调整所述车辆运动的角速度，使得车辆能够追踪所述车辆运动轨迹曲线运动。因此，本申请实施例所提供的方案中，通过Hermite插值法计算车辆运动轨迹曲线，不仅适用于起点和终点在圆弧上的情况，还适用于起点和终点不在圆弧上的情况，提高了方案的适用性。
可选地，所述车辆运动轨迹曲线的具体计算方法，包括：
确定所述终点的横坐标和所述起点的横坐标之差的倒数，将所述倒数作为横向压缩比例；
基于所述横向压缩比例将所述起点的横坐标和所述终点的横坐标进行压缩，并根据所述横向压缩比例重新计算所述起点以及所述终点所对应的斜率；
根据所述起点的纵坐标、所述终点的纵坐标、以及重新计算的所述起点以及所述终点所对应的斜率，采用Hermite插值法计算出所述车辆运动轨迹曲线。
可选地，根据所述实际位置的坐标和所述终点的坐标，确定出位于车辆运动轨迹曲线上与所述实际位置对应的目标位置的坐标，包括：
根据所述横向压缩比例对所述实际位置的横坐标进行压缩，得到所述目标位置的横坐标；
将所述目标位置的横坐标代入所述车辆运动轨迹曲线的表达式，得到所述目标位置的纵坐标。
可选地，根据所述实际位置的坐标和所述目标位置的坐标计算实际位置和目标位置之间的位置偏移量，包括：
根据所述实际位置的坐标确定所述实际位置与坐标原点之间的第一连线，计算所述第一连线与所述第一坐标系的横轴正方向的第一夹角，以及根据所述目标位置的坐标确定所述目标位置与坐标原点之间的第二连线，计算所述第二连线与所述横轴正方向的第二夹角；
计算所述实际位置的坐标与所述目标位置的坐标之间的坐标偏差，以及计算所述第一夹角与所述第二夹角之间的角度偏差；
将所述坐标偏差和所述角度偏差进行加权处理，得到所述位置偏移量。
可选地，根据所述位置偏移量确定当前所述车辆运动的角速度的补偿量，包括：
根据下式计算角速度的变化量：
Figure DEST_PATH_IMAGE001
其中，
Figure DEST_PATH_IMAGE002
；
Figure 100002_DEST_PATH_IMAGE003
、
Figure DEST_PATH_IMAGE004
、
Figure 100002_DEST_PATH_IMAGE005
表示权重因子，
Figure DEST_PATH_IMAGE006
表示当前 实际位置所对应的位置偏移量；
Figure 100002_DEST_PATH_IMAGE007
表示上一次采集的实际位置所对应的位置偏移量；
Figure DEST_PATH_IMAGE008
表示上上一次采集的实际位置所对应的位置偏移量；
根据下式计算当前所述车辆运动的角速度的补偿量：
Figure 100002_DEST_PATH_IMAGE009
其中，
Figure DEST_PATH_IMAGE010
表示当前所述车辆运动的角速度的补偿量，
Figure 100002_DEST_PATH_IMAGE011
上一次所述车辆 运动的角速度的补偿量。
可选地，基于所述角速度的补偿量调整所述车辆运动的角速度，包括：
根据所述轨迹曲线确定所述目标位置对应的一阶导数和二阶导数，根据所述目标位置对应的一阶导数和二阶导数确定所述实际位置对应的一阶导数和二阶导数；
所述实际位置对应的一阶导数和二阶导数确定所述实际位置对应的曲率半径；
获取所述车辆运动的线速度，根据所述曲率半径以及所述线速度确定所述车辆运动的角速度，基于所述角速度的补偿量调整所述车辆运动的角速度。
可选地，获取当前所述车辆的实际位置的坐标之后，还包括：
判断所述实际位置的坐标与所述终点位置的坐标是否相同；
若相同，则生成第一指示信息，所述第一指示信息用于提示用户所述车辆到达所述终点位置。
可选地，在第一坐标系下确定车辆运动的起点位置参数和终点位置参数之前，还包括：
获取世界坐标系下起点坐标和终点坐标，确定起点坐标和终点坐标的连线与横轴正方向的夹角；
将所述世界坐标系沿顺时针方向旋转所述夹角的角度，并沿着所述起点指向所述终点的方向将所述世界坐标系原点平移到所述终点，得到所述第一坐标系。
第二方面，本申请实施例提供一种控制车辆运动的装置，该装置包括：
确定单元，用于获取当前车辆的实际位置的坐标，并根据所述实际位置的坐标和车辆运动的终点的坐标，确定出位于车辆运动轨迹曲线上与所述实际位置对应的目标位置的坐标；其中，所述车辆运动轨迹曲线是在第一坐标系下根据车辆运动的起点的位置参数和终点的位置参数，采用艾尔米特Hermite插值法计算得到的；所述第一坐标系是指以所述终点为坐标原点，所述起点指向所述终点的方向表示横轴正方向的坐标系，所述位置参数包括坐标和斜率；
处理单元，用于根据所述实际位置的坐标和所述目标位置的坐标，计算实际位置和目标位置之间的位置偏移量，并根据所述位置偏移量确定当前所述车辆运动的角速度的补偿量，基于所述角速度的补偿量调整所述车辆运动的角速度，直到检测到所述车辆运动到所述终点位置为止。
可选地，所述确定单元，具体用于：
确定所述终点的横坐标和所述起点的横坐标之差的倒数，将所述倒数作为横向压缩比例；
基于所述横向压缩比例将所述起点的横坐标和所述终点的横坐标进行压缩，并根据所述横向压缩比例重新计算所述起点以及所述终点所对应的斜率；
根据所述起点的纵坐标、所述终点的纵坐标、以及重新计算的所述起点以及所述终点所对应的斜率，采用Hermite插值法计算出所述车辆运动轨迹曲线。
可选地，所述确定单元，具体用于：
根据所述横向压缩比例对所述实际位置的横坐标进行压缩，得到所述目标位置的横坐标；
将所述目标位置的横坐标代入所述车辆运动轨迹曲线的表达式，得到所述目标位置的纵坐标。
可选地，所述处理单元，具体用于：
根据所述实际位置的坐标确定所述实际位置与坐标原点之间的第一连线，计算所述第一连线与所述第一坐标系的横轴正方向的第一夹角，以及根据所述目标位置的坐标确定所述目标位置与坐标原点之间的第二连线，计算所述第二连线与所述横轴正方向的第二夹角；
计算所述实际位置的坐标与所述目标位置的坐标之间的坐标偏差，以及计算所述第一夹角与所述第二夹角之间的角度偏差；
将所述坐标偏差和所述角度偏差进行加权处理，得到所述位置偏移量。
可选地，所述处理单元，具体用于：
根据下式计算角速度的变化量：
Figure DEST_PATH_IMAGE012
其中，
Figure 100002_DEST_PATH_IMAGE013
表示角速度的增量；
Figure 105206DEST_PATH_IMAGE003
、
Figure 553505DEST_PATH_IMAGE004
、
Figure 598821DEST_PATH_IMAGE005
表示权重因子，
Figure 913738DEST_PATH_IMAGE006
表示当前实际位 置所对应的位置偏移量；
Figure 259269DEST_PATH_IMAGE007
表示上一次采集的实际位置所对应的位置偏移量；
Figure 488256DEST_PATH_IMAGE008
表示 上上一次采集的实际位置所对应的位置偏移量；
根据下式计算当前所述车辆运动的角速度的补偿量：
Figure 20869DEST_PATH_IMAGE009
其中，
Figure 626294DEST_PATH_IMAGE010
表示当前所述车辆运动的角速度的补偿量，
Figure 826331DEST_PATH_IMAGE011
上一次所述车辆 运动的角速度的补偿量。
可选地，所述处理单元，具体用于：
根据所述轨迹曲线确定所述目标位置对应的一阶导数和二阶导数，根据所述目标位置对应的一阶导数和二阶导数确定所述实际位置对应的一阶导数和二阶导数；
所述实际位置对应的一阶导数和二阶导数确定所述实际位置对应的曲率半径；
获取所述车辆运动的线速度，根据所述曲率半径以及所述线速度确定所述车辆运动的角速度，基于所述角速度的补偿量调整所述车辆运动的角速度。
可选地，所述装置还包括判断单元，所述判断单元具体用于：
判断所述实际位置的坐标与所述终点位置的坐标是否相同；
若相同，则生成第一指示信息，所述第一指示信息用于提示用户所述车辆到达所述终点位置。
可选地，所述处理单元，还具体用于：
获取世界坐标系下起点坐标和终点坐标，确定起点坐标和终点坐标的连线与横轴正方向的夹角；
将所述世界坐标系沿顺时针方向旋转所述夹角的角度，并沿着所述起点指向所述终点的方向将所述世界坐标系原点平移到所述终点，得到所述第一坐标系。
第三方面，本申请提供一种计算设备，该计算设备，包括：
存储器，用于存储至少一个处理器所执行的指令；
处理器，用于执行存储器中存储的指令执行第一方面所述的方法。
第四方面，本申请提供一种计算机可读存储介质，所述计算机可读存储介质存储有计算机指令，当所述计算机指令在计算机上运行时，使得计算机执行第一方面所述的方法。
附图说明
图1为本申请实施例所提供的一种控制车辆运动的方法的流程图；
图2为本申请实施例所提供的一种坐标系转换的示意图；
图3为本申请实施例所提供的一种控制车辆运动的装置的结构示意图；
图4为本申请实施例所提供的一种控制车辆运动的装置的结构示意图；
图5为本申请实施例所提供的一种计算设备的结构示意图。
具体实施方式
本申请实施例提供的方案中，所描述的实施例仅是本申请一部分实施例，而不是全部的实施例。基于本申请中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本申请保护的范围。
为了更好的理解上述技术方案，下面通过附图以及具体实施例对本申请技术方案做详细的说明，应当理解本申请实施例以及实施例中的具体特征是对本申请技术方案的详细的说明，而不是对本申请技术方案的限定，在不冲突的情况下，本申请实施例以及实施例中的技术特征可以相互组合。
实施例一
以下结合说明书附图对本申请实施例所提供的一种控制车辆运动的方法做进一步详细的说明，该方法具体实现方式可以包括以下步骤（方法流程如图1所示）：
步骤101，获取当前车辆的实际位置的坐标，并根据所述实际位置的坐标和车辆运动的终点的坐标，确定出位于车辆运动轨迹曲线上与所述实际位置对应的目标位置的坐标；其中，所述车辆运动轨迹曲线是在第一坐标系下根据车辆运动的起点的位置参数和终点的位置参数，采用艾尔米特Hermite插值法计算得到的；所述第一坐标系是指以所述终点为坐标原点，所述起点指向所述终点的方向表示横轴正方向的坐标系，所述位置参数包括坐标和斜率。
具体的，在获取当前车辆的实际位置的坐标之前，建立第一坐标系；其中，建立第一坐标系的方法有多种，下面以一种较佳的方式为例进行说明。
建立第一坐标系，包括：获取世界坐标系下起点坐标和终点坐标，确定起点坐标和终点坐标的连线与横轴正方向的夹角；将所述世界坐标系沿顺时针方向旋转所述夹角的角度，并沿着所述起点指向所述终点的方向将所述世界坐标系原点平移到所述终点，得到所述第一坐标系。
例如，图2所示，在世界坐标系下车辆运动的起点为A（1，1，90°），终点为B（2，2，0°），根据A和B点的坐标计算线段AB与横轴正方向的夹角为45度，将世界坐标系沿顺时针旋转45度，使得横轴正与线段AB重合，然后，沿着A指向B的方向平移世界坐标系，直到坐标系的原点与B点重合为止，得到以终点B为坐标原点，起点A指向终点B的方向表示横轴正方向的第一坐标系。
然后，在建立第一坐标系之后，确定该第一坐标系中起点的位置参数和终点的位置参数，其中，位置参数包括坐标和斜率，然后，采用Hermite插值法计算车辆运动轨迹曲线。
具体的，所述车辆运动轨迹曲线的计算方法，包括：
确定所述终点的横坐标和所述起点的横坐标之差的倒数，将所述倒数作为横向压缩比例；
基于所述横向压缩比例将所述起点的横坐标和所述终点的横坐标进行压缩，并根据所述横向压缩比例重新计算所述起点以及所述终点所对应的斜率；
根据所述起点的纵坐标、所述终点的纵坐标、以及重新计算的所述起点以及所述终点所对应的斜率，采用Hermite插值法计算出所述车辆运动轨迹曲线。
例如，若车辆运动的起始点A的坐标为（
Figure DEST_PATH_IMAGE014
，
Figure DEST_PATH_IMAGE015
），终点B的坐标为（
Figure DEST_PATH_IMAGE016
，
Figure DEST_PATH_IMAGE017
），A点处 切线的斜率为
Figure DEST_PATH_IMAGE018
，B点处切线的斜率为
Figure DEST_PATH_IMAGE019
。首先，提取A点的横坐标
Figure 537804DEST_PATH_IMAGE014
，B点的横坐标
Figure 823292DEST_PATH_IMAGE016
，确 定A点和B点的横坐标之差的倒数为K，
Figure DEST_PATH_IMAGE020
，并将K作为横向压缩比例，然后， 根据K的值对A点的横坐标以及B点的横坐标进行压缩，得到压缩后的A点的横坐标为
Figure DEST_PATH_IMAGE021
，压缩后的B点的横坐标为
Figure DEST_PATH_IMAGE022
，再根据K值重新计算A点的切线的斜率为
Figure DEST_PATH_IMAGE023
/K，B点的切 线的斜率为
Figure DEST_PATH_IMAGE024
/K，最后，根据
Figure 343659DEST_PATH_IMAGE015
、
Figure 398203DEST_PATH_IMAGE017
、
Figure 234572DEST_PATH_IMAGE023
/K以及
Figure 7356DEST_PATH_IMAGE024
/K，计算轨迹曲线。
具体的，计算轨迹曲线的过程如下：
采用Hermite插值法确定轨迹曲线的几何形式为：
Figure DEST_PATH_IMAGE025
其中，a、b、c、d为每一项的系数，t为自变量。
将轨迹曲线的几何形式转换为矩阵形式：
Figure DEST_PATH_IMAGE026
令
Figure DEST_PATH_IMAGE027
其中，
Figure DEST_PATH_IMAGE028
；
Figure DEST_PATH_IMAGE029
表示
Figure DEST_PATH_IMAGE030
几何矢量，
Figure DEST_PATH_IMAGE031
，
Figure DEST_PATH_IMAGE032
表示起点坐标，
Figure DEST_PATH_IMAGE033
表示终点的坐标，
Figure DEST_PATH_IMAGE034
表示起点处切线的斜率，
Figure DEST_PATH_IMAGE035
表示终点处切线的斜率。
将计算得到的
Figure 642999DEST_PATH_IMAGE015
、
Figure 817628DEST_PATH_IMAGE017
、
Figure DEST_PATH_IMAGE036
以及
Figure DEST_PATH_IMAGE037
带入
Figure 231423DEST_PATH_IMAGE030
几何矢量，即可计算出轨迹 曲线的表达式中每一项的系数，进而确定出轨迹曲线。
进一步，在计算出车辆运动轨迹曲线之后，在第一坐标系下，获取当前车辆的实际位置的坐标；具体的，获取当前车辆的实际位置的坐标的方式有多种，下面以两种较佳的方式为例进行说明。
方式1、将车辆运行的区域划分为多个网格的形式，在每一网格中铺设二维码，其中，二维码包括坐标位置信息，在车辆运行过程中，车载相机采集当前的二维码图像，基于所述二维码图像解析出当前车辆的实际位置的坐标。
方式2，在车辆运行过程中通过GPS定位装置获取当前车辆的实际位置，将该实际位置映射到第一坐标系中得到当前车辆的实际位置的坐标。
在获取当前车辆的实际位置的坐标之后，根据所述实际位置的坐标和车辆运动的终点的坐标，确定出位于车辆运动轨迹曲线上与所述实际位置对应的目标位置的坐标。具体的，确定出目标位置的坐标的方式有多种，下面以一种较佳的方式为例进行说明。
根据所述实际位置的坐标和所述终点的坐标，确定出位于车辆运动轨迹曲线上与所述实际位置对应的目标位置的坐标，包括：
根据所述横向压缩比例对所述实际位置的横坐标进行压缩，得到所述目标位置的横坐标；
将所述目标位置的横坐标代入所述车辆运动轨迹曲线的表达式，得到所述目标位置的纵坐标。
步骤102，根据所述实际位置的坐标和所述目标位置的坐标，计算实际位置和目标位置之间的位置偏移量，并根据所述位置偏移量确定当前所述车辆运动的角速度的补偿量，基于所述角速度的补偿量调整所述车辆运动的角速度，直到检测到所述车辆运动到所述终点位置为止。
在确定出车辆运动轨迹上与所述实际位置对应的目标位置的坐标之后，根据实际位置的坐标和目标位置的坐标计算实际位置和目标位置之间的偏移量。具体的，根据实际位置的坐标和目标位置的坐标计算实际位置和目标位置之间的偏移量的方式有多种，下面以一种较佳的方式为例进行说明。
根据所述实际位置的坐标和所述目标位置的坐标计算实际位置和目标位置之间的位置偏移量，包括：
根据所述实际位置的坐标确定所述实际位置与坐标原点之间的第一连线，计算所述第一连线与所述第一坐标系的横轴正方向的第一夹角，以及根据所述目标位置的坐标确定所述目标位置与坐标原点之间的第二连线，计算所述第二连线与所述横轴正方向的第二夹角；
计算所述实际位置的坐标与所述目标位置的坐标之间的坐标偏差，以及计算所述第一夹角与所述第二夹角之间的角度偏差；
将所述坐标偏差和所述角度偏差进行加权处理，得到所述位置偏移量。
具体的，假设实际位置的坐标为（
Figure DEST_PATH_IMAGE038
，
Figure DEST_PATH_IMAGE039
），目标位置的坐标为（
Figure DEST_PATH_IMAGE040
，
Figure DEST_PATH_IMAGE041
），,实际位 置处的切线的斜率
Figure DEST_PATH_IMAGE042
，以及目标位置处的切线的斜率
Figure DEST_PATH_IMAGE043
。将
Figure 803088DEST_PATH_IMAGE042
和
Figure 288427DEST_PATH_IMAGE043
带入角度公式
Figure DEST_PATH_IMAGE044
中，得到实际位置所对应的角度
Figure DEST_PATH_IMAGE045
，目标位置所对应 的角度
Figure DEST_PATH_IMAGE046
，然后，计算实际位置的坐
Figure 694394DEST_PATH_IMAGE039
与
Figure 872565DEST_PATH_IMAGE041
之间的差值，以及
Figure DEST_PATH_IMAGE047
和
Figure DEST_PATH_IMAGE048
之间的差值，得到坐标偏差
Figure DEST_PATH_IMAGE049
-
Figure 557624DEST_PATH_IMAGE041
，角度偏差
Figure DEST_PATH_IMAGE050
-
Figure 377813DEST_PATH_IMAGE048
。
然后，再根据如下公式对坐标偏差和角度偏差进行加权处理，得到位置偏移量：
Figure DEST_PATH_IMAGE051
其中，
Figure DEST_PATH_IMAGE052
表示位置偏移量；
Figure DEST_PATH_IMAGE053
、
Figure DEST_PATH_IMAGE054
为权重因子。
在本申请实施例中，权重因子
Figure 245144DEST_PATH_IMAGE053
、
Figure 718850DEST_PATH_IMAGE054
可以是默认的，例如，默认设置
Figure DEST_PATH_IMAGE055
，
Figure DEST_PATH_IMAGE056
，
Figure DEST_PATH_IMAGE057
=7.162，也可以用户自定义，在此并不做限定。
进一步，在通过上述公式对坐标偏差和角度偏差进行加权处理之前，还可以对坐 标偏差
Figure DEST_PATH_IMAGE058
和角度偏差
Figure DEST_PATH_IMAGE059
进行归一化处理。
进一步，为了避免车辆的车体左右摇摆带来的偏差，在计算当前车辆的位置偏移量之后，还包括：
通过如下公式将与当前实际位置所对应的位置偏移量与相邻二次计算的位置偏移量进行加权处理，得到加权后的位置偏移量：
Figure DEST_PATH_IMAGE060
其中，
Figure 866105DEST_PATH_IMAGE006
表示加权后的位置偏移量；
Figure DEST_PATH_IMAGE061
表示权重因子；
Figure DEST_PATH_IMAGE062
表示当前实际位置所对 应的位置偏移量；
Figure DEST_PATH_IMAGE063
表示下一次实际位置所对应的位置偏移量；
Figure DEST_PATH_IMAGE064
表示下下一次 实际位置所对应的位置偏移量。
具体的，为了对当前实际位置的偏移量进行加权处理，得到加权后的位置偏移量， 需要以当前时刻为参考
Figure DEST_PATH_IMAGE065
，预测下一次实际位置的所对应的位置偏移量
Figure 598306DEST_PATH_IMAGE063
以及下下 一次实际位置所对应的位置偏移量
Figure 602035DEST_PATH_IMAGE064
。为了便于理解，下面对预测下一次实际位置的 所对应的位置偏移量
Figure 387588DEST_PATH_IMAGE063
以及下下一次实际位置所对应的位置偏移量
Figure 843977DEST_PATH_IMAGE064
的过程进 行详述。
具体的，本申请实施例所提供的方案中，计算设备周期性的采集车辆的位置信息以及速度信息，例如，计算设备每隔40秒获取一次车辆的位置信息以及速度信息，其中，速度信息包括角速度以及线速度信息。应理解，本申请实施例提供的计算设备可以是计算机或者服务器等具有计算功能的设备。
计算设备首先确定当前时刻车辆运动的线速度和角速度的比值
Figure DEST_PATH_IMAGE066
，其中，
Figure DEST_PATH_IMAGE067
其中，
Figure DEST_PATH_IMAGE068
表示当前时刻车辆运动的线速度，
Figure DEST_PATH_IMAGE069
表示当前时刻车辆运动的角速度；
然后，根据如下公式预测下一次车辆运动所到达的位置坐标：
Figure DEST_PATH_IMAGE070
Figure DEST_PATH_IMAGE071
其中，
Figure DEST_PATH_IMAGE072
表示下一次车辆运动所到达的位置的横坐标；
Figure DEST_PATH_IMAGE073
表示下一次车辆运 动所到达的位置的纵坐标；
Figure DEST_PATH_IMAGE074
表示采集周期时长。
同理，通过同样的方式预测得到下下一次车辆运动所到达的位置坐标（
Figure DEST_PATH_IMAGE075
，
Figure DEST_PATH_IMAGE076
）。
然后，在确定下一次车辆的位置坐标和下下一次车辆的位置坐标之后，根据前述 方法计算下一次车辆的实际位置偏移量
Figure 428804DEST_PATH_IMAGE063
，以及下下一次车辆的实际位置偏移量
Figure 755881DEST_PATH_IMAGE064
，再根据权重因子
Figure 712335DEST_PATH_IMAGE061
的值，将与当前实际位置所对应的位置偏移量与相邻二次计算 的位置偏移量进行加权处理，得到加权后的位置偏移量。
本申请实施例中，
Figure 531387DEST_PATH_IMAGE061
为位置偏移量的权重因子，用户可以预先自定义，例如，
Figure DEST_PATH_IMAGE077
也可以通过其它的方式获得，在此并不做限制。
进一步，在确定出实际位置和目标位置之间的位置偏移量之后，根据所述位置偏移量确定当前所述车辆运动的角速度的补偿量。具体的，根据位置偏移量确定当前所述车辆运动的角速度的补偿量的方式有多种，下面以一种较佳的方式为例进行说明。
根据所述位置偏移量确定当前所述车辆运动的角速度的补偿量，包括：
根据下式计算角速度的变化量：
Figure 356123DEST_PATH_IMAGE001
其中，
Figure 944230DEST_PATH_IMAGE013
表示角速度的增量；
Figure 399483DEST_PATH_IMAGE003
、
Figure 472874DEST_PATH_IMAGE004
、
Figure 570143DEST_PATH_IMAGE005
表示权重因子，
Figure 12757DEST_PATH_IMAGE006
表示当前实际位 置所对应的位置偏移量；
Figure 904490DEST_PATH_IMAGE007
表示上一次采集的实际位置所对应的位置偏移量；
Figure 698133DEST_PATH_IMAGE008
表示 上上一次采集的实际位置所对应的位置偏移量；
根据下式计算当前所述车辆运动的角速度的补偿量：
Figure DEST_PATH_IMAGE078
其中，
Figure 5618DEST_PATH_IMAGE010
表示当前所述车辆运动的角速度的补偿量，
Figure 161793DEST_PATH_IMAGE011
上一次所述车辆 运动的角速度的补偿量。
进一步，在确定当前所述车辆运动的角速度的补偿量之后，基于所述角速度的补偿量调整所述车辆运动的角速度。基于所述角速度的补偿量调整所述车辆运动的角速度的方式有多种，下面以一种较佳的方式为例进行说明。
基于所述角速度的补偿量调整所述车辆运动的角速度，包括：
根据所述轨迹曲线确定所述目标位置对应的一阶导数和二阶导数，根据所述目标位置对应的一阶导数和二阶导数确定所述实际位置对应的一阶导数和二阶导数；
所述实际位置对应的一阶导数和二阶导数确定所述实际位置对应的曲率半径；
获取所述车辆运动的线速度，根据所述曲率半径以及所述线速度确定所述车辆运动的角速度，基于所述角速度的补偿量调整所述车辆运动的角速度。
具体的，根据车辆运动轨迹曲线表达式确定目标位置所对应的一阶导数表达式
Figure DEST_PATH_IMAGE079
和二阶导数表达式
Figure DEST_PATH_IMAGE080
，根据目标位置和实际位置之间的关系，确定实际位 置所对应的一阶导数表达式为
Figure DEST_PATH_IMAGE081
K*
Figure 332749DEST_PATH_IMAGE079
，二阶导数表达式为
Figure DEST_PATH_IMAGE082
*
Figure 879268DEST_PATH_IMAGE080
， 然后，根据曲率计算公式
Figure DEST_PATH_IMAGE083
计算实际位置所对应的曲率。
然后，获取车辆运动的线速度，根据所述曲率半径以及所述线速度确定所述车辆运动的角速度，基于所述角速度的补偿量调整所述车辆运动的角速度。
具体的，根据如下公式调整车辆运动的角速度：
Figure DEST_PATH_IMAGE084
其中，
Figure DEST_PATH_IMAGE085
表示调整后的车辆运动的角速度；
Figure DEST_PATH_IMAGE086
表示车辆运动的线速度。
本申请实施例提供的方案中，通过Hermite插值法计算车辆运动轨迹曲线，并根据车辆的实际位置和车辆运动轨迹曲线上与实际位置对应的目标位置之间的位置偏移量，来确定车辆运动的角速度的补偿量，基于所述补偿量调整所述车辆运动的角速度，使得车辆能够追踪所述车辆运动轨迹曲线运动。因此，本申请实施例所提供的方案中，通过Hermite插值法计算车辆运动轨迹曲线，不仅适用于起点和终点在圆弧上的情况，还适用于起点和终点不在圆弧上的情况，提高了方案的适用性。
进一步，为了检测车辆是否到达终点，在获取当前所述车辆的实际位置的坐标之后，还包括：
判断所述实际位置的坐标与所述终点位置的坐标是否相同；
若相同，则生成第一指示信息，所述第一指示信息用于提示用户所述车辆到达所述终点位置。
实施例二
本申请实施例提供一种控制车辆运动的装置，参见图3，该装置包括：
确定单元301，用于获取当前车辆的实际位置的坐标，并根据所述实际位置的坐标和车辆运动的终点的坐标，确定出位于车辆运动轨迹曲线上与所述实际位置对应的目标位置的坐标；其中，所述车辆运动轨迹曲线是在第一坐标系下根据车辆运动的起点的位置参数和终点的位置参数，采用艾尔米特Hermite插值法计算得到的；所述第一坐标系是指以所述终点为坐标原点，所述起点指向所述终点的方向表示横轴正方向的坐标系，所述位置参数包括坐标和斜率；
处理单元302，用于根据所述实际位置的坐标和所述目标位置的坐标，计算实际位置和目标位置之间的位置偏移量，并根据所述位置偏移量确定当前所述车辆运动的角速度的补偿量，基于所述角速度的补偿量调整所述车辆运动的角速度，直到检测到所述车辆运动到所述终点位置为止。
可选地，所述确定单元301，具体用于：
确定所述终点的横坐标和所述起点的横坐标之差的倒数，将所述倒数作为横向压缩比例；
基于所述横向压缩比例将所述起点的横坐标和所述终点的横坐标进行压缩，并根据所述横向压缩比例重新计算所述起点以及所述终点所对应的斜率；
根据所述起点的纵坐标、所述终点的纵坐标、以及重新计算的所述起点以及所述终点所对应的斜率，采用Hermite插值法计算出所述车辆运动轨迹曲线。
可选地，所述确定单元301，具体用于：
根据所述横向压缩比例对所述实际位置的横坐标进行压缩，得到所述目标位置的横坐标；
将所述目标位置的横坐标代入所述车辆运动轨迹曲线的表达式，得到所述目标位置的纵坐标。
可选地，所述处理单元302，具体用于：
根据所述实际位置的坐标确定所述实际位置与坐标原点之间的第一连线，计算所述第一连线与所述第一坐标系的横轴正方向的第一夹角，以及根据所述目标位置的坐标确定所述目标位置与坐标原点之间的第二连线，计算所述第二连线与所述横轴正方向的第二夹角；
计算所述实际位置的坐标与所述目标位置的坐标之间的坐标偏差，以及计算所述第一夹角与所述第二夹角之间的角度偏差；
将所述坐标偏差和所述角度偏差进行加权处理，得到所述位置偏移量。
可选地，所述处理单元302，具体用于：
根据下式计算角速度的变化量：
Figure DEST_PATH_IMAGE087
其中，
Figure 367274DEST_PATH_IMAGE013
表示角速度的增量；
Figure 909114DEST_PATH_IMAGE003
、
Figure 283595DEST_PATH_IMAGE004
、
Figure 645306DEST_PATH_IMAGE005
表示权重因子，
Figure 763435DEST_PATH_IMAGE006
表示当前实际位 置所对应的位置偏移量；
Figure 159781DEST_PATH_IMAGE007
表示上一次采集的实际位置所对应的位置偏移量；
Figure 203698DEST_PATH_IMAGE008
表示 上上一次采集的实际位置所对应的位置偏移量；
根据下式计算当前所述车辆运动的角速度的补偿量：
Figure DEST_PATH_IMAGE088
其中，
Figure 724809DEST_PATH_IMAGE010
表示当前所述车辆运动的角速度的补偿量，
Figure 505683DEST_PATH_IMAGE011
上一次所述车辆 运动的角速度的补偿量。
可选地，所述处理单元302，具体用于：
根据所述轨迹曲线确定所述目标位置对应的曲率半径；
获取所述车辆运动的线速度，根据所述曲率半径以及所述线速度确定所述车辆运动的角速度；
基于所述角速度的补偿量调整所述车辆运动的角速度。
可选地，参见图4，所述装置还包括判断单元303，所述判断单元303具体用于：
判断所述实际位置的坐标与所述终点位置的坐标是否相同；
若相同，则生成第一指示信息，所述第一指示信息用于提示用户所述车辆到达所述终点位置。
可选地，所述处理单元302，还具体用于：
获取世界坐标系下起点坐标和终点坐标，确定起点坐标和终点坐标的连线与横轴正方向的夹角；
将所述世界坐标系沿顺时针方向旋转所述夹角的角度，并沿着所述起点指向所述终点的方向将所述世界坐标系原点平移到所述终点，得到所述第一坐标系。
实施例三
本申请提供一种计算设备，参见图5，该计算设备，包括：
存储器501，用于存储至少一个处理器所执行的指令；
处理器502，用于执行存储器中存储的指令执行实施例一所述的方法。
第四方面，本申请提供一种计算机可读存储介质，所述计算机可读存储介质存储有计算机指令，当所述计算机指令在计算机上运行时，使得计算机执行实施例一所述的方法。
本领域内的技术人员应明白，本申请的实施例可提供为方法、系统、或计算机程序产品。因此，本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且，本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质（包括但不限于磁盘存储器和光学存储器等）上实施的计算机程序产品的形式。
本申请是参照根据本申请实施例的方法、设备（系统）、和计算机程序产品的流程图和／或方框图来描述的。应理解可由计算机程序指令实现流程图和／或方框图中的每一流程和／或方框、以及流程图和／或方框图中的流程和／或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和／或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和／或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上，使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和／或方框图一个方框或多个方框中指定的功能的步骤。
显然，本领域的技术人员可以对本申请进行各种改动和变型而不脱离本申请的精神和范围。这样，倘若本申请的这些修改和变型属于本申请权利要求及其等同技术的范围之内，则本申请也意图包含这些改动和变型在内。

Claims (9)

1.一种控制车辆运动的方法，其特征在于，包括：
在第一坐标系下，确定所述车辆运动的终点的横坐标和起点的横坐标之差的倒数，将所述倒数作为横向压缩比例，所述第一坐标系是指以所述终点为坐标原点，所述起点指向所述终点的方向表示横轴正方向的坐标系；
基于所述横向压缩比例将所述起点的横坐标和所述终点的横坐标进行压缩，并根据所述横向压缩比例重新计算所述起点以及所述终点所对应的斜率；
根据所述起点的纵坐标、所述终点的纵坐标、以及重新计算的所述起点以及所述终点所对应的斜率，采用Hermite插值法计算出所述车辆运动轨迹曲线；
获取当前车辆的实际位置的坐标，并根据所述实际位置的坐标和车辆运动的终点的坐标，确定出位于车辆运动轨迹曲线上与所述实际位置对应的目标位置的坐标；
根据所述实际位置的坐标和所述目标位置的坐标，计算实际位置和目标位置之间的位置偏移量，并根据所述位置偏移量确定当前所述车辆运动的角速度的补偿量，基于所述角速度的补偿量调整所述车辆运动的角速度，直到检测到所述车辆运动到所述终点位置为止。
2.如权利要求1所述的方法，其特征在于，根据所述实际位置的坐标和所述终点的坐标，确定出位于车辆运动轨迹曲线上与所述实际位置对应的目标位置的坐标，包括：
根据所述横向压缩比例对所述实际位置的横坐标进行压缩，得到所述目标位置的横坐标；
将所述目标位置的横坐标代入所述车辆运动轨迹曲线的表达式，得到所述目标位置的纵坐标。
3.如权利要求2所述的方法，其特征在于，根据所述实际位置的坐标和所述目标位置的坐标计算实际位置和目标位置之间的位置偏移量，包括：
根据所述实际位置的坐标确定所述实际位置与坐标原点之间的第一连线，计算所述第一连线与所述第一坐标系的横轴正方向的第一夹角，以及根据所述目标位置的坐标确定所述目标位置与坐标原点之间的第二连线，计算所述第二连线与所述横轴正方向的第二夹角；
计算所述实际位置的坐标与所述目标位置的坐标之间的坐标偏差，以及计算所述第一夹角与所述第二夹角之间的角度偏差；
将所述坐标偏差和所述角度偏差进行加权处理，得到所述位置偏移量。
4.如权利要求3所述的方法，其特征在于，根据所述位置偏移量确定当前所述车辆运动的角速度的补偿量，包括：
根据下式计算角速度的变化量：
Figure 829565DEST_PATH_IMAGE002
其中，
Figure DEST_PATH_IMAGE003
表示补偿角速度的增量；
Figure 342586DEST_PATH_IMAGE004
、
Figure DEST_PATH_IMAGE005
、
Figure 118037DEST_PATH_IMAGE006
表示权重因子，
Figure DEST_PATH_IMAGE007
表示当前实际位置 所对应的位置偏移量；
Figure 109127DEST_PATH_IMAGE008
表示上一次采集的实际位置所对应的位置偏移量；
Figure DEST_PATH_IMAGE009
表示上 上一次采集的实际位置所对应的位置偏移量；
根据下式计算当前所述车辆运动的角速度的补偿量：
Figure DEST_PATH_IMAGE011
其中，
Figure 558694DEST_PATH_IMAGE012
表示当前所述车辆运动的角速度的补偿量，
Figure DEST_PATH_IMAGE013
上一次所述车辆运动的 角速度的补偿量。
5.如权利要求1-4任一项所述的方法，其特征在于，基于所述角速度的补偿量调整所述车辆运动的角速度，包括：
根据所述轨迹曲线确定所述目标位置对应的一阶导数和二阶导数，根据所述目标位置对应的一阶导数和二阶导数确定所述实际位置对应的一阶导数和二阶导数；
所述实际位置对应的一阶导数和二阶导数确定所述实际位置对应的曲率半径；
获取所述车辆运动的线速度，根据所述曲率半径以及所述线速度确定所述车辆运动的角速度，基于所述角速度的补偿量调整所述车辆运动的角速度。
6.如权利要求1-4任一项所述的方法，其特征在于，获取当前所述车辆的实际位置的坐标之后，还包括：
判断所述实际位置的坐标与所述终点位置的坐标是否相同；
若相同，则生成第一指示信息，所述第一指示信息用于提示用户所述车辆到达所述终点位置。
7.如权利要求1-4任一项所述的方法，其特征在于，在第一坐标系下确定车辆运动的起点位置参数和终点位置参数之前，还包括：
获取世界坐标系下起点坐标和终点坐标，确定起点坐标和终点坐标的连线与横轴正方向的夹角；
将所述世界坐标系沿顺时针方向旋转所述夹角的角度，并沿着所述起点指向所述终点的方向将所述世界坐标系原点平移到所述终点，得到所述第一坐标系。
8.一种控制车辆运动的装置，其特征在于，包括：
确定单元，用于在第一坐标系下，确定所述车辆运动的终点的横坐标和起点的横坐标之差的倒数，将所述倒数作为横向压缩比例，所述第一坐标系是指以所述终点为坐标原点，所述起点指向所述终点的方向表示横轴正方向的坐标系，基于所述横向压缩比例将所述起点的横坐标和所述终点的横坐标进行压缩，并根据所述横向压缩比例重新计算所述起点以及所述终点所对应的斜率，根据所述起点的纵坐标、所述终点的纵坐标、以及重新计算的所述起点以及所述终点所对应的斜率，采用Hermite插值法计算出所述车辆运动轨迹曲线，以及获取当前车辆的实际位置的坐标，并根据所述实际位置的坐标和车辆运动的终点的坐标，确定出位于车辆运动轨迹曲线上与所述实际位置对应的目标位置的坐标；
调整单元，用于根据所述实际位置的坐标和所述目标位置的坐标，计算实际位置和目标位置之间的位置偏移量，并根据所述位置偏移量确定当前所述车辆运动的角速度的补偿量，基于所述角速度的补偿量调整所述车辆运动的角速度，直到检测到所述车辆运动到所述终点位置为止。
9.一种计算设备，其特征在于，包括：
存储器，用于存储至少一个处理器所执行的指令；
处理器，用于执行存储器中存储的指令执行如权利要求1-7任一项所述的方法。
CN201910964146.0A 2019-10-11 2019-10-11 一种控制车辆运动的方法及装置 Active CN110703749B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910964146.0A CN110703749B (zh) 2019-10-11 2019-10-11 一种控制车辆运动的方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910964146.0A CN110703749B (zh) 2019-10-11 2019-10-11 一种控制车辆运动的方法及装置

Publications (2)

Publication Number Publication Date
CN110703749A CN110703749A (zh) 2020-01-17
CN110703749B true CN110703749B (zh) 2022-11-18

Family

ID=69199360

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910964146.0A Active CN110703749B (zh) 2019-10-11 2019-10-11 一种控制车辆运动的方法及装置

Country Status (1)

Country Link
CN (1) CN110703749B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111176299A (zh) * 2020-01-22 2020-05-19 广州富港万嘉智能科技有限公司 车辆位置调整方法、计算机可读存储介质、agv控制系统及agv小车
CN111888774B (zh) * 2020-07-03 2021-11-30 深圳怡丰自动化科技有限公司 一种座舱的控制方法和控制装置以及存储介质
CN111994169A (zh) * 2020-09-08 2020-11-27 北京北特圣迪科技发展有限公司 基于位置补偿的独立驱动转向的表演小车运动控制方法
CN112124295B (zh) * 2020-09-29 2024-01-05 北京易控智驾科技有限公司 无人驾驶车辆及其终点横向稳态控制方法、电子设备
CN112327844B (zh) * 2020-11-02 2022-10-28 珠海格力智能装备有限公司 轨迹控制方法及装置、导航车辆、计算机可读存储介质
CN112947487B (zh) * 2021-03-31 2024-04-16 深圳市优必选科技股份有限公司 一种自动引导车辆及其曲线路径跟踪方法、控制装置
CN114111768B (zh) * 2021-10-29 2023-10-13 北京自动化控制设备研究所 一种基于偏角异常补偿的轨道线型拟合方法
GB2619774A (en) * 2022-06-17 2023-12-20 Horiba Mira Ltd A control system and method
CN115328135B (zh) * 2022-08-16 2023-03-31 上海联适导航技术股份有限公司 划线机器人校准及划线方法、装置、电子设备及划线机器人

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2569840A1 (fr) * 1984-08-31 1986-03-07 Schnerb Pierre Dispositif destine a representer sur l'ecran d'un tube de television les deplacements d'un mobile, en vue notamment de faciliter le pilotage des vehicules, en particulier des vehicules aeriens
CN108255174A (zh) * 2017-12-20 2018-07-06 北京理工华汇智能科技有限公司 机器人路径规划方法及装置
CN108932737A (zh) * 2018-06-15 2018-12-04 深圳地平线机器人科技有限公司 车载相机俯仰角标定方法和装置、电子设备以及车辆
CN109676602A (zh) * 2018-09-25 2019-04-26 上海肇观电子科技有限公司 行走机器人的自适应标定方法、系统、设备及存储介质

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4617502A (en) * 1983-06-30 1986-10-14 Hitachi, Ltd. Method and apparatus for controlling a robot hand along a predetermined path
AU642638B2 (en) * 1989-12-11 1993-10-28 Caterpillar Inc. Integrated vehicle positioning and navigation system, apparatus and method
FR2779518B1 (fr) * 1998-06-09 2000-08-18 Thomson Csf Procede optique de reconstruction du trace d'une voie le long de laquelle se deplace un vehicule guide
CN103439884B (zh) * 2013-07-19 2015-12-23 大连理工大学 一种基于模糊滑模的智能汽车横向控制方法
JP2018199433A (ja) * 2017-05-29 2018-12-20 三菱電機株式会社 自動操舵制御装置および操舵制御方法
CN107963077B (zh) * 2017-10-26 2020-02-21 东软集团股份有限公司 一种车辆通过路口的控制方法、装置及系统
CN108490943B (zh) * 2018-04-04 2021-08-31 上海华测导航技术股份有限公司 一种农业机械自适应曲线自动驾驶控制方法
CN108510719A (zh) * 2018-05-29 2018-09-07 重庆工业职业技术学院 一种基于车联网的汽车报警控制系统
CN109823393A (zh) * 2018-12-14 2019-05-31 清华大学苏州汽车研究院（相城） 一种智能驾驶车辆轨迹跟踪控制方法
CN110286672A (zh) * 2019-05-13 2019-09-27 深圳创动科技有限公司 机器人及其导航控制方法、导航控制装置以及存储介质

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2569840A1 (fr) * 1984-08-31 1986-03-07 Schnerb Pierre Dispositif destine a representer sur l'ecran d'un tube de television les deplacements d'un mobile, en vue notamment de faciliter le pilotage des vehicules, en particulier des vehicules aeriens
CN108255174A (zh) * 2017-12-20 2018-07-06 北京理工华汇智能科技有限公司 机器人路径规划方法及装置
CN108932737A (zh) * 2018-06-15 2018-12-04 深圳地平线机器人科技有限公司 车载相机俯仰角标定方法和装置、电子设备以及车辆
CN109676602A (zh) * 2018-09-25 2019-04-26 上海肇观电子科技有限公司 行走机器人的自适应标定方法、系统、设备及存储介质

Also Published As

Publication number Publication date
CN110703749A (zh) 2020-01-17

Similar Documents

Publication Publication Date Title
CN110703749B (zh) 一种控制车辆运动的方法及装置
CN109959381B (zh) 一种定位方法、装置、机器人及计算机可读存储介质
JP6785620B2 (ja) ステレオカメラセンサを用いた車両用の予測的サスペンション制御
US8538671B2 (en) Apparatus and method for detecting position and orientation of mobile object
CN110084832B (zh) 相机位姿的纠正方法、装置、系统、设备和存储介质
JP5804185B2 (ja) 移動物体位置姿勢推定装置及び移動物体位置姿勢推定方法
CN111098335B (zh) 一种双轮差速驱动机器人里程计标定方法及装置
CN107703973B (zh) 轨迹跟踪方法、装置
CN111857152A (zh) 用于生成车辆控制信息的方法和装置
CN110155172A (zh) 一种车辆行驶调整方法、装置、车辆控制系统及存储介质
CN108061555B (zh) 一种车辆定位误差矫正方法及装置
CN107065883A (zh) 移动控制方法、装置、机器人及存储介质
CN107179091B (zh) 一种agv行走视觉定位误差修正方法
CN107941212B (zh) 一种视觉与惯性联合定位方法
CN109343539A (zh) 运动控制方法、装置、机器人及存储介质
CN111142527A (zh) 无人船任意路径的追踪控制方法
CN112731952A (zh) 一种机器人质心规划方法、装置、可读存储介质及机器人
CN113119947A (zh) 车辆的控制方法及装置
CN104197932B (zh) 基于人类行为学的位置跟踪方法
CN110207715B (zh) 车辆定位的修正方法及修正系统
CN113885514B (zh) 基于模糊控制和几何追踪的agv路径跟踪方法及系统
WO2020136770A1 (ja) 移動体制御装置、移動体制御学習装置、及び移動体制御方法
KR102468355B1 (ko) 변위 정보 이분화를 통한 상호보완적 짐벌 제어 기반의 이동 객체 감시 장치 및 방법
CN117213510A (zh) 自动驾驶循迹行程信息处理方法、装置、设备及存储介质
CN101777610B (zh) 一种led芯片角度快速调校方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20201217

Address after: C10, No. 1199 Bin'an Road, Binjiang District, Hangzhou City, Zhejiang Province

Applicant after: ZHEJIANG HUARAY TECHNOLOGY Co.,Ltd.

Address before: No. 176, Xinning Road, ningwei street, Xiaoshan District, Hangzhou City, Zhejiang Province

Applicant before: ZHEJIANG DAHUA ROBOT TECHNOLOGY Co.,Ltd.

CB02 Change of applicant information
CB02 Change of applicant information

Address after: C10, No. 1199 Bin'an Road, Binjiang District, Hangzhou City, Zhejiang Province

Applicant after: Zhejiang Huarui Technology Co.,Ltd.

Address before: C10, No. 1199 Bin'an Road, Binjiang District, Hangzhou City, Zhejiang Province

Applicant before: ZHEJIANG HUARAY TECHNOLOGY Co.,Ltd.

GR01 Patent grant
GR01 Patent grant