jazz/rb1
1
0 Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

takes a couple steps and returns to crouch-stand without fall

Browse Source
This commit is contained in:
jazz committed 2026-08-06 04:06:06 -05:00
1 parent 546e5b425a
commit aec544f291
1 file changed
+4 -4
Download Patch File Download Diff File Expand all files Collapse all files
dat/W1.m
+4 -4
View File
@@ -19,8 +19,8 @@ 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.38 * 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.28 * pi, -0.28 * pi, -0.28 * pi]; % positive: move foot back
tr_LHipX = [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -0.01 * pi, -0.01 * pi, -0.01 * pi, -0.01 * pi, -0.01 * pi]; % pos: move foot inward 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.55 * pi, 0.55 * pi, 0.55 * pi]; % pos: bend knee normally
@@ -29,8 +29,8 @@ tr_LAnkleY = [0, -0.2 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.25 * pi, -0.2
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.42 * 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.28 * pi, -0.28 * pi, -0.28 * pi]; % positive: move leg back
tr_RHipX = [0, 0, 0, -0.05 * pi, 0, 0, 0, 0, 0, -0.05 * pi, 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.55 * pi, 0.55 * pi, 0.55 * pi]; % pos: bend knee