Saturday, May 5, 2012

May 5 Robotic Arm app

The real task is to:

  • Arm Down
  • Claw Close (pick-up cup or other object)
  • Arm Up
  • Turn 
  • Claw Open (drop object)
  • Turn back (reset)

Currently this application is divided into 3 parts corresponding the 3 motor functions:

  1. UP/ DOWN robotic arm until Touch pressed 
  2. OPEN / CLOSE claw
  3. Turn RT/LT 
Extra E_DELAYs are used to simulate when another motor would be active.

1. 
UP/ DOWN robotic arm until Touch pressed :

2. OPEN / CLOSE claw = 3. Turn RT/LT   except for motor and led port #s

Claw Close, Stop, wait until needed again, Open, Stop
Turn  Right, Stop, wait until needed again,  Left,  Stop

Currently looking into if this is best as Composite FB or Sub-system.
The generalized version has the problem that both motor plus and motor minus end with motor stop, from the last event output its not clear if its from forward or backward.

No comments:

Post a Comment