Cate did stuff

Stuff done with Cate. Detected center goal direction, added horizontal
and vertical lift control.