-Add publishing of target veloecity and acceleration