三坐标定位器调姿运控方法、系统、调姿控制器及存储介质

基本信息

申请号 CN202010534922.6 申请日 -
公开(公告)号 CN111708322B 公开(公告)日 2021-09-17
申请公布号 CN111708322B 申请公布日 2021-09-17
分类号 G05B19/404 分类 控制;调节;
发明人 鄢继红;周玉龙 申请(专利权)人 广州数控设备有限公司
代理机构 广州市华学知识产权代理有限公司 代理人 陈燕娴;李君
地址 510530 广东省广州市萝岗区观达路22号
法律状态 -

摘要

摘要 本发明公开了一种三坐标定位器调姿运控方法、系统、调姿控制器及存储介质,该方法包括:解算刚体的平动移动量和平动方向矢量,以及刚体定轴转动的转动角度和转动轴矢量;解算刚体定轴转动过程的每个定位器的空间圆弧轨迹的圆心和半径,并解算圆弧角速度范围和刚体角速度范围;进行刚体复合运动速度规划并修整;按每个定位器驱动轴允许的速度范围和加速度范围调整刚体复合运动的速度和加速度,重新进行刚体复合运动速度规划并修整;按时间分割法进行插补计算,输出每个定位器三轴指令坐标位置;根据每个定位器三轴指令坐标位置和空间误差数据进行空间补偿,输出各轴驱动器的实际位置。本发明可满足加速度要求且有冗余驱动轴,调姿过程平稳无冲击。