JTI-CS2-2018-CFP09-LPA-03-18 Safe emergency trajectory generator