一种充电机械臂的位姿调整方法、装置、电子设备及介质与流程

摘要: 本发明涉及充电机械臂,具体涉及一种充电机械臂的位姿调整方法、装置、电子设备及介质。背景技术:1、随着新能源汽车的广泛应用,以及自动驾驶技术的全面发展,关于新能源...
一种充电机械臂的位姿调整方法、装置、电子设备及介质与流程

本发明涉及充电机械臂,具体涉及一种充电机械臂的位姿调整方法、装置、电子设备及介质。

背景技术:

1、随着新能源汽车的广泛应用,以及自动驾驶技术的全面发展,关于新能源汽车的自动充电装置的技术研究已经成为该趋势中必不可少的一个环节,基于该背景下展开了对新能源汽车的自动充电技术研究。由于自动充电装置在实际应用场景中,汽车的停车位置可能会各有差异,因此摄像头采集图像时,初始帧画面中可能没有充电枪座或充电枪座拍摄不全,这就导致摄像头需要反复地多次迭代拍摄才能将充电枪座比较完整地拍摄在画面中,如何能有效的提高效率、节约时间是本发明的核心。

技术实现思路

1、为了解决现有技术存在的问题,本发明提出了一种充电机械臂的位姿调整方法、装置、电子设备及介质。

2、本发明的第一方面,提供了一种充电机械臂的位姿调整方法,所述方法包括:

3、在待充电车辆处于目标区域时,获取所述待充电车辆的图像数据;

4、根据所述待充电车辆的图像数据,确定充电枪座在所述图像数据中的位置坐标,所述待充电车辆包含有所述充电枪座;

5、在所述充电枪座未处于所述图像数据的居中位置时,按照预设位姿调整策略对所述充电机械臂的位姿进行调整。

6、可选地,所述预设位姿调整策略,包括:

7、根据所述充电枪座在所述图像数据中的位置坐标,确定目标圆孔在相机坐标系下的单位向量;

8、其中,所述相机坐标系为以拍摄所述图像数据的摄像机建立的坐标系;

9、根据所述目标圆孔在相机坐标系下的单位向量,确定所述单位向量在相机坐标系下的各坐标轴分量;

10、根据所述各坐标轴分量,对所述充电机械臂的位姿进行调整。

11、可选地,所述根据所述各坐标轴分量,对所述充电机械臂的位姿进行调整,包括:

12、按照预设坐标系建立策略,以所述目标圆孔在相机坐标系下的单位向量为基准建立新坐标系;

13、其中,所述预设坐标系建立策略,包括:以所述目标圆孔在相机坐标系下的单位向量为新坐标系的z轴,且所述新坐标系的x轴的y方向分量在相机坐标系下为零;

14、根据所述各坐标轴分量,确定所述目标圆孔在所述新坐标系下的待用坐标;

15、根据所述待用坐标,确定从所述相机坐标系到所述新坐标系的旋转矩阵;

16、根据所述旋转矩阵,对所述充电机械臂的位姿进行调整。

17、可选地,所述根据所述充电枪座在所述图像数据中的位置坐标,确定目标圆孔在相机坐标系下的单位向量,包括:

18、以垂直于所述充电枪座质心向里的方向为z轴,水平向右的方向为x轴,竖直向下的方向为y轴,建立充电枪座坐标系;

19、根据所述充电枪座的类型和所述充电枪座坐标系,确定所述充电枪座上每个圆孔的充电枪座坐标;

20、根据目标圆孔的充电枪座坐标,确定所述目标圆孔中待用点的待用充电枪座坐标;

21、根据所述待用充电枪座坐标,从所述位置坐标中确定所述待用点在所述图像数据中的待用位置坐标;

22、根据所述待用位置坐标,确定所述单位向量在相机坐标系下的各坐标轴分量。

23、可选地,所述根据所述待用位置坐标,确定所述单位向量在相机坐标系下的各坐标轴分量,包括:

24、根据所述待用位置坐标,估计所述充电枪座的深度;

25、根据所述充电枪座的深度,确定所述目标圆孔在相机坐标系下的单位向量;

26、根据所述目标圆孔在相机坐标系下的单位向量,确定所述单位向量在相机坐标系下的各坐标轴分量。

27、可选地,所述根据所述充电枪座在所述图像数据中的位置坐标,确定目标圆孔在相机坐标系下的单位向量,还包括:

28、根据所述充电枪座在所述图像数据中的位置坐标,确定所述位置坐标对应的中心坐标;

29、根据所述中心坐标,确定所述目标圆孔在相机坐标系下的单位向量。

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

31、在所述充电枪座处于所述图像数据的居中位置时,根据所述充电枪座在所述图像数据中的位置坐标,对所述充电机械臂的位姿进行解算,确定所述充电机械臂的位姿信息;

32、根据所述充电机械臂的位姿信息,对所述充电机械臂的位姿进行调整。

