Finished up vector-ization.
Added a PID loop for the lift.

Possibly non-functional.