diff --git a/src/initializeJointDynamics.m b/src/initializeJointDynamics.m index 831296d..62f23e5 100644 --- a/src/initializeJointDynamics.m +++ b/src/initializeJointDynamics.m @@ -5,30 +5,30 @@ function [stewart] = initializeJointDynamics(stewart, args) % % Inputs: % - args - Structure with the following fields: -% - Ksbi [6x1] - Bending (Rx, Ry) Stiffness for each top Spherical joints [N/rad] -% - Csbi [6x1] - Bending (Rx, Ry) Damping of each top Spherical joint [N/(rad/s)] -% - Ksti [6x1] - Torsion (Rz) Stiffness for each top Spherical joints [N/rad] -% - Csti [6x1] - Torsion (Rz) Damping of each top Spherical joint [N/(rad/s)] -% - Kubi [6x1] - Bending (Rx, Ry) Stiffness for each bottom Universal joints [N/rad] -% - Cubi [6x1] - Bending (Rx, Ry) Damping of each bottom Universal joint [N/(rad/s)] -% - disable [true/false] - Sets all the stiffness/damping to zero +% - Ksbi [6x1] - Bending (Rx, Ry) Stiffness for each top Spherical joints [(N.m)/rad] +% - Csbi [6x1] - Bending (Rx, Ry) Damping of each top Spherical joint [(N.m)/(rad/s)] +% - Ksti [6x1] - Torsion (Rz) Stiffness for each top Spherical joints [(N.m)/rad] +% - Csti [6x1] - Torsion (Rz) Damping of each top Spherical joint [(N.m)/(rad/s)] +% - Kubi [6x1] - Bending (Rx, Ry) Stiffness for each bottom Universal joints [(N.m)/rad] +% - Cubi [6x1] - Bending (Rx, Ry) Damping of each bottom Universal joint [(N.m)/(rad/s)] +% - disable [boolean] - Sets all the stiffness/damping to zero % % Outputs: % - stewart - updated Stewart structure with the added fields: -% - Ksbi [6x1] - Bending (Rx, Ry) Stiffness for each top Spherical joints [N/rad] -% - Csbi [6x1] - Bending (Rx, Ry) Damping of each top Spherical joint [N/(rad/s)] -% - Ksti [6x1] - Torsion (Rz) Stiffness for each top Spherical joints [N/rad] -% - Csti [6x1] - Torsion (Rz) Damping of each top Spherical joint [N/(rad/s)] -% - Kubi [6x1] - Bending (Rx, Ry) Stiffness for each bottom Universal joints [N/rad] -% - Cubi [6x1] - Bending (Rx, Ry) Damping of each bottom Universal joint [N/(rad/s)] +% - Ksbi [6x1] - Bending (Rx, Ry) Stiffness for each top Spherical joints [(N.m)/rad] +% - Csbi [6x1] - Bending (Rx, Ry) Damping of each top Spherical joint [(N.m)/(rad/s)] +% - Ksti [6x1] - Torsion (Rz) Stiffness for each top Spherical joints [(N.m)/rad] +% - Csti [6x1] - Torsion (Rz) Damping of each top Spherical joint [(N.m)/(rad/s)] +% - Kubi [6x1] - Bending (Rx, Ry) Stiffness for each bottom Universal joints [(N.m)/rad] +% - Cubi [6x1] - Bending (Rx, Ry) Damping of each bottom Universal joint [(N.m)/(rad/s)] arguments stewart - args.Ksbi (6,1) double {mustBeNumeric, mustBeNonnegative} = 1e+1*ones(6,1) + args.Ksbi (6,1) double {mustBeNumeric, mustBeNonnegative} = 15*ones(6,1) args.Csbi (6,1) double {mustBeNumeric, mustBeNonnegative} = 1e-4*ones(6,1) - args.Ksti (6,1) double {mustBeNumeric, mustBeNonnegative} = 1e+0*ones(6,1) + args.Ksti (6,1) double {mustBeNumeric, mustBeNonnegative} = 20*ones(6,1) args.Csti (6,1) double {mustBeNumeric, mustBeNonnegative} = 1e-3*ones(6,1) - args.Kubi (6,1) double {mustBeNumeric, mustBeNonnegative} = 1e+1*ones(6,1) + args.Kubi (6,1) double {mustBeNumeric, mustBeNonnegative} = 15*ones(6,1) args.Cubi (6,1) double {mustBeNumeric, mustBeNonnegative} = 1e-4*ones(6,1) args.disable logical {mustBeNumericOrLogical} = false end diff --git a/stewart-architecture.html b/stewart-architecture.html index 37943b7..43100e7 100644 --- a/stewart-architecture.html +++ b/stewart-architecture.html @@ -4,7 +4,7 @@ "http://www.w3.org/TR/xhtml1/DTD/xhtml1-strict.dtd"> - + Stewart Platform - Definition of the Architecture @@ -268,104 +268,104 @@ for the JavaScript code in this tag.

Table of Contents

-
-

Compute the orientation of the Joints

-
+
+

Compute the orientation of the Joints

+
stewart.FRa = zeros(3,3,6);
 stewart.MRb = zeros(3,3,6);
@@ -1077,11 +1077,11 @@ stewart.MRb = zeros(3,3,6);
 
-
-

5.4 initializeStewartPose: Determine the initial stroke in each leg to have the wanted pose

+
+

5.4 initializeStewartPose: Determine the initial stroke in each leg to have the wanted pose

- +

@@ -1089,9 +1089,9 @@ This Matlab function is accessible here

-
-

Function description

-
+
+

Function description

+
function [stewart] = initializeStewartPose(stewart, args)
 % initializeStewartPose - Determine the initial stroke in each leg to have the wanted pose
@@ -1115,9 +1115,9 @@ This Matlab function is accessible here
 
-
-

Optional Parameters

-
+
+

Optional Parameters

+
arguments
     stewart
@@ -1129,9 +1129,9 @@ This Matlab function is accessible here
 
-
-

Use the Inverse Kinematic function

-
+
+

Use the Inverse Kinematic function

+
[Li, dLi] = inverseKinematics(stewart, 'AP', args.AP, 'ARB', args.ARB);
 
@@ -1142,11 +1142,11 @@ stewart.dLi = dLi;
 
-
-

5.5 initializeCylindricalPlatforms: Initialize the geometry of the Fixed and Mobile Platforms

+
+

5.5 initializeCylindricalPlatforms: Initialize the geometry of the Fixed and Mobile Platforms

- +

@@ -1154,9 +1154,9 @@ This Matlab function is accessible -

Function description

-
+
+

Function description

+
function [stewart] = initializeCylindricalPlatforms(stewart, args)
 % initializeCylindricalPlatforms - Initialize the geometry of the Fixed and Mobile Platforms
@@ -1188,9 +1188,9 @@ This Matlab function is accessible 
-

Optional Parameters

-
+
+

Optional Parameters

+
arguments
     stewart
@@ -1206,9 +1206,9 @@ This Matlab function is accessible 
-

Create the platforms struct

-
+
+

Create the platforms struct

+
platforms = struct();
 
