1 / 12

Stickybot Force Control

Stickybot Force Control. Salomon Trujillo October 17, 2006. Outline. Force vs. Position Control Implementing Stiffness Control Whole Body Control: Grasp Matrices Performing Weight Transfer Between Feet Leg Phasing. Force vs. Position Prioritizing.

uriah
Télécharger la présentation

Stickybot Force Control

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. Stickybot Force Control Salomon Trujillo October 17, 2006

  2. Outline • Force vs. Position Control • Implementing Stiffness Control • Whole Body Control: Grasp Matrices • Performing Weight Transfer Between Feet • Leg Phasing

  3. Force vs. Position Prioritizing Desired force and position might contradict. The comprise is implemented through stiffness control. High stiffness gives priority to position. Low stiffness gives priority to force.

  4. Impedance Control mx’’ + bx’ + kx = Fmotor Fmotor = Kmx’’ + Kbx’ + Kkx (m-Km)x’’ + (b-Kb)x’ + (k-Kk)x = 0 Kk = (kphysical-kdesired), Km = Kb = 0 Physical system: Control law: Resulting system: Stiffness Control:

  5. Stiffness-Controlled Servo Xpos fload = kdsrdxpos xpos = xcmd + (fload ÷ kphys) xcmd = (fload ÷ kdsrd) - (fload ÷ kphys) xcmd = fload ÷ kgain kgain = (kdsrdkphys) ÷ (kdsrd - kphys) Xpos Xcmd = kphys kdsrd fload fload

  6. Commanding a Force & Position Xpos Xff-cmd = Xpos – Fdsrd÷ kphys Xfb-cmd = (Fload – Fdsrd) ÷ kgain KGain = (kdsrdkphys) ÷ (kdsrd - kphys) Xcmd Actuator: Servomotor Receives Position Command Sensor: Hall Effect Returns spring displacement kphys fload Feed-forward: Feed-back:

  7. f1 f2 fTOT fTRQ fINT2 fINT3 1 1 1 1 1 -1 1 -1 1 1 -1 -1 1 -1 -1 1 f1 f2 f3 f4 X1 X3 X2 X4 = f3 f4 G 1-D Grasp Matrix

  8. f1 f2 X1 X3 X2 X4 f3 f4 Force Balancing:Grasp-Coupled Stiffness Matrix fi = kixi f=Kx f = (G-1KgrspG)x K = (KdsrdKphys) (Kdsrd - Kphys)-1

  9. 1 1 1 1 1 -1 1 -1 1 1 -1 -1 1 -1 -1 1 1 0 0 0 0 1 1 0 0 1 -1 0 0 0 0 1 f1 f2 X1 X3 X2 X4 f3 f4 Grasp Matrix Transitions G4: All legs in contact G2: Two legs (2 & 3) in contact

  10. Not in contact with the wall In contact with the wall Weight Transfer During Trot xcmd = xpos – K-1physfdsrd + (G-1K-1grspG)(fload – fdsrd) 1 2 • Legs 1 and 4 make contact with the wall. G4 becomes active. • Weight is transferred from one pair to the other. 3 4 • Legs 2 and 3 release from the wall. G2 becomes active.

  11. Not in contact with the wall In contact with the wall Leg Phasing During Trot LF RF LB RB Attach Legs in stance might lose phase due to force balancing. Stroke Center During weight transfer, all legs move in unison Detach Phase is restored during flight

  12. Questions? Where can I find a good burger around here?

More Related