Disabled all tests other than Fsquared_test
Removed updateDestination prototype and edited handleCollisionAvoidance parameters
Changed parameters to handleCollisionAvoidance and removed previous implementation
Changed paramaters to the handleCollisionAvoidance function call