TODO Update from 2022 running TPs Clear all output for pushed version Add LQR finite horizon Add GJK-2D Add Other planning algorithm For deployments create virgin repo and copy all the content do rm [0-9]* rm -r tp[0-9]* add tpX folder and X_ notebooks incrementaly.