Fixed the fact I was calculating the wrong heading.../vibrate command