added changes to navigation

added comments to ask connor later
and added a methods to calculate at whatt angle the x and y is also
added speed changes to the turn method