merged rudder init with drive init and changed some test harnesses to test rudder control. It works fine.
Merge pull request #43 from ddeo/master

Test harnesses for drive is changed. Rudder control tested. Rudder init was merged with the drive init.