added barebones trajectory controller