Post Test Commit V1

During Testing both the calculations for the distance and angle were
somewhat high. Implementations of relative angle to the camera and
removal of lift forces are included.