added code for simple spin to heading.  Need to add motor moves