Dynamic modelling of robots with rigid links (I)

Defining the dynamic model

The conventional robotics equation describing the inner forces (1) of a kinematic chain of rigid forces in the absence of external forces can be obtained by employing any established algorithm, e.g. Newton-Euler iterative method or the Lagrangian method.

eq

(1)

 

where,

taum vector of motor torques exerted in each joint.

his the robot inertia matrix, which is a function of the joints’ values.

cis the Coriolis and centripetal forces vector, which also depends on the joints’ values and velocities.

tau g is the gravity forces vector depending on the robot position.

tau f is the friction torques vector. In general terms, it also dependent on the joints velocities.

Although the friction is a complex nonlinear phenomenon, in many robotics applications it is modelled by considering only the Coulomb term and viscous friction yielding to (2).

friccionFigure 1- Typical shape of friction torque versus joint speed.
frccion eq

(2)

 

This expression of the friction maintains the linear model and ensures the possibility of applying linear estimators for the model identification. In (1), the motor torque is also linear with the inertial parameters. On a hydraulic actuator based on servo-valves the motor torque  can be estimated by using the expression in (3), where  Kp is a constant and ΔP is the differential pressure between the two chambers of the hydraulic actuator.

                                       taum2

(3)

Similar expression is often employed to estimate the motor torque in an electrical actuator, such as the three-phase brusshless motors, typically mounted in robotics. Instead of using the differential pressure, the measured quadrature current is employed to estimate the feedback torque by using the motor torque constant in . The quadrature current is proportional to the amplitude of the three-phase current, thus either the amplitude or the RMS value can be easily obtained from it.

tm3(4)

When no access to the quadrature current is possible, the Park transformation can be used to transform a three-phase system  into a direct and quadrature system (5).

idqo(5)

Advertisements
Tagged with: , , , , ,
Posted in Robot Dynamics, Robotics, Uncategorized

Leave a Reply

Fill in your details below or click an icon to log in:

WordPress.com Logo

You are commenting using your WordPress.com account. Log Out /  Change )

Google+ photo

You are commenting using your Google+ account. Log Out /  Change )

Twitter picture

You are commenting using your Twitter account. Log Out /  Change )

Facebook photo

You are commenting using your Facebook account. Log Out /  Change )

Connecting to %s

Blogs I Follow
Follow me on Twitter
%d bloggers like this: