Utility.py: The MotionState has been fixed, All have been tested
Approach.py: I don't remember what' been changed
gate.py: modified to use Utility.py, MotionState, and SuperApproach