General bugfixing

* Updated lift controls
* Added wraparound for servos