static AbstractComsSetup() { if (!s_initialized) { HAL.Base.HAL.Initialize(); HAL.Base.HALDriverStation.HAL_ObserveUserProgramStarting(); LiveWindow.LiveWindow.SetEnabled(false); Console.WriteLine("Started coms"); if (RobotBase.IsSimulation) { s_initialized = true; DriverStationHelper.StartDSLoop(); DriverStationHelper.SetRobotMode(DriverStationHelper.RobotMode.Teleop); DriverStationHelper.SetEnabledState(DriverStationHelper.EnabledState.Enabled); Thread.Sleep(500); SimJumpers.AttachDioPins(6, 7); SimJumpers.AttachDioPins(8, 9); SimJumpers.AttachRelay(0, 19, 18); SimJumpers.AttachAio(2, 0); SimData.Accelerometer.SetX(0.0); SimData.Accelerometer.SetY(0.0); SimData.Accelerometer.SetZ(1.0); return; } int i = 0; while (!DriverStation.Instance.Enabled) { try { Thread.Sleep(1000); } catch (ThreadInterruptedException e) { Console.WriteLine(e); } Console.Write("\rWaiting for enable: " + i++); } Console.WriteLine(); s_initialized = true; Console.WriteLine("Running!"); } }