Implemented updateHeading for rudder control and velocity control
Merge branch 'master' of git://github.com/dagoodma/sdp
Implemented controller for velocity and rudder
Merge pull request #42 from ddeo/master

Rudder control started implementation.