CN111427344A - 自主体轨迹冲突的解决方法、装置、设备和存储介质 - Google Patents
自主体轨迹冲突的解决方法、装置、设备和存储介质 Download PDFInfo
- Publication number
- CN111427344A CN111427344A CN202010089992.5A CN202010089992A CN111427344A CN 111427344 A CN111427344 A CN 111427344A CN 202010089992 A CN202010089992 A CN 202010089992A CN 111427344 A CN111427344 A CN 111427344A
- Authority
- CN
- China
- Prior art keywords
- conflict
- self
- track
- autonomous
- bodies
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 56
- 238000001514 detection method Methods 0.000 claims description 10
- 238000012163 sequencing technique Methods 0.000 claims description 9
- 238000004590 computer program Methods 0.000 claims description 6
- 230000006870 function Effects 0.000 description 12
- 239000013598 vector Substances 0.000 description 11
- 230000000737 periodic effect Effects 0.000 description 7
- 230000003287 optical effect Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 4
- 238000004891 communication Methods 0.000 description 2
- 230000003111 delayed effect Effects 0.000 description 2
- 239000013307 optical fiber Substances 0.000 description 2
- 230000002093 peripheral effect Effects 0.000 description 2
- 230000000644 propagated effect Effects 0.000 description 2
- 238000003491 array Methods 0.000 description 1
- 230000002567 autonomic effect Effects 0.000 description 1
- 230000006399 behavior Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 230000002035 prolonged effect Effects 0.000 description 1
- 230000008707 rearrangement Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明实施例公开了一种自主体轨迹冲突的解决方法、装置、设备和存储介质。该自主体轨迹冲突的解决方法包括：在自主体运动过程中，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示；其中，轨迹点信息至少包括时间信息和位置信息；根据至少两个自主体的轨迹表示确定自主体冲突信息；其中，自主体冲突信息至少包括冲突时间、冲突位置以及冲突自主体；根据冲突时间和冲突位置，更新冲突自主体的轨迹表示，以使在冲突时间下所述冲突自主体的位置不同。本发明实施例通过对自主体运行轨迹中冲突信息的确定，进而对冲突自主体的轨迹进行更新，简化对自主体轨迹的确定过程，提高自主体轨迹冲突规避的效率和准确率。
Description
技术领域
本发明实施例涉及自主体调度技术领域，尤其涉及一种自主体轨迹冲突的解决方法、装置、设备和存储介质。
背景技术
自主体包括AGV(Automatic Guided Vehicle，自动导引车)以及无人机等。对于自主体目前已运用在多个行业，如仓储业、制造业以及机场等。并且为了提高工作效率，通过采用多个自主体进行同时操作，多个自主体之间或完成不同的任务，或完成相同的任务。但是均需要对自主体的运动轨迹进行确定。
目前只考虑到了任务执行过程中的时间因素，即多自主体完成任务时间或者行驶路程是唯一标准。但是在实际应用中，系统除了要考虑多自主体完成任务所需的时间代价、路程代价之外，往往在任务完成过程中的路径冲突避免也显得尤为重要，即保证自主体在任务执行过程中进行无冲突的移动。
发明内容
本发明实施例提供一种自主体轨迹冲突的解决方法、装置、设备和存储介质，通过对自主体运行轨迹中冲突信息的确定，简化对自主体轨迹冲突的解决过程，提高自主体轨迹冲突规避的效率和准确率。
第一方面，本发明实施例提供了一种自主体轨迹冲突的解决方法，包括：
在自主体运动过程中，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示；其中，轨迹点信息至少包括时间信息和位置信息；
根据所述至少两个自主体的轨迹表示确定自主体冲突信息；其中，自主体冲突信息至少包括冲突时间、冲突位置以及冲突自主体；
根据所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，以使在所述冲突时间下所述冲突自主体的位置不同。
第二方面，本发明实施例还提供了一种自主体轨迹冲突的解决装置，包括：
轨迹表示确定模块，用于在自主体运动过程中，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示；其中，轨迹点信息至少包括时间信息和位置信息；
冲突信息确定模块，用于根据所述至少两个自主体的轨迹表示确定自主体冲突信息；其中，自主体冲突信息至少包括冲突时间、冲突位置以及冲突自主体；
轨迹表示更新模块，用于根据所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，以使在所述冲突时间下所述冲突自主体的位置不同。
第三方面，本发明实施例还提供了一种设备，包括：
一个或多个处理器；
存储装置，用于存储一个或多个程序，
当所述一个或多个程序被所述一个或多个处理器执行，使得所述一个或多个处理器实现如本发明任一实施例所述的自主体轨迹冲突的解决方法。
第四方面，本发明实施例还提供了一种计算机可读存储介质，其上存储有计算机程序，该程序被处理器执行时实现如本发明任一实施例所述的自主体轨迹冲突的解决方法。
本发明实施例基于对自主体的运动轨迹进行表示，根据其轨迹表示确定轨迹存在冲突的自主体信息以及冲突信息，根据确定的信息，对自主体的轨迹进行更新，规避轨迹冲突的点。通过对自主体运行轨迹中冲突信息的确定，进而对冲突自主体的轨迹进行更新，简化对自主体轨迹的确定过程，提高自主体轨迹冲突规避的效率和准确率。
附图说明
图1是本发明实施例一中的自主体轨迹冲突的解决方法的流程图；
图2是本发明实施例二中的自主体轨迹冲突的解决方法的流程图；
图3是本发明实施例三中的自主体轨迹冲突的解决装置的结构示意图；
图4是本发明实施例四中的设备的结构示意图。
具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是，此处所描述的具体实施例仅仅用于解释本发明，而非对本发明的限定。另外还需要说明的是，为了便于描述，附图中仅示出了与本发明相关的部分而非全部结构。
实施例一
图1是本发明实施例一中的自主体轨迹冲突的解决方法的流程图，本实施例可适用于解决多个自主体运行轨迹冲突的情况。该方法可以由自主体轨迹冲突的解决装置来执行，该装置可以采用软件和/或硬件的方式实现，并可配置在设备中，例如设备可以是后台服务器等具有通信和计算能力的设备。如图1所示，该方法具体包括：
步骤101、在自主体运动过程中，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示；其中，轨迹点信息至少包括时间信息和位置信息。
其中，自主体包括AGV小车以及无人机等。对于应用在不同行业执行不同任务的自主体来说，轨迹点信息是指自主体在运行过程中在具体时间点所到达的位置坐标信息。轨迹表示可以对自主体的运动进行表示。
在本实施例中，假定自主体在执行任务过程中，进行周期性地运动，也即从起点A到目标点B之间是具有周期性，从而可以利用周期函数来对A到B之间的轨迹点进行表示，得到自主体的轨迹表示。例如自主体在A点和B点之间作周期性的往返运动。在本实施中，对于自主体的运动的约束条件不局限于匀速行驶，在非匀速行驶的条件下也适用。获取自主体的周期性的轨迹运动过程中多个轨迹点信息，根据周期性的轨迹点信息中确定自主体的运行规律，进而确定自主体的轨迹表示。例如获取自主体从A点到B点之间运动时所经过的多个轨迹点信息，根据轨迹点信息中包含的时间信息与位置信息的对应关系，确定自主体的周期性的轨迹表示。根据多个轨迹点信息确定周期函数的表达式，表达式的输入可以是时间，输出为自主体的位置信息，即根据该函数可以确定自主体在不同时间下所处位置的信息。
可选的，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示，包括：
基于傅里叶级数，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示。
具体的，在自主体的正常运行过程中，其运行轨迹可以等价于满足狄利克雷条件的周期函数。在本实施例中，使用傅里叶级数描述自主体的轨迹函数，即
其中，根据获取到的自主体的轨迹点信息，将时间与对应的位置信息代入傅里叶级数中
求得傅里叶级数中的公共系数。因此对于不同自主体的轨迹点信息，其公共系数是不同的。在本实施例中，根据轨迹点信息求解公共系数可以采用高斯牛顿迭代法，在此不做赘述。示例性的，对于两个自主体的轨迹表示来说，可以采用f(t)＝(x,y)和g(t)＝(x,y)表示，基于傅里叶级数，
可选的，自主体的轨迹表示可以根据泰勒展开式进行确定。
步骤102、根据所述至少两个自主体的轨迹表示确定自主体冲突信息；其中，自主体冲突信息至少包括冲突时间、冲突位置以及冲突自主体。
其中，冲突时间是指自主体之间发生冲突的时间点，冲突位置是指自主体之间发生冲突的位置坐标点，冲突自主体是指发生冲突的自主体信息，如自主体的ID信息等。
具体的，对于自主体之间发生冲突的定义可以表示为至少两个自主体在相同时间点处于同一位置，即冲突自主体之间存在时间和空间的重叠。因此冲突也可以叫冲突点，解决冲突问题也就等价于解决冲突点问题。示例性的，当自主体A和自主体B发生冲突时，其关系描述可以用f(t)＝g(t)表示。根据确定自主体的轨迹表示，可以确定自主体之间的冲突信息。
可选的，根据所述至少两个自主体的轨迹表示确定自主体冲突信息，包括：
若根据至少两个自主体的轨迹表示，确定至少两个自主体在任一时间的位置相同，则将所述至少两个自主体作为所述冲突自主体，该时间作为冲突时间，且在该时间的位置作为冲突位置。
示例性的，在上述示例的基础上，寻找自主体之间的冲突点问题就等价于求解两个傅里叶级数的公共解问题，即f(t)-g(t)＝0，即求解当
求解出来的t即为冲突时间，在时间t下f(t)的值为冲突位置，自主体A和自主体B为冲突自主体。可以明确的是，发生冲突的自主体的个数不局限于两个，所有在时间t下轨迹表示的值相同的自主体均为冲突自主体。
步骤103、根据所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，以使在所述冲突时间下所述冲突自主体的位置不同。
具体的，完成对冲突点的判定后，通过对自主体轨迹表示的更新实现多自主体的无冲突调度。示例性的，当自主体A和自主体B在时间t1发生冲突时，即f(t1)＝g(t1)，可以通过更改任一自主体到达该位置的时间或者更改任一自主体在该时间下的位置，实现对冲突自主体轨迹表示的更新。更新完成后的自主体的轨迹表示f(t1)和g(t1)的值不相等。
可选的，根据所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，包括：
根据自主体的优先级对所述冲突自主体进行排序，确定冲突自主体排序结果；
按照所述冲突自主体排序结果，对排序在后的冲突自主体到达所述冲突位置的时间进行延迟，以确定更新后的冲突自主体的轨迹表示。
其中，优先级是指自主体的属性信息，可以根据自主体完成任务的优先级进行设置，或者根据自主体的性能进行设置。
具体的，确定冲突自主体的优先级，并按照优先级从高到低进行排序，通过修改自主体的到达时间，即延长低优先级自主体的到达时间。示例性的，对于最高优先级的自主体的冲突时间不作延迟，对于次优先级的自主体依次进行延迟到达冲突位置的时间。示例性的，在上述示例的基础上，对于自主体A和自主体B，使得f(t1)＝g(t2)，f(t1)＝g(t1+Δt)，从而满足f(t1)≠g(t1)。
通过根据优先级延迟冲突自主体到达冲突位置的时间，使得高优先级可以优先到达冲突位置，不影响其任务的执行，从而提高对自主体轨迹冲突解决的效率。
本发明实施例基于对自主体的运动轨迹进行表示，根据其轨迹表示确定轨迹存在冲突的自主体信息以及冲突信息，根据确定的信息，对自主体的轨迹进行更新，规避轨迹冲突的点。由于对自主体运行轨迹中冲突信息的确定不涉及对自主体的速度计算，只与自主体的运动轨迹相关，因此简化了对自主体轨迹的确定过程，提高自主体轨迹冲突规避的效率和准确率。
实施例二
图2是本发明实施例二中的自主体轨迹冲突的解决方法的流程图，本实施例二在实施例一的基础上进行进一步地优化，实现了根据冲突类型的不同采取不同的冲突检测操作，提高冲突检测的效率。如图2所示，所述方法包括：
步骤201、在自主体运动过程中，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示；其中，轨迹点信息至少包括时间信息和位置信息。
步骤202、根据所述至少两个自主体的轨迹表示确定自主体冲突信息；其中，自主体冲突信息至少包括冲突时间、冲突位置以及冲突自主体。
步骤203、根据至少两个冲突自主体的原轨迹表示，确定不同冲突自主体之间的夹角信息。
其中，原轨迹表示是指根据自主体的轨迹点信息确定的轨迹。夹角信息是指冲突自主体在冲突位置时各自的轨迹运行方向构成的夹角值。
具体的，根据自主体的原轨迹表示，确定在冲突点时自主体的运行方向，根据确定的运行方向的角度差确定不同冲突自主体之间的夹角信息。示例性的，自主体在冲突点的运行方向可以根据自主体的原轨迹表示在冲突位置的斜率进行确定。示例性的，对于冲突自主体中包括三个或三个以上的自主体时，需要确定任意两个冲突自主体之间的夹角信息。
可选的，所述原轨迹表示为傅里叶级数轨迹表示；
相应地，所述根据至少两个冲突自主体的原轨迹表示，确定不同冲突自主体之间的夹角信息，包括：
根据所述至少两个自主体的傅里叶轨迹表示的偏导结果，确定所述至少两个冲突自主体的轨迹方向；
根据不同冲突自主体的轨迹方向的内积或方向余弦，确定不同冲突自主体之间的夹角信息。
其中，傅里叶级数轨迹表示是指根据傅里叶级数表示的自主体的轨迹函数结果。可参照实施例一中的确定过程，在此不作赘述。偏导反映了傅里叶轨迹函数沿坐标轴正方向的变化率，其可以表示自主体的运行方向，对于多元函数，其偏导结果可以用向量表示。内积可以表示两个向量在空间中的关系，可以用来表示两个向量的夹角关系。方向余弦是指在解析几何里，一个向量的三个方向余弦分别是这向量与三个坐标轴之间的角度的余弦。两个向量之间的方向余弦指的是这两个向量之间的角度的余弦，根据方向余弦也可以确定两个向量之间的夹角关系。
具体的采用向量的方式对自主体的运行空间方向进行描述，向量通过对傅里叶轨迹表示求偏导数进行确定。示例性的，在上述示例的基础上，对轨迹函数f(t)求关于(x,y)的偏导数，即
通过结果组成的向量，表示自主体的轨迹方向。
确定冲突自主体的轨迹方向后，根据轨迹方向的信息确定不同冲突自主体之间的夹角信息。示例性的，对求偏导得到的表示轨迹方向的向量求内积或方向余弦，例如，对于冲突自主体A和冲突自主体B，对其傅里叶轨迹表示求偏导得到的向量为a和b，对a和b求方向余弦，根据求方向余弦的定义，可以确定求得方向余弦的结果落在区间[-1,1]中，则基于方向余弦的值与夹角的对应关系，根据求得方向余弦的值确定冲突自主体A和冲突自主体B之间的夹角值。例如，方向余弦值为-1时，对应的夹角值为0，方向余弦值为1时，对应的夹角值为180。
步骤204、根据所述夹角信息，确定不同冲突自主体的冲突类型。
其中，冲突类型根据冲突自主体发生冲突时的运行轨迹的朝向进行划分，在本实施例中，根据冲突自主体的运行轨迹方向之间的夹角不同，将冲突类型分为同向冲突和相向冲突，同向冲突是指冲突自主体的运行轨迹处于同一方向；相向冲突是指冲突自主体的运行轨迹是相对的，即两个自主体是朝着相反的方向在运行。可选的，根据实际情况可以将冲突类型细分为同向冲突、正交冲突、相遇冲突以及追赶冲突等。
具体的，基于预先确定的夹角信息与冲突类型之间的映射关系，根据确定的两个冲突自主体之间的夹角信息，确定对应的冲突类型。示例性的，预先设置对于夹角值在区间(135,180]中，对应的冲突类型为相向冲突；对于夹角值在区间[0,135]中，对应的冲突类型为同向冲突。可选的，对于冲突类型增加的情况，可以根据夹角值进行进一步的细分。
通过根据轨迹表示的偏导结果确定自主体的轨迹方向，从而确定冲突类型，简化了对冲突类型的确定步骤，提高对冲突类型的确定效率，同时可以保证对自主体冲突类型确定的准确性。
步骤205、根据所述冲突类型、所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，以使在所述冲突时间下所述冲突自主体的位置不同。
具体的，根据冲突自主体在冲突位置下两两之间的冲突类型不同，进行对应的延迟冲突时间，进而实现对冲突自主体的轨迹表示。示例性的对于冲突类型为同向冲突的冲突时间的延迟可优先于冲突类型为相向冲突，实现了根据冲突类型的不同更新自主体的轨迹表示，可以实现自主体的无冲突调度，避免给后续自主体的运行带来更多的冲突。
可选的，根据所述冲突类型、所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，包括：
若所述冲突类型为相向冲突，则根据所述冲突时间和冲突位置，更新所述冲突自主体中任一自主体的轨迹表示，并停止冲突检测；
若所述冲突类型为同向冲突，则根据所述冲突时间和冲突位置，更新所述冲突自主体中任一自主体的轨迹表示，并继续进行冲突检测。
由于冲突类型为相向冲突时，冲突自主体的运行轨迹是处于相反方向，因此对于一次冲突后，这两个冲突自主体之间的距离会越来越远，不会发生冲突事件。因此当冲突类型为相向冲突时，根据冲突时间和冲突位置，对冲突自主体的轨迹表示更新后，停止对冲突类型为相向冲突的自主体的冲突检测。而对于冲突类型为同向冲突的自主体来说，其运行轨迹是处于相同方向，因此无法对后续的冲突发生概率进行预测，因此，当根据冲突时间和冲突位置对冲突自主体的轨迹表示进行更新后，继续进行冲突信息的确定，定位冲突类型，更新轨迹表示。
根据冲突类型的不同确定轨迹表示更新后的操作，可以实现减少对自主体冲突信息的计算量，提高对冲突信息确定的效率，进而提高对自主体无冲突调度实现的效率。
本发明实施例对自主体在冲突点下轨迹表示的更新实质上是为多自主体无障碍行驶实现可靠的行为调度规划，并且在遭遇冲突情况下实现快速重规划。通过本实施例实现了对自主体路径规划中的准确避障。并且在本实施中对自主体冲突信息的确定以及轨迹表示的更新时没有涉及到对自主体的速度计算，只与自主体的时间轨迹有关，因此本实施例适用于存在复数冲突类型时的调度规划，即在同一冲突位置下存在多种冲突类型，提高对自主体轨迹更新的效率，避免发生冲突现象。
本发明实施例通过确定不同冲突自主体之间的夹角信息，进而对冲突类型进行确定。根据不同的冲突类型采取对应的冲突检测操作，实现了减少对多自主体冲突信息确定的计算，提高冲突信息确定的效率。并且本发明实施例通过调配冲突自主体的时间和空间实现自主体间无冲突运行，简化对自主体冲突的确定过程，提高自主体轨迹冲突规避的效率和准确率。
实施例三
图3是本发明实施例三中的自主体轨迹冲突的解决装置的结构示意图，本实施例可适用于解决多个自主体运行轨迹冲突的情况。如图3所示，该装置包括：
轨迹表示确定模块310，用于在自主体运动过程中，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示；其中，轨迹点信息至少包括时间信息和位置信息；
冲突信息确定模块320，用于根据所述至少两个自主体的轨迹表示确定自主体冲突信息；其中，自主体冲突信息至少包括冲突时间、冲突位置以及冲突自主体；
轨迹表示更新模块330，用于根据所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，以使在所述冲突时间下所述冲突自主体的位置不同。
本发明实施例基于对自主体的运动轨迹进行表示，根据其轨迹表示确定轨迹存在冲突的自主体信息以及冲突信息，根据确定的信息，对自主体的轨迹进行更新，规避轨迹冲突的点。通过对自主体运行轨迹中冲突信息的确定，进而对冲突自主体的轨迹进行更新，简化对自主体轨迹的确定过程，提高自主体轨迹冲突规避的效率和准确率。
可选的，轨迹表示确定模块310，具体用于：
基于傅里叶级数，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示。
可选的，冲突信息确定模块320，具体用于：
若根据至少两个自主体的轨迹表示，确定至少两个自主体在任一时间的位置相同，则将所述至少两个自主体作为所述冲突自主体，该时间作为冲突时间，且在该时间的位置作为冲突位置。
可选的，轨迹表示更新模块330，具体用于：
根据自主体的优先级对所述冲突自主体进行排序，确定冲突自主体排序结果；
按照所述冲突自主体排序结果，对排序在后的冲突自主体到达所述冲突位置的时间进行延迟，以确定更新后的冲突自主体的轨迹表示。
可选的，轨迹表示更新模块330，包括：
夹角信息确定单元，用于根据至少两个冲突自主体的原轨迹表示，确定不同冲突自主体之间的夹角信息；
冲突类型确定单元，用于根据所述夹角信息，确定不同冲突自主体的冲突类型；
轨迹表示更新单元，用于根据所述冲突类型、所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示。
可选的，所述原轨迹表示为傅里叶级数轨迹表示；
相应地，夹角信息确定单元，具体用于：
根据所述至少两个自主体的傅里叶轨迹表示的偏导结果，确定所述至少两个冲突自主体的轨迹方向；
根据不同冲突自主体的轨迹方向的内积或方向余弦，确定不同冲突自主体之间的夹角信息。
可选的，轨迹表示更新单元，具体用于：
若所述冲突类型为相向冲突，则根据所述冲突时间和冲突位置，更新所述冲突自主体中任一自主体的轨迹表示，并停止冲突检测；
若所述冲突类型为同向冲突，则根据所述冲突时间和冲突位置，更新所述冲突自主体中任一自主体的轨迹表示，并继续进行冲突检测。
本发明实施例所提供的自主体轨迹冲突的解决装置可执行本发明任意实施例所提供的自主体轨迹冲突的解决方法，具备执行自主体轨迹冲突的解决方法相应的功能模块和有益效果。
实施例四
图4是本发明实施例四提供的一种设备的结构示意图。图4示出了适于用来实现本发明实施方式的示例性设备12的框图。图4显示的设备12仅仅是一个示例，不应对本发明实施例的功能和使用范围带来任何限制。
如图4所示，设备12以通用计算设备的形式表现。设备12的组件可以包括但不限于：一个或者多个处理器或者处理单元16，系统存储装置28，连接不同系统组件(包括系统存储装置28和处理单元16)的总线18。
总线18表示几类总线结构中的一种或多种，包括存储装置总线或者存储装置控制器，外围总线，图形加速端口，处理器或者使用多种总线结构中的任意总线结构的局域总线。举例来说，这些体系结构包括但不限于工业标准体系结构(ISA)总线，微通道体系结构(MAC)总线，增强型ISA总线、视频电子标准协会(VESA)局域总线以及外围组件互连(PCI)总线。
设备12典型地包括多种计算机系统可读介质。这些介质可以是任何能够被设备12访问的可用介质，包括易失性和非易失性介质，可移动的和不可移动的介质。
系统存储装置28可以包括易失性存储装置形式的计算机系统可读介质，例如随机存取存储装置(RAM)30和/或高速缓存存储装置32。设备12可以进一步包括其它可移动/不可移动的、易失性/非易失性计算机系统存储介质。仅作为举例，存储系统34可以用于读写不可移动的、非易失性磁介质(图4未显示，通常称为“硬盘驱动器”)。尽管图4中未示出，可以提供用于对可移动非易失性磁盘(例如“软盘”)读写的磁盘驱动器，以及对可移动非易失性光盘(例如CD-ROM,DVD-ROM或者其它光介质)读写的光盘驱动器。在这些情况下，每个驱动器可以通过一个或者多个数据介质接口与总线18相连。存储装置28可以包括至少一个程序产品，该程序产品具有一组(例如至少一个)程序模块，这些程序模块被配置以执行本发明各实施例的功能。
具有一组(至少一个)程序模块42的程序/实用工具40，可以存储在例如存储装置28中，这样的程序模块42包括但不限于操作系统、一个或者多个应用程序、其它程序模块以及程序数据，这些示例中的每一个或某种组合中可能包括网络环境的实现。程序模块42通常执行本发明所描述的实施例中的功能和/或方法。
设备12也可以与一个或多个外部设备14(例如键盘、指向设备、显示器24等)通信，还可与一个或者多个使得用户能与该设备12交互的设备通信，和/或与使得该设备12能与一个或多个其它计算设备进行通信的任何设备(例如网卡，调制解调器等等)通信。这种通信可以通过输入/输出(I/O)接口22进行。并且，设备12还可以通过网络适配器20与一个或者多个网络(例如局域网(LAN)，广域网(WAN)和/或公共网络，例如因特网)通信。如图4所示，网络适配器20通过总线18与设备12的其它模块通信。应当明白，尽管图4中未示出，可以结合设备12使用其它硬件和/或软件模块，包括但不限于：微代码、设备驱动器、冗余处理单元、外部磁盘驱动阵列、RAID系统、磁带驱动器以及数据备份存储系统等。
处理单元16通过运行存储在系统存储装置28中的程序，从而执行各种功能应用以及数据处理，例如实现本发明实施例所提供的自主体轨迹冲突的解决方法，包括：
在自主体运动过程中，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示；其中，轨迹点信息至少包括时间信息和位置信息；
根据所述至少两个自主体的轨迹表示确定自主体冲突信息；其中，自主体冲突信息至少包括冲突时间、冲突位置以及冲突自主体；
根据所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，以使在所述冲突时间下所述冲突自主体的位置不同。
实施例五
本发明实施例五还提供了一种计算机可读存储介质，其上存储有计算机程序，该程序被处理器执行时实现如本发明实施例所提供的自主体轨迹冲突的解决方法，包括：
在自主体运动过程中，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示；其中，轨迹点信息至少包括时间信息和位置信息；
根据所述至少两个自主体的轨迹表示确定自主体冲突信息；其中，自主体冲突信息至少包括冲突时间、冲突位置以及冲突自主体；
根据所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，以使在所述冲突时间下所述冲突自主体的位置不同。
本发明实施例的计算机存储介质，可以采用一个或多个计算机可读的介质的任意组合。计算机可读介质可以是计算机可读信号介质或者计算机可读存储介质。计算机可读存储介质例如可以是——但不限于——电、磁、光、电磁、红外线、或半导体的系统、装置或器件，或者任意以上的组合。计算机可读存储介质的更具体的例子(非穷举的列表)包括：具有一个或多个导线的电连接、便携式计算机磁盘、硬盘、随机存取存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、光纤、便携式紧凑磁盘只读存储器(CD-ROM)、光存储器件、磁存储器件、或者上述的任意合适的组合。在本文件中，计算机可读存储介质可以是任何包含或存储程序的有形介质，该程序可以被指令执行系统、装置或者器件使用或者与其结合使用。
计算机可读的信号介质可以包括在基带中或者作为载波一部分传播的数据信号，其中承载了计算机可读的程序代码。这种传播的数据信号可以采用多种形式，包括但不限于电磁信号、光信号或上述的任意合适的组合。计算机可读的信号介质还可以是计算机可读存储介质以外的任何计算机可读介质，该计算机可读介质可以发送、传播或者传输用于由指令执行系统、装置或者器件使用或者与其结合使用的程序。
计算机可读介质上包含的程序代码可以用任何适当的介质传输，包括——但不限于无线、电线、光缆、RF等等，或者上述的任意合适的组合。
可以以一种或多种程序设计语言或其组合来编写用于执行本发明操作的计算机程序代码，所述程序设计语言包括面向对象的程序设计语言—诸如Java、Smalltalk、C++，还包括常规的过程式程序设计语言—诸如”C”语言或类似的程序设计语言。程序代码可以完全地在用户计算机上执行、部分地在用户计算机上执行、作为一个独立的软件包执行、部分在用户计算机上部分在远程计算机上执行、或者完全在远程计算机或服务器上执行。在涉及远程计算机的情形中，远程计算机可以通过任意种类的网络——包括局域网(LAN)或广域网(WAN)—连接到用户计算机，或者，可以连接到外部计算机(例如利用因特网服务提供商来通过因特网连接)。
注意，上述仅为本发明的较佳实施例及所运用技术原理。本领域技术人员会理解，本发明不限于这里所述的特定实施例，对本领域技术人员来说能够进行各种明显的变化、重新调整和替代而不会脱离本发明的保护范围。因此，虽然通过以上实施例对本发明进行了较为详细的说明，但是本发明不仅仅限于以上实施例，在不脱离本发明构思的情况下，还可以包括更多其他等效实施例，而本发明的范围由所附的权利要求范围决定。
Claims (10)
1.一种自主体轨迹冲突的解决方法，其特征在于，包括：
在自主体运动过程中，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示；其中，轨迹点信息至少包括时间信息和位置信息；
根据所述至少两个自主体的轨迹表示确定自主体冲突信息；其中，自主体冲突信息至少包括冲突时间、冲突位置以及冲突自主体；
根据所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，以使在所述冲突时间下所述冲突自主体的位置不同。
2.根据权利要求1所述的方法，其特征在于，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示，包括：
基于傅里叶级数，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示。
3.根据权利要求1所述的方法，其特征在于，根据所述至少两个自主体的轨迹表示确定自主体冲突信息，包括：
若根据至少两个自主体的轨迹表示，确定至少两个自主体在任一时间的位置相同，则将所述至少两个自主体作为所述冲突自主体，该时间作为冲突时间，且在该时间的位置作为冲突位置。
4.根据权利要求1所述的方法，其特征在于，根据所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，包括：
根据自主体的优先级对所述冲突自主体进行排序，确定冲突自主体排序结果；
按照所述冲突自主体排序结果，对排序在后的冲突自主体到达所述冲突位置的时间进行延迟，以确定更新后的冲突自主体的轨迹表示。
5.根据权利要求1所述的方法，其特征在于，根据所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，包括：
根据至少两个冲突自主体的原轨迹表示，确定不同冲突自主体之间的夹角信息；
根据所述夹角信息，确定不同冲突自主体的冲突类型；
根据所述冲突类型、所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示。
6.根据权利要求5所述的方法，其特征在于，所述原轨迹表示为傅里叶级数轨迹表示；
相应地，所述根据至少两个冲突自主体的原轨迹表示，确定不同冲突自主体之间的夹角信息，包括：
根据所述至少两个自主体的傅里叶轨迹表示的偏导结果，确定所述至少两个冲突自主体的轨迹方向；
根据不同冲突自主体的轨迹方向的内积或方向余弦，确定不同冲突自主体之间的夹角信息。
7.根据权利要求5所述的方法，其特征在于，根据所述冲突类型、所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，包括：
若所述冲突类型为相向冲突，则根据所述冲突时间和冲突位置，更新所述冲突自主体中任一自主体的轨迹表示，并停止冲突检测；
若所述冲突类型为同向冲突，则根据所述冲突时间和冲突位置，更新所述冲突自主体中任一自主体的轨迹表示，并继续进行冲突检测。
8.一种自主体轨迹冲突的解决装置，其特征在于，包括：
轨迹表示确定模块，用于在自主体运动过程中，根据至少两个自主体的轨迹点信息，确定至少两个自主体的轨迹表示；其中，轨迹点信息至少包括时间信息和位置信息；
冲突信息确定模块，用于根据所述至少两个自主体的轨迹表示确定自主体冲突信息；其中，自主体冲突信息至少包括冲突时间、冲突位置以及冲突自主体；
轨迹表示更新模块，用于根据所述冲突时间和冲突位置，更新所述冲突自主体的轨迹表示，以使在所述冲突时间下所述冲突自主体的位置不同。
9.一种设备，其特征在于，包括：
一个或多个处理器；
存储装置，用于存储一个或多个程序，
当所述一个或多个程序被所述一个或多个处理器执行，使得所述一个或多个处理器实现如权利要求1-7中任一所述的自主体轨迹冲突的解决方法。
10.一种计算机可读存储介质，其上存储有计算机程序，其特征在于，该程序被处理器执行时实现如权利要求1-7中任一所述的自主体轨迹冲突的解决方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010089992.5A CN111427344A (zh) | 2020-02-13 | 2020-02-13 | 自主体轨迹冲突的解决方法、装置、设备和存储介质 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010089992.5A CN111427344A (zh) | 2020-02-13 | 2020-02-13 | 自主体轨迹冲突的解决方法、装置、设备和存储介质 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN111427344A true CN111427344A (zh) | 2020-07-17 |
Family
ID=71547027
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010089992.5A Pending CN111427344A (zh) | 2020-02-13 | 2020-02-13 | 自主体轨迹冲突的解决方法、装置、设备和存储介质 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN111427344A (zh) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112214013A (zh) * | 2020-08-07 | 2021-01-12 | 上海海得控制系统股份有限公司 | 直线往复式多rgv死锁避免和冲突实时控制方法、系统、介质、终端 |
| CN113741443A (zh) * | 2021-08-26 | 2021-12-03 | 北京京东乾石科技有限公司 | 有轨制导车辆的控制方法、装置、存储介质及电子设备 |
Citations (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102254430A (zh) * | 2011-06-03 | 2011-11-23 | 东南大学 | 一种利用交通冲突判别事故易发路段的方法 |
| CN102368351A (zh) * | 2011-10-19 | 2012-03-07 | 北京航空航天大学 | 一种消解无信号交叉口两车交通冲突的方法 |
| CN103034123A (zh) * | 2012-12-11 | 2013-04-10 | 中国科学技术大学 | 基于动力学模型参数辨识的并联机器人控制方法 |
| CN104240535A (zh) * | 2013-06-13 | 2014-12-24 | 奥迪股份公司 | 用于对机动车的运行进行协调的方法 |
| CN104537431A (zh) * | 2014-12-16 | 2015-04-22 | 南京航空航天大学 | 一种基于冲突检测的滑行道路径优化方法 |
| CN105118329A (zh) * | 2015-08-24 | 2015-12-02 | 西安电子科技大学 | 一种消解无信号交叉口两车交通冲突的方法 |
| CN105243876A (zh) * | 2015-11-06 | 2016-01-13 | 东南大学 | 一种用于互通立交的交通冲突严重性分析方法 |
| CN105469644A (zh) * | 2014-08-22 | 2016-04-06 | 北京航空航天大学 | 飞行冲突解脱方法及设备 |
| CN107133610A (zh) * | 2017-06-01 | 2017-09-05 | 电子科技大学 | 一种复杂路况下行车流量视觉检测与计数方法 |
| CN108961800A (zh) * | 2018-07-25 | 2018-12-07 | 长沙理工大学 | 一种自动驾驶下基于交叉口空间离散化的车辆通行时间建模方法 |
| CN109102697A (zh) * | 2018-08-30 | 2018-12-28 | 青海民族大学 | 基于出口车道选择行为模型的平面交叉口危险点分析方法 |
| CN109693668A (zh) * | 2018-12-27 | 2019-04-30 | 驭势科技（北京）有限公司 | 一种自动驾驶车辆速度控制系统与方法 |
| CN109827582A (zh) * | 2019-03-29 | 2019-05-31 | 深圳市鹏途交通科技有限公司 | 一种快速确定道路路网病害相对位置的方法及系统 |
| CN110027551A (zh) * | 2019-05-09 | 2019-07-19 | 禾多科技（北京）有限公司 | 应用于自动泊车的多车调度方法 |
| CN110544390A (zh) * | 2019-08-31 | 2019-12-06 | 武汉理工大学 | 一种车车交互式的行人主动避撞方法与装置 |
| CN110764416A (zh) * | 2019-11-11 | 2020-02-07 | 河海大学 | 基于深度q网络的仿人机器人步态优化控制方法 |
-
2020
- 2020-02-13 CN CN202010089992.5A patent/CN111427344A/zh active Pending
Patent Citations (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102254430A (zh) * | 2011-06-03 | 2011-11-23 | 东南大学 | 一种利用交通冲突判别事故易发路段的方法 |
| CN102368351A (zh) * | 2011-10-19 | 2012-03-07 | 北京航空航天大学 | 一种消解无信号交叉口两车交通冲突的方法 |
| CN103034123A (zh) * | 2012-12-11 | 2013-04-10 | 中国科学技术大学 | 基于动力学模型参数辨识的并联机器人控制方法 |
| CN104240535A (zh) * | 2013-06-13 | 2014-12-24 | 奥迪股份公司 | 用于对机动车的运行进行协调的方法 |
| CN105469644A (zh) * | 2014-08-22 | 2016-04-06 | 北京航空航天大学 | 飞行冲突解脱方法及设备 |
| CN104537431A (zh) * | 2014-12-16 | 2015-04-22 | 南京航空航天大学 | 一种基于冲突检测的滑行道路径优化方法 |
| CN105118329A (zh) * | 2015-08-24 | 2015-12-02 | 西安电子科技大学 | 一种消解无信号交叉口两车交通冲突的方法 |
| CN105243876A (zh) * | 2015-11-06 | 2016-01-13 | 东南大学 | 一种用于互通立交的交通冲突严重性分析方法 |
| CN107133610A (zh) * | 2017-06-01 | 2017-09-05 | 电子科技大学 | 一种复杂路况下行车流量视觉检测与计数方法 |
| CN108961800A (zh) * | 2018-07-25 | 2018-12-07 | 长沙理工大学 | 一种自动驾驶下基于交叉口空间离散化的车辆通行时间建模方法 |
| CN109102697A (zh) * | 2018-08-30 | 2018-12-28 | 青海民族大学 | 基于出口车道选择行为模型的平面交叉口危险点分析方法 |
| CN109693668A (zh) * | 2018-12-27 | 2019-04-30 | 驭势科技（北京）有限公司 | 一种自动驾驶车辆速度控制系统与方法 |
| CN109827582A (zh) * | 2019-03-29 | 2019-05-31 | 深圳市鹏途交通科技有限公司 | 一种快速确定道路路网病害相对位置的方法及系统 |
| CN110027551A (zh) * | 2019-05-09 | 2019-07-19 | 禾多科技（北京）有限公司 | 应用于自动泊车的多车调度方法 |
| CN110544390A (zh) * | 2019-08-31 | 2019-12-06 | 武汉理工大学 | 一种车车交互式的行人主动避撞方法与装置 |
| CN110764416A (zh) * | 2019-11-11 | 2020-02-07 | 河海大学 | 基于深度q网络的仿人机器人步态优化控制方法 |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112214013A (zh) * | 2020-08-07 | 2021-01-12 | 上海海得控制系统股份有限公司 | 直线往复式多rgv死锁避免和冲突实时控制方法、系统、介质、终端 |
| CN113741443A (zh) * | 2021-08-26 | 2021-12-03 | 北京京东乾石科技有限公司 | 有轨制导车辆的控制方法、装置、存储介质及电子设备 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| WO2022056770A1 (zh) | 一种路径规划方法和路径规划装置 | |
| CN108638062B (zh) | 机器人定位方法、装置、定位设备及存储介质 | |
| CN111209978B (zh) | 三维视觉重定位方法、装置及计算设备、存储介质 | |
| CN109558854B (zh) | 障碍物感知方法、装置、电子设备及存储介质 | |
| CN110850807B (zh) | 一种奇异点规避方法、装置、设备及介质 | |
| CN111427060B (zh) | 一种基于激光雷达的二维栅格地图构建方法和系统 | |
| CN111427344A (zh) | 自主体轨迹冲突的解决方法、装置、设备和存储介质 | |
| Kavuncu et al. | Potential ilqr: A potential-minimizing controller for planning multi-agent interactive trajectories | |
| CN111862604B (zh) | 无人车的控制方法及装置、计算机存储介质、电子设备 | |
| CN113960995A (zh) | 一种避障规划方法、系统及设备 | |
| CN113324542A (zh) | 一种定位方法、装置、设备和存储介质 | |
| WO2023036044A1 (zh) | 全局路径规划方法、运动控制方法及计算机程序产品 | |
| CN114506343A (zh) | 轨迹规划方法、装置、设备、存储介质及自动驾驶车辆 | |
| Bucki et al. | Rapid collision detection for multicopter trajectories | |
| CN115061499A (zh) | 无人机控制方法及无人机控制装置 | |
| CN115157270A (zh) | 一种机械人末端轨迹的规划方法及装置 | |
| CN113671941A (zh) | 一种轨迹规划方法、装置、设备和存储介质 | |
| WO2021217341A1 (zh) | 避障方法、可移动平台、控制设备和存储介质 | |
| Sadeghzadeh-Nokhodberiz et al. | Vision-based particle filtering for quad-copter attitude estimation using multirate delayed measurements | |
| CN113759887B (zh) | 一种路径规划方法、装置、存储介质及电子设备 | |
| CN115291166A (zh) | 井下高精度定位方法、装置、设备及存储介质 | |
| CN114578402A (zh) | 目标位置信息确定方法、装置、电子设备以及存储介质 | |
| Zambom et al. | Robot path planning in a dynamic environment with stochastic measurements | |
| CN110967990B (zh) | 轨迹确定方法、装置和电子设备 | |
| CN113885487A (zh) | 路径跟踪方法、系统、装置及计算机可读存储介质 |
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 | ||
| RJ01 | Rejection of invention patent application after publication | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200717 |