连续在轨运动的主体和分离体轨迹捕获实验运动分配方法与流程

文档序号:22303112发布日期:2020-09-23 01:25阅读:来源:国知局

技术特征:

1.连续在轨运动的主体和分离体轨迹捕获实验运动分配方法,其特征在于,所述的运动分配方法使用的解耦机构包括串联或并联的主体机构和分离体机构;

所述的主体机构具有六个自由度,分别由串联的六部分机构来控制,包括主体x向直线移动机构、主体y向直线移动机构、主体z向直线移动机构、主体α俯仰转动机构、主体β偏航转动机构和主体γ滚转机构;主体x向直线移动机构、主体z向直线移动机构、主体y向直线移动机构均由电机与丝杠配合驱动,主体α俯仰转动机构、主体β偏航转动机构通过电机与直线变圆弧机构实现,主体γ滚转机构由滚转电机配合减速器驱动;主体模型固定在主体机构执行末端的主体支杆上,主体模型的质心位于主体机构的解耦点,主体机构状态为主体解耦机构状态;

所述的分离体机构具有六个自由度,分别由串联的六部分机构来控制,包括分离体x向直线移动机构、分离体y向直线移动机构、分离体z向直线移动机构、分离体α俯仰转动机构、分离体β偏航转动机构和分离体γ滚转机构;分离体x向直线移动机构、分离体z向直线移动机构、分离体y向直线移动机构均由电机与丝杠配合驱动,分离体α俯仰转动机构、分离体β偏航转动机构通过电机与直线变圆弧机构实现,分离体γ滚转机构由滚转电机配合减速器驱动;分离体模型固定在分离体机构执行末端的分离体支杆上,分离体模型的质心位于分离体机构的解耦点,分离体机构状态为分离体解耦机构状态;

所述的运动分配方法包括以下步骤:

a.采集主体模型和分离体模型当前时刻的当前位姿;

主体模型当前位姿azo=(xzo,yzo,zzo,αzo,βzo,θzo),分离体模型当前位姿afo=(xfo,yfo,zfo,αfo,βfo,θfo);

b.通过当前时刻的当前位姿的主体模型和分离体模型的气动力数据,计算主体模型和分离体模型下一时间步长的理论位姿;

主体模型理论位姿azn=(xzn,yzn,zzn,αzn,βzn,θzn),分离体模型理论位姿afn=(xfn,yfn,zfn,αfn,βfn,θfn);

c.从当前位姿到达理论位姿,主体机构的三个角度自由度机构的运动角度分别为αzn-αz0,βzn-βz0,θzn-θz0;分离体机构的三个角度自由度机构的运动角度分别为αfn-αf0,βfn-βf0,θfn-θf0;

d.计算当前位姿和理论位姿状态下,主体模型和分离体模型的x向、y向、z向相对距离和相对距离变动量;

x向,主体模型当前位姿和分离体模型当前位姿相对距离xfo-xzo、主体模型理论位姿和分离体模型理论位姿相对距离xfn-xzn,相对距离变动量sx=xfn-xzn-xfo+xzo;

y向,主体模型当前位姿和分离体模型当前位姿相对距离yfo-yzo、主体模型理论位姿和分离体模型理论位姿相对距离yfn-yzn,相对距离变动量sy=yfn-yzn-yfo+yzo;

z向,主体模型当前位姿和分离体模型当前位姿相对距离zfo-zzo、主体模型理论位姿和分离体模型理论位姿相对距离zfn-zzn,相对距离变动量sz=zfn-zzn-zfo+zzo;

e.计算主体模型当前位姿和分离体模型当前位姿在x向、y向、z向的负端余量和正端余量;

将主体机构的x向、y向、z向的运动行程分别表示为[xzmin,xzmax]、[yzmin,yzmax]、[zzmin,zzmax],则主体机构x向、y向、z向的负端余量分别为xzo-xzmin、yzo-yzmin、zzo-zzmin,正端余量分别为xzmax-xzo、yzmax-yzo、zzmax-zzo;

将分离体机构的x向、y向、z向的运动行程分别表示为[xfmin,xfmax]、[yfmin,yfmax]、[zfmin,zfmax],则分离体机构x向、y向、z向的负端余量分别为xfo-xfmin、yfo-yfmin、zfo-zfmin,正端余量分别为xfmax-xfo、yfmax-yfo、zfmax-zfo;

f.按行程余量比重分配主体机构和分离体机构的运动;

主体机构的x向运动量为sx*(xzo-xzmin)/(xzmin-xzmax),数值为正,则运行方向为主体机构的x向正向,否则为主体机构的x向负向;

主体机构的y向运动量为sy*(yzo-yzmin)/(yzmin-yzmax),数值为正,则运行方向为主体机构的y向正向,否则为主体机构的y向负向;

主体机构的z向运动量为sz*(zzo-zzmin)/(zzmin-zzmax),数值为正,则运行方向为主体机构的z向正向,否则为主体机构的z向负向;

分离体机构的x向运动量为sx*(xfo-xfmin)/(xfmin-xfmax),数值为正,则运行方向为分离体机构的x向正向,否则为分离体机构的x向负向;

分离体机构的y向运动量为sy*(yfo-yfmin)/(yfmin-yfmax),数值为正,则运行方向为分离体机构的y向正向,否则为分离体机构的y向负向;

分离体机构的z向运动量为sz*(zfo-zfmin)/(zfmin-zfmax),数值为正,则运行方向为分离体机构的z向正向,否则为分离体机构的z向负向;

g.控制主体机构和分离体机构分别完成步骤c的角度运动和步骤f的x向、y向、z向运动,到达下一时间步长的主体模型理论位姿和分离体模型理论位姿。

2.根据权利要求1所述的连续在轨运动的主体和分离体轨迹捕获实验运动分配方法,其特征在于,所述的下一时间步长为常值。

3.根据权利要求1所述的连续在轨运动的主体和分离体轨迹捕获实验运动分配方法,其特征在于,所述的步骤a的具体步骤如下:

a1.获取当前时刻主体机构和分离体机构各自由度电机的编码器位置,编码器的值能够准确反映出电机转动的角度,再根据丝杠导程计算丝杠传动的距离:其中q为丝杠传动距离,ph为丝杠导程,θ为电机转动的角度,i为相应减速器的减速比;分别计算获得(xzo,yzo,zzo)和(xfo,yfo,zfo);

a2.主体γ滚转机构和分离体γ滚转机构是电机配合减速器直接运动,主体机构和分离体机构的滚转角θγ(t)与滚转电机转角γ(t)关系为:只与减速比相关;分别计算获得θzo和θfo;

a3.主体α俯仰转动机构和分离体α俯仰转动机构采用直线变圆弧结构;

a点为丝杠上滑块初始位置,坐标为a(x0,y0),b点为连杆与俯仰机构的转动轴处,转动轴与俯仰中心的连线与x向夹角为俯仰转轴做弧形运动的圆弧半径ob为r,连杆ab长度为l;设俯仰电机驱动俯仰直线滑块a运动位移aa′为s,则连杆带动俯仰部分绕o做旋转运动;俯仰转动角度α计算公式如下:

分别计算获得αzo和αfo;

a4.主体β偏航转动机构和分离体β偏航转动机构采用直线变圆弧结构;

c点为丝杠上滑块初始位置,坐标为c(x0,z0),d点为连杆与偏航机构的转动轴处,转动轴与偏航中心的连线与x向夹角为ω0;偏航转轴做弧形运动的圆弧半径od为r′,连杆cd长度为l′;设偏航电机驱动偏航直线滑块c运动位移cc′为s′,则连杆带动偏航部分绕o做旋转运动;偏航转动角度β计算公式如下:

分别计算获得βzo和βfo。


技术总结
本发明公开了一种连续在轨运动的主体和分离体轨迹捕获实验运动分配方法。该方法通过采集当前时刻分离体模型和主体模型的当前位姿,获得下一时间步长的分离体模型和主体模型的理论位姿,计算X、Y、Z向相对位置变化距离;按行程余量比重分配主体机构和分离体机构的运动;控制主体机构和分离体机构完成X、Y、Z向运动以及各自角度运动,到达下一时间步长的主体模型和分离体模型理论位姿。该方法能够避免主体机构和分离体机构同向运动,提高实验空间的利用率,获得更长的实验时间和更多捕获的轨迹点位数量,提高主体机构和分离体机构的使用寿命,具有计算简单快速,运行高效可靠的优点。

技术研发人员:林敬周;张涛;钟俊;谢志江;李佳鑫;皮阳军;解福田;张德炜;许晓斌;王雄;邹东阳;赵健;宋代平
受保护的技术使用者:中国空气动力研究与发展中心超高速空气动力研究所;重庆大学
技术研发日:2020.06.23
技术公布日:2020.09.22
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1