[WIP] Added much lift code

PID :)