Added manual command feature
Drew speed and acceleration vectors