updated function test script plotting
Merge branch 'develop' of github.com:erhs-robotics/Robo2013 into develop