Advertisement
Guest User

Untitled

a guest
Jul 22nd, 2019
78
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.17 KB | None | 0 0
  1. FDab(rob, [0;0;0], [0;0;0], [0;0;0]) %a_grav = [0,0,-9.81]
  2.  
  3. Error using *
  4. Inner matrix dimensions must agree.
  5. Error in FDab (line 49)
  6. a{i} = Xup{i} * -a_grav + c{i};
  7.  
  8. rob.NB = 3;
  9. rob.parent = [0:2];
  10. rob.jtype = { 'R', 'R', 'R' }
  11. model.gravity = [0 0 0];
  12. rob.Xtree{1} = rotx(1.57) * xlt([0 0 0]);
  13. rob.Xtree{2} = roty(1.57) * xlt([0.15,0,0]);
  14. rob.Xtree{3} = xlt([0.34 0 0]);
  15. ax1=0.03; ay1=0.03; az1=0.03;
  16. ax2=0.28; ay2=0.05; az2=0.05;
  17. ax3=0.2; ay3=0.05; az3=0.05;
  18. rob.I{1} = mcI( 1, [0 0 -0.02], 1/12*[ay1^2+az1^2 0 0; 0 ax1^2+az1^2 0; 0 0 ax1^2+ay1^2] )
  19. rob.I{2} = mcI( 4, [0.14 0 0], 4/12*[ay2^2+az2^2 0 0; 0 ax2^2+az2^2 0; 0 0 ax2^2+ay2^2] )
  20. rob.I{3} = mcI( 3, [0.1 0 0], 3/12*[ay3^2+az3^2 0 0; 0 ax3^2+az3^2 0; 0 0 ax3^2+ay3^2] )
  21. rob.appearance.base = ...
  22. { 'box', [-0.2 -0.3 -0.2; 0.2 0.3 -0.07] };
  23. rob.appearance.body{1} = ...
  24. { 'cyl', [0 0 0; 0.11 0 0], 0.05, ...
  25. 'cyl', [0 0 -0.06; 0 0 0.06], 0.06 };
  26. rob.appearance.body{2} = ...
  27. { 'cyl', [0 0 0; 0.34 0 0], 0.05, ...
  28. 'cyl', [0 0 -0.06; 0 0 0.06], 0.06 };
  29. rob.appearance.body{3} = ...
  30. { 'cyl', [0 0 0; 0.26 0 0], 0.05, ...
  31. 'cyl', [0 0 -0.06; 0 0 0.06], 0.06 };
  32. showmotion(rob)
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement