[发明专利]调姿机的控制方法、装置、控制器和计算机存储介质在审
申请号: | 202110861695.2 | 申请日: | 2021-07-29 |
公开(公告)号: | CN113568439A | 公开(公告)日: | 2021-10-29 |
发明(设计)人: | 王鹏飞 | 申请(专利权)人: | 西门子(中国)有限公司 |
主分类号: | G05D3/20 | 分类号: | G05D3/20 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 100102 *** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 调姿机 控制 方法 装置 控制器 计算机 存储 介质 | ||
1.一种调姿机的控制方法,其中,所述方法包括:
获取调姿机的各支撑机构的初始位置信息、调姿机平台的旋转位姿信息,所述旋转位姿信息包括:待旋转角度、旋转中心的位置信息以及旋转轴方向信息;
基于所述各支撑机构绕所述旋转中心的旋转角速度相同,根据所述初始位置信息和所述旋转位姿信息,得到控制过程中每个支撑机构的位置随时间的变化关系;
基于所述变化关系,控制各支撑机构绕所述旋转中心同步转动。
2.根据权利要求1所述的方法,其中,所述基于所述各支撑机构绕所述旋转中心的旋转角速度相同,根据所述初始位置信息和所述旋转位姿信息,得到控制过程中每个支撑机构的位置随时间的变化关系,包括:
基于所述各支撑机构绕所述旋转中心的旋转角速度相同,根据所述初始位置信息和所述旋转位姿信息,分别得到控制过程中,每个支撑机构在第一方向上的位置随时间的变化关系、每个支撑机构在第二方向上的位置随时间的变化关系以及每个支撑机构在第三方向上的位置随时间的变化关系;
其中,所述第一方向、所述第二方向以及所述第三方向之间两两垂直。
3.根据权利要求2所述的方法,其中,所述初始位置包括:所述第一方向的初始位置、所述第二方向的初始位置以及所述第三方向的初始位置;所述旋转中心的位置信息包括:所述旋转中心在所述第一方向上的位置信息、所述旋转中心在所述第二方向上的位置信息以及所述旋转中心在所述第三方向上的位置信息;
当所述旋转轴方向为所述第三方向时,所述基于所述各支撑机构绕所述旋转中心的旋转角速度相同,根据所述初始位置信息和所述旋转位姿信息,分别得到控制过程中,每个支撑机构在第一方向上的位置随时间的变化关系、每个支撑机构在第二方向上的位置随时间的变化关系以及每个支撑机构在第三方向上的位置随时间的变化关系,包括:
基于所述旋转中心的旋转角速度相同,根据所述第一方向的初始位置、所述第二方向的初始位置、所述旋转中心在所述第一方向上的位置信息以及所述旋转中心在所述第二方向上的位置信息,分别得到控制过程中,每个支撑机构在第一方向上的位置随时间的变化关系和每个支撑机构在第二方向上的位置随时间的变化关系;
将每个支撑机构的第三方向的初始位置作为控制过程中,该支撑机构在第三方向上的位置。
4.根据权利要求3所述的方法,其中,所述基于所述旋转中心的旋转角速度相同,根据所述第一方向初始位置、所述第二方向初始位置、所述旋转中心在所述第一方向上的位置信息以及所述旋转中心在所述第二方向上的位置信息,分别得到控制过程中,每个支撑机构在第一方向上的位置随时间的变化关系和每个支撑机构在第二方向上的位置随时间的变化关系,包括:
基于所述旋转中心的旋转角速度相同,根据所述第一方向初始位置、所述第二方向初始位置、所述旋转中心在所述第一方向上的位置信息以及所述旋转中心在所述第二方向上的位置信息,采用第一预设公式得到控制过程中,每个支撑机构在所述第一方向上的位置随时间的变化关系;
采用第二预设公式得到控制过程中,每个支撑机构在所述第二方向上的位置随时间的变化关系;
其中,所述第一预设公式为:
x2=(x1-x0)*cos(v*t)-(y1-y0)*sin(v*t)+x0
所述第二预设公式为:
y2=(x1-x0)*sin(v*t)+(y1-y0)*cos(v*t)+y0
其中,v为预设的旋转角速度;t为时间;x1、y1分别为每个支撑机构第一方向的初始位置信息、第二方向的初始位置信息;x0、y0分别为所旋转中心在所述第一方向上的位置信息、所述旋转中心在所述第二方向上的位置信息;x2、y2分别为每个支撑机构在所述第一方向上的位置、每个支撑机构在所述第二方向上的位置。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于西门子(中国)有限公司,未经西门子(中国)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202110861695.2/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种业务执行方法及装置
- 下一篇:一种便捷的滴眼夹子