Everything wrapped up; moving on to acrobot. SQP up and running, not tuned yet