[script/robot_wrapper] add momentum function. add vcom and acom to separately compute the quantities