CN109398350B - 一种自动泊车方法及用于车辆的自动泊车系统 - Google Patents
一种自动泊车方法及用于车辆的自动泊车系统 Download PDFInfo
- Publication number
- CN109398350B CN109398350B CN201811220218.2A CN201811220218A CN109398350B CN 109398350 B CN109398350 B CN 109398350B CN 201811220218 A CN201811220218 A CN 201811220218A CN 109398350 B CN109398350 B CN 109398350B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- parking
- station
- calculating
- power
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 27
- 238000004891 communication Methods 0.000 claims abstract description 71
- 230000008859 change Effects 0.000 claims description 7
- 230000000977 initiatory effect Effects 0.000 claims description 6
- 239000000126 substance Substances 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 7
- 238000001514 detection method Methods 0.000 description 6
- 230000009286 beneficial effect Effects 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 3
- 238000012423 maintenance Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/06—Automatic manoeuvring for parking
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60S—SERVICING, CLEANING, REPAIRING, SUPPORTING, LIFTING, OR MANOEUVRING OF VEHICLES, NOT OTHERWISE PROVIDED FOR
- B60S5/00—Servicing, maintaining, repairing, or refitting of vehicles
- B60S5/06—Supplying batteries to, or removing batteries from, vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/408—Radar; Laser, e.g. lidar
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/70—Energy storage systems for electromobility, e.g. batteries
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/7072—Electromobility specific charging systems or methods for batteries, ultracapacitors, supercapacitors or double-layer capacitors
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
- Y02T90/10—Technologies relating to charging of electric vehicles
- Y02T90/16—Information or communication technologies improving the operation of electric vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Traffic Control Systems (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
Abstract
本发明公开了一种自动泊车方法及用于车辆的自动泊车系统,该方法包括:车辆与换电站建立通信连接;换电站根据预设的条件判断是否能够接纳所述车辆;若能够接纳所述车辆,则布置在所述换电站处的激光雷达检测所述车辆的形状,基于所述车辆的形状计算得到所述车辆的定位信息,并反馈至所述车辆;所述车辆基于所述定位信息获得泊车路径。本发明提供的方法通过安装在换电站端的激光雷达探测车辆来对车辆进定位并将定位信息通过无线传输给车辆,车辆利用定位信息完成泊入换电站的功能,解决了换电站泊车困难的问题。
Description
技术领域
本发明涉及汽车领域,尤其是一种自动泊车方法及用于车辆的自动泊车系统。
背景技术
电动汽车的续航里程是消费者十分关心并关注的部分,市面上的电动汽车的满电续航里程标准工况200km~500km不等,相比于油车有较大的劣势。换电站是解决这一问题的可行方案之一,可以较好地解决里程续航问题。换电站布置紧凑,只占地表3个车位大小的面积,在换电站内设置有车辆的支撑台架、换电小车、举升机构等大量的设备。用于换电时支撑车辆的支撑台架的尺寸很小,仅为车宽+30cm左右,因而对于换电站内泊车的准确度有很高的要求。一般需要驾驶者具有高超的泊车技术,才能准确的将车辆准确的停放,如果驾驶者泊车不准确,可能造成停放不当,不便于换电操作;或者需要驾驶者多次泊车才能准确停放。停放的次数过多或停放不当,会浪费驾驶者的时间,导致换电的效率低。
发明内容
本发明的目的是提供一种自动泊车方法及用于车辆的自动泊车系统,能够解决现有技术中在换电站内泊车难度大的技术问题,采用自动泊车方法及用于车辆的自动泊车系统,能够提高在换电站内泊车的准确度。
为解决上述问题,本发明的第一方面提供了一种自动泊车方法,包括:车辆与换电站建立通信连接;换电站根据预设的条件判断是否能够接纳车辆;若能够接纳车辆,则布置在换电站处的激光雷达检测车辆的形状,基于车辆的形状计算得到车辆的定位信息,并反馈至车辆;车辆基于定位信息获得泊车路径。
进一步地,换电站根据预设的条件,判断是否能够接纳车辆的步骤包括:当车辆与换电站的距离低于第一预设值时,车辆向换电站发出泊车请求;换电站接收到泊车请求后,若换电站无故障或换电站没有被占用,则确定换电站内能够接纳车辆;或者,车辆的电量低于第二预设值,且车辆与换电站的距离低于第三预设值,车辆向所述换电站发出泊车请求;换电站接收到泊车请求后,若换电站无故障或换电站没有被占用,则确定换电站内能够接纳所述车辆。
进一步地,基于车辆的形状计算得到车辆的定位信息步骤包括:基于所述车辆同一长边的两个边缘点A、B的位置计算得到车辆在预设坐标系下的坐标以及车辆的航向角。
进一步地,以泊车换电站为坐标原点O,以该换电站的宽度和长度方向分别为x、y轴方向建立预设坐标系,车辆的位置设置为所述车辆的后轴中心P的坐标,车辆的位置计算步骤包括:计算得到车辆同一长边的边缘点A、B的坐标;计算得到后轴中心P与坐标原点O的距离PO;计算得到后轴中心P、坐标原点O与坐标轴y方向的角度∠POy;后轴中心P的坐标为(xp,yp),xp=PO*sin(∠POy),yp=PO*cos(∠POy)。
进一步地,以泊车换电站为坐标原点O,以该换电站的宽度和长度方向分别为x、y轴方向建立预设坐标系,车辆的位置设置为车辆的后轴中心P的坐标,航向角yaw的计算步骤包括:计算得到与坐标原点距离相对远的边缘点B、后轴中心P与车辆的长边对称轴K的夹角∠BPK;直线PB与穿过P点平行于x方向的直线x1的夹角∠BPx1;计算后轴中心P的航向角yaw=∠BPK-∠BPx1。
进一步地,车辆基于定位信息获得泊车路径的步骤包括:基于车辆的定位信息判断车辆是否位于泊入启动区域内;若车辆位于泊入启动区域内,则确定车辆相对于换电站内预设地面标识的位置;基于地面标识的位置,确定泊入换电站的路径。
进一步地,若车辆位于泊入启动区域外,则调整车辆的位置,直至车辆位于泊入启动区域内。
进一步地,若位于同一地点的换电站为多个,车辆分别计算与每个换电站的距离,依次和与其最近的换电站发出通信请求,直至与某一换电站建立通信连接。
进一步地,多个换电站成排、成列或队列设置。
进一步地,车辆与换电站建立通信连接步骤包括:当车辆与换电站的距离低于第四预设值时,车辆自动连接所述换电站处设置的WiFi,车辆通过WiFi向换电站发出泊车请求,第四预设值不小于第一预设值以及第三预设值。
根据本发明的另一方面,提供了一种用于车辆的自动泊车系统,包括设置在换电站处的激光雷达、第一通信模块、第一计算模块和判断模块;以及设置在车辆上的第二通讯模块、第二计算模块、驾驶模块;其中,第二通讯模块与第一通信模块建立通信连接;判断模块根据预设的条件判断是否能够接纳车辆,若能够接纳车辆,则将第一判断结果发送至激光雷达;激光雷达检测车辆的形状并将其发送至第一计算模块;第一计算模块基于车辆的形状计算得到车辆的定位信息,并反馈至车辆的第二计算模块;第二计算模块基于定位信息获得泊车路径。
进一步地,判断模块根据预设的条件判断是否能够接纳车辆包括:当车辆与换电站的距离低于第一预设值时,第二通信模块向第一通信模块发出泊车请求;第一通信模块接收到所述泊车请求后,若换电站无故障或换电站没有被占用,则确定换电站内能够接纳车辆;或者,车辆的电量低于第二预设值,且车辆与换电站的距离低于第三预设值,第二通信模块向第一通信模块发出泊车请求;第一通信模块接收到泊车请求后,若换电站无故障或换电站没有被占用,则确定换电站内能够接纳车辆。
进一步地,第一计算模块基于车辆的形状计算得到车辆的定位信息步骤包括:基于所述车辆同一长边的两个边缘点A、B的位置计算得到所述车辆的位置及航向角。
进一步地,以泊车换电站为坐标原点O,以该换电站的宽度和长度方向分别为x、y轴方向建立预设坐标系,车辆的位置设置为所述车辆的后轴中心P的坐标,第一计算模块计算车辆的位置的步骤包括:计算得到后轴中心P与坐标原点O的距离PO;计算得到后轴中心P、坐标原点O与坐标轴y方向的角度∠POy;后轴中心P的坐标为(xp,yp),xp=PO*sin(∠POy),yp=PO*cos(∠POy)。
进一步地,以泊车换电站为坐标原点(O),以该换电站的宽度和长度方向分别为x、y轴方向建立预设坐标系,所述车辆的位置设置为所述车辆的后轴中心(P)的坐标,第一计算模块计算航向角的步骤包括:计算与坐标原点距离相对远的边缘点B、后轴中心P与车辆的长边对称轴K的夹角∠BPK;计算直线PB与穿过P点平行于x方向的直线x1的夹角∠BPx1;计算后轴中心P的航向角yaw=∠BPK-∠BPx1。
进一步地,第二计算模块基于定位信息获得泊车路径的步骤包括:基于车辆的定位信息判断车辆是否位于泊入启动区域内;若车辆位于泊入启动区域内,则确定车辆相对于所述换电站内预设地面标识的位置;基于地面标识的位置,确定泊入换电站的路径。
进一步地,若车辆位于泊入启动区域外;所述第二计算模块计算车辆与泊入启动区域的直线距离并生成路径图发送至驾驶模块;驾驶模块基于路径图调整车辆的位置,直至车辆位于泊入启动区域内。
进一步地,若位于同一地点的换电站为多个,第二计算模块分别计算与每个换电站的距离,依次和与其最近的换电站发出通信请求,直至与某一换电站建立通信连接。
进一步地,第二通信模块与第一通信模块建立通信连接步骤包括:当车辆与换电站的距离低于第四预设值时,车辆自动连接换电站内的WiFi,所述车辆通过WiFi向换电站发出泊车请求,第四预设值不小于第一预设值以及第三预设值。
本发明提供的一种自动泊车方法及用于车辆的自动泊车系统,具有如下的有益效果:
(1)通过安装在换电站端的激光雷达探测车辆来对车辆进定位并将定位信息通过无线传输给车辆,车辆利用定位信息完成泊入换电站的功能,解决了换电站泊车困难的问题。
(2)激光雷达的纵向检测精度可以达到mm级别,因而通过检测距离值换算得出车辆的定位信息也可以达到cm级别。通过激光雷达能够使得车辆在换电站内自动泊车的定位精度显著提高。
(3)将激光雷达安装在换电站端,一坐换电站可以服务多辆车辆,不需要在每台车辆上安装很多的传感器,节省了对车辆安装传感器的费用,方便了对换电站端内激光雷达维护和迭代。
附图说明
图1是根据本发明第一实施方式的自动泊车方法流程示意图;
图2是根据本发明第一实施方式的计算泊车路径的场景示意图;
图3是根据本发明第一实施方式的自动泊车方法的应用场景图;
图4是根据本发明第二实施方式的用于车辆的自动泊车系统的结构示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明了,下面结合具体实施方式并参照附图,对本发明进一步详细说明。应该理解,这些描述只是示例性的,而并非要限制本发明的范围。此外,在以下说明中,省略了对公知结构和技术的描述,以避免不必要地混淆本发明的概念。
图1是根据本发明第一实施方式的自动泊车方法流程示意图。
如图1所示,该方法包括步骤S101-步骤S104。
步骤S101,车辆与换电站建立通信连接。
优选的,当车辆与换电站之间的距离低于第四预设值时,车辆自动连接换电站处设置的WiFi后,车辆通过WiFi向换电站发出泊车请求。可选的,第四预设值可以是20m。
优选的,在车辆内预先存储全部换电站的WiFi密码,当车辆与换电站的距离低于第四预设值时,车辆内的驾驶员可通过预设设置的“无线连接按钮”,自动连接换电站内的WiFi。
在一个优选的实施例中,预先将车辆的特征信息存储至全部换电站内,当换电站的激光雷达通过对预设距离的车辆特征进行扫描,识别出某一汽车为预先存储的汽车的特征,则与车辆建立无线网络连接(WiFi连接)。其中,汽车的特征信息可以为:车牌号、车的发动机编号、车的类型和某品牌的汽车中的一种或多种。
步骤S102,换电站根据预设的条件判断是否能够接纳车辆。
在一个实施例中,换电站根据预设的条件判断是否能够接纳车辆包括:车辆与换电站的距离低于第一预设值,车辆向换电站发出泊车请求;换电站接收到泊车请求,若换电站无故障或换电站没有被占用,则确定换电站内能够接纳车辆。若换电站内出现故障,或者换电站内无泊车位,则换电站发出拒绝车辆进入换电站的信号给车辆。
可选的,第一预设值为20m。
优选的,上述第四预设值不小于第一预设值。
在一个实施例中,换电站根据预设的条件判断是否能够接纳车辆包括:车辆的电量低于第二预设值,且车辆与换电站的距离低于第三预设值,车辆向换电站发出泊车请求;换电站接收到泊车请求,若换电站无故障或换电站没有被占用,则确定换电站内能够接纳车辆。若换电站内出现故障,或者换电站内无泊车位,则换电站发出拒绝车辆进入换电站的信号给车辆。
可选的,第二预设值为30%,第三预设值为20m。
优选的,上述第四预设值不小于第三预设值。
步骤S103,若能够接纳所述车辆,则布置在换电站处的激光雷达检测车辆的形状,基于车辆的形状计算得到车辆的定位信息,并反馈至车辆。
在一个实施例中,基于车辆的形状计算得到车辆的定位信息步骤包括:基于车辆同一长边的两个边缘点A、B的位置计算得到车辆的位置以及车辆的航向角yaw。
其中,航向角为车身轴线K、车辆的参考点和沿着车辆参考点的预设坐标系x轴的平行线x1的夹角。在图2所示的例子中,航向角为∠kpx1。具体地,以泊车换电站为坐标原点O,以该换电站的宽度和长度方向分别为x、y轴方向建立预设坐标系,车辆的位置设置为车辆的后轴中心P的坐标。
需要说明的是,车辆在预设坐标系下的坐标本发明是以后轴中心P的坐标代表车辆,主要是考虑到用车辆的后轴中心作为车辆的参考点,车辆的部分参数可以简化为0,因此在做车辆控制时候选用后轴中心来作为参考点,以方便计算。还可以选用其他的点的坐标代表车辆,例如前轴中心Q。
进一步具体地,车辆的位置(后轴中心P)的计算步骤包括:计算得到车辆同一长边的边缘点A和B的坐标;计算得到后轴中心P与坐标原点O的距离PO;计算得到后轴中心P、坐标原点O与坐标轴y方向的角度∠POy;后轴中心P的坐标为(xp,yp),xp=PO*sin(∠POy),yp=PO*cos(∠POy)。
进一步具体地,以泊车换电站为坐标原点O,以该换电站的宽度和长度方向分别为x、y轴方向建立预设坐标系,车辆的位置设置为车辆的后轴中心P的坐标,航向角yaw的计算步骤包括:计算得到与坐标原点距离稍远的边缘点B、所述后轴中心P与车辆的长边对称轴K的夹角∠BPK;计算直线PB与穿过P点平行于x方向的直线x1的夹角∠BPx1;计算后轴中心P的航向角yaw=∠BPK-∠BPx1。
步骤S104,车辆基于定位信息获得泊车路径,并基于泊车路径进行泊车。
在一个实施例中,车辆基于定位信息计算泊车路径的步骤包括:基于车辆的定位信息判断车辆是否位于泊入启动区域内;若车辆位于泊入启动区域内,则确定车辆相对于换电站内预设地面标识的位置;基于地面标识的位置,确定泊入换电站的路径。地面标识可以是换电站的坐标原点、换电站内台架的中心等等。
在一个实施例中,若车辆位于泊入启动区域外,则调整车辆的位置,直至车辆位于泊入启动区域内。
参阅图2,图2所示的例子中,Pt1表示车辆的后轴中心,该泊入启动区域可以用Pt1的横纵坐标的取值范围来表征,即,在将换电车位(图2右下方的Pt5点所在的车辆位置)的宽度方向作为x轴方向并且将换电车位的长度方向作为y轴方向的情况下,只要车辆处于x1min~x1max且y1min~y1max(其中x1min、x1max、y1min、y1max为常数)这样的区域内,即可判定车辆位于泊入启动区域内。关于x1min、x1max、y1min、y1max的取值,当换电站内台架的长度和宽度均确定下来之后,沿x轴延伸的地面标志也随之确定,x1min、x1max、y1min、y1max也相应地被确定。
在图2所示的例子中,假设车辆停在Pt1点的位置,此时基于该当前位置确定出车辆以当前位置为起始点沿着X轴正方向直行至Pt2(x2,y2)点、然后从Pt2点沿X轴负方向直行至Pt3(x3,y3)点、进而沿弧线轨迹行驶至位置Pt4(x4,y4)、最后直行进入换电车位(图2右下方的Pt5点所在的车辆位置)的泊入路线。
需要说明的是,本申请以同一地点设置有一个换电站为例,但是并不以此为限,还可以在一个地点设置有多个换电站,多个换电站成排或成列或者队列设置。按照这种方式排列的换电站,车辆计算与每个换电站的距离,依次与与其最近的换电站发出通信请求,直到与某一换电站建立通信连接后,就不再向其他换电站发出通信请求,以方便进行换电。
图3为根据本发明第一实施方式提供的自动泊车方法的应用场景图。
图3所示的应用场景中,以换电站左上角的点为坐标原点O,其宽度方向为x轴,长度方向为y轴。激光雷达lidar设置在换电站的中心,车辆与换电站已建立了通信连接。
激光雷达检测车辆的形状,得到有关于车辆的点云数据。将点云数据换算到靠近换电站的车辆的长边的边缘点A、边缘点B的坐标,以及车辆的长边对称轴K。其中,边缘点A为靠近坐标原点的长边的一个边缘点,后轴中心P的坐标为(x,y)。
基于上述边缘点A和边缘点B的坐标能够计算得到距离AO、BO、AB、AP、BP、∠AOy、∠BOy、∠BPK。
∠PAO=∠OAB+∠PAB
∠POy=∠AOP+∠AOy
则可计算得到后轴中心P的坐标(xp,yp)中xp=PO×sin(∠POy),yp=PO×cos(∠POy)。
在P点做与坐标轴的x方向的平行线x1;
则∠BPx1=∠OPX1-∠OPB=PI/2+∠POy-∠OPB。
则点P的航向角yaw=∠BPK-∠BPX1。
换电站将计算后的后轴中心P以及P点的航向角。
本发明提供的一种自动泊车方法具有如下的有益效果:
(1)通过安装在换电站端的激光雷达探测车辆来对车辆进定位并将定位信息通过无线传输给车辆,车辆利用定位信息完成泊入换电站的功能,解决了换电站泊车困难的问题。
(2)激光雷达的纵向检测精度可以达到mm级别,因而通过检测距离值换算得出车辆的定位信息也可以达到cm级别。通过激光雷达能够使得车辆在换电站内自动泊车的定位精度显著提高。
(3)将激光雷达安装在换电站端,一坐换电站可以服务多辆车辆,不需要在每台车辆上安装很多的传感器,节省了对车辆安装传感器的费用,方便了对换电站端内激光雷达维护和迭代。
图4是根据本发明第二实施方式的用于车辆的自动泊车系统的结构示意图。
如图4所示,上述系统包括:设置在换电站内的激光雷达10、第一通信模块11、第一计算模块12和判断模块13,以及设置在车辆上的第二通讯模块20、第二计算模块21和驾驶模块22。其中,
第二通信模块20与第一通信模块11建立通信连接。
在一个优选的实施例中,第二通信模块20与第一通信模块11建立通信连接包括:换电站之间的距离低于第四预设值时,车辆自动连接换电站内的WiFi后,车辆通过WiFi向换电站发出泊车请求。可选的,第四预设值可以是20m。
优选的,在车辆内预先存储全部换电站的WiFi密码,当车辆与换电站的距离低于第四预设值时,车辆自动连接换电站内的WiFi。
判断模块13根据预设的条件判断是否能够接纳车辆,若能够接纳车辆,则将第一判断结果发送至激光雷达10。
在一个实施例中,判断模块13根据预设的条件判断是否能够接纳车辆包括:车辆与换电站的距离低于第一预设值时,第二通信模块20向第一通信模块11发出泊车请求;第一通信模块11接收到泊车请求,若换电站无故障或换电站没有被占用,则确定换电站内能够接纳车辆,则产生第一判断结果,将该第一判断结果对应的第一信号通过第一通信模块发送至第二通信模块。若换电站内有故障或被占用,则确定换电站不能接纳车辆,则产生第二判断结果,将该第二判断结果对应的第二信号通过第一通信模块发送至第二通信模块,拒绝车辆进入该换电站。
可选的,第一预设值为20m。
优选的,第一预设值小于等于上述第四预设值。
在一个实施例中,判断模块13根据预设的条件判断是否能够接纳车辆包括:车辆的电量低于第二预设值,且车辆与换电站的距离低于第三预设值,第二通信模块20向第一通信模块11发出泊车请求;第一通信模块11接收到泊车请求,若换电站无故障或换电站没有被占用,则确定换电站内能够接纳车辆,并产生第一判断结果,将该第一判断结果对应的第一信号通过第一通信模块发送至第二通信模块。若换电站内有故障或被占用,则确定换电站不能接纳车辆,则产生第二判断结果,将该第二判断结果对应的第二信号通过第一通信模块发送至第二通信模块,拒绝车辆进入该换电站。
可选的,第二预设值为30%,第三预设值为20m。
优选的,第一预设值小于等于上述第四预设值。
激光雷达10检测车辆的形状,并将其发送至第一计算模块12。
第一计算模块12,基于车辆的形状计算得到车辆的定位信息,并反馈至车辆的第二计算模块21。
具体地,第一计算模块12基于车辆的形状计算得到车辆的定位信息包括:基于车辆同一长边的两个边缘点A、B的位置计算得到车辆的位置及航向角。
具体地,以泊车换电站为坐标原点O,以该换电站的宽度和长度方向分别为x、y轴方向建立预设坐标系,车辆的位置设置为所述车辆的后轴中心P的坐标。进一步具体地,第一计算模块12计算车辆的位置的步骤包括:计算得到后轴中心P与坐标原点O的距离PO;计算得到后轴中心P、坐标原点O与坐标轴y方向的角度∠POy;后轴中心P的坐标为(xp,yp),xp=PO*sin(∠POy),yp=PO*cos(∠POy)。
进一步具体地,第一计算模块12计算航向角yaw的步骤包括:计算与坐标原点距离相对远的边缘点B、后轴中心P与车辆的长边对称轴K的夹角∠BPK;计算直线PB与穿过P点平行于x方向的直线x1的夹角∠BPx1;后轴中心P的航向角yaw=∠BPK-∠BPx1。
需要说明的是,车辆在预设坐标系下的坐标本发明是以后轴中心P的坐标代表车辆,主要是考虑到用车辆的后轴中心作为车辆的参考点,一些车辆的参数可以近似看为0,能够简化计算,因此在做车辆控制时候选用后轴中心来作为参考点。当然,还可以选用其他的点的坐标代表车辆,例如前轴中心Q。
第二计算模块21基于定位信息计算泊车路径。
在一个实施例中,第二计算模块21基于定位信息计算泊车路径的步骤包括:基于车辆的定位信息判断车辆是否位于泊入启动区域内;若车辆位于泊入启动区域内,则确定车辆相对于换电站内预设地面标识的位置;基于地面标识的位置,确定泊入换电站的路径。
在一个实施例中,若车辆位于泊入启动区域外;第二计算模块21计算车辆与泊入启动区域的直线距离并生成路径图发送至驾驶模块22;驾驶模块22基于路径图调整车辆的位置,直至车辆位于泊入启动区域内。
驾驶模块22基于泊车路径进行泊车。
需要说明的是,本申请以同一地点设置有一个换电站为例,但是并不以此为限,还可以在一个地点设置有多个换电站,多个换电站成排或成列或者队列设置。按照这种方式排列的换电站,车辆计算与每个换电站的距离,依次与与其最近的换电站发出通信请求,直到与某一换电站建立通信连接后,就不再向其他换电站发出通信请求,以方便进行换电。
本发明提供的一种用于车辆的自动泊车系统具有如下的有益效果:
(1)通过安装在换电站端的激光雷达探测车辆来对车辆进定位并将定位信息通过无线传输给车辆,车辆利用定位信息完成泊入换电站的功能,解决了换电站泊车困难的问题。
(2)激光雷达的纵向检测精度可以达到mm级别,因而通过检测距离值换算得出车辆的定位信息也可以达到cm级别。通过激光雷达能够使得车辆在换电站内自动泊车的定位精度显著提高。
(3)将激光雷达安装在换电站端,一坐换电站可以服务多辆车辆,不需要在每台车辆上安装很多的传感器,节省了对车辆安装传感器的费用,方便了对换电站端内激光雷达维护和迭代。
应当理解的是,本发明的上述具体实施方式仅仅用于示例性说明或解释本发明的原理,而不构成对本发明的限制。因此,在不偏离本发明的精神和范围的情况下所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。此外,本发明所附权利要求旨在涵盖落入所附权利要求范围和边界、或者这种范围和边界的等同形式内的全部变化和修改例。
Claims (17)
1.一种自动泊车方法,其特征在于,包括:
车辆与换电站建立通信连接;
换电站根据预设的条件判断是否能够接纳所述车辆;
若能够接纳所述车辆,则布置在所述换电站处的激光雷达检测所述车辆的形状,基于所述车辆的形状计算得到所述车辆的定位信息,并反馈至所述车辆;其中,基于所述车辆的形状计算得到所述车辆的定位信息步骤包括:基于所述车辆同一长边的边缘点A和边缘点B的位置计算得到所述车辆的位置及航向角;
所述车辆基于所述定位信息获得泊车路径。
2.根据权利要求1所述的泊车方法,其特征在于,所述换电站根据预设的条件,判断是否能够接纳所述车辆的步骤包括:
当所述车辆与所述换电站的距离低于第一预设值时,所述车辆向所述换电站发出泊车请求;
所述换电站接收到泊车请求后,若所述换电站无故障或所述换电站没有被占用,则确定所述换电站内能够接纳所述车辆;或者,
所述车辆的电量低于第二预设值,且所述车辆与所述换电站的距离低于第三预设值,所述车辆向所述换电站发出泊车请求;
所述换电站接收到泊车请求后,若所述换电站无故障或所述换电站没有被占用,则确定所述换电站内能够接纳所述车辆。
3.根据权利要求1所述的泊车方法,其特征在于,以泊车换电站为坐标原点(O),以该换电站的宽度和长度方向分别为x、y轴方向建立预设坐标系,所述车辆的位置设置为所述车辆的后轴中心(P)的坐标,所述车辆的位置的计算步骤包括:
计算所述后轴中心(P)与坐标原点(O)的距离PO;
计算所述后轴中心(P)、坐标原点(O)与所述坐标系y方向的角度∠POy;
所述后轴中心(P)的坐标为(xp,yp),xp=PO*sin(∠POy),yp=PO*cos(∠POy)。
4.根据权利要求1所述的泊车方法,其特征在于,以泊车换电站为坐标原点(O),以该换电站的宽度和长度方向分别为x、y轴方向建立预设坐标系,所述车辆的位置设置为所述车辆的后轴中心(P)的坐标,所述航向角的计算步骤包括:
计算与所述坐标原点(O)距离相对远的所述边缘点B、所述后轴中心(P)与所述车辆的长边对称轴K的夹角∠BPK;
计算直线PB与穿过后轴中心(P)平行于x方向的直线x1的夹角∠BPx1;
计算所述后轴中心(P)的航向角yaw=∠BPK-∠BPx1。
5.根据权利要求1所述的泊车方法,其特征在于,所述车辆基于所述定位信息获得泊车路径的步骤包括:
基于所述车辆的定位信息判断所述车辆是否位于泊入启动区域内;
若所述车辆位于泊入启动区域内,则确定所述车辆相对于所述换电站内预设第一地面标识的位置;
基于所述第一地面标识的位置,确定泊入所述换电站的路径。
6.根据权利要求5所述的泊车方法,其特征在于,
若所述车辆位于泊入启动区域外,则调整车辆的位置,直至所述车辆位于泊入启动区域内。
7.根据权利要求1所述的泊车方法,其特征在于,若位于同一地点的所述换电站为多个,所述车辆分别计算与每个所述换电站的距离,依次和与其最近的所述换电站发出通信请求,直至与某一换电站建立通信连接。
8.根据权利要求7所述的泊车方法,其特征在于,多个所述换电站成排或成列设置。
9.根据权利要求2所述的泊车方法,其特征在于,所述车辆与换电站建立通信连接步骤包括:
当所述车辆与所述换电站的距离低于第四预设值时,所述车辆自动连接所述换电站处设置的WiFi,所述车辆通过WiFi向所述换电站发出泊车请求,所述第四预设值不小于所述第一预设值以及所述第三预设值。
10.一种用于车辆的自动泊车系统,其特征在于,包括设置在换电站处的激光雷达(10)、第一通信模块(11)、第一计算模块(12)和判断模块(13);以及设置在车辆上的第二通讯模块(20)、第二计算模块(21)和驾驶模块(22);其中,
所述第二通讯模块(20)与所述第一通信模块(11)建立通信连接;
所述判断模块(13)根据预设的条件判断是否能够接纳所述车辆,若能够接纳所述车辆,则将第一判断结果发送至所述激光雷达(10);
所述激光雷达(10)检测所述车辆的形状,并将其发送至第一计算模块(12);
所述第一计算模块(12),基于所述车辆的形状计算得到所述车辆的定位信息,并反馈至所述车辆的第二计算模块(21);其中,所述第一计算模块(12)基于所述车辆的形状计算得到所述车辆的定位信息步骤包括:
基于所述车辆同一长边的边缘点A和边缘点B的位置计算得到所述车辆的位置及航向角;
所述第二计算模块(21)基于所述定位信息获得泊车路径。
11.根据权利要求10所述的泊车系统,其特征在于,所述判断模块(13)根据预设的条件判断是否能够接纳所述车辆包括:
当所述车辆与所述换电站的距离低于第一预设值时,所述第二通讯模块(20)向所述第一通信模块(11)发出泊车请求;
所述第一通信模块(11)接收到所述泊车请求后,若所述换电站无故障或所述换电站内没有被占用,则确定所述换电站内能够接纳所述车辆;或者,
所述车辆的电量低于第二预设值,且所述车辆与所述换电站的距离低于第三预设值,所述第二通讯模块(20)向所述第一通信模块(11)发出泊车请求;
所述第一通信模块(11)接收到所述泊车请求后,若所述换电站无故障或换电站没有被占用,则确定所述换电站内能够接纳所述车辆。
12.根据权利要求10所述的泊车系统,其特征在于,以泊车换电站为坐标原点(O),以该换电站的宽度和长度方向分别为x、y轴方向建立预设坐标系,所述车辆的位置设置为所述车辆的后轴中心(P)的坐标,所述第一计算模块(12)计算所述车辆的位置的步骤包括:
计算得到所述后轴中心(P)与坐标原点(O)的距离PO;
计算得到所述后轴中心(P)、坐标原点(O)与所述坐标系y方向的角度∠POy;
所述后轴中心(P)的坐标为(xp,yp),xp=PO*sin(∠POy),yp=PO*cos(∠POy)。
13.根据权利要求11所述的泊车系统,其特征在于,以泊车换电站为坐标原点(O),以该换电站的宽度和长度方向分别为x、y轴方向建立预设坐标系,所述车辆的位置设置为所述车辆的后轴中心(P)的坐标,所述第一计算模块(12)计算所述航向角的步骤包括:
计算与所述坐标原点(O)距离相对远的所述边缘点B、所述后轴中心(P)与所述车辆的长边对称轴K的夹角∠BPK;
计算直线PB与穿过后轴中心(P)点平行于x方向的直线x1的夹角∠BPx1;
所述后轴中心(P)的航向角yaw=∠BPK-∠BPx1。
14.根据权利要求10所述的泊车系统,其特征在于,所述第二计算模块(21)基于所述定位信息获得泊车路径的步骤包括:
基于车辆的定位信息判断所述车辆是否位于泊入启动区域内;
若所述车辆位于泊入启动区域内,则确定所述车辆相对于所述换电站内预设地面标识的位置;
基于所述地面标识的位置,确定泊入所述换电站的路径。
15.根据权利要求14所述的泊车系统,其特征在于,若所述车辆位于泊入启动区域外;
所述第二计算模块(21)计算车辆与泊入启动区域的直线距离并生成路径图发送至所述驾驶模块(22);
所述驾驶模块(22)基于所述路径图调整车辆的位置,直至所述车辆位于泊入启动区域内。
16.根据权利要求10所述的泊车系统,其特征在于,若位于同一地点的所述换电站为多个,第二计算模块(21)分别计算与每个所述换电站的距离,依次和与其最近的所述换电站发出通信请求,直至与某一换电站建立通信连接。
17.根据权利要求11所述的泊车系统,其特征在于,所述第二通讯模块(20)与所述第一通信模块(11)建立通信连接步骤包括:
当所述车辆与所述换电站的距离低于第四预设值时,所述车辆自动连接所述换电站处设置的WiFi,所述车辆通过WiFi向所述换电站发出泊车请求,所述第四预设值不小于所述第一预设值以及所述第三预设值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811220218.2A CN109398350B (zh) | 2018-10-19 | 2018-10-19 | 一种自动泊车方法及用于车辆的自动泊车系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811220218.2A CN109398350B (zh) | 2018-10-19 | 2018-10-19 | 一种自动泊车方法及用于车辆的自动泊车系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109398350A CN109398350A (zh) | 2019-03-01 |
CN109398350B true CN109398350B (zh) | 2021-05-28 |
Family
ID=65468591
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811220218.2A Active CN109398350B (zh) | 2018-10-19 | 2018-10-19 | 一种自动泊车方法及用于车辆的自动泊车系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109398350B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112937553B (zh) * | 2019-11-26 | 2023-06-23 | 帝亚一维新能源汽车有限公司 | 无人驾驶车辆自动泊车方法 |
CN111572551B (zh) * | 2020-05-19 | 2021-07-20 | 安徽江淮汽车集团股份有限公司 | 泊车工况下的航向角计算方法、装置、设备及存储介质 |
CN111882879B (zh) * | 2020-07-15 | 2024-04-16 | 浙江吉智新能源汽车科技有限公司 | 一种换电站内车辆检测方法、系统、介质及换电站 |
CN112406618B (zh) * | 2020-11-23 | 2022-09-23 | 东风汽车集团有限公司 | 一种电动汽车自动换电方法 |
CN114347846B (zh) * | 2022-03-18 | 2023-01-03 | 蔚来汽车科技(安徽)有限公司 | 用于控制车辆换电的方法、计算机系统、介质及换电站 |
CN114347849B (zh) * | 2022-03-21 | 2022-09-02 | 蔚来汽车科技(安徽)有限公司 | 用于换电站的换电车辆管理系统和方法 |
CN114368383B (zh) * | 2022-03-22 | 2022-06-14 | 蔚来汽车科技(安徽)有限公司 | 控制车辆泊车的方法、计算机系统、介质及车辆 |
CN114368317B (zh) * | 2022-03-22 | 2022-07-05 | 蔚来汽车科技(安徽)有限公司 | 用于控制车辆换电的方法、计算机系统、介质及车辆 |
CN115009075A (zh) * | 2022-05-19 | 2022-09-06 | 中国第一汽车股份有限公司 | 一种充电位泊车方法、装置、设备及存储介质 |
CN115146824B (zh) * | 2022-06-01 | 2023-05-26 | 禾多科技(北京)有限公司 | 车辆换电方法、装置、电子设备和计算机可读介质 |
Family Cites Families (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102009003298A1 (de) * | 2009-05-20 | 2010-11-25 | Robert Bosch Gmbh | Vorrichtung und Verfahren zum unterstützten Einparken eines Fahrzeugs |
US9581997B1 (en) * | 2011-04-22 | 2017-02-28 | Angel A. Penilla | Method and system for cloud-based communication for automatic driverless movement |
DE102012209724B4 (de) * | 2012-06-11 | 2014-11-27 | Siemens Aktiengesellschaft | Positionsbestimmung von Radfahrzeugen mittels Laserscanner |
US9302594B2 (en) * | 2012-07-31 | 2016-04-05 | Qualcomm Incorporated | Selective communication based on distance from a plurality of electric vehicle wireless charging stations in a facility |
EP2712762B1 (de) * | 2012-09-28 | 2021-09-01 | Valeo Siemens eAutomotive Germany GmbH | Positioniersystem und Verfahren zur Positionierung eines Fahrzeuges |
DE102014210759A1 (de) * | 2014-06-05 | 2015-12-17 | Siemens Aktiengesellschaft | Ortungssystem zur Bestimmung der Position eines Fahrzeugs in einer Ladestation |
DE102016200792B4 (de) * | 2016-01-21 | 2022-02-24 | Robert Bosch Gmbh | Verfahren und System zum Ermitteln von Daten für eine fahrerlose Fahrt eines Kraftfahrzeugs |
CN105730271A (zh) * | 2016-02-03 | 2016-07-06 | 武汉天梯极客网络科技有限公司 | 一种电动车辆更换电池的方法和云管理服务器 |
CN106530820A (zh) * | 2017-01-05 | 2017-03-22 | 吉林大学 | 一种电动汽车代客自动泊车入位充电系统 |
CN106828152B (zh) * | 2017-01-09 | 2019-12-31 | 上海蔚来汽车有限公司 | 电动车辆自动充换电方法 |
CN106912001B (zh) * | 2017-01-09 | 2021-12-03 | 上海蔚来汽车有限公司 | 基于wifi广播的自动鉴权方法和系统 |
CN107499166B (zh) * | 2017-08-31 | 2020-09-29 | 上海蔚来汽车有限公司 | 充换电设施与充电口引导充换电方法及装置 |
-
2018
- 2018-10-19 CN CN201811220218.2A patent/CN109398350B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109398350A (zh) | 2019-03-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109398350B (zh) | 一种自动泊车方法及用于车辆的自动泊车系统 | |
US11409300B2 (en) | Autonomous car, traveling controller, traveling control method, and storage medium storing control program | |
EP2230146B1 (en) | Method of power management for plug-in hybrid and electric vehicle | |
US10596920B2 (en) | Vehicle charging system | |
US10875420B2 (en) | Full-service charging station for an electric vehicle and method of operating the same | |
US20180290561A1 (en) | Use of an autonomous range extender vehicle and autonomous range extender vehicle | |
CN105486318B (zh) | 车辆及电动自行车充电监测接口 | |
KR101063656B1 (ko) | 전기차량의 충전소 정보 제공 시스템 | |
GB2544176A (en) | Identification of acceptable vehicle charge stations | |
US20110184842A1 (en) | Energy transfer systems and methods for mobile vehicles | |
US11108259B2 (en) | Charging control apparatus for vehicle | |
US20140337253A1 (en) | Transmitting charge event information to electrical utility through telematics communication infrastructure | |
CN104935038A (zh) | 移动储能充电装置以及移动储能充电系统 | |
CN113119749B (zh) | 电动滑板车的行驶方法、电动滑板车 | |
US11762354B2 (en) | Apparatus for controlling charging of electric vehicle and method therefor | |
US20170210239A1 (en) | Electrical charging control device, charging method and charging system thereof | |
WO2014034298A1 (ja) | 航続可能距離表示システム | |
CN106643753A (zh) | 电动汽车充电场站桩位导航系统及方法 | |
CN108116242B (zh) | 渡运车、电动汽车及电动汽车充电方法 | |
JP2012152018A (ja) | 情報処理システム、そのシステムを構成する送信装置及び受信装置 | |
JP2013055731A (ja) | 充電システム及び充電方法 | |
CN109774501B (zh) | 电动滑板车的充电方法、电动滑板车 | |
CN111845404A (zh) | 一种移动充电桩的控制方法及移动充电系统 | |
KR20150052965A (ko) | 전기자동차의 배터리 충전량 결정 방법 | |
CN215621508U (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 |