W1 gets into position, duckwalks a bit, and then stands up straight

This commit is contained in:
jazz committed 2026-08-06 04:22:09 -05:00
1 parent aec544f291
commit 4675c5a518
1 file changed
+6 -6
+6 -6
View File
@@ -19,23 +19,23 @@ q = 0 : 1: COUNT - 1; % set precision. e.g. q = 0 : 0.001 : COUNT-1; for 1e-3 pr
% of each array is to be equal to the value of COUNT. % of each array is to be equal to the value of COUNT.
%% TRACKS: Left Leg Joints X, Y, Z%% %% TRACKS: Left Leg Joints X, Y, Z%%
tr_LHipY = [0, -0.14 * pi, -0.14 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi]; % positive: move foot back tr_LHipY = [0, -0.14 * pi, -0.14 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, 0, 0, 0]; % positive: move foot back
tr_LHipX = [0, 0, 0, 0, 0, 0, 0.01 * pi, 0, 0, 0, 0, 0, 0, 0, 0, 0]; % pos: move foot outward tr_LHipX = [0, 0, 0, 0, 0, 0, 0.01 * pi, 0, 0, 0, 0, 0, 0, 0, 0, 0]; % pos: move foot outward
tr_LHipZ = zeros(1, COUNT); % pos: move knee left (c-clockw) tr_LHipZ = zeros(1, COUNT); % pos: move knee left (c-clockw)
tr_LKneeY = [0, 0.375 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi]; % pos: bend knee normally tr_LKneeY = [0, 0.375 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0, 0, 0]; % pos: bend knee normally
tr_LAnkleY = [0, -0.2 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi]; % pos: point toes down (pitch) tr_LAnkleY = [0, -0.2 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, 0, 0, 0]; % pos: point toes down (pitch)
tr_LAnkleX = [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0]; % pos: right side of foot down tr_LAnkleX = [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0]; % pos: right side of foot down
%% TRACKS: Right Leg Joints X, Y, Z%% %% TRACKS: Right Leg Joints X, Y, Z%%
tr_RHipY = [0, -0.14 * pi, -0.14 * pi, -0.14 * pi, -0.14 * pi, -0.28 * pi, -0.38 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi]; % positive: move leg back tr_RHipY = [0, -0.14 * pi, -0.14 * pi, -0.14 * pi, -0.14 * pi, -0.28 * pi, -0.38 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, -0.28 * pi, 0, 0, 0]; % positive: move leg back
tr_RHipX = [0, 0, 0, -0.05 * pi, 0, 0, 0, -0.1 * pi, 0, 0, 0, 0, 0, 0, 0, 0]; % pos: mv foot in tr_RHipX = [0, 0, 0, -0.05 * pi, 0, 0, 0, -0.1 * pi, 0, 0, 0, 0, 0, 0, 0, 0]; % pos: mv foot in
tr_RHipZ = zeros(1, COUNT); % pos: mv c-clockw tr_RHipZ = zeros(1, COUNT); % pos: mv c-clockw
tr_RKneeY = [0, 0.375 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi]; % pos: bend knee tr_RKneeY = [0, 0.375 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0.55 * pi, 0, 0, 0]; % pos: bend knee
tr_RAnkleY = [0, -0.2 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi]; % pos: toes down tr_RAnkleY = [0, -0.2 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, 0, 0, 0]; % pos: toes down
tr_RAnkleX = [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0]; % pos: right side down tr_RAnkleX = [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0]; % pos: right side down
%% The rest of this script does not need to be modified by hand.%% %% The rest of this script does not need to be modified by hand.%%