@@ -1230,9 +1230,9 @@ platforms.Mpi = diag([1/12 
 
-
-

Save the platforms struct

-
+
+

Save the platforms struct

+
stewart.platforms = platforms;
 
@@ -1241,11 +1241,11 @@ platforms.Mpi = diag([1/12
-
-

5.6 initializeCylindricalStruts: Define the inertia of cylindrical struts

+
+

5.6 initializeCylindricalStruts: Define the inertia of cylindrical struts

- +

@@ -1253,9 +1253,9 @@ This Matlab function is accessible h

-
-

Function description

-
+
+

Function description

+
-
-

Optional Parameters

-
+
+

Optional Parameters

+
-
-

Create the struts structure

-
+
+

Create the struts structure

+
struts = struct();
 
@@ -1340,11 +1340,11 @@ struts.Msi = zeros(3, 3, 6);
 
-
-

5.7 initializeStrutDynamics: Add Stiffness and Damping properties of each strut

+
+

5.7 initializeStrutDynamics: Add Stiffness and Damping properties of each strut

- +

@@ -1352,9 +1352,9 @@ This Matlab function is accessible here<

-
-

Function description

-
+
+

Function description

+
-
-

Optional Parameters

-
+
+

Optional Parameters

+
-
-

Add Stiffness and Damping properties of each strut

-
+
+

Add Stiffness and Damping properties of each strut

+
stewart.Ki = args.Ki;
 stewart.Ci = args.Ci;
@@ -1401,11 +1401,11 @@ stewart.Ci = args.Ci;
 
-
-

5.8 initializeJointDynamics: Add Stiffness and Damping properties for spherical joints

+
+

5.8 initializeJointDynamics: Add Stiffness and Damping properties for spherical joints

- +

@@ -1413,9 +1413,9 @@ This Matlab function is accessible here<

-
-

Function description

-
+
+

Function description

+
function [stewart] = initializeJointDynamics(stewart, args)
 % initializeJointDynamics - Add Stiffness and Damping properties for the spherical joints
@@ -1424,38 +1424,38 @@ This Matlab function is accessible here<
 %
 % Inputs:
 %    - args - Structure with the following fields:
-%        - Ksbi [6x1] - Bending (Rx, Ry) Stiffness for each top Spherical joints [N/rad]
-%        - Csbi [6x1] - Bending (Rx, Ry) Damping of each top Spherical joint [N/(rad/s)]
-%        - Ksti [6x1] - Torsion (Rz) Stiffness for each top Spherical joints [N/rad]
-%        - Csti [6x1] - Torsion (Rz) Damping of each top Spherical joint [N/(rad/s)]
-%        - Kubi [6x1] - Bending (Rx, Ry) Stiffness for each bottom Universal joints [N/rad]
-%        - Cubi [6x1] - Bending (Rx, Ry) Damping of each bottom Universal joint [N/(rad/s)]
-%        - disable [true/false] - Sets all the stiffness/damping to zero
+%        - Ksbi [6x1] - Bending (Rx, Ry) Stiffness for each top Spherical joints [(N.m)/rad]
+%        - Csbi [6x1] - Bending (Rx, Ry) Damping of each top Spherical joint [(N.m)/(rad/s)]
+%        - Ksti [6x1] - Torsion (Rz) Stiffness for each top Spherical joints [(N.m)/rad]
+%        - Csti [6x1] - Torsion (Rz) Damping of each top Spherical joint [(N.m)/(rad/s)]
+%        - Kubi [6x1] - Bending (Rx, Ry) Stiffness for each bottom Universal joints [(N.m)/rad]
+%        - Cubi [6x1] - Bending (Rx, Ry) Damping of each bottom Universal joint [(N.m)/(rad/s)]
+%        - disable [boolean] - Sets all the stiffness/damping to zero
 %
 % Outputs:
 %    - stewart - updated Stewart structure with the added fields:
-%        - Ksbi [6x1] - Bending (Rx, Ry) Stiffness for each top Spherical joints [N/rad]
-%        - Csbi [6x1] - Bending (Rx, Ry) Damping of each top Spherical joint [N/(rad/s)]
-%        - Ksti [6x1] - Torsion (Rz) Stiffness for each top Spherical joints [N/rad]
-%        - Csti [6x1] - Torsion (Rz) Damping of each top Spherical joint [N/(rad/s)]
-%        - Kubi [6x1] - Bending (Rx, Ry) Stiffness for each bottom Universal joints [N/rad]
-%        - Cubi [6x1] - Bending (Rx, Ry) Damping of each bottom Universal joint [N/(rad/s)]
+%        - Ksbi [6x1] - Bending (Rx, Ry) Stiffness for each top Spherical joints [(N.m)/rad]
+%        - Csbi [6x1] - Bending (Rx, Ry) Damping of each top Spherical joint [(N.m)/(rad/s)]
+%        - Ksti [6x1] - Torsion (Rz) Stiffness for each top Spherical joints [(N.m)/rad]
+%        - Csti [6x1] - Torsion (Rz) Damping of each top Spherical joint [(N.m)/(rad/s)]
+%        - Kubi [6x1] - Bending (Rx, Ry) Stiffness for each bottom Universal joints [(N.m)/rad]
+%        - Cubi [6x1] - Bending (Rx, Ry) Damping of each bottom Universal joint [(N.m)/(rad/s)]
 
-
-

Optional Parameters

-
+
+

Optional Parameters

+
-
-

Add Stiffness and Damping properties of each strut

-
+
+

Add Stiffness and Damping properties of each strut

+
-
-

5.9 displayArchitecture: 3D plot of the Stewart platform architecture

+
+

5.9 displayArchitecture: 3D plot of the Stewart platform architecture

- +

@@ -1501,9 +1501,9 @@ This Matlab function is accessible here.

-
-

Function description

-
+
+

Function description

+
function [] = displayArchitecture(stewart, args)
 % displayArchitecture - 3D plot of the Stewart platform architecture
@@ -1531,9 +1531,9 @@ This Matlab function is accessible here.
 
-
-

Optional Parameters

-
+
+

Optional Parameters

+
arguments
     stewart
@@ -1553,9 +1553,9 @@ This Matlab function is accessible here.
 
-
-

Figure Creation, Frames and Homogeneous transformations

-
+
+

Figure Creation, Frames and Homogeneous transformations

+

The reference frame of the 3d plot corresponds to the frame \(\{F\}\).

@@ -1598,9 +1598,9 @@ Let’s define a parameter used to position the labels with respect to the c
-
-

Fixed Base elements

-
+
+

Fixed Base elements

+

Let’s first plot the frame \(\{F\}\).

@@ -1678,9 +1678,9 @@ Let’s now plot the position and labels of the Fixed Joints
-
-

Mobile Platform elements

-
+
+

Mobile Platform elements

+

Plot the frame \(\{M\}\).

@@ -1764,9 +1764,9 @@ Plot the position and labels of the rotation joints fixed to the mobile platform
-
-

Legs

-
+
+

Legs

+

Plot the legs connecting the joints of the fixed base to the joints of the mobile platform.

@@ -1789,8 +1789,8 @@ Plot the legs connecting the joints of the fixed base to the joints of the mobil
-
-

5.9.1 Figure parameters

+
+

5.9.1 Figure parameters

view([1 -0.6 0.4]);
@@ -1812,7 +1812,7 @@ Plot the legs connecting the joints of the fixed base to the joints of the mobil
 

Author: Dehaeze Thomas

-

Created: 2020-02-07 ven. 17:18

+

Created: 2020-02-07 ven. 17:34

diff --git a/stewart-architecture.org b/stewart-architecture.org index 2372cfe..e76927e 100644 --- a/stewart-architecture.org +++ b/stewart-architecture.org @@ -868,22 +868,22 @@ This Matlab function is accessible [[file:src/initializeJointDynamics.m][here]]. % % Inputs: % - args - Structure with the following fields: - % - Ksbi [6x1] - Bending (Rx, Ry) Stiffness for each top Spherical joints [N/rad] - % - Csbi [6x1] - Bending (Rx, Ry) Damping of each top Spherical joint [N/(rad/s)] - % - Ksti [6x1] - Torsion (Rz) Stiffness for each top Spherical joints [N/rad] - % - Csti [6x1] - Torsion (Rz) Damping of each top Spherical joint [N/(rad/s)] - % - Kubi [6x1] - Bending (Rx, Ry) Stiffness for each bottom Universal joints [N/rad] - % - Cubi [6x1] - Bending (Rx, Ry) Damping of each bottom Universal joint [N/(rad/s)] - % - disable [true/false] - Sets all the stiffness/damping to zero + % - Ksbi [6x1] - Bending (Rx, Ry) Stiffness for each top Spherical joints [(N.m)/rad] + % - Csbi [6x1] - Bending (Rx, Ry) Damping of each top Spherical joint [(N.m)/(rad/s)] + % - Ksti [6x1] - Torsion (Rz) Stiffness for each top Spherical joints [(N.m)/rad] + % - Csti [6x1] - Torsion (Rz) Damping of each top Spherical joint [(N.m)/(rad/s)] + % - Kubi [6x1] - Bending (Rx, Ry) Stiffness for each bottom Universal joints [(N.m)/rad] + % - Cubi [6x1] - Bending (Rx, Ry) Damping of each bottom Universal joint [(N.m)/(rad/s)] + % - disable [boolean] - Sets all the stiffness/damping to zero % % Outputs: % - stewart - updated Stewart structure with the added fields: - % - Ksbi [6x1] - Bending (Rx, Ry) Stiffness for each top Spherical joints [N/rad] - % - Csbi [6x1] - Bending (Rx, Ry) Damping of each top Spherical joint [N/(rad/s)] - % - Ksti [6x1] - Torsion (Rz) Stiffness for each top Spherical joints [N/rad] - % - Csti [6x1] - Torsion (Rz) Damping of each top Spherical joint [N/(rad/s)] - % - Kubi [6x1] - Bending (Rx, Ry) Stiffness for each bottom Universal joints [N/rad] - % - Cubi [6x1] - Bending (Rx, Ry) Damping of each bottom Universal joint [N/(rad/s)] + % - Ksbi [6x1] - Bending (Rx, Ry) Stiffness for each top Spherical joints [(N.m)/rad] + % - Csbi [6x1] - Bending (Rx, Ry) Damping of each top Spherical joint [(N.m)/(rad/s)] + % - Ksti [6x1] - Torsion (Rz) Stiffness for each top Spherical joints [(N.m)/rad] + % - Csti [6x1] - Torsion (Rz) Damping of each top Spherical joint [(N.m)/(rad/s)] + % - Kubi [6x1] - Bending (Rx, Ry) Stiffness for each bottom Universal joints [(N.m)/rad] + % - Cubi [6x1] - Bending (Rx, Ry) Damping of each bottom Universal joint [(N.m)/(rad/s)] #+end_src *** Optional Parameters @@ -893,11 +893,11 @@ This Matlab function is accessible [[file:src/initializeJointDynamics.m][here]]. #+begin_src matlab arguments stewart - args.Ksbi (6,1) double {mustBeNumeric, mustBeNonnegative} = 1e+1*ones(6,1) + args.Ksbi (6,1) double {mustBeNumeric, mustBeNonnegative} = 15*ones(6,1) args.Csbi (6,1) double {mustBeNumeric, mustBeNonnegative} = 1e-4*ones(6,1) - args.Ksti (6,1) double {mustBeNumeric, mustBeNonnegative} = 1e+0*ones(6,1) + args.Ksti (6,1) double {mustBeNumeric, mustBeNonnegative} = 20*ones(6,1) args.Csti (6,1) double {mustBeNumeric, mustBeNonnegative} = 1e-3*ones(6,1) - args.Kubi (6,1) double {mustBeNumeric, mustBeNonnegative} = 1e+1*ones(6,1) + args.Kubi (6,1) double {mustBeNumeric, mustBeNonnegative} = 15*ones(6,1) args.Cubi (6,1) double {mustBeNumeric, mustBeNonnegative} = 1e-4*ones(6,1) args.disable logical {mustBeNumericOrLogical} = false end