Rudder control started implementation.

Creating rudder control for heading correction and implementing velocity controller.