自动充电终端的车辆充电口定位方法和装置、电子设备与流程
本发明涉及自动充电,具体涉及一种自动充电终端的车辆充电口定位方法和装置、电子设备。
背景技术:
1、随着新能源汽车产业的快速发展,自动充电技术已成为智能充电领域的研究热点。在自动充电的常规流程中,通常需要通过感知系统对充电口进行位姿定位,然后控制机械臂带动充电枪实现自动插枪。为确保机械臂在运动过程中不与车体发生碰撞,需预先建立车体的碰撞模型,为机械臂的路径规划提供依据。
2、在车体建模方面,激光雷达点云与包围盒技术的结合已被广泛采用,现有方案大多针对单个障碍物或整辆车构建单一的包围盒或层次树结构。而采用单一包围盒难以紧密贴合车体表面,会留下较大空间空隙,导致机械臂的可达空间被过度压缩;简单的多层次包围盒又会带来冗余计算,影响实时性。
技术实现思路
1、为了克服上述机械臂的可达空间被过度压缩、计算量大、实时性差的问题,本发明提供一种自动充电终端的车辆充电口定位方法和装置、电子设备。
2、一方面,本发明提供一种自动充电终端的车辆充电口定位方法,包括:
3、通过自动充电终端的单线激光雷达获取待充电车辆的原始点云数据;将所述原始点云数据转换至机械臂的基坐标系,生成基础点云;
4、沿待充电车辆的高度方向将所述基础点云分割为不同高度层的子点云集合,并对各所述子点云集合构建初始包围盒;根据各所述子点云集合的空间分布特征及预置的机械臂运动规划约束,对相邻高度层的所述初始包围盒进行自适应合并,生成用于表征车体表面的优化包围盒集;
5、根据各所述子点云集合中离群点相对于所述优化包围盒集的内外位置关系,分别构建属于突出物类别的第一包围盒和属于凹陷类别的第二包围盒;
6、基于所述第一包围盒的几何朝向和所述第二包围盒的空间特征,确定待充电车辆充电口对应的目标包围盒,进而确定出充电口的位置。
7、另一方面,本发明还提供一种自动充电终端的车辆充电口定位装置,包括:
8、点云获取模块,用于通过自动充电终端的单线激光雷达获取待充电车辆的原始点云数据;将所述原始点云数据转换至机械臂的基坐标系,生成基础点云;
9、第一构建模块,用于沿待充电车辆的高度方向将所述基础点云分割为不同高度层的子点云集合,并对各所述子点云集合构建初始包围盒;根据各所述子点云集合的空间分布特征及预置的机械臂运动规划约束,对相邻高度层的所述初始包围盒进行自适应合并,生成用于表征车体表面的优化包围盒集;
10、第二构建模块,用于根据各所述子点云集合中离群点相对于所述优化包围盒集的内外位置关系,分别构建属于突出物类别的第一包围盒和属于凹陷类别的第二包围盒;
11、定位模块,用于基于所述第一包围盒的几何朝向和所述第二包围盒的空间特征,确定待充电车辆充电口对应的目标包围盒,进而确定出充电口的位置。
12、另一方面,本发明还提供一种电子设备,包括:至少一个处理器和存储器;所述存储器和处理器通过总线相连;
13、所述存储器,用于存储一个或多个程序;
14、当所述一个或多个程序被所述至少一个处理器执行时,实现上述中任意一项所述的方法。
15、另一方面,本发明还提供一种可读存储介质,其上存有执行程序,所述执行程序被执行时,实现上述中任意一项所述的方法。
16、与现有技术相比,本发明的有益效果为:
17、本发明提供一种自动充电终端的车辆充电口定位方法和装置,首先沿高度方向将点云分割为多层子点云集合,对各层分别构建初始包围盒,使得每一层包围盒仅需贴合该高度层内的局部点云分布,相较于单一包围盒显著降低了空间空隙。进一步地,根据各子点云集合的空间分布特征以及预置的机械臂运动规划约束,对相邻高度层的初始包围盒进行自适应合并,仅在车体表面实际需要的区域保持精细化建模,在非敏感区域主动降低模型复杂度,从而在保证碰撞模型紧密性的同时避免不必要的计算开销。
18、本发明从各子点云集合的离群点中分别构建突出物类别和凹陷类别的包围盒,其中突出物类别包围盒可用于识别充电口盖等车体表面突出物,凹陷类别包围盒可直接对应充电口凹陷区域。在此基础上,基于第一包围盒的几何朝向和第二包围盒的空间特征,通过几何推理确定充电口位置。可以对各种情况下的充电口和各种车型通过当前实时扫描的点云数据完成定位,泛化能力高。
1.一种自动充电终端的车辆充电口定位方法,其特征在于,包括:
2.根据权利要求1所述的方法,其特征在于,所述对相邻高度层的所述初始包围盒进行自适应合并,生成优化包围盒集,包括:
3.根据权利要求1所述的方法,其特征在于,基于所述第一包围盒的几何朝向和所述第二包围盒的空间特征,确定待充电车辆充电口对应的目标包围盒,进而确定出充电口的位置,包括:
4.根据权利要求3所述的方法,其特征在于,所述根据所述第一包围盒的几何特征判断是否满足充电口盖识别条件,包括:
5.根据权利要求3所述的方法,其特征在于,所述基于所述第一包围盒的几何朝向确定充电口盖的翻转形式,并根据所述翻转形式在相应搜索区域内定位充电口对应的目标包围盒,包括:
6.根据权利要求1所述的方法,其特征在于,在沿待充电车辆的高度方向将所述基础点云分割为不同高度层的子点云集合之前,还包括:
7.根据权利要求1所述的方法,其特征在于,所述对各所述子点云集合构建初始包围盒,包括:
8.根据权利要求7所述的方法,其特征在于,根据各所述子点云集合中离群点相对于所述优化包围盒集的内外位置关系,分别构建属于突出物类别的第一包围盒和属于凹陷类别的第二包围盒,包括:
9.一种自动充电终端的车辆充电口定位装置,其特征在于,包括:
10.一种电子设备,其特征在于,包括:至少一个处理器和存储器;所述存储器和处理器通过总线相连;
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com