_get_slip_angle function improvements

Add tests to _get_slip_angle with answers hand calculated. Make _get_slip_angle function much simpler