代写TRC4800/MEC4456 Robotics PC 8: Joint Control调试R语言

Department of Mechanical and Aerospace Engineering

TRC4800/MEC4456 Robotics

PC 8: Joint Control

Objective: To model the dynamics and master the partitioned controller design of robotic systems.

Problem 1. Prove that the torque equation for the mechanism shown in Figure 1 is

where gear ratio

What are the effective inertia and effecting damping terms of the system?

Figure 1: Mechanism for Problem 1.

Problem 2. The torque equation for joint 1 for the manipulator shown in Figure 2 is

where masses are point masses at the end of each link.

Figure 2: A two-link RR manipulator.

Compute the variation (as a percentage of the maximum) of inertia “seen" by joint 1 of the manipulator as it changes configuration. Use the numerical values

l1 = l2 = 0:5 m m1 = 4:0 kg            m2 = 2:0 kg

Consider that the robot is direct drive and that the rotor inertia is negligible.

Hint: Find the manipulator's mass matrix.

Repeat the calculation for the case of a geared robot (use η = 20) and a rotor inertia of Im = 0:01 kgm2.

Problem 3. In a system like that shown in Figure 3, find the criteria for KD and KP of a PD controller such that the system is never unstable and never underdamped. Design the PD control to control τ (solve the torque balance equations for τ, rather than τm).

The system possesses an un-modelled resonance due to an end-point stiffness K (on the non motor side, not shown in figure). Any damping terms in the system are negligible. Also, η = R1/R2 >1.

Figure 3: Mechanical model of a DC torque motor connected through gearing to inertial load.