m_xkk[0]= VEHICLE_INITIAL_X;
    m_xkk[1]= VEHICLE_INITIAL_Y;
    m_xkk[2]=-VEHICLE_INITIAL_V;
    m_xkk[3]=0;