Implemented OmniControl functions

Implemented functions in OmniControl and renamed from omniMotor.
Added license

Pending final license decision.
Defined crServo Interface and implemented