/****************************************************************************
 Module
   Angels_DrivingRoutines.c

 Revision
   1.0.

 Description
  A module to store instruction routines for the ME218B project.

 Notes

 History
 When           Who     What/Why
 -------------- ---     --------
 02/21/12       JAK     adapted for project
 01/16/12       JAK     started coding for Lab 5  
****************************************************************************/


/*------------------------------------
Function DoPickUpAction
Called on a timeout from the
PickUpBalls section of the Driving SM.
Takes integer, returns no value
-------------------------------------*/

 Function DoPickUpAction
   Start switch statement with input value 
      input is 0: (Called when no bumpers hit)
		 Drive forward
		 Start Drive timer
      input is 1: (Called when Front right hit)
		 Back out while turning CCW
		 Start Drive timer
      input is 2: (Called when Front left hit )
         Back out and CCW
		 Start Drive timer
      input is 3: (Called when Back right hit)
         Drive forward and CW
		 Start Drive timer
      input is 4: (Called when back left hit)
		 Drive forward and CCW
		 Start Drive timer
	End switch statement
End function