机械臂控制方法及控制系统与流程

摘要: 本公开涉及车辆,具体地,涉及一种机械臂控制方法及控制系统。背景技术:1、相关技术中,通过机械臂驱动充电枪移动,以实现电动汽车自动充电插枪,当充电枪插入充电口时,...
机械臂控制方法及控制系统与流程

本公开涉及车辆,具体地,涉及一种机械臂控制方法及控制系统。

背景技术:

1、相关技术中,通过机械臂驱动充电枪移动,以实现电动汽车自动充电插枪,当充电枪插入充电口时,如若车辆浮动,机械臂与车身产生刚性对抗力,此时充电装置和充电口可能会损坏。

技术实现思路

1、本公开的目的是提供一种机械臂控制方法及控制系统,该机械臂能够实现插拔枪过程中的零力顺应,减小刚性接触,保护充电口和充电装置,保证充电安全,以至少部分地解决上述技术问题。

2、为了实现上述目的,根据本公开的第一方面,提供一种机械臂控制方法,所述机械臂用于驱动充电枪向车辆充电口插枪和/或从所述充电口拔枪,所述方法包括:

3、确定所述机械臂处于力控模式且所述充电枪位于所述充电口内;

4、在获取到车身浮动事件的情况下,将所述机械臂从所述力控模式切换为零力模式,以便所述充电枪的位置能够随车身浮动变化。

5、可选地,所述方法还包括:

6、获取距离信息,所述距离信息指示所述机械臂末端或者所述充电枪与所述充电口的开口端之间的距离;

7、在所述距离信息小于或等于预设的距离阈值的情况下,确定所述充电枪位于所述充电口内。

8、可选地,所述获取到车身浮动事件包括以下任一者:

9、根据车辆状态信息预测到所述车辆的车身位置将产生浮动;

10、检测到所述车辆的车身位置产生浮动。

11、可选地,所述车辆状态信息包括车门状态标识位,所述根据车辆状态信息预测到所述车辆的车身位置将产生浮动,包括:

12、在所述车门状态标识位发生变化时,确定所述车辆的车身位置将产生浮动。

13、可选地,所述将所述机械臂从所述力控模式切换为零力模式,包括:

14、将所述机械臂各关节的输出刚度设置为零,使所述机械臂末端呈现零阻力顺应状态;

15、在所述机械臂的轴向方向保持当前位姿不变,在所述机械臂的径向方向允许所述机械臂末端被动跟随外力运动,所述轴向方向为所述充电枪的插拔方向,所述径向方向为垂直于所述插拔方向的方向。

16、可选地,所述方法还包括:

17、获取所述充电枪与所述充电口之间的径向接触力;

18、在所述径向接触力大于等于预设接触力阈值时,将所述机械臂从所述力控模式切换为所述零力模式;

19、在所述径向接触力小于所述接触力阈值、且持续稳定时间达到预设的时长阈值后,将所述机械臂从所述零力模式切换回所述力控模式。

20、可选地,所述将所述机械臂从所述零力模式切换回所述力控模式包括:

21、将所述机械臂各关节的输出刚度按照缓冲函数从零逐渐增加至目标刚度,并将所述机械臂末端的输出力按照同一缓冲函数从零逐渐增加至目标力。

22、可选地,所述方法还包括:

23、在所述机械臂处于接近阶段且所述充电枪位于所述充电口外的情况下,若获取到车身浮动事件,则控制所述机械臂停止向所述充电口方向移动,或者将所述充电枪回退至预设位置。

24、根据本公开的第二方面,提供一种机械臂的控制系统,所述机械臂用于夹持充电枪向车辆充电口插枪和/或从所述充电口拔枪,所述控制系统包括:

25、控制器、第一检测装置和第二检测装置;

26、所述控制器与第一检测装置和第二检测装置均连接;

27、所述第一检测装置布置在所述机械臂的末端,用于检测充电枪是否位于所述充电口内;所述第二检测装置用于获取车身浮动事件;

28、所述控制器用于执行上述的方法。

29、可选地,所述第一检测装置包括视觉定位模块,和/或,所述第二检测装置包括通信模块,用于与所述车辆进行通信连接。

30、通过上述技术方案,至少能够达到以下技术效果:

31、在机械臂处于力控模式以驱动充电枪进入或脱出充电口,以进行插枪或拔枪动作时,基于车身浮动事件的发生,机械臂可以通过控制器由力控模式切换为零力模式,以使得机械臂切换为零力顺应状态,充电枪随车身位置及充电口的位置浮动而变化。这样,能够减小因充电枪和充电口的刚性接触造成的非正常损坏,保护充电口和充电装置,并显著降低充电故障率。

32、本公开的其他特征和优点将在随后的具体实施方式部分予以详细说明。

1.一种机械臂控制方法,其特征在于,所述机械臂用于驱动充电枪向车辆充电口插枪和/或从所述充电口拔枪,所述方法包括:

2.根据权利要求1所述的方法,其特征在于,所述方法还包括:

3.根据权利要求1所述的方法,其特征在于,所述获取到车身浮动事件包括以下任一者:

4.根据权利要求3所述的方法,其特征在于,所述车辆状态信息包括车门状态标识位,所述根据车辆状态信息预测到所述车辆的车身位置将产生浮动,包括:

5.根据权利要求1所述的方法,其特征在于,所述将所述机械臂从所述力控模式切换为零力模式,包括:

6.根据权利要求1所述的方法,其特征在于,所述方法还包括:

7.根据权利要求6所述的方法,其特征在于,所述将所述机械臂从所述零力模式切换回所述力控模式包括:

8.根据权利要求1-6中任一项所述的方法,其特征在于,所述方法还包括:

9.一种机械臂的控制系统,其特征在于,所述机械臂用于夹持充电枪向车辆充电口插枪和/或从所述充电口拔枪,所述控制系统包括:

10.根据权利要求9所述的控制系统,其特征在于,所述第一检测装置包括视觉定位模块,和/或,所述第二检测装置包括通信模块,用于与所述车辆进行通信连接。