public void sendDriveState(UGV.DriveState state, byte id = 1)
 {
     NGCP.VehicleSystemStatus vss = new NGCP.VehicleSystemStatus((byte)NodeID, 0, (byte)state);
     Node.Send(vss, id);
 }
 public void sendMode(UGV.DriveMode mode, byte id = 1)
 {
     NGCP.VehicleSystemStatus vss = new NGCP.VehicleSystemStatus((byte)NodeID, (byte)mode);
     Node.Send(vss, id);
 }