Updated test cases

Completed both the test classes for the waypoint and the vector classes