initialize _vel_dot and _STEdotErrLast