1 / 38

Lecture 26. Control of the Diver

Lecture 26. Control of the Diver. In order for a diver to do what he or she does the diver applies effective torques at the joints. We want to find a recipe for doing this that will cause the simulated diver to execute the diver. This is a control problem.

bin
Download Presentation

Lecture 26. Control of the Diver

An Image/Link below is provided (as is) to download presentation Download Policy: Content on the Website is provided to you AS IS for your information and personal use and may not be sold / licensed / shared on other websites without getting consent from its author. Content is provided to you AS IS for your information and personal use only. Download presentation by click this link. While downloading, if for some reason you are not able to download a presentation, the publisher may have deleted the file from their server. During download, if you can't get a presentation, the file might be deleted by the publisher.

E N D

Presentation Transcript

  1. Lecture 26. Control of the Diver In order for a diver to do what he or she does the diver applies effective torques at the joints We want to find a recipe for doing this that will cause the simulated diver to execute the diver This is a control problem

  2. Tomorrow’s office hours will be 1:30 to 3:30 I have to leave at 3:30

  3. We have a special case of nonlinear control here and I want to explore that, beginning with some discussion and then some simpler models

  4. Suppose we want the solution of a second order system to follow some prescription We can write the second order system The error can be made to satisfy the homogeneous equation by the proper choice of f(t)

  5. choose then is the desired error equation

  6. This can be extended to a quasilinear system, which is what we typically have given this choice for f(t) converts the nonlinear equation to the linear form that yields a decaying error This is called feedback linearization

  7. What are we doing here? We are asking that become and we choose the forcing function to make this happen This is cool, but it’s only 1D — what happens in a coupled system?

  8. For the class of problems we are considering, which includes divers and some robots, we can choose the generalized coordinates such that each external force appears in only one reduced Hamilton equation This is not necessary, but it cleans up the algebra and I’ll assume we’ve taken the trouble to do that, so my simplest coupled case is

  9. substitute into the system and solve for f1 and f2 When these are substituted back into the original equations we obtain

  10. and if the system is not singular then the identical parenthetical equations must equal zero: the errors vanish asymptotically

  11. This looks like magic, but it isn’t To make this work we have a necessary condition: as many forces as controlled variables There’re more, but I can’t give them all to you. It works for sufficiently simple systems with only revolute joints — divers and many robots (not the Stanford arm) I’d like to look at the inverted double pendulum from this perspective before moving on to more complicated systems

  12. Planar inverted double pendulum: base fixed to the ground parameters: l1, l2 m1, m2 I treat them as slender members

  13. We know how the double pendulum goes Six holonomic constraints to restrict it to the x = 0 plane Four connectivity constraints relating CMs to the ground Apply all ten constraints and define a two dimensional q

  14. We can form a Lagrangian

  15. There are no additional constraints, so we can let qdot equal u We can find p and then the pieces of Hamilton’s equations

  16. We have four differential equations and seven algebraic equations (We can actually look at these in the Mathematica notebook) The next issue is designing the control so by assigning we assign

  17. We can look at various desired angles, both steady and time-dependent Here’s the algorithm for vertical stabilization

  18. and the result

  19. Here we ask both links to follow sinusoidal paths out of phase

  20. and here’s the result of that

  21. Here are the torques required to perform the tracking shown on the previous slide

  22. How about a simple diving problem — a three link diver?

  23. Three links —> 18 variables Confine to the x constant plane —> nine variables Four connectivity constraints —> five variables Number the links from the bottom to the top and select the middle link as the reference link

  24. There are two torques — one at each joint — as shown in the sketch and we want to choose our variables accordingly

  25. We get the Lagrangian as usual

  26. This is a fancy torque, suitable for 3D but of course only two of the components actually do anything The important thing is that the choice of q has isolated the two torques

  27. Note that we have written this in terms of the desired qs, not the yi The next slide shows the development of the Zs and their gradients

  28. We need the symbolic versions to build the equations we intend to integrate

  29. The two internal angles start at zero, go to a maximum of 2π/3, and back to zero in the time interval tf Midway through the ends of the two outboard links should touch We can do this integration and see what the results are We can start by looking at the closest approach, when the two links are to touch

  30. It is now probably worth looking at the Mathematica notebooks

More Related