System.ArgumentOutOfRangeException: 索引和长度必须引用该字符串内的位置。 参数名: length 在 System.String.Substring(Int32 startIndex, Int32 length) 在 zhuanliShow.Bind() 逆运动学求解的方法、装置、模型、设备及存储介质制造方法及图纸_技高网

逆运动学求解的方法、装置、模型、设备及存储介质制造方法及图纸

技术编号:41643575 阅读:15 留言:0更新日期:2024-06-13 02:36
本发明专利技术涉及一种逆运动学求解的方法、装置、模型、设备及存储介质,方法包括:根据机械臂姿态信息和机械臂末端位置信息,获取输入参数;根据机械臂的关节数和每个关节的角度,获取初始数据集;根据初始数据集获取训练样本集;获取初始神经网络模型;根据训练样本集对初始神经网络模型进行训练,以对初始神经网络模型的初始权重值进行优化,获得优化权重值;将训练后的初始神经网络模型作为逆运动学求解神经网络模型;将待求解机械臂末端位置输入逆运动学求解神经网络模型,获得待求解机械臂末端位置对应的每个关节的角度。本发明专利技术可以避免大量的运算,操作简单,效率高。

【技术实现步骤摘要】

本专利技术涉及神经网络领域,尤其涉及一种逆运动学求解的方法、装置、模型、设备及存储介质


技术介绍

1、随着信息技术、自动化和智能化水平的不断提高,多自由度机械臂因其更高的灵活性和适应性,在复杂作业环境中的应用日益广泛。

2、人形机器人的多自由度机械臂更是一种复杂的机器人系统,包括多个关节,每个关节对应一个自由度,关节不同的角度、不同的转动轨迹,对应的机械臂末端执行器的不同位姿逆。多自由度机械臂在执行工作时有更多可能的姿态,使得路径规划和障碍物回避等功能更加高效和精确,使得其自由度机械臂可以模拟人类手臂的灵活运动,使它在很多应用中具有优势。

3、对于机械臂,运动学求解和逆运动学求解是实现其控制的重要过程。其中,运动学的求解指的是根据机械臂的各关节角度来确定末端执行器的位姿,而逆运动学求解为根据末端执行器的位姿来确定机器人各关节的角度。

4、多自由度机械臂由于具备多个关节,由一个末端位姿计算多个关节,即逆运动学的求解的难度更高。传统逆运动学求解方法中,推导过程繁复,还可能会产生大量的解,而且容易陷入局部最优但总体非最优,同时传统求解产生的解,可能使机械臂的运动形式怪异,与人类的运动形式相比差异较大,无法满足用户的需求。

5、可见,现有的多自由度机械臂的逆运动学求解方法还不完善。


技术实现思路

1、为了解决上述技术问题或者至少部分地解决上述技术问题,本专利技术提供了一种逆运动学求解的方法、装置、模型、设备及存储介质。

2、第一方面,本专利技术提供了一种逆运动学求解的方法,所述方法包括:

3、根据机械臂姿态信息和机械臂末端位置信息,获取输入参数;

4、根据机械臂的关节数和每个关节的角度,获取初始数据集;

5、根据所述初始数据集获取训练样本集;

6、获取初始神经网络模型,所述初始神经网络模型的输入为所述输入参数,所述初始神经网络的输出为所述输入参数对应的所述每个关节的角度,所述初始神经网络包括初始权重值和偏置值;

7、根据所述训练样本集对所述初始神经网络模型进行训练,以对所述初始神经网络模型的初始权重值进行优化,获得优化权重值;

8、将训练后的所述初始神经网络模型作为逆运动学求解神经网络模型,所述逆运动学求解神经网络模型包括所述优化权重值和所述偏置值;

9、将待求解机械臂末端位置输入所述逆运动学求解神经网络模型,获得所述待求解机械臂末端位置对应的每个关节的角度。

10、可选的,所述输入参数为位姿矩阵,所述位姿矩阵为:

11、

12、其中,k为机械臂的关节数,k为正整数;n、o、a为机械臂姿态参数;p为3×1的矩阵,用于指示机械臂末端位置信息。

13、可选的,所述根据机械臂的关节数和每个关节的角度,获取初始数据集,包括:

14、根据机械臂的关节数和每个关节的角度,获取参考数据,将多个所述参考数据作为所述参考数据集;

15、对所述参考数据集进行筛选,获取所述初始数据集;

