Merge pull request #1 from abubeck/master

Changed Trajectory from back to front
configs for MoveToNeutralFront
added new state to bring the arm home after box was delivered
Changes for working scenario shown at AGV meeting.