Pieter said trajopt doesn't do self collisions, so reverting back to old myRaven