Added non-complete integrated trajectory controller