CN110631587A - 一种自动归位椅复合路径规划方法 - Google Patents
一种自动归位椅复合路径规划方法 Download PDFInfo
- Publication number
- CN110631587A CN110631587A CN201910920768.3A CN201910920768A CN110631587A CN 110631587 A CN110631587 A CN 110631587A CN 201910920768 A CN201910920768 A CN 201910920768A CN 110631587 A CN110631587 A CN 110631587A
- Authority
- CN
- China
- Prior art keywords
- station
- straight line
- arc
- previous
- turning
- 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.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
Abstract
本发明属于自动归位椅领域,具体涉及一种自动归位椅复合路径规划方法,包括:步骤1)上位机向下发送一组站点数据;步骤2)接收器收到站点后,对站点进行分类,遍历所有站点;步骤3)直线生成器接受到一个站点时,计算其与上一个站点的方向角和距离;步骤4.1)曲线生成器接受到一个站点时,根据该站点以及与该站点邻近的上下站点的关系计算出该站点转弯时的圆弧及该圆弧的弧度,然后调用直线生成器生成上一站点到转弯起点的直线点;步骤4.2)利用曲线生成器生成转弯起点到转弯终点的圆弧点。本发明将曲线模式与直线模式相结合,在保证安全性的情况下,部分站点采用曲线模式,使运输更加合理、高效。
Description
技术领域
本发明属于自动归位椅领域,具体涉及一种自动归位椅复合路径规划方法。
背景技术
自动引导的凳子或者椅子简称自动归位椅,已经成为现代化商业进步与生活中越来越受关注的一部分。现有的商业自动归位椅领域中,路径规划一般按拐弯点处直弯或弧弯,分为两种模式:(1)直线模式,(2)曲线模式。在直线模式下,所有路径都由直线构成,拐弯点处都是给定夹角的直弯。这样的路径能够保证自动归位椅在运行过程中的安全性,但是在每个拐弯点处自动归位椅都会经过减速、停止、自转、加速等一系列过程,这使得运输效率下降。曲线模式下,拐弯点处自动归位椅会沿着弧线直接过弯,提高了运输效率,然而需要足够的空间来保证安全性。现假设在一个任务路径中,转弯空间大的弯可以使用弧角过弯来提高效率,而转弯空间较小的,为了保证安全性,建议使用直弯,这样的路径在保证了安全性的前提下,更加合理高效。对于该情况目前只能依靠路径拼接来实现。因此,现有的技术需要改进。
现有路径规划方法存在的问题:
一、现有的技术模式单一,无法将两种模式并存。
二、现有的直弯模式,效率低下。
发明内容
为了弥补现有技术的不足,本发明提供一种自动归位椅复合路径规划方法的技术方案。
所述的一种自动归位椅复合路径规划方法,其特征在于包括:
步骤1)上位机向下发送一组站点数据,站点数据包括该站点的站点位姿、直弯/弧弯、转弯半径、前进/后退;
步骤2)接收器收到站点后,按照直弯/弧弯对站点进行分类,遍历所有站点,分别下发给直线生成器和曲线生成器;
步骤3)直线生成器接受到一个站点时,计算其与上一个站点的方向角和距离,接着判断上一个站点的类型,若是直弯,则距离为该站点到上一站点的直线距离;若是弧弯,则距离为该站点到上一站点的直线距离减去上一段路径的长度,利用所获得的方向角和距离,进行二次线性插值,生成直线段路径;
步骤4.1)曲线生成器接受到一个站点时,根据该站点以及与该站点邻近的上下站点的关系计算出该站点转弯时的圆弧及该圆弧的弧度,再根据圆心角算出上一站点到转弯起点的距离,然后调用直线生成器生成上一站点到转弯起点的直线点;
步骤4.2)利用曲线生成器生成转弯起点到转弯终点的圆弧点;
步骤4.3)调用直线生成器生成转弯终点到下一站点的直线点。
所述的一种自动归位椅复合路径规划方法,其特征在于所述步骤4.1)中,调用直线生成器生成上一站点到转弯起点的直线点之前先判断上一站点的类型是直弯还是弧弯,若是直弯,则上一站点到转弯起点的距离就是上一站点到转弯起点的直线距离;若是弧弯,则上一站点到转弯起点的距离是上一站点到转弯起点的直线距离减去上一段路径的长度。
所述的一种自动归位椅复合路径规划方法,其特征在于所述步骤4.2)中,利用曲线生成器生成转弯起点到转弯终点的圆弧点时,先要判断圆弧的方向,计算角分辨率,最后将圆弧的弧度、圆弧的方向、圆弧的直径及角分辨率传入曲线生成器,进而生成相应的圆弧点。
本发明的有益效果是:本发明将曲线模式与直线模式相结合,在保证安全性的情况下,部分站点采用曲线模式,使运输更加合理、高效。
附图说明
图1为本发明的流程图;
图2为本发明的曲线发生器生成路径示意图;
图3为本发明的复合路径规划示意图。
具体实施方式
下面结合附图对本发明作进一步说明。
如图1所示,一种自动归位椅复合路径规划方法,包括:
步骤1)上位机向下发送一组站点数据,站点数据包括该站点的站点位姿、直弯/弧弯、转弯半径、前进/后退,如{[(x,y,theta),Straight,0.0,Forward],[(x,y,theta),Curve,1.0,Forward],[(x,y,theta),Curve,0.6,Backward]...};
步骤2)接收器收到站点后,进行分类,计算直弯点为num_s,弧弯点为num_c,遍历所有站点,分别下发给直线生成器和曲线生成器;
步骤3)若直线生成器接受到一个站点,计算其与上一个站点的方向角ori和距离dist(若该点为第一个点,则上一个点为自动归位椅的初始位置)。接着判断上一个点的类型,若是直弯,则距离为dist=dist直线;若是弧弯,则距离为dist=dist直线-dist_previous,其中dist直线为该站点到上一站点的直线距离,dist_previous为上一段路径的长度。利用该ori和dist,进行二次线性插值,生成直线段路径;
步骤4.1)曲线生成器接受到一个站点时,根据该站点以及与该站点邻近的上下站点的关系计算出该站点转弯时的圆弧及该圆弧的弧度,再根据圆心角算出上一站点到转弯起点的距离,然后调用直线生成器生成上一站点到转弯起点的直线点;
步骤4.2)利用曲线生成器生成转弯起点到转弯终点的圆弧点;
步骤4.3)调用直线生成器生成转弯终点到下一站点的直线点;
在步骤4.1)中,调用直线生成器生成上一站点到转弯起点的直线点之前先判断上一站点的类型是直弯还是弧弯,若是直弯,则上一站点到转弯起点的距离就是上一站点到转弯起点的直线距离;若是弧弯,则上一站点到转弯起点的距离是上一站点到转弯起点的直线距离减去上一段路径的长度。
在步骤4.2)中,利用曲线生成器生成转弯起点到转弯终点的圆弧点时,先要判断圆弧的方向,计算角分辨率,最后将圆弧的弧度、圆弧的方向、圆弧的直径及角分辨率传入曲线生成器,进而生成相应的圆弧点。
下面借具体实施例对步骤4)进行说明:
如图2所示,曲线生成器接受到一个站点b,且站点b的属性为{(5.0,5.0,0.0),Curve,1.0,Forward},a为上一站点,e为转弯起点,d为转弯终点,c为下一站点,用公式(1)计算夹角α,
其中A为站点a和b的距离,B为站点b到c的距离,C为站点a到c的距离。因此,圆心角β=π-α。用公式(2)计算eb的长度,
其中转弯半径r=1.0m。因此ae的长度为lae=A-leb。
(4.1)有了ae段的距离,计算ae段的方向角,就可以调用直线生成器生成ae段的直线点。当然,这里先要进行判断上一点的类型是否为弯直,如果是,则传入直线生成器的距离为lae-lprevious,其中lprevious为上一段路径的长度。
(4.2)接着用两个向量的叉乘来判断圆弧的方向sign。计算角分辨率为其中resglobal为提前设定的路径点分辨率,一般设为0.05m。最后将β,sign,r和res传入曲线生成器生成相应的圆弧点。
最后将当前leb的长度保存为lprevious,在此b点到d点的距离与leb相等,这就相当于把b点到d点的距离保存成lprevious。
最终复合路径规划出的示意路径如图3所示。
上述的曲线生成器、直线生成器均为公知技术。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (3)
1.一种自动归位椅复合路径规划方法,其特征在于包括:
步骤1)上位机向下发送一组站点数据,站点数据包括该站点的站点位姿、直弯/弧弯、转弯半径、前进/后退;
步骤2)接收器收到站点后,按照直弯/弧弯对站点进行分类,遍历所有站点,分别下发给直线生成器和曲线生成器;
步骤3)直线生成器接受到一个站点时,计算其与上一个站点的方向角和距离,接着判断上一个站点的类型,若是直弯,则距离为该站点到上一站点的直线距离;若是弧弯,则距离为该站点到上一站点的直线距离减去上一段路径的长度,利用所获得的方向角和距离,进行二次线性插值,生成直线段路径;
步骤4.1)曲线生成器接受到一个站点时,根据该站点以及与该站点邻近的上下站点的关系计算出该站点转弯时的圆弧及该圆弧的弧度,再根据圆心角算出上一站点到转弯起点的距离,然后调用直线生成器生成上一站点到转弯起点的直线点;
步骤4.2)利用曲线生成器生成转弯起点到转弯终点的圆弧点;
步骤4.3)调用直线生成器生成转弯终点到下一站点的直线点。
2.根据权利要求1所述的一种自动归位椅复合路径规划方法,其特征在于所述步骤4.1)中,调用直线生成器生成上一站点到转弯起点的直线点之前先判断上一站点的类型是直弯还是弧弯,若是直弯,则上一站点到转弯起点的距离就是上一站点到转弯起点的直线距离;若是弧弯,则上一站点到转弯起点的距离是上一站点到转弯起点的直线距离减去上一段路径的长度。
3.根据权利要求1所述的一种自动归位椅复合路径规划方法,其特征在于所述步骤4.2)中,利用曲线生成器生成转弯起点到转弯终点的圆弧点时,先要判断圆弧的方向,计算角分辨率,最后将圆弧的弧度、圆弧的方向、圆弧的直径及角分辨率传入曲线生成器,进而生成相应的圆弧点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910920768.3A CN110631587B (zh) | 2019-09-26 | 2019-09-26 | 一种自动归位椅复合路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910920768.3A CN110631587B (zh) | 2019-09-26 | 2019-09-26 | 一种自动归位椅复合路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110631587A true CN110631587A (zh) | 2019-12-31 |
CN110631587B CN110631587B (zh) | 2021-05-25 |
Family
ID=68974560
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910920768.3A Active CN110631587B (zh) | 2019-09-26 | 2019-09-26 | 一种自动归位椅复合路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110631587B (zh) |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0762361A1 (en) * | 1995-08-25 | 1997-03-12 | Aisin Aw Co., Ltd. | Navigation system for vehicles |
CN107672585A (zh) * | 2017-08-29 | 2018-02-09 | 广州小鹏汽车科技有限公司 | 一种自动泊车路径规划方法及系统 |
CN108225359A (zh) * | 2017-12-26 | 2018-06-29 | 上海展扬通信技术有限公司 | 一种路径规划的方法及相关设备 |
CN108534777A (zh) * | 2018-01-25 | 2018-09-14 | 江苏大学 | 一种平行泊车路径规划方法 |
CN109307517A (zh) * | 2017-07-28 | 2019-02-05 | 高德信息技术有限公司 | 交叉路口定位方法和装置 |
CN109557914A (zh) * | 2018-10-30 | 2019-04-02 | 浙江圣奥家具制造有限公司 | 一种基于纯追踪模型的自动归位椅子路径跟踪方法 |
CN109828570A (zh) * | 2019-02-18 | 2019-05-31 | 哈尔滨工程大学 | 一种自适应边界层水面无人艇控制导引方法 |
CN109936975A (zh) * | 2016-12-02 | 2019-06-25 | 株式会社久保田 | 行进路线管理系统及行进路线决定装置 |
CN110207706A (zh) * | 2019-05-30 | 2019-09-06 | 浙江圣奥家具制造有限公司 | 一种基于栅格地图的自动归位椅路径规划算法 |
-
2019
- 2019-09-26 CN CN201910920768.3A patent/CN110631587B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0762361A1 (en) * | 1995-08-25 | 1997-03-12 | Aisin Aw Co., Ltd. | Navigation system for vehicles |
CN109936975A (zh) * | 2016-12-02 | 2019-06-25 | 株式会社久保田 | 行进路线管理系统及行进路线决定装置 |
CN109307517A (zh) * | 2017-07-28 | 2019-02-05 | 高德信息技术有限公司 | 交叉路口定位方法和装置 |
CN107672585A (zh) * | 2017-08-29 | 2018-02-09 | 广州小鹏汽车科技有限公司 | 一种自动泊车路径规划方法及系统 |
CN108225359A (zh) * | 2017-12-26 | 2018-06-29 | 上海展扬通信技术有限公司 | 一种路径规划的方法及相关设备 |
CN108534777A (zh) * | 2018-01-25 | 2018-09-14 | 江苏大学 | 一种平行泊车路径规划方法 |
CN109557914A (zh) * | 2018-10-30 | 2019-04-02 | 浙江圣奥家具制造有限公司 | 一种基于纯追踪模型的自动归位椅子路径跟踪方法 |
CN109828570A (zh) * | 2019-02-18 | 2019-05-31 | 哈尔滨工程大学 | 一种自适应边界层水面无人艇控制导引方法 |
CN110207706A (zh) * | 2019-05-30 | 2019-09-06 | 浙江圣奥家具制造有限公司 | 一种基于栅格地图的自动归位椅路径规划算法 |
Also Published As
Publication number | Publication date |
---|---|
CN110631587B (zh) | 2021-05-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102874279B (zh) | 一种列车进路办理方法 | |
CN109542098A (zh) | 一种基于最小转弯代价的agv路径规划方法 | |
CN108469263B (zh) | 一种基于曲率进行形点优化的方法及系统 | |
US11273727B2 (en) | In-motion electric vehicle-to-vehicle recharging | |
US10475347B2 (en) | Method and device for generating an optimum flight path intended to be followed by an aircraft | |
EP3951321A8 (en) | Method and system for rapid generation of reference driving route, terminal and storage medium | |
CN105281356A (zh) | 一种多端柔性直流输电系统的协调控制方法 | |
CN111539345B (zh) | 用于确定变道动作的方法、装置、设备及可读存储介质 | |
CN112923946B (zh) | 一种基于Hybrid-astar的动态路径规划方法 | |
CN110631587B (zh) | 一种自动归位椅复合路径规划方法 | |
CN104503457A (zh) | 无人机编队飞行转弯防碰控制方法 | |
CN101969406A (zh) | 基于选择探测的多约束QoS路由方法 | |
CN115071686A (zh) | 一种狭长区域的无人驾驶矿用车辆的泊车方法 | |
CN114700944B (zh) | 一种面向异种任务的双机器人协同路径规划方法 | |
CN104018845A (zh) | 敞开式tbm的最小水平转弯半径的确定方法 | |
CN109596136B (zh) | 基于Hermite插值路径生成方法、插入路径生成方法及存储装置 | |
CN112706760B (zh) | 一种用于特殊道路场景的无人驾驶泊车路径规划方法 | |
CN112261588B (zh) | 有人车引导的多无人车自适应编队组网方法、系统及设备 | |
CN113450589B (zh) | 车辆的调度方法、装置和系统 | |
CN106301528B (zh) | 一种航天器的协同控制方法及装置 | |
CN104168189A (zh) | 一种在dtn网络中基于节点属性模型的散发等待路由方法 | |
CN113395301B (zh) | 基于车联网的智慧城市网外运算方法及系统 | |
CN105490941B (zh) | 一种基于网络与用户协作休眠的路由方法 | |
CN110986943B (zh) | 一种船舶航行路径智能优化方法及装置 | |
CN113176784A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CP01 | Change in the name or title of a patent holder |
Address after: 311200 No.35 Ningdong Road, Xiaoshan Economic Development Zone, Xiaoshan District, Hangzhou City, Zhejiang Province Patentee after: Shengao Technology Co.,Ltd. Address before: 311200 No.35 Ningdong Road, Xiaoshan Economic Development Zone, Xiaoshan District, Hangzhou City, Zhejiang Province Patentee before: ZHEJIANG SUNON FURNITURE MANUFACTURING Co.,Ltd. |
|
CP01 | Change in the name or title of a patent holder |