Add simple joint trajectory replay