微信:HuangL1121
部分参数如下:
clc;
clear;
close all;
Times = 0.1;
%姿态调整参数
%%
%right foot 1:
%0
RF1_A1 =0;
RF1_F1 =0;
RF1_th1=0;
%50*sin(u);
RF1_A2 =50;
RF1_F2 =1;
RF1_th2=0;
%30*sin(u-pi/2);
RF1_A3 =30;
RF1_F3 =1;
RF1_th3=-pi/2;
%%
%right foot 2:0
%0
RF2_A1 =0;
RF2_F1 =0;
RF2_th1=0;
%y = -50*sin(u);
RF2_A2 =-50;
RF2_F2 =1;
RF2_th2=0;
%30*cos(u);
RF2_A3 =30;
RF2_F3 =1;
RF2_th3=0;
%%
%right foot 3:0
%0
RF3_A1 =0;
RF3_F1 =0;
RF3_th1=0;
%y = 50*sin(u);
RF3_A2 =50;
RF3_F2 =1;
RF3_th2=0;
%30*sin(u - pi/2);
RF3_A3 =30;
RF3_F3 =1;
RF3_th3=-pi/2;
%%
%left foot 1:0
%0
LF1_A1 =0;
LF1_F1 =0;
LF1_th1=0;
%y = -50*sin(u);
LF1_A2 =-50;
LF1_F2 =1;
LF1_th2=0;
%y = 30*cos(u);
LF1_A3 =30;
LF1_F3 =1;
LF1_th3=0;
%%
%left foot 2:0
%0
LF2_A1 =0;
LF2_F1 =0;
LF2_th1=0;
%y = 50*sin(u);
LF2_A2 =50;
LF2_F2 =1;
LF2_th2=0;
%y = 30*sin(u - pi/2);
LF2_A3 =30;
LF2_F3 =1;
LF2_th3=-pi/2;
%%
%left foot 3:0
%0
LF3_A1 =0;
LF3_F1 =0;
LF3_th1=0;
%y = y = -50*sin(u);
LF3_A2 =-50;
LF3_F2 =1;
LF3_th2=0;
%y = 30*cos(u);
LF3_A3 =30;
LF3_F3 =1;
LF3_th3=0;
联系:highspeedlogic
QQ :1224848052
微信:HuangL1121
邮箱:1224848052@qq.com
微信扫一扫: