Design a joint angle tracking pd controller

Reference no: EM131225829

Robot Dynamics and Control

Fall 2015Note: Do not discuss with others, Write out your work to show the process how you arrived at the answer.

Problem 1.

The following tables show specifications of the motor and amplifier that we have chosen for our robot design. Our chosen amplifier controls an armature current (ia) to provide a controlled torque τ_m = K_mii_aa, where K_m is a torque constant. We also have a gear box which has 1:50 gear ratio. Given these system setup, please answer the following questions.

Motor

Resistance	0.716 ?
Inductance	0.26 mH
Torque constant	42.9 mNm/A
Speed constant	223 rpm/V
Rotor Inertia	9870 g cm²
Friction coefficient	2.0e^-7 Nm/rpm

Amplifier

a) Obtain two differential equations (electrical and mechanical) for the motor.

b) The following graph shows typical operating point of our robot in terms of magnitude of joint angular velocity and magnitude of load torque. Will the selected motor be able to cover all the operating point of our robot? To obtain ball park estimation, you can assume

di/dt = 0, d²θm/dt² = 0

c) Design a joint angle tracking PD controller on the selected motor and gear box system shown in the diagram below so that the controlled system satisfies the given design criteria. Show that your designed PD controller actually satisfies all of the design criteria by showing step response of the closed-loop system.

Design criteria: %Overshoot<10%, Settling Time<1 sec

d) When the load torque is -10Nm, obtain the steady state error in joint angle and corresponding motor current for unit step input.

e) Design a PID controller to remove the steady state error. Find the bound of integral gain which provides stable closed-loop system when we are using the same PD gain designed in c). Simulate the result with the load torque of -10Nm.

f) As seen in the amplifier specification table, our chosen amplifier cannot generate the current more than 10A. Simulate the PID controlled system with the current saturated at ±10A. Compare the result to the result of PD controlled system. If necessary, add anti-windup control. Take a screenshot of your Simulink model and paste it here.

g) Consider the following time-varying desired joint trajectory θ_j^d = 0.1sin(2πt) rad. Design a controller which tracks desired joint trajectory within |error|<1e-5 rad, augmented with the same PD controller you designed in c).

Problem 2.

Consider the Bipedal robot illustrated on the right. The robot has three links and three actuators on the ankle, knee, and hip joints (u₁ = [u₁, u₂, u₃]^T). The value of the robot's inertial parameters and geometric parameters are, m₁ = 3kg, l₁ = 0.01 kgm², m₂ =3kg, I₂ = 0.01 kgm², m₃= 28kg, I₃ = 0.1 kgm², l₁ = 0.5, l₂ = 0.5, l₃ = 0.5

All the inertias are calculated with respect to the joint position (not Center of Mass) which connects to the parent link. Center of mass position for each link is

P₁^CoM,x = 0,P₁^CoM,y = 0.5l₁, P₂^CoM,x = 0, P₂^CoM,y = 0.5l₂, P₃^CoM,x =0, P₃^CoM,y = 0.5l₃

The robot's generalized coordinates in vector form is q = [q₁, q₂, q₃]^T and corresponding velocity coordinates is d_q = [dq₁, dq₂, dq₃]^T. Use MATLAB package posted in Compass2g to solve the following problems.

a) Obtain forward kinematics of position p₂ = [p₂^x , p₂^y ] and orientation θ₃ of link 3 at the hip joint.

Obtain the values when q₁ = -30°, q₂ = 50°, q₃ = 10°

b) Obtain Jacobian of position p₂ and orientation θ₃ of link 3 at the hip joint. Obtain the values when

q₁ = -30°, q₂ = 50°, q₃ = 10°

c) Obtain equation of motion of the robot, and print Inertia Matrix, Coriolis and Centrifugal matrix, and Gravity vector value when q₁ = -30°, q₂ = 50°, q₃ = 10°, q^·₁ = 1 rad/sec, q^·₂ = 2 rad/sec, q^·₃ = 3 rad/sec

d) Obtain and plot joint angles, velocities, accelerations and joint torques at t = [0, 0.005, 0.01, ... ,0.195, 0.2]sec for the following two cases

a. Case 1
i. Horizontal position of the hip joint progress from -0.2 m to 0.2 m with constant velocity of 2 m/sec,
ii. Vertical position of the hip joint p2 stays at 0.85 m,
iii. While torso is upright vertically (θ = 0) and knee bent inward (q₂ > 0).
b. Case 2
i. Horizontal position of hip joint progress from -0.2 m to 0.2 m with constant velocity of 3 m/sec,
ii. Vertical position of the hip joint stays at 0.9 m,
iii. While torso is upright vertically (θ = 0) and knee bent inward (q₂ > 0).

e) Calculate the following cost function for the case 1 and case 2. Use MATLAB function "trapz" to do numerical integration. This cost roughly indicates energy efficiency of the walking. Please discuss how we can improve energy efficiency of the walking further without changing hardware design. Discuss what kind of constraints you have to take into account to obtain a "good walking motion" with optimized energy efficiency.

Cost Function: J = t = 0∫^{t = 0.2}||u||^d dt

Reference no: EM131225829

Questions Cloud

Stewardship of resources thread : Stewardship of Resources Thread: Owners, Managers and employees all are accountable to some extent for their use of resources owned by others. In light of all that you have learned in this BUSI320 class and in your other business courses, how can you..

Development of job descriptions and job specifications : How might you involve customers in the development of job descriptions and job specifications? Are there any constraints on what customers can stipulate in job specifications?

Forecasting interest rates based on prevailing conditions : Forecasting Interest Rates Based on Prevailing Conditions: - Based on these conditions, do you think interest rates will likely increase or decrease during this semester?

What stage of culture shock is kelly family experiencing : Explain the clashes in culture, customs, and expectations that occurred in this situation. What stage of culture shock is Kelly's family experiencing? Turn back the clock to when Kelly was offered the position in Tokyo. What, if anything, should hav..

Design a joint angle tracking pd controller : Design a joint angle tracking PD controller on the selected motor and gear box system shown in the diagram below so that the controlled system satisfies the given design criteria - Design a PID controller to remove the steady state error. Find the ..

Make assumption about its stage in the product life cycle : Compare and contrast the assertions made in each article/blog. Where do they agree and disagree? Using the lean and/or Six Sigma approach, what two actions could an organization take to improve the possibility for long-term improvement in an organiza..

Bulleted list of economic-political-legal and cultural : Pick one of the countries mentioned as an important target for Starbucks. Make a bulleted list of economic, political-legal, and cultural characteristics of this country.

Write an overview of configuring vcenter and vmware esxi : Write an overview of Configuring vCenter and VMware ESXi. Each overview should be between one half and one full page long. You should use a minimum of two sources for each overview.

Describe each of the big-five personality traits : Describe each of the Big-Five personality traits. If you were a manager, what job functions would you give to employees with each of the Big-Five personality traits so that they can be high performers?

User Account

All Pages