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

robot takes 3 steps and falls after 3rd step

Browse Source
This commit is contained in:
jazz committed 2026-08-04 05:28:14 -05:00
1 parent 05e0e87336
commit 546e5b425a
1 file changed
+3 -3
Download Patch File Download Diff File Expand all files Collapse all files
dat/W1.m
+3 -3
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.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.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_LHipX = [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0]; % pos: move foot inward 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_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
@@ -30,7 +30,7 @@ tr_LAnkleX = [0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0];
%% 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.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_RHipX = [0, 0, 0, -0.05 * pi, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0]; % pos: mv foot in 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_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