400 025 3599
网站首页
全控简介
模拟平台
产品中心
荣誉资质
新闻资讯
招贤纳士
联系我们
电话咨询
固话:025-83983051
手机:13905180520
返回顶部
当前位置: 主页 > 新闻中心 > 技术文档 >
六自由度电动平台控制程序算法
发布时间:2022-05-09 14:52

  六自由度运动平台是由六个伺服电机带动电动缸做伸缩变化运动,六个电动缸并联设置共同驱动运动平台。运动平台的每个电动缸都能够实现空间中单独的伸缩运动,因此控制系统通过对六个电动缸的伸缩量的控制,可以驱动上平台完成空间中的六自由度运动,从而实现上平台位姿的改变。六自由度分别指的是平台沿着x、y、z三个坐标轴的平移运动,以及绕三个坐标轴的φx、φy、φz旋转运动。

  根据六自由度平台的运动状态,计算出各电动缸的相应位置和速度指令信号,从而控制运动平台的动作,保证按照预定的轨迹运动;当运动平台到达要求的位置时,各电动缸的速度指令信号给定为零,运动平台就立刻停下来,达到了点位控制的目的。
 

  1 位置解算算法

  对于并联机构的六自由度平台在运动过程中,要保证运动的实时性和正确性,就需要通过对伸缩杠的精确控制来实现,这就需要引入六自由度平台的实时位置正反解算法。所谓六自由度平台的位置反解,是指由运动平台的空间姿态求六个伸缩杠的伸缩量。而六自由度的位置正解,是指有六个伸缩杠的伸缩量来求运动平台的空间姿态。

  本次设计仍然采用位置反解的算法作为六自由度平台的位置算法。经过推算后动平台的各点坐标相对于静平台的各点坐标的方向转换矩阵表示如下:

  其中a,b,c对应为动平台在X轴,Y轴,Z轴三个方向上的位移;对应为动平台绕X轴,Y轴,Z轴三个轴旋转的角度。
 

  2 连续运动规划

  本设计将依次完成对YYPT平移、旋转以及X-Y圆周运动三种运行曲线。

  1、平移运动:动平台不对X、Y、Z任一轴做旋转,以平台中心为控制点,在X、Y、Z任一轴向做往复轴向运动。

  2、旋转运动:以平台中心位于X-Y平面的原点,并在Z轴行程中心,在X、Y、Z绕任一轴做角度旋转的往复运动。

  3、X-Y平面圆周运动:YYPT平台在Z向行程为一半的X-Y平面上,以平台中心为原点沿所规划的圆形轨迹运动。其公式为

  

 

  ,其中X、Y分别为圆形在X、Y上的距离,r为所画圆的半径,按照此公式计算上平台的运动轨迹。
 

  3 控制策略

  采用了位置环加驱动器内部的速度环、电流环相结合的三环反馈的控制方法。在控制算法中采用了前馈的算法,使控制效果更平稳、更精确。
 

  4 控制软件

  软件设计中采用了??榛?、面向对象的设计方法,将程序分为以下??椋?/p>

  1)六通道伺服控制??椋涸?ms伺服周期内,采集每个通道的反馈信号,将PID计算的信号对应通道输出,并做必要的限位判断。

  2)六通道PID运算??椋涸?ms的伺服周期内,将反馈的信号和设置的信号进行PID运算,得出输出信号量。

  3)运动曲线规划??椋荷柚闷教ò凑展婊玫那叻匠探性硕?。

  4)六通道PID参数设置??椋荷柚昧У缍椎腜ID参数。

  5)数据采集及输出??椋翰杉嗦肫鞯姆蠢∈莶⒏軵ID计算出的结果输出相应的脉冲量。
 

  5 软件流程框图

关键词: 六自由度平台程序,六自由度平台控制算法
相关新闻
本网站所有内容未经授权,不得转载,违者追究相应法律责任! 法律声明

白城渴克新材料有限公司 剪刀北京有限公司| 冲孔板北京有限公司| 广州环鑫网络技术有限公司| 鹤壁市永成矿山设备机械厂| 广州享购信息科技有限公司| 烘干机有限公司| 铸造机床有限公司| 广州光纳广告策划公司| 活性炭北京有限公司| 苏州范恩空间装饰工程有限公司| 水工业上海有限公司| http://www.jhocom.com http://www.faxshack.com http://www.woah1063.com