Minor Feature addition and bug removal

-Naming of variables
-F/w versioning
-motor speed set
-PID correction
-enable/disable servo,encoder