CN107618396B - 自动充电系统及方法 - Google Patents
自动充电系统及方法 Download PDFInfo
- Publication number
- CN107618396B CN107618396B CN201710978979.3A CN201710978979A CN107618396B CN 107618396 B CN107618396 B CN 107618396B CN 201710978979 A CN201710978979 A CN 201710978979A CN 107618396 B CN107618396 B CN 107618396B
- Authority
- CN
- China
- Prior art keywords
- charging
- charging interface
- mechanical arm
- pose
- movable end
- 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 40
- 230000008569 process Effects 0.000 claims abstract description 12
- 238000001514 detection method Methods 0.000 claims description 52
- 238000006073 displacement reaction Methods 0.000 claims description 14
- 238000003780 insertion Methods 0.000 claims description 7
- 230000037431 insertion Effects 0.000 claims description 7
- 238000004891 communication Methods 0.000 claims description 2
- 230000000977 initiatory effect Effects 0.000 claims 1
- 238000012423 maintenance Methods 0.000 abstract description 5
- 206010063385 Intellectualisation Diseases 0.000 abstract description 3
- 238000007726 management method Methods 0.000 description 15
- 238000010586 diagram Methods 0.000 description 12
- 230000009471 action Effects 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000004140 cleaning Methods 0.000 description 2
- 238000003032 molecular docking Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 230000002411 adverse Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 239000003086 colorant Substances 0.000 description 1
- 230000006835 compression Effects 0.000 description 1
- 238000007906 compression Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
- 230000003252 repetitive effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000001502 supplementing effect Effects 0.000 description 1
- 239000002699 waste material Substances 0.000 description 1
Classifications
-
- 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
Landscapes
- Charge And Discharge Circuits For Batteries Or The Like (AREA)
Abstract
本发明提供了一种自动充电系统及方法,其中包括机械臂;充电接口位姿识别模块,设置在机械臂的活动端;充电装置;控制器,用于获取所述充电接口位姿识别模块识别的充电接口的空间位姿;根据充电接口的空间位姿控制所述机械臂的活动端移动,以使得所述充电接头插入所述充电接口;以及控制所述充电装置为所述车辆充电。本发明的自动充电系统及方法,极大地提高了电动汽车尤其是租赁用电动汽车的用车体验和操作安全性;解决用户遗忘充电导致车辆缺电的问题,尤其提高租赁用电动汽车的使用率;电动汽车自动充电可与其他自动化设施相结合,形成完善的电动汽车自动化服务体系,充分实现智能化;全程无需人工参与,降低了后期维护成本。
Description
技术领域
本发明涉及充电技术领域,尤其涉及一种自动识别充电接口并自动将充电接头插入充电接口的自动充电系统及方法。
背景技术
电动汽车分时租赁业务的兴起一定程度上给人民带来了便利,用户可以很方便地取用公共电动汽车,并且取用点和还车点不需要保持一致,满足了用户出行的需要,并且使用方式十分灵活。
然而,现有的电动汽车分时租赁遇到的一个问题在于充电的不方便。停车场充电桩数量有限给电动汽车的续航带来了不利的影响,也一定程度上阻碍了电动汽车分时租赁业务的发展。目前国内大型停车场设置了部分充电车位,在车位后方设置充电桩,为用户提供车辆充电服务。如申请号为CN201710176604.5的专利申请公开的充电桩,为目前市场上存在比较通用的一类充电桩,一般包括设置在停车位旁边的充电枪和配电箱。在采用这种充电桩时,用户在停车后需要手动将充电枪拔下充电桩,插入电动汽车充电接口进行充电,操作较为复杂,给用户使用电动汽车造成了一定的负担,也一定程度上削弱了电动汽车分时租赁的便利性。同时也可能因为部分用户操作不当,容易造成充电枪损伤,后续造成无法充电,带来了后续维护成本的增加。
发明内容
针对现有技术中的问题,本发明的目的在于提供一种自动充电系统及方法,可以自动识别充电接口的空间位姿,并且控制充电接头自动插入充电接口进行充电,实现全自动化电动汽车充电,而不必用户再手动操作。
本发明实施例提供一种自动充电系统,包括:
机械臂,所述机械臂包括一活动端和一固定端,所述机械臂的活动端设置有一充电接头,且所述机械臂的活动端相对于所述机械臂的固定端可移动;
充电接口位姿识别模块,设置于所述机械臂的活动端,所述充电接口位姿识别模块用于识别车辆的充电接口的空间位姿;
充电装置,所述充电装置通过充电线缆与所述充电接头电连接,所述充电装置用于当所述充电接头插入所述充电接口中时,为车辆充电;
控制器,用于执行如下充电步骤:
获取所述充电接口位姿识别模块识别到的充电接口的空间位姿;
根据所述充电接口的空间位姿控制所述机械臂的活动端移动,以使得所述充电接头插入所述充电接口;
控制所述充电装置为所述车辆充电。
可选地,所述充电接头的端面设置有一个或多个力传感器,所述力传感器采集所述充电接头的端面处的力数据,并将采集的力数据发送至所述控制器,所述控制器根据所述力数据,判断所述充电接头是否插入所述充电接口和/或调整所述充电接头在所述充电接口中的插入姿态。
可选地,所述充电接头的端面设置有多个力传感器,所述控制器比较各个所述力传感器的力数据与预设力限值,如果存在力数据大于预设力限值的过压力传感器,则设定调整方向为从过压力传感器指向力数据小于预设压力限值的力传感器,并控制所述机械臂的活动端沿所述调整方向移动。
可选地,所述充电接口位姿识别模块中预存所述充电接口的特征区域的特征信息;所述充电接口位姿识别模块包括两个摄像头,所述充电接口位姿识别模块获取所述两个摄像头采集的图像,识别采集的图像中的充电接口的特征区域,并计算所述充电接口的特征区域的六维空间坐标,所述六维空间坐标包括所述特征区域分别在x轴、y轴、z轴方向的线位移和所述特征区域分别相对于x轴、y轴、z轴方向的角位移。
可选地,所述充电接口位姿识别模块中预存所述充电接口的特征区域的标准图像;所述充电接口位姿识别模块包括一个摄像头,所述充电接口位姿识别模块获取所述摄像头采集的图像,将所述摄像头采集的图像与预存的充电接口的特征区域标准图像进行对比,确定所述充电接口的空间位姿。
可选地,所述充电接口位姿识别模块中预存所述充电接口的特征区域的特征信息;所述充电接口位姿识别模块包括一个摄像头,所述充电接口位姿识别模块获取所述摄像头于两个位置分别采集的图像,根据两次采集的图像和两个位置之间的位置关系,计算所述充电接口的六维空间坐标,所述六维空间坐标包括所述充电接口的特征区域分别在x轴、y轴、z轴方向的线位移和所述特征区域的平面分别相对于x轴、y轴、z轴方向的角位移。
可选地,所述机械臂的活动端还设置有一闪光灯,所述摄像头的采光率低于预设采光率阈值时,所述控制器开启所述闪光灯,或所述摄像头开启图像采集时,开启所述闪光灯。
可选地,所述控制器根据如下步骤控制所述机械臂的活动端移动:
控制所述机械臂的活动端执行初始化运动;
计算并比较所述机械臂的活动端在初始化运动之前和之后,充电接口的空间位姿,根据比较结果选择下一步运动方向;
根据下一步运动方向控制所述机械臂的活动端移动;
当满足预设方向调整条件时,计算当前充电接口的空间位姿;
比较当前充电接口的空间位姿和前一次计算的充电接口的空间位姿,根据比较结果更新下一步运动方向。
可选地,所述初始化运动包括控制所述机械臂的活动端沿一预设参考方向移动预设间隔时间或移动预设间隔距离;
所述控制器根据如下步骤更新下一步运动方向:
所述机械臂的活动端的运动过程中,每隔预设间隔时间或预设间隔距离,所述充电接口位姿识别模块重新识别充电接口的空间位姿;
比较当前充电接口的空间位姿和前一次识别的充电接口的空间位姿,根据比较结果更新下一步运动方向。
可选地,在所述机械臂的活动端和所述充电接口之间设置多个节点;
所述控制器根据如下步骤更新下一步运动方向:
所述机械臂的活动端的运动过程中,每到一个节点,所述充电接口位姿识别模块重新识别充电接口的空间位姿;
比较当前节点识别的充电接口的空间位姿和前一节点识别的充电接口的空间位姿,根据比较结果更新下一步运动方向;
根据更新后的下一步运动方向,控制所述机械臂的活动端移动至下一个节点。
可选地,所述控制器中存储一预设安全位置的信息,所述控制器根据如下步骤更新下一步运动方向:
所述机械臂的活动端运动至预设安全位置时,计算当前充电接口的空间位姿;
比较当前充电接口的空间位姿和前一次计算的特征点的空间位姿,根据比较结果更新下一步运动方向;
根据更新后的下一步运动方向,控制所述机械臂的活动端运动使得所述充电接头插入所述充电接口。
可选地,所述充电接口的空间位姿包括所述充电接口的特征区域的六维空间坐标,所述六维空间坐标包括所述特征区域分别在x轴、y轴、z轴方向的线位移和所述特征区域分别相对于x轴、y轴、z轴方向的角位移;
所述控制器控制所述机械臂的活动端移动时,还执行充电接头垂直对准所述充电接口的步骤;
所述充电接头垂直对准所述充电接口,包括如下步骤:
根据所述特征区域的六维空间坐标确定所述特征区域的表面相对于预设参考面的倾斜角度;
根据所述特征区域的倾斜角度调整所述机械臂的活动端的倾斜角度,使所述充电接头垂直对准所述充电接口。
可选地,还包括车辆检测模块,所述车辆检测模块用于检测在预设检测范围内是否有车辆停靠,并将车辆检测结果发送至所述控制器;
所述控制器获取所述车辆检测结果,如果所述车辆检测模块检测到有车辆停靠,则所述控制器启动所述充电步骤;如果所述车辆检测模块未检测到有车辆停靠,则所述控制器不启动所述充电步骤。
可选地,所述车辆检测模块包括激光收发器、摄像头、电磁波收发器、超声波收发器、红外收发器和蓝牙收发器之中的至少一种。
可选地,还包括数据收发模块,所述数据收发模块用于与车辆的充电盖管理模块进行通信;
所述控制器通过所述数据收发模块向所述车辆的充电盖管理模块发送充电请求信号,所述车辆的充电盖管理模块在接收到充电请求信号后控制车辆的充电盖打开。
可选地,所述机械臂为多关节机械臂,所述机械臂的活动端的关节延伸方向平行于或垂直于所述充电接头的延伸方向,所述充电接口位姿识别模块位于所述机械臂的活动端的一侧面,且所述充电接口位姿识别模块与所述充电接头的末端的距离大于所述充电接口的深度;所述充电线缆沿所述多关节机械臂的一侧延伸设置。
可选地,所述自动充电系统的底部还设置有至少一个移动轮或传动带,所述移动轮或传送带由一个或多个驱动电机驱动转动,所述驱动电机由所述控制器控制。
可选地,自动充电系统的侧面还设置有至少一防撞条或至少一撞击传感器,所述撞击传感器与所述控制器进行连接。
可选地,所述充电接口位姿识别模块包括信号收发设备,所述信号收发设备向预设检测区域内发送检测信号,并接收所述检测信号在所述充电接口处的反射检测信号;
所述充电接口位姿识别模块根据所述信号收发设备接收到的反射检测信号确定所述充电接口的空间位姿。
可选地,所述信号收发设备包括激光收发设备、超声波收发设备和红外收发设备中的至少一种。
可选地,所述充电接口位姿识别模块包括信号接收设备,所述充电接口处设置有至少一信号发生器,所述信号接收设备接收所述信号发生器发出的信号;
所述充电接口位姿识别模块根据所述信号接收设备接收到的信号确定所述充电接口的空间位姿。
可选地,所述信号发生器为激光发射器、超声波发射器、红外发射器、射频电子标签和UWB电子标签中的至少一种。
可选地,还包括声音提示模块和/或指示灯,所述控制器控制所述声音提示模块播放预设提示语音,所述控制器控制所述指示灯显示充电状态。
可选地,所述机械臂的活动端还设置有一机械抓手,所述机械抓手与所述控制器进行通信,所述机械臂的活动端通过所述机械抓手与所述充电接头相连接。
可选地,所述控制器还用于与外部终端进行通信,接收外部终端的指令对所述自动充电系统的执行动作进行控制。
本发明实施例还提供一种自动充电方法,采用所述的自动充电系统,所述方法包括如下步骤:
所述充电接口位姿识别模块识别车辆的充电接口的空间位姿;
所述控制器根据所述充电接口位姿识别模块识别到的充电接口的空间位姿控制所述机械臂的活动端移动,以使得所述充电接头插入所述充电接口;
所述控制器控制所述充电装置为所述车辆充电。
本发明所提供的自动充电系统及方法具有下列优点:
本发明提供了一种全自动电动汽车充电的系统及方法,在车辆停放后,可以通过充电接口位姿识别模块识别充电接口的空间位姿,由控制器根据充电接口的空间位姿控制机械臂移动靠近充电接口,从而控制充电接头自动插入充电接口,然后控制充电装置对电动汽车进行充电;极大地提高了电动汽车尤其是租赁用电动汽车的用车体验和操作安全性;解决了用户遗忘充电导致车辆缺电的问题,尤其提高租赁用电动汽车的使用率;电动汽车自动充电可与其他自动化设施相结合,例如自动泊车、自动清洁等,形成完善的电动汽车自动化服务体系,充分实现智能化;全程无人参与,降低了维护成本。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述,本发明的其它特征、目的和优点将会变得更明显。
图1是本发明一实施例的自动充电系统的结构框图;
图2是本发明一实施例的自动充电系统的结构示意图;
图3是本发明一实施例的本发明一实施例的机械臂处于另一状态时自动充电系统的结构示意图;
图4是图3中的自动充电系统与汽车充电接口对接的结构示意图;
图5是本发明一实施例的自动充电方法的流程图;
图6是本发明一实施例的控制器控制机械臂的活动端移动的流程图;
图7是本发明一实施例的双目视觉识别模块对特征点的三维重建模型的示意图;
图8是本发明一实施例的规划所述机械臂的活动端的移动路线的流程图;
图9是本发明一实施例的机械臂的活动端的移动方式的示意图;
图10是本发明一实施例的以时间为单位规划机械臂的活动端的移动路线的流程图;
图11是本发明一实施例的以距离为单位规划机械臂的活动端的移动路线的流程图。
图12是本发明一实施例的采用节点调整机械臂的活动端的移动路线的流程图;
图13是本发明一实施例的充电接头垂直对准充电接口的流程图;
图14是本发明一实施例的根据充电接口表面的倾斜角度调整机械臂的活动端的倾斜角度的示意图;
图15是本发明一实施例的充电接口的特征点的示意图;
图16是本发明一实施例的摄像头的摄像范围的示意图;
图17是本发明一实施例的机械臂的活动端移动的距离区段的示意图;
图18是本发明一实施例的机械臂的活动端移动的距离区段的示意图;
图19是本发明一具体实施例中控制器控制机械臂的活动端移动的流程图;
图20是本发明一具体实施例中自动充电方法的流程图;
图21~22是本发明一实施例的增加移动小车的自动充电系统的结构示意图。
具体实施方式
现在将参考附图更全面地描述示例实施方式。然而,示例实施方式能够以多种形式实施,且不应被理解为限于在此阐述的实施方式;相反,提供这些实施方式使得本发明将全面和完整,并将示例实施方式的构思全面地传达给本领域的技术人员。在图中相同的附图标记表示相同或类似的结构,因而将省略对它们的重复描述。
如图1所示,本发明实施例提供一种自动充电系统,所述系统包括机械臂100、充电接口位姿识别模块200、充电装置300和控制器400。其中,充电接口位姿识别模块200设置于机械臂100的活动端,充电接口位姿识别模块200识别车辆的充电接口的空间位姿,控制器400分别与机械臂100、充电接口位姿识别模块200和充电装置300进行通信,获取充电接口位姿识别模块200识别的充电接口的空间位姿,控制机械臂100的移动,并控制充电装置300的充电开启和关闭。本发明中的空间位姿可以包括充电接口的特征区域在空间中的三维空间坐标或六维空间坐标,六维空间坐标包括除了特征区域的三维坐标(x、y、z轴的坐标),还有特征区域的表面分别相对于x、y、z轴的旋转角位移,或者是充电接口与机械臂的活动端之间的相对位置,即为能够引导机械臂的活动端的充电接头插入充电接口的信息即可。
如图2所示,为本发明一实施例中自动充电系统的结构示意图。其中,所述控制器400设置于一个控制箱401中,机械臂100包括一活动端101和一固定端102,机械臂100的固定端102固定于控制箱401的上方,控制箱401设置于充电装置300的上方。此处控制箱401可以是一个一侧开门的箱体结构,也可以是一个具有上部平台的支架结构。
机械臂100的活动端101设置有一充电接头500,且机械臂100的活动端101相对于所述机械臂100的固定端102可移动。在该实施例中,充电接口位姿识别模块200包括双目视觉识别模块201,但本发明不限于此。机械臂100的活动端101还设置有双目视觉识别模块201,此处双目视觉识别模块201包括两个摄像头:第一摄像头和第二摄像头,两个摄像头分别采集对应的摄像范围内的图像。充电装置300通过充电线缆与充电接头500电连接,充电装置300用于当充电接头500插入车辆的充电接口中时,为车辆充电。
所述控制器400用于执行如下充电步骤:
首先获取充电接口位姿识别模块200识别到的充电接口的空间位姿;在本发明中,由于采用两个摄像头,因此充电接口位姿识别模块200获取到的是两个摄像头的采集图像,并且摄像头设置在机械臂100活动的一端,因此摄像头在活动过程中的采集图像也是会变化的,充电接口位姿识别模块200根据两个摄像头的采集图像可以识别到充电接口的六维坐标,此处六维空间坐标包括除了三维坐标(x、y、z轴的坐标),还有充电接口的表面分别相对于x、y、z轴的旋转角位移;
然后控制器400根据采集图像判断车辆的充电接口位置,并控制机械臂100的活动端移动,以使得充电接头500插入充电接口;
确定充电接头500插入到车辆的充电接口601之后,控制器400即可以控制充电装置300为车辆充电。
因此,采用该实施例的自动充电系统,在车辆停放后,可以通过双目视觉识别模块201自动采集充电接口图像,由充电接口识别模块200在采集图像中识别充电接口位置,并且控制机械臂100移动靠近充电接口,从而控制充电接头500自动插入充电接口,然后控制充电装置300对电动汽车进行充电;全程均无需人工参与,提高了电动汽车充电操作的效率,避免对充电接头500和充电接口造成损坏,降低后期维护成本,提升了用户的使用体验。
进一步地,所述控制器400还可以与外部终端进行通信,接收外部终端的指令,对该自动充电系统的动作进行控制。例如,所述外部终端可以是手机、个人电脑、服务器等,控制器400可以在外部终端的指令下执行相应的控制。
如图3所示,为本发明一实施例的机械臂处于另一状态时自动充电系统的结构示意图。图4为图3中自动充电系统与汽车对接的结构示意图。
其中车辆600的一侧设置有充电接口601,并且车辆600中还设置有充电盖管理模块602。此处充电盖管理模块602可以是设置在电动汽车的整车控制系统中的,也可以是单独的充电盖管理设备。充电接口601和充电盖管理模块602在图中的位置仅为示意,在实际应用中不以此为限。充电盖管理模块可以控制充电接口601上的充电盖自动开启。
该实施例的自动充电系统还可以包括一个数据收发模块,数据收发模块用于与车辆600的充电盖管理模块602进行通信。控制器在充电开始前,可以先通过数据收发模块向充电盖管理模块602发送一个充电请求信号,充电盖管理模块602在接收到充电请求信号后控制车辆600的充电盖自动打开。此处充电盖自动打开的方式不限,例如充电盖上可以设置由气缸驱动的连杆结构,当气缸接收到打开信号时,驱动连杆向外伸出,将充电盖撑开。当充电完成后,控制器400将充电接头500收回后,还可以发送一个充电结束信号,充电盖管理模块602可以控制车辆600的气缸压缩,通过连杆将充电盖拉回。此处充电盖自动开闭的结构仅为示例,在实际应用中不以此为限,其他例如利用弹簧等部件的结构也是可以的,均属于本发明的保护范围之内。
通过采用充电盖自动开闭的结构,实现了完全自动化充电,用户将车辆600停靠在指定位置后,无需手动控制开启充电盖,即可以进行充电,进一步地,在充电完成后,充电盖也可以自动关闭,而无需充电人员手动关闭,进一步完善了自动充电系统的自动化流程。这对于分时租赁的电动汽车来说尤为有利,用户使用完毕电动汽车需要还车时,只需要将车辆600停放在指定位置即可离开。自动充电系统会自行为电动汽车充电,充电完成后,控制器400进一步可以控制机械臂100移动返回初始位置。用户还车时也就不用再手动将充电接头500插入到充电接口601,极大地方便了用户的使用。
进一步地,该实施例的自动充电系统还可以包括车辆检测模块402,车辆检测模块402用于检测在预设检测范围内是否有车辆600停靠,并将车辆检测结果发送至控制器400;控制器400获取车辆检测结果,如果车辆检测模块402检测到有车辆600停靠,则控制器400启动充电步骤;如果车辆检测模块402未检测到有车辆停靠,则控制器400不启动充电步骤。即只有当车辆检测模块402检测到有车辆600停靠时,才启动视觉识别模块200进行图像采集,并且控制机械臂100移动进行充电,当车辆检测模块402未检测到车辆停靠时,自动充电系统进入休眠状态,即视觉识别模块200不再进行图像采集,机械臂100保持在初始位置,充电装置300也并未开启,这样可以节省资源,避免执行不必要的动作造成资源浪费。
进一步地,车辆检测模块402可以包括激光收发器、电磁波收发器、超声波收发器、红外收发器或蓝牙收发器。例如,车辆检测模块402采用激光收发器时,可以在图4中两条虚线范围内定时发射激光,判断接收到的反射的激光的情况,以此来判断预设检测范围内是否有车辆停靠。或者车辆检测模块402可以采用红外收发器或蓝牙收发器,与车辆进行通信,接收到车辆的反馈信息后,确定预设检测范围内有车辆停靠等等。此处仅为几种方式的列举,在实际应用中,采用其他类型的车辆检测模块也是可以的,均属于本发明的保护范围之内。
进一步地,充电接头500的端面可以设置有至少一力传感器,力传感器采集充电接头的端面处的力数据,并将采集的力数据发送至控制器400,控制器400根据力数据,判断充电接头500是否插入充电接口601。即当充电接头500插入到充电接口601中时,充电接头500会受到来自该充电接口601的力(压力或拉力),当力传感器检测到力数据时,则判断充电接头500已经插入到了充电接口601中,控制器400可以控制充电装置300开启充电功能。
进一步地,在充电接头500插入到充电接口601中时,可能会存在姿态不正的情况。充电接头500的端面可以设置有多个力传感器,控制器400根据各个力传感器的力数据与预设压力限值的比较结果,调整充电接头500在充电接口601中的插入姿态。
具体地,控制器400比较各个力传感器的力数据与预设压力限值,如果存在力数据大于预设压力限值的过压力传感器,则设定调整方向为从过压力传感器指向力数据小于预设压力限值的力传感器,并控制机械臂100的活动端101沿该调整方向移动,以使得各个力传感器受到的压力相对均匀分布,避免因为某个位置压力过大而损坏充电接头500或充电接口601。优选地,各个力传感器可以均匀分布在充电接头500的端面上。另外,也可以直接根据各个力传感器的力数据的检测情况调整充电接头500的插入姿态,例如,有一部分力传感器检测到力数据,而另一部分力传感器则检测不到力数据,说明充电接头500也存在歪斜的情况,可以将充电接头500的插入姿态进行调整,使得各个力传感器均能够检测到力数据。
可选地,机械臂100为多关节机械臂,机械臂100的活动端101的关节延伸方向优选平行于或垂直于充电接头500的延伸方向;充电线缆沿多关节机械臂的一侧延伸设置。这样通过控制机械臂100的活动端101的关节延伸方向,即可以控制充电接头500的延伸方向。另外,机械臂100的活动端101的关节延伸方向也可以与充电接头500具有一定的已知角度,这样可以根据该已知角度控制充电接头500的延伸方向。双目视觉识别模块201设置在机械臂100的活动端101的侧面,且视觉识别模块201和充电接头500的端部之间的距离大于充电接口601的深度。从而保证在充电接头500插入到充电接口601中时不至于受到视觉识别模块201的阻挡,即使充电接头500完全插入到充电接口601中,充电接口位姿识别设备200也是露在外部的。
此处多关节机械臂优选为六轴联动机械臂,具有较高的自由度,可以很好地模拟手臂的动作,实现机械臂的活动端位置的灵活控制。但实际应用中,采用五轴联动机械臂、三轴联动机械臂等均是可以的,均属于本发明的保护范围之内。
在本发明其他的实施例中,充电接口位姿识别模块200还可以采用其他实施方式,例如充电接口位姿识别模块200包括一个摄像头,该摄像头在两个距离较近的位置处均采集一个图像,所述充电接口位姿识别模块200获取该摄像头于两个位置分别采集的图像,根据两次采集的图像和两个位置之间的距离,计算充电接口的六维空间坐标;或者充电接口位姿识别模块200包括一个摄像头,充电接口位姿识别模块200获取该摄像头采集的图像,识别该摄像头采集的图像中充电接口的特征区域的图像,将识别到的特征区域的图像与预存的充电接口的特征区域标准图像进行对比,依据图像近大远小、近宽远窄的原理,根据两个图像特征部分的比例关系和角度偏移,确定所述充电接口600的空间位姿。另外,充电接口位姿识别模块200还可以采用激光测距方式、红外测距方式、超声波测距方式、射频测距方式、UWB(Ultra Wideband,超宽带)测距方式等等,其具体测距方式会在下文进行进一步介绍。
如图5所示,本发明实施例还提供一种自动充电方法,采用所述的自动充电系统,该方法包括如下步骤:
S1:充电接口位姿识别模块识别车辆的充电接口的空间位姿;
S2:控制器获取所述充电接口位姿识别模块识别到的充电接口的空间位姿;
S3:控制器根据充电接口的空间位姿控制机械臂的活动端移动,以使得充电接头插入充电接口;
S4:控制器控制充电装置为车辆充电。
在本发明实施例中,以双目视觉识别为例来介绍自动充电方法,但本发明的技术方案不限于此,下文会就其他方式进行介绍。
在该实施例中,采用双目视觉识别模块201采集两个摄像头的拍摄图像,首先在采集图像中识别出来充电接口,可以采用多种方式,例如识别充电接口的整体图形,识别充电接口中的特征点,识别充电接口中的特征区域等等。控制器中可以存储有充电接口的至少一个特征点的预设特征点信息。在实际应用中,特征点可以有很多个,具体可以分布在几个特征区域中,每个特征区域中集中有多个特征点,通过特征区域的识别实现充电接口的识别,也可以通过几个单独的特征点,来实现整个充电接口表面的识别。在该实施例中,以几个单独的特征点为例进行说明,但本发明的实现方式不限于此。
本发明的视觉识别模块采用双目识别机制,不仅可以获取充电接口在采集图像中的位置,还可以获取充电接口与摄像头之间的距离信息。即可以通过两个摄像头的两维图像得到一个特征点的三维信息。
在实际应用中,特征区域的实现可以通过特征区域中多个特征点的识别来实现。如图6所示,控制器根据如下步骤识别充电接口的空间位姿:
S100:预存充电接口表面的至少一个特征点的预设特征点信息;此处特征点信息可以是指特征点的特殊的颜色、形状、图案、颜色和形状组合等信息,用以区分特征点的图像与特征点周围的图像;
S200:根据充电接口的预设特征点信息识别采集图像中的特征点;
S300:计算识别到的特征点的三维坐标;
S400:根据多个特征点的三维坐标确定充电接口的空间位姿,即上文所述的特征区域的六维坐标:除了三维坐标(x、y、z轴的坐标),还有特征区域的表面分别相对于x、y、z轴的旋转角位移。
根据摄像头的个数,计算机视觉一般可以分为单目视觉识别和双目视觉识别。单目视觉识别只能通过一个摄像头来获取外界的视觉信息,方式简单,但是只能获得目标的二维空间信息。而双目视觉识别则可以具备获取三维空间信息的能力。
如图7所示,为该实施例的双目视觉识别模块对特征点的三维重建模型的示意图。其中左边和右边的摄像头分别可以获取一个采集图像,在采集图像中分别可以识别到对应的特征点P1和P2(此处仅为举例,实际应用中,特征点可以为一个或多个),并且每个摄像头分别具有一个以O1和O2为坐标原点的坐标系,每个摄像头可以根据自身的坐标系确定对应的特征点P1和P2的二维坐标,但无法获取特征点的三维坐标。将两个摄像头结合起来时,可以得到特征点P实际上是位于O1P1和O2P2两条直线的交点,也就可以唯一确定特征点P的三维位置。
在实际应用中,可以在双目视觉识别模块中设定一个参考三维坐标系(一般采用左边摄像头的坐标系,但不限于此),然后通过结合分析两个摄像头的采集图像,可以计算得到特征点P的三维坐标。
如图8所示,控制器根据如下步骤控制机械臂的移动:
S501:控制机械臂的活动端执行初始化运动,该初始化运动是系统预设的,即一开始获取到的参数较少,可能并不足以确定机械臂的活动端如何运动,则将其执行一个初始化运动,获取到更多的参数再规划移动路线;
S502:计算并比较机械臂的活动端在初始化运动之前和之后,充电接口的空间位姿,根据比较结果选择下一步运动方向;
例如,在初始化运动后,机械臂的活动端更加靠近充电接口了,则可以继续选择初始化运动的方向,如果在初始化运动后,机械臂的活动端反而远离充电接口了,则需要选择与初始化运动背离的方向,并且可以进一步根据充电接口的空间位姿的改变进行角度的调整。
S503:根据下一步运动方向控制机械臂的活动端移动;
S504:当满足预设方向调整条件时,识别当前充电接口的空间位姿;
S505:比较当前充电接口的空间坐标和前一次识别的充电接口的空间位姿,根据比较结果更新下一步运动方向。
如图9所示,为该实施例中机械臂的活动端的移动方式的示意图。在该实施例中,充电接头500设置于机械臂的活动端101,机械臂的活动端101在朝向充电接口601的移动过程中,运动方向是可以根据设定条件进行调整的。例如在从位置S1移动至位置S2时,沿与水平方向成A1角的运动方向运动,在到达位置S2时,比较位置S2与位置S1处获得的采集图像中,充电接口的空间坐标,进一步调整了机械臂的活动端101的运动方向,即相对于原运动方向调整了A2角度,沿调整后的运动方向移动至位置S3,可以看出,调整后的运动方向有利于充电接头500更快更准确地向充电接口601移动靠近。
其中,预先设定的初始化运动可以包括控制机械臂的活动端沿一预设参考方向移动预设间隔时间或移动预设间隔距离。该预设参考方向的指向可以根据需要进行设置。预设间隔时间和预设间隔距离也可以根据需要进行设置,优选设置为较小的值,即使得机械臂的活动端相对移动一小段距离,避免车辆停靠太近,在初始化运动时机械臂的活动端即碰到车辆或其他障碍物。
进一步地,控制器根据如下步骤更新下一步运动方向:
每隔预设间隔时间或预设间隔距离重新获取采集图像并识别图像中充电接口的空间位姿;
比较当前充电接口的空间位姿和前一次识别的充电接口的空间位姿,根据比较结果更新下一步运动方向。
如图10所示,为该实施例中以时间为单位规划机械臂的活动端的移动路线的流程图。控制器根据如下步骤规划机械臂的活动端的移动路线:
S511:控制机械臂的活动端向一预设参考方向移动预设间隔时间;
S512:比较在机械臂的活动端移动前和移动后,采集的图像中的充电接口的空间位姿,根据比较结果选择下一时刻运动方向;
S513:根据下一时刻运动方向控制机械臂的活动端移动;
S514:每隔预设间隔时间重新识别采集的图像中充电接口的空间位姿,根据当前充电接口的空间位姿更新下一时刻运动方向。
以时间为单位规划机械臂的活动端的移动路线,将预设间隔时间设置得很短时,也就实现了机械臂的活动端移动路线的实时调整,例如每隔1s(不以此为限)重新更新一次下一时刻运动方向,快速运算,再执行下一步移动。
如图11所示,为该实施例中以距离为单位规划机械臂的活动端的移动路线的流程图。控制器根据如下步骤规划机械臂的活动端的移动路线:
S521:控制机械臂的活动端向一预设参考方向移动预设间隔距离;
S522:比较在机械臂的活动端移动前和移动后,采集的图像中的充电接口的空间位姿,根据比较结果选择下一位置运动方向;
S523:根据下一位置运动方向控制机械臂的活动端移动;
S524:每隔预设间隔距离重新计算采集的图像中充电接口的空间位姿,根据当前充电接口的空间位姿更新下一位置运动方向。
以距离为单位规划机械臂的活动端的移动路线时,即每当机械臂的活动端沿当前运动方向移动了预设间隔距离时,即重新计算特征点的三维坐标并更新运动方向,预设间隔距离值的大小可以用来调整控制精度,例如预设间隔距离值较大时,每个运动方向的更新可能间隔较长,移动路线可能无法实现最优,但是可以简化算法,预设间隔距离值较小时,每个运动方向的更新间隔较短,则可以优化移动路线,使移动路线接近于最优路线,但是算法较为复杂。同样地,预设间隔时间的长短也可以用来调整控制精度。可以根据实际需要选择采用时间为单位或以距离为单位,并根据需要选择预设间隔时间的长短或预设间隔距离的大小。
如图12所示,在机械臂的活动端的移动路线规划时,还可以采用根据节点调整的方式。具体地,初始化运动可以包括如下步骤:
S531:在机械臂的活动端和充电接口之间设置多个节点,节点的设置方式有很多种,例如在该实施例中,各个节点之间沿一预设参考方向的距离等于一预设间隔距离,或者是将机械臂的活动端和充电接口之间的距离平分成多份,每份关联一个节点等等;此处预设参考方向可以根据实际需要进行设置,例如平行于地面或垂直于充电接口的表面的方向等等;
S532:控制机械臂的活动端沿一预设参考方向移动至距离当前位置最近的节点;
初始化运动后,控制器执行步骤S533:计算并比较机械臂的活动端在初始化运动之前和之后,充电接口的空间位姿,根据比较结果选择下一步运动方向和步骤S534:根据下一步运动方向控制机械臂的活动端移动至下一个节点;
在此基础上,控制器根据如下步骤更新下一步运动方向:
S535:在机械臂的活动端运动的过程中,每到一个节点重新获取采集图像并计算采集图像中充电接口的空间位姿;
S536:比较当前节点充电接口的空间位姿和前一节点充电接口的空间位姿,根据比较结果更新下一步运动方向。
在实际应用中,为了简便算法,可以只设置两个节点:一个初始化运动节点,一个安全位置节点,在控制器中预存安全位置的信息,机械臂的活动端的运动可以包括三步:
机械臂的活动端执行所述初始化运动移动至预设的初始化运动节点,摄像头采集图像,进一步确定充电接口的空间位姿,确定机械臂的活动端的下一步运动方向;
机械臂的活动端移动至预设的安全位置时,控制摄像头重新采集图像,进一步确定充电接口的空间位姿,重新更新下一步运动方向;
根据更新后的下一步运动方向,控制机械臂的活动端移动以使得充电接头插入到充电接口中。
预设的安全位置往往是机械臂的活动端距离充电接口较近的位置,为了确保插入姿态的准确,可以重新进行一次计算。此处仅为一种优选的实施方式,在实际应用中,节点的数量和位置可以根据实际需要进行设置。
进一步地,在实际应用中,车辆的充电接口表面往往是一个斜面,而不是一个垂直于地面的平面,因此为了保证充电接头和充电接口的良好对接,本发明实施例还提供了一种充电接头垂直对准充电接口的方式,以保证充电接头在插入到充电接口中时,充电接头是垂直于充电接口表面插入的,保证充电接头的姿态,而不会因为充电接头歪斜而造成意外事故或损伤。
如图13所示,控制器规划机械臂的活动端的移动路线时,还执行充电接头垂直对准充电接口的步骤,例如可以根据充电接口表面的六维坐标确定充电接口在空间中的旋转向量,借此调整充电接头的插入角度;
具体地,充电接头垂直对准充电接口,包括如下步骤:
S541:预存充电接口表面上多个特征点的预设特征点信息,多个特征点至少包括不在同一条直线上的三个特征点,即通过多个特征点即可以确定充电接口表面的平面,在实际应用中,特征点可以为很多个,分布在充电接口的表面,也可以集中在充电接口表面的某个特征区域,通过该特征区域即可以确定充电接口;
S542:识别采集图像中的多个特征点后,根据多个特征点的三维坐标确定充电接口的表面延伸方向;
S543:判断充电接口表面相对于至少一个预设参考面的倾斜角度,一般为了精确表达充电接口表面的倾斜方向,需要判断充电接口表面相对于三个相互垂直的预设参考面的倾斜角度;预设参考面例如可以是x轴和y轴组成的平面,y轴和z轴组成的平面或x轴和z轴组成的平面。
S543:根据充电接口表面的倾斜角度调整机械臂的活动端的倾斜角度,使充电接头垂直对准充电接口。
如上所述,机械臂可选为多关节机械臂,例如六轴联动机械臂、五轴联动机械臂、三轴联动机械臂等等,关节越多,机械臂的灵活性越好,充电接头的延伸方向平行于机械臂的活动端的关节延伸方向,一般是指机械臂的末端的关节延伸方向。这样通过控制机械臂的活动端的倾斜角度即可以控制充电接头的倾斜角度。但不限于此,在实际应用中,如果充电接头和机械臂的活动端的关节延伸方向成一定角度,则在调整机械臂的活动端时,考虑到这个角度即可,保证充电接头可以垂直对准充电接口,而机械臂的活动端则不一定要垂直对准充电接口。
如图14所示,为根据充电接口表面的倾斜角度调整机械臂的活动端的倾斜角度的示意图。当确定充电接口的表面延伸方向时,可以确定充电接口表面相对于一预设参考面M的倾斜角度为B1。此时为了使得充电接头500垂直对准充电接口601,控制机械臂的活动端101旋转一个倾斜角度B2,即机械臂的活动端101和充电接头500从实线示出的位置旋转到虚线示出的位置,可以保证充电接头500插入充电接口601时的姿态准确。
进一步地,步骤S541中,所述多个特征点可以有多种设置方式,例如图15中示出了两种充电接头的特征点的分布结构。如图所示,可以设置四个特征点H1、H2、H3、H4,分别位于充电接口601的四个角上,形成一个矩形,且矩形的中心H5为充电接口601的中心。根据四个特征点不仅可以确定充电接口的位置和平面延伸方向,还可以确定充电接口的中心位置。另外,也可以选择其他的组合,例如选择三个特征点H1、H2、H5,或选择三个特征点H1、H4、H5等等,均是可以的,甚至可以直接选择五个特征点H1~H5,或另外增加其他的特征点。另外,也可以设置三个特征点K1、K2、K3,其组成一个三角形,充电接口601的中心可以跟该三角形的重心、垂心、内心或外心等重合,以能够根据三角形的位置确定充电接口601的中心。
图15仅示出了两种可选的实施方式,在实际应用中,多个特征点的排布和组合可以根据实际需要进行调整,均属于本发明的保护范围之内。
另外,特征区域也可以选择为充电接口上一个很小的区域,通过该特征区域即可以引申至充电接口整个表面的空间姿态。如图16所示,为该实施例的摄像头的摄像范围的示意图,其中示出了充电接口601的基本结构。特征区域可以选择充电接口601上一个很小的区域,例如,左上角的区域、中间一定范围的区域、右上角的区域等等。
进一步地,本发明的充电接口识别和定位方法还可以包括如下步骤:
预存多个距离区段信息,各个距离区段信息包括各个距离区段所对应的机械臂的活动端相对于充电接口的距离范围和该距离区段所对应的机械臂移动速度,与充电接口距离越近的距离区段所对应的机械臂移动速度越小;
判断当前机械臂的活动端所处的距离区段,将该距离区段对应的机械臂移动速度作为当前机械臂的活动端的移动速度。
如图17和图18是该实施例中机械臂的活动端移动的距离区段的两种设置方式的示意图。
图17中,机械臂的活动端相对于充电接口的距离为沿一预设参考方向的距离,在图中示出的例子中,为沿水平方向的距离,在实际应用中,还可以设置为垂直于充电接口表面的方向等等。图17中示例性地示出了三个距离区段T1、T2、T3,其中距离区段T1的速度小于距离区段T2的速度,距离区段T2的速度小于距离区段T3的速度。即在距离充电接口越远的地方,机械臂的活动端移动速度可以快一些,以尽快接近充电接口;到靠近充电接口时,则要尽量减慢速度,避免速度过快与车辆碰到。
图18中,机械臂的活动端相对于充电接口的距离为机械臂的活动端到充电接口的中心的直线距离。图18中示例性地示出了三个距离区段R1、R2、R3,同样地,距离区段R1的速度小于距离区段R2的速度,距离区段R2的速度小于距离区段R3的速度。
进一步地,还可以在两个摄像头的中间设置一个闪光灯,用于光线暗弱的时候,进行补光;闪光灯的开启方式可以有两种,当双目视觉识别模块的采光率低于预设采光率阈值时开启闪光灯,或启动双目视觉识别模块进行图像采集时,开启闪光灯。闪光灯的位置也可以有很多种,例如设置在控制箱的表面的其他位置,只要摄像头位于闪光灯的光辐射范围内即可,而不限于设置于两个摄像头之间。
进一步地,本发明的自动充电系统还可以包括声音提示模块和/或指示灯,控制器控制声音提示模块播放预设提示语音,控制器控制指示灯显示充电状态。例如,在充电开始前,控制器控制声音提示模块播放提示语音,提醒用户马上要开始进行充电,如果没有打开充电盖,请打开充电盖,当充电接头插入充电接口后,指示灯显示红灯,表示正在充电,充电完成后,指示灯可以变成绿灯,表示充电完成,声音提示模块可以播放提示语音,提醒用户已经充电完成,车辆可以继续使用。
如上所述,充电接口位姿识别模块200还可以采用激光测距方式、红外测距方式、超声波测距方式、射频测距方式、UWB(Ultra Wideband,超宽带)测距方式等等。具体地,可以采用下面两种方式:
(1)充电接口位姿识别模块200包括一信号收发设备,该信号收发设备向一预设检测区域内发送检测信号,并接收检测信号在所述充电接口处的反射检测信号;
充电接口位姿识别模块200根据该信号收发设备接收到的反射检测信号确定充电接口的空间位姿。
采用这种方式时,信号收发设备可以包括激光收发设备、超声波收发设备和红外收发设备中的至少一种。
(2)充电接口位姿识别模块200包括一信号接收设备,充电接口601处设置有至少一信号发生器,该信号接收设备接收由信号发生器发出的信号;
充电接口位姿识别模块200根据信号接收设备接收到的信号确定充电接口的空间位姿。
采用这种方式时,信号发生器可以为激光发射器、超声波发射器、红外发射器、射频电子标签和UWB电子标签中的至少一种,对应的信号接收设备可以为激光接收器、超声波接收器、红外接收器、射频信号接收器和UWB接收器中的至少一种。
如图19所示是本发明一具体实施例中,采用控制器控制机械臂的活动端移动的流程图。此处图19中示出的仅为一个示例,在实际应用中,可以根据需要进行步骤的选择和调整,而不以此为限。图中示出的控制器根据如下步骤控制机械臂的活动端移动:
控制机械臂的活动端向一预设参考方向移动预设间隔时间/距离;
比较在机械臂的活动端移动前和移动后,充电接口的空间位姿,根据比较结果选择下一步运动方向;
判断机械臂的活动端与充电接口的距离位于哪个距离区段,选择该距离区段对应的速度;
判断机械臂的活动端与充电接口的距离是否小于预设安全距离;
如果是,则判断充电接口表面与预设参考面的倾斜程度,如果否,则机械臂的活动端沿下一步运动方向移动预设间隔时间/距离至与充电接口的距离小于预设安全距离为止;
根据充电接口表面的倾斜角度调整机械臂的第一端的倾斜角度,以使充电接头垂直对准充电接口。
此处仅为一个可选的实施方式,在实际应用中,充电接头角度的调整可以是跟随运动方向的调整一致的,即每次重新识别充电接口表面的空间位姿时,即调整充电接头的角度至垂直于充电接口。
如图20所示,为本发明一具体实施例中自动充电方法的流程图。图中示出的仅为一种具体的优选实施方式,在实际应用中不限于此。该自动充电方法包括如下步骤:
车辆检测模块检测预设检测区域内是否有车辆停靠;
如果是,则控制器向车辆发送充电请求信号,否则等待下一次车辆检测,可以是每间隔一段固定时间检测一次,检测到有车辆停靠为止;
车辆的充电盖管理模块在接收到充电请求信号后,会控制充电盖自动打开;
双目视觉识别模块获取两个摄像头的采集图像;
控制器分析采集图像,并控制机械臂的活动端移动,以使得充电接头插入充电接口;
充电接头插入充电接口后,控制器控制双目视觉识别模块停止采集图像,并且通知充电装置,充电装置开启充电功能,开始对车辆充电;
充电完成后,控制器控制机械臂的活动端移动,拔出充电接头;
控制器向车辆发送充电完成信号,车辆的充电盖管理模块在接收到充电完成信号后,控制自动关闭充电盖。
如图21~22所示,进一步地,还可以在本发明的自动充电系统的底部设置移动小车,使得整个自动充电系统可以在不同状态下自行移动。该移动小车可以是传送带或者移动轮700,传送带或者移动轮700可以由至少一个驱动电机驱动,控制器400可以控制驱动电机正转或反转以控制传送带或者移动轮700的运动方向。控制器400还可以进一步控制驱动电机的转动速度来控制自动充电系统移动的速度。
在增加了本实施例的移动小车后,车辆停靠时可以不用停靠在具体的设定区域中,车辆停靠在某一位置后,车辆检测模块402可以检测到车辆的位置,通过移动小车移动自动充电系统先靠近车辆,然后再通过控制器400控制充电接头500插入充电接口601中,再进行充电。从而使得车辆的自动充电过程更加灵活,避免在车辆停靠距离太远时,机械臂的活动端无法抵达充电接口,更加方便用户的使用。
进一步地,还可以在自动充电系统的侧面设置至少一个防撞条或至少一个撞击传感器,所述撞击传感器可以与控制器进行通信。防撞条可以采用具有一定的材料制成,在移动小车控制自动充电系统移动时,如果遇到障碍物,可以缓冲一定的撞击力,撞击传感器在遇到障碍物时,可以将检测信号发送至控制器中。
进一步地,机械臂的活动端101与充电接头500之间还可以有一个机械抓手,即充电接头500可以不是固定在机械臂的活动端101的。在使用过程中,机械臂的活动端101可以先移动至充电接头500所在的位置,通过机械抓手抓取充电接头500,再通过控制器400的引导将充电接头500插入到充电接口601中。采用该种方式,可以不用对现有的充电枪进行改造,直接用机械臂的活动端101的机械抓手去抓取充电枪即可,也是一种可行的实施方式。
本发明所提供的自动充电系统及方法具有下列优点:
本发明提供了一种全自动电动汽车充电的系统及方法,在车辆停放后,可以通过充电接口位姿识别模块识别充电接口的空间位姿,由控制器根据充电接口的空间位姿控制机械臂移动靠近充电接口,从而控制充电接头自动插入充电接口,然后控制充电装置对电动汽车进行充电;极大地提高了电动汽车尤其是租赁用电动汽车的用车体验和操作安全性;解决了用户遗忘充电导致车辆缺电的问题,尤其提高租赁用电动汽车的使用率;电动汽车自动充电可与其他自动化设施相结合,例如自动泊车、自动清洁等,形成完善的电动汽车自动化服务体系,充分实现智能化;全程无人参与,降低维护成本。
以上内容是结合具体的优选实施方式对本发明所作的进一步详细说明,不能认定本发明的具体实施只局限于这些说明。对于本发明所属技术领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干简单推演或替换,都应当视为属于本发明的保护范围。
Claims (21)
1.一种自动充电系统,其特征在于,包括:
机械臂,所述机械臂包括一活动端和一固定端,所述机械臂的活动端设置有一充电接头,且所述机械臂的活动端相对于所述机械臂的固定端可移动;
充电接口位姿识别模块,设置于所述机械臂的活动端,所述充电接口位姿识别模块用于识别车辆的充电接口的空间位姿;
充电装置,所述充电装置通过充电线缆与所述充电接头电连接,所述充电装置用于当所述充电接头插入所述充电接口中时,为车辆充电;
控制器,用于执行如下充电步骤:
获取所述充电接口位姿识别模块识别到的充电接口的空间位姿;
根据所述充电接口的空间位姿控制所述机械臂的活动端移动,以使得所述充电接头插入所述充电接口;
控制所述充电装置为所述车辆充电;
所述充电接头的端面设置有多个力传感器,所述力传感器采集所述充电接头的端面处的力数据,并将采集的力数据发送至所述控制器,所述控制器根据所述力数据,判断所述充电接头是否插入所述充电接口和调整所述充电接头在所述充电接口中的插入姿态,所述控制器还用于比较各个所述力传感器的力数据与预设力限值,如果存在力数据大于预设力限值的过压力传感器,则设定调整方向为从过压力传感器指向力数据小于预设压力限值的力传感器,并控制所述机械臂的活动端沿所述调整方向移动;
所述控制器根据如下步骤控制所述机械臂的活动端移动:
控制所述机械臂的活动端执行初始化运动;
计算并比较所述机械臂的活动端在初始化运动之前和之后,充电接口的空间位姿,根据比较结果选择下一步运动方向;
根据下一步运动方向控制所述机械臂的活动端移动;
当满足预设方向调整条件时,计算当前充电接口的空间位姿;
比较当前充电接口的空间位姿和前一次计算的充电接口的空间位姿,根据比较结果更新下一步运动方向;
所述控制器中存储一预设安全位置的信息,在所述机械臂的活动端和所述充电接口之间仅设置两个节点:一个初始化运动节点,一个安全位置节点;
所述控制器根据如下步骤更新下一步运动方向:
所述机械臂的活动端运动至预设安全位置时,计算当前充电接口的空间位姿;
比较当前充电接口的空间位姿和前一次计算的特征点的空间位姿,根据比较结果更新下一步运动方向;
根据更新后的下一步运动方向,控制所述机械臂的活动端运动使得所述充电接头插入所述充电接口。
2.根据权利要求1所述的自动充电系统,其特征在于,所述充电接口位姿识别模块中预存所述充电接口的特征区域的特征信息;所述充电接口位姿识别模块包括两个摄像头,所述充电接口位姿识别模块获取所述两个摄像头采集的图像,识别采集的图像中的充电接口的特征区域,并计算所述充电接口的特征区域的六维空间坐标,所述六维空间坐标包括所述特征区域分别在x轴、y轴、z轴方向的线位移和所述特征区域分别相对于x轴、y轴、z轴方向的角位移。
3.根据权利要求1所述的自动充电系统,其特征在于,所述充电接口位姿识别模块中预存所述充电接口的特征区域的标准图像;所述充电接口位姿识别模块包括一个摄像头,所述充电接口位姿识别模块获取所述摄像头采集的图像,将所述摄像头采集的图像与预存的充电接口的特征区域标准图像进行对比,确定所述充电接口的空间位姿。
4.根据权利要求1所述的自动充电系统,其特征在于,所述充电接口位姿识别模块中预存所述充电接口的特征区域的特征信息;所述充电接口位姿识别模块包括一个摄像头,所述充电接口位姿识别模块获取所述摄像头于两个位置分别采集的图像,根据两次采集的图像和两个位置之间的位置关系,计算所述充电接口的六维空间坐标,所述六维空间坐标包括所述充电接口的特征区域分别在x轴、y轴、z轴方向的线位移和所述特征区域的平面分别相对于x轴、y轴、z轴方向的角位移。
5.根据权利要求2至4中任一项所述的自动充电系统,其特征在于,所述机械臂的活动端还设置有一闪光灯,所述摄像头的采光率低于预设采光率阈值时,所述控制器开启所述闪光灯,或所述摄像头开启图像采集时,开启所述闪光灯。
6.根据权利要求1所述的自动充电系统,其特征在于,所述初始化运动包括控制所述机械臂的活动端沿一预设参考方向移动预设间隔时间或移动预设间隔距离;
所述控制器根据如下步骤更新下一步运动方向:
所述机械臂的活动端的运动过程中,每隔预设间隔时间或预设间隔距离,所述充电接口位姿识别模块重新识别充电接口的空间位姿;
比较当前充电接口的空间位姿和前一次识别的充电接口的空间位姿,根据比较结果更新下一步运动方向。
7.根据权利要求1所述的自动充电系统,其特征在于,所述充电接口的空间位姿包括所述充电接口的特征区域的六维空间坐标,所述六维空间坐标包括所述特征区域分别在x轴、y轴、z轴方向的线位移和所述特征区域分别相对于x轴、y轴、z轴方向的角位移;
所述控制器控制所述机械臂的活动端移动时,还执行充电接头垂直对准所述充电接口的步骤;
所述充电接头垂直对准所述充电接口,包括如下步骤:
根据所述特征区域的六维空间坐标确定所述特征区域的表面相对于预设参考面的倾斜角度;
根据所述特征区域的倾斜角度调整所述机械臂的活动端的倾斜角度,使所述充电接头垂直对准所述充电接口。
8.根据权利要求1所述的自动充电系统,其特征在于,还包括车辆检测模块,所述车辆检测模块用于检测在预设检测范围内是否有车辆停靠,并将车辆检测结果发送至所述控制器;
所述控制器获取所述车辆检测结果,如果所述车辆检测模块检测到有车辆停靠,则所述控制器启动所述充电步骤;如果所述车辆检测模块未检测到有车辆停靠,则所述控制器不启动所述充电步骤。
9.根据权利要求8所述的自动充电系统,其特征在于,所述车辆检测模块包括激光收发器、摄像头、电磁波收发器、超声波收发器、红外收发器和蓝牙收发器之中的至少一种。
10.根据权利要求1所述的自动充电系统,其特征在于,还包括数据收发模块,所述数据收发模块用于与车辆的充电盖管理模块进行通信;
所述控制器通过所述数据收发模块向所述车辆的充电盖管理模块发送充电请求信号,所述车辆的充电盖管理模块在接收到充电请求信号后控制车辆的充电盖打开。
11.根据权利要求1所述的自动充电系统,其特征在于,所述机械臂为多关节机械臂,所述机械臂的活动端的关节延伸方向平行于或垂直于所述充电接头的延伸方向,所述充电接口位姿识别模块位于所述机械臂的活动端的一侧面,且所述充电接口位姿识别模块与所述充电接头的末端的距离大于所述充电接口的深度;所述充电线缆沿所述多关节机械臂的一侧延伸设置。
12.根据权利要求1所述的自动充电系统,其特征在于,所述自动充电系统的底部还设置有至少一个移动轮或传动带,所述移动轮或传送带由一个或多个驱动电机驱动转动,所述驱动电机由所述控制器控制。
13.根据权利要求1所述的自动充电系统,其特征在于,所述自动充电系统的侧面还设置有至少一防撞条或至少一撞击传感器,所述撞击传感器与所述控制器进行连接。
14.根据权利要求1所述的自动充电系统,其特征在于,所述充电接口位姿识别模块包括信号收发设备,所述信号收发设备向预设检测区域内发送检测信号,并接收所述检测信号在所述充电接口处的反射检测信号;
所述充电接口位姿识别模块根据所述信号收发设备接收到的反射检测信号确定所述充电接口的空间位姿。
15.根据权利要求14所述的自动充电系统,其特征在于,所述信号收发设备包括激光收发设备、超声波收发设备和红外收发设备中的至少一种。
16.根据权利要求1所述的自动充电系统,其特征在于,所述充电接口位姿识别模块包括信号接收设备,所述充电接口处设置有至少一信号发生器,所述信号接收设备接收所述信号发生器发出的信号;
所述充电接口位姿识别模块根据所述信号接收设备接收到的信号确定所述充电接口的空间位姿。
17.根据权利要求16所述的自动充电系统,其特征在于,所述信号发生器为激光发射器、超声波发射器、红外发射器、射频电子标签和UWB电子标签中的至少一种。
18.根据权利要求1所述的自动充电系统,其特征在于,还包括声音提示模块和/或指示灯,所述控制器控制所述声音提示模块播放预设提示语音,所述控制器控制所述指示灯显示充电状态。
19.根据权利要求1所述的自动充电系统,其特征在于,所述机械臂的活动端还设置有一机械抓手,所述机械抓手与所述控制器进行通信,所述机械臂的活动端通过所述机械抓手与所述充电接头相连接。
20.根据权利要求1所述的自动充电系统,其特征在于,所述控制器还用于与外部终端进行通信,接收外部终端的指令对所述自动充电系统的执行动作进行控制。
21.一种自动充电方法,其特征在于,采用权利要求1至20中任一项所述的自动充电系统,所述方法包括如下步骤:
所述充电接口位姿识别模块识别车辆的充电接口的空间位姿;
所述控制器根据所述充电接口位姿识别模块识别到的充电接口的空间位姿控制所述机械臂的活动端移动,以使得所述充电接头插入所述充电接口;
所述控制器控制所述充电装置为所述车辆充电。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710978979.3A CN107618396B (zh) | 2017-10-19 | 2017-10-19 | 自动充电系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710978979.3A CN107618396B (zh) | 2017-10-19 | 2017-10-19 | 自动充电系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107618396A CN107618396A (zh) | 2018-01-23 |
CN107618396B true CN107618396B (zh) | 2023-11-07 |
Family
ID=61092051
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710978979.3A Active CN107618396B (zh) | 2017-10-19 | 2017-10-19 | 自动充电系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107618396B (zh) |
Families Citing this family (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108749592B (zh) * | 2018-03-22 | 2021-10-19 | 常熟共兴合创智能科技合伙企业(有限合伙) | 基于uwb定位的大巴车快速充电精确定位装置 |
CN108556664A (zh) * | 2018-04-25 | 2018-09-21 | 广州市君望机器人自动化有限公司 | 机械手控制方法及装置 |
CN108732572B (zh) * | 2018-05-24 | 2020-11-06 | 环球车享汽车租赁有限公司 | 超声波车辆位姿检测方法及系统 |
CN108891291B (zh) * | 2018-07-17 | 2021-11-05 | 江苏英能新能源科技有限公司 | 一种新能源汽车充电装置 |
CN108767933A (zh) * | 2018-07-30 | 2018-11-06 | 杭州迦智科技有限公司 | 一种用于充电的控制方法及其装置、存储介质和充电设备 |
CN109159688A (zh) * | 2018-09-05 | 2019-01-08 | 享奕自动化科技(上海)有限公司 | 线路隐藏式布置的自动充电装置及自动充电系统 |
CN109435730A (zh) * | 2018-11-09 | 2019-03-08 | 同济大学 | 一种基于仿蛇形机械臂的自动充电系统及方法 |
CN109591632A (zh) * | 2018-11-29 | 2019-04-09 | 上海上汽安悦充电科技有限公司 | 一种快充系统 |
CN109552091A (zh) * | 2018-11-29 | 2019-04-02 | 上海上汽安悦充电科技有限公司 | 一种机械传动系统 |
CN109318736A (zh) * | 2018-11-29 | 2019-02-12 | 上海上汽安悦充电科技有限公司 | 一种采用可升降托盘的充电连接器 |
CN114364569B (zh) * | 2019-05-31 | 2024-03-15 | Abb电动汽车有限责任公司 | 用于为电动车辆充电的装置和方法、以及用于校准为电动车辆充电的装置的方法 |
CN110254400A (zh) * | 2019-07-22 | 2019-09-20 | 海宁金豪机电有限公司 | 电池交换智能充电站 |
CN112406608B (zh) * | 2019-08-23 | 2022-06-21 | 国创移动能源创新中心(江苏)有限公司 | 充电桩及其自动充电装置和方法 |
DE102019126377A1 (de) * | 2019-09-30 | 2021-04-01 | Technische Universität Graz | Verfahren zum automatisierten Herstellen einer Steckverbindung zum Laden von Elektrofahrzeugen |
CN110920450A (zh) * | 2019-10-25 | 2020-03-27 | 北京华商三优新能源科技有限公司 | 一种电动汽车全自动充电系统 |
CN112060961A (zh) * | 2020-09-01 | 2020-12-11 | 国网天津市电力公司 | 一种自动充电站控制系统的控制方法 |
CN112248834A (zh) * | 2020-10-21 | 2021-01-22 | 北京理工大学 | 一种电动汽车充电装置与方法 |
CN113511087B (zh) * | 2021-06-30 | 2023-03-14 | 吴嘉毅 | 一种无人驾驶汽车自动化充电系统及充电对接方法 |
CN114441807B (zh) * | 2021-07-22 | 2023-07-07 | 荣耀终端有限公司 | 一种接线方法及系统 |
CN114194045B (zh) * | 2021-10-25 | 2022-11-01 | 东风汽车集团股份有限公司 | 车辆充电接口与外部充电接头的自动对准方法及系统 |
CN116278880A (zh) * | 2021-12-20 | 2023-06-23 | 华为技术有限公司 | 一种充电设备以及控制机械臂充电的方法 |
CN115610250B (zh) * | 2022-11-03 | 2024-09-27 | 北京华商三优新能源科技有限公司 | 一种自动充电设备控制方法及系统 |
CN115958599B (zh) * | 2022-12-27 | 2024-08-02 | 国广顺能(上海)能源科技有限公司 | 一种移动机器人系统和停靠位置获取方法 |
CN116620079A (zh) * | 2023-06-14 | 2023-08-22 | 北京博瑞智造科技有限公司 | 一种自动充电方法、装置、系统、可充电设备及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104241948A (zh) * | 2013-12-05 | 2014-12-24 | 齐向前 | 充电接口自动连接装置 |
CN105334850A (zh) * | 2014-08-07 | 2016-02-17 | 苏州宝时得电动工具有限公司 | 自动移动设备 |
CN106335381A (zh) * | 2015-07-06 | 2017-01-18 | 鸿富锦精密工业(深圳)有限公司 | 充电控制系统、充电设备及充电方法 |
CN106553195A (zh) * | 2016-11-25 | 2017-04-05 | 中国科学技术大学 | 工业机器人抓取过程中的物体6自由度定位方法及系统 |
CN106696747A (zh) * | 2017-01-22 | 2017-05-24 | 厦门大学 | 一种电动汽车自动充电系统及其控制方法 |
CN106740171A (zh) * | 2016-11-28 | 2017-05-31 | 德阳九鼎智远知识产权运营有限公司 | 一种新能源汽车充电枪 |
-
2017
- 2017-10-19 CN CN201710978979.3A patent/CN107618396B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104241948A (zh) * | 2013-12-05 | 2014-12-24 | 齐向前 | 充电接口自动连接装置 |
CN105334850A (zh) * | 2014-08-07 | 2016-02-17 | 苏州宝时得电动工具有限公司 | 自动移动设备 |
CN106335381A (zh) * | 2015-07-06 | 2017-01-18 | 鸿富锦精密工业(深圳)有限公司 | 充电控制系统、充电设备及充电方法 |
CN106553195A (zh) * | 2016-11-25 | 2017-04-05 | 中国科学技术大学 | 工业机器人抓取过程中的物体6自由度定位方法及系统 |
CN106740171A (zh) * | 2016-11-28 | 2017-05-31 | 德阳九鼎智远知识产权运营有限公司 | 一种新能源汽车充电枪 |
CN106696747A (zh) * | 2017-01-22 | 2017-05-24 | 厦门大学 | 一种电动汽车自动充电系统及其控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107618396A (zh) | 2018-01-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107618396B (zh) | 自动充电系统及方法 | |
KR102597830B1 (ko) | 전기차 충전 로봇 및 그 제어 방법 | |
CN107640055A (zh) | 自动充电系统及方法 | |
KR100854653B1 (ko) | 충전스테이션을 이용한 이동로봇의 위치 인식장치 | |
CN112248835B (zh) | 一种充电机械臂控制方法和系统 | |
CN103419944B (zh) | 一种登机桥及其自动靠接方法 | |
CN205736996U (zh) | 一种电动车自动充电机械臂 | |
CN105045268A (zh) | 一种agv激光磁带混合导航系统 | |
CN114670682B (zh) | 一种电动汽车充电枪及其使用方法和装置 | |
CN109094556B (zh) | 一种基于车位特征点的自动泊车方法及系统 | |
CN209776188U (zh) | 一种基于3d视觉技术的汽车无人充电系统 | |
US20190001831A1 (en) | Method for implementing power supply procedures from at least one power supply unit to a plurality of transportation vehicles to be supplied with power | |
WO2023025028A1 (zh) | 充电方法、充电装置及机器人 | |
CN107728621A (zh) | 充电接口识别和定位方法及系统 | |
CN109040677A (zh) | 园区安防预警防御系统 | |
CN109079795B (zh) | 具有视觉识别功能的巡检机器人 | |
EP3643454A1 (en) | Anti-collision method for robot | |
JP6987248B2 (ja) | 電動車両及びシステム | |
CN210133030U (zh) | 车辆自动充电设备以及移动充电小车 | |
CN111547047B (zh) | 一种平行车位自动泊车方法及装置 | |
KR102014338B1 (ko) | 전기차 충전 로봇, 로봇의 제어 방법 및 프로그램 | |
CN108175337B (zh) | 扫地机器人及其行走的方法 | |
CN207772911U (zh) | 充电接口识别和定位系统 | |
CN212133473U (zh) | 一种用于爆破工作的agv导航车 | |
CN208993511U (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 |