33、本发明的第二方面,还提供了一种充电机械臂的位姿调整装置,所述位姿调整装置包括:

34、图像数据获取单元,用于在待充电车辆处于目标区域时,获取所述待充电车辆的图像数据;

35、位置坐标确定单元,用于根据所述待充电车辆的图像数据,确定充电枪座在所述图像数据中的位置坐标,所述待充电车辆包含有所述充电枪座;

36、第一位姿调整单元,用于根据所述充电枪座在所述图像数据中的位置坐标,对所述充电机械臂的位姿进行调整。

37、可选地,所述预设位姿调整策略,包括:

38、根据所述充电枪座在所述图像数据中的位置坐标,确定目标圆孔在相机坐标系下的单位向量;

39、其中,所述相机坐标系为以拍摄所述图像数据的摄像机建立的坐标系;

40、根据所述目标圆孔在相机坐标系下的单位向量,确定所述单位向量在相机坐标系下的各坐标轴分量;

41、根据所述各坐标轴分量,对所述充电机械臂的位姿进行调整。

42、可选地,所述根据所述各坐标轴分量,对所述充电机械臂的位姿进行调整,包括:

43、按照预设坐标系建立策略,以所述目标圆孔在相机坐标系下的单位向量为基准建立新坐标系;

44、其中,所述预设坐标系建立策略,包括:以所述目标圆孔在相机坐标系下的单位向量为新坐标系的z轴,且所述新坐标系的x轴的y方向分量在相机坐标系下为零;

45、根据所述各坐标轴分量,确定所述目标圆孔在所述新坐标系下的待用坐标;

46、根据所述待用坐标,确定从所述相机坐标系到所述新坐标系的旋转矩阵;

47、根据所述旋转矩阵,对所述充电机械臂的位姿进行调整。

48、可选地,所述根据所述充电枪座在所述图像数据中的位置坐标,确定目标圆孔在相机坐标系下的单位向量,包括:

49、以垂直于所述充电枪座质心向里的方向为z轴,水平向右的方向为x轴,竖直向下的方向为y轴,建立充电枪座坐标系;

50、根据所述充电枪座的类型和所述充电枪座坐标系,确定所述充电枪座上每个圆孔的充电枪座坐标;

51、根据目标圆孔的充电枪座坐标,确定所述目标圆孔中待用点的待用充电枪座坐标;

52、根据所述待用充电枪座坐标,从所述位置坐标中确定所述待用点在所述图像数据中的待用位置坐标;

53、根据所述待用位置坐标,确定所述单位向量在相机坐标系下的各坐标轴分量。

54、可选地,所述根据所述待用位置坐标,确定所述单位向量在相机坐标系下的各坐标轴分量,包括:

55、根据所述待用位置坐标,估计所述充电枪座的深度;

56、根据所述充电枪座的深度,确定所述目标圆孔在相机坐标系下的单位向量;

57、根据所述目标圆孔在相机坐标系下的单位向量,确定所述单位向量在相机坐标系下的各坐标轴分量。

58、可选地,所述根据所述充电枪座在所述图像数据中的位置坐标,确定目标圆孔在相机坐标系下的单位向量,还包括:

59、根据所述充电枪座在所述图像数据中的位置坐标,确定所述位置坐标对应的中心坐标;

60、根据所述中心坐标,确定所述目标圆孔在相机坐标系下的单位向量。

61、可选地,所述位姿调整装置还包括:

62、位姿信息确定单元,用于在所述充电枪座处于所述图像数据的居中位置时,根据所述充电枪座在所述图像数据中的位置坐标,对所述充电机械臂的位姿进行解算,确定所述充电机械臂的位姿信息;

63、第二位姿调整单元,用于根据所述充电机械臂的位姿信息,对所述充电机械臂的位姿进行调整。

64、本发明的第三方面,还提供了一种电子设备,包括:存储器、一个或多个处理器;

65、所述存储器,用于存储一个或多个程序;

66、所述一个或多个处理器,用于通过执行所述一个或多个程序,实现如上述所述的一种充电机械臂的位姿调整方法。

67、本发明的第四方面,还提供了一种计算机可读存储介质,其上存有计算机程序,所述计算机程序被执行时,实现如上述所述的一种充电机械臂的位姿调整方法。

68、与现有技术相比,本发明的有益效果为:

69、本发明提供了一种充电机械臂的位姿调整方法、装置、电子设备及介质,该充电机械臂的位姿调整方法根据充电枪座在图像数据中的位置坐标,判断充电枪座是否处于图像数据的居中位置,在所述充电枪座未处于所述图像数据的居中位置时,按照预设位姿调整策略能够缩短了充电机械臂插枪时位姿调整、迭代的时间,从而对摄像头的位置进行调整,使得充电枪座能快速、完整地出现在摄像头拍摄画面中心,节约了机械臂插枪准备时间,使得用户观感和体验更好。