16、其中,所述根据机械臂的关节数和每个关节的角度,获取参考数据,包括:

17、从关节角度组数据集中获取一个关节角度组,一个所述关节角度组包含的关节角度个数与机械臂的关节数相等,一个所述关节角度组中的每一个关节角度对应机械臂的一个关节的角度,

18、根据当前关节角度组,正运动学求解获得所述当前关节角度组对应的末端位置信息,

19、将所述当前关节角度组和所述当前关节角度组对应的末端位置信息作为参考数据集中的一个参考数据。

20、可选的,k为机械臂的关节数;

21、所述从关节角度组数据集中获取一个关节角度组,包括:

22、获取第i关节的预设转动角度范围,i=1……k;

23、从第i关节的预设转动角度范围中随机选取j个不重复的角度,将所述j个不重复的角度作为第i角度集;

24、从第1角度集至第i角度集中的每一个角度集中选择任一角度,将选择的k个角度作为一个所述关节角度组;

25、将多个所述关节角度组作为关节角度组数据集;

26、其中,k为正整数。

27、可选的,所述对所述参考数据集进行筛选,获取所述初始数据集,包括:

28、根据预设规则对所述参考数据集进行筛选,将筛选后的所述参考数据集作为所述初始数据集。

29、可选的,所述根据预设规则对所述参考数据集进行筛选,将筛选后的所述参考数据集作为所述初始数据集,包括:

30、将所述参考数据集中,不符合人类手臂运动模式的数据滤去后的所述参考数据集,作为所述初始数据集。

31、可选的,所述根据预设规则对所述参考数据集进行筛选,将筛选后的所述参考数据集作为所述初始数据集,包括:

32、从所述参考数据集中任选一个参考数据作为筛选参考数据;

33、使机械臂的关节按照选择的所述筛选参考数据中的关节角度转动;

34、检测所述机械臂的关节转动后的筛选末端位置是否符合所述筛选参考数据中的末端位置;

35、若符合,保留所述筛选参考数据,

36、若不符合,滤去所述筛选参考数据;

37、重复所述从所述参考数据集中任选一个参考数据作为筛选参考数据,直到所述筛选参考数据的个数满足预设筛选个数。

38、可选的,所述使机械臂的关节按照选择的所述筛选参考数据中的关节角度转动,包括:

39、对于每一个所述筛选参考数据,使所述机械臂的关节从预设起始位置开始运动。

40、可选的,所述根据所述初始数据集获取训练样本集,包括:

41、将所述初始数据集根据预设比例进行划分,一部分作为所述训练样本集。

42、可选的,所述方法还包括:

43、将所述初始数据集根据所述预设比例进行划分,一部分作为所述训练样本集后,剩余的部分作为测试样本集。

44、可选的,所述初始神经网络模型包括:

45、输入层,用于接收所述输入参数;

46、隐藏层,用于使所述输入参数依次通过所述隐藏层中的每一层,以获取输出数据;

47、输出层,用于根据所述输出数据输出所述输入参数对应的所述每个关节的角度。

48、可选的,所述隐藏层包括:

49、第一卷积层,用于从所述输入层接收所述输入参数,所述第一卷积层的卷积核为第一预设大小,所述第一卷积层的输出通道数为m个;

50、第二卷积层,连接所述第一卷积层,所述第二卷积层的卷积核为第二预设大小,所述第二卷积层的输出通道数为2m个;

51、第三卷积层,连接所述第二卷积层,所述第三卷积层的卷积核为第三预设大小,所述第三卷积层的输出通道数为4m个;

52、第一全连接层,连接所述第三卷积层,输出数为4m个;

53、第二全本文档来自技高网...

【技术保护点】

1.一种逆运动学求解的方法,其特征在于,所述方法包括:

2.根据权利要求1所述的方法,其特征在于,所述输入参数为位姿矩阵,所述位姿矩阵为:

3.根据权利要求1所述的方法,其特征在于,所述根据机械臂的关节数和每个关节的角度,获取初始数据集,包括:

4.根据权利要求3所述的方法,其特征在于,K为机械臂的关节数;

5.根据权利要求3所述的方法,其特征在于,所述对所述参考数据集进行筛选,获取所述初始数据集,包括:

6.根据权利要求5所述的方法,其特征在于,所述根据预设规则对所述参考数据集进行筛选,将筛选后的所述参考数据集作为所述初始数据集,包括:

7.根据权利要求5所述的方法,其特征在于,所述根据预设规则对所述参考数据集进行筛选,将筛选后的所述参考数据集作为所述初始数据集,包括:

8.根据权利要求7所述的方法,其特征在于,所述使机械臂的关节按照选择的所述筛选参考数据中的关节角度转动,包括:

9.根据权利要求5所述的方法,其特征在于,所述根据所述初始数据集获取训练样本集,包括:

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

11.根据权利要求1所述的方法,其特征在于,所述初始神经网络模型包括:

12.根据权利要求11所述的方法,其特征在于,所述隐藏层包括:

13.根据权利要求12所述的方法,其特征在于,组合列向量的值为:

14.根据权利要求1所述的方法,其特征在于,所述根据所述训练样本集对所述初始神经网络模型进行训练,以对所述初始神经网络模型的初始权重值进行优化,获得优化权重值,包括:

15.根据权利要求14所述的方法,其特征在于,所述正向传播所述更新后的训练样本集,反向传播所述更新后的训练样本集,以修正初始权重值获取所述优化权重值,包括:

16.根据权利要求15所述的方法,其特征在于,所述初始化所述初始权重值,获取当前权重值,包括:

17.根据权利要求15所述的方法,其特征在于,所述正向传播所述更新后的训练样本集,反向传播所述更新后的训练样本集,以修正初始权重值获取所述优化权重值,包括:

18.根据权利要求17所述的方法,其特征在于,根据所述当前权重值和预设约束参数,获取所述当前权重值的L2范数正则化的值,包括:

19.根据权利要求17所述的方法,其特征在于,所述反向传播所述当前训练样本,修正所述当前权重值,包括:

20.根据权利要求1所述的方法,其特征在于,所述根据所述训练样本集对所述初始神经网络模型进行训练之后,所述方法还包括:

21.根据权利要求20所述的方法,其特征在于,所述根据测试样本集,对训练后的所述初始神经网络模型进行测试,包括:

22.根据权利要求21所述的方法,其特征在于,期望轨迹函数为:

23.一种逆运动学求解的装置,其特征在于,所述装置包括:

24.一种逆运动学求解的方法,其特征在于,应用于七自由度的机械臂,所述方法应用于如权利要求1至22中任一项所述的方法。

25.一种逆运动学神经网络模型,其特征在于,应用于如权利要求1至22中任一项所述的方法。

26.一种计算机设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1至22中任一项所述的方法。

27.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至22中任一项所述的方法。

...

【技术特征摘要】

1.一种逆运动学求解的方法,其特征在于,所述方法包括:

2.根据权利要求1所述的方法,其特征在于,所述输入参数为位姿矩阵,所述位姿矩阵为:

3.根据权利要求1所述的方法,其特征在于,所述根据机械臂的关节数和每个关节的角度,获取初始数据集,包括:

4.根据权利要求3所述的方法,其特征在于,k为机械臂的关节数;

5.根据权利要求3所述的方法,其特征在于,所述对所述参考数据集进行筛选,获取所述初始数据集,包括:

6.根据权利要求5所述的方法,其特征在于,所述根据预设规则对所述参考数据集进行筛选,将筛选后的所述参考数据集作为所述初始数据集,包括:

7.根据权利要求5所述的方法,其特征在于,所述根据预设规则对所述参考数据集进行筛选,将筛选后的所述参考数据集作为所述初始数据集,包括:

8.根据权利要求7所述的方法,其特征在于,所述使机械臂的关节按照选择的所述筛选参考数据中的关节角度转动,包括:

9.根据权利要求5所述的方法,其特征在于,所述根据所述初始数据集获取训练样本集,包括:

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

11.根据权利要求1所述的方法,其特征在于,所述初始神经网络模型包括:

12.根据权利要求11所述的方法,其特征在于,所述隐藏层包括:

13.根据权利要求12所述的方法,其特征在于,组合列向量的值为:

14.根据权利要求1所述的方法,其特征在于,所述根据所述训练样本集对所述初始神经网络模型进行训练,以对所述初始神经网络模型的初始权重值进行优化,获得优化权重值,包括:

15.根据权利要求14所述的方法,其特征在于,所述正向传播所述更新后的训练样本集,反向传...

【专利技术属性】
技术研发人员:请求不公布姓名
申请(专利权)人:上海开普勒探索机器人有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1