added velocity equation to the message, and a function for velocity