Removed inflation layer full
Checks total trajectory now and deaccelerates with max when no solution can be found