Ejemplo n.º 1
0
        //Reset all the byte arrays from modules
        public void ResetAllModuleCommValues()
        {
            relayData[rdHeaderHi]             = 127; // PGN - 32762
            relayData[rdHeaderLo]             = 250;
            relayData[rdSectionControlByteHi] = 0;
            relayData[rdSectionControlByteLo] = 0;
            relayData[rdSpeedXFour]           = 0;
            relayData[rdTramLine]             = 0;
            relayData[rdTree]    = 0;
            relayData[rdUTurn]   = 0;
            relayData[rdHydLift] = 0;
            relayData[rd9]       = 0;

            mf.RelayOutToPort(relayData, pgnSentenceLength);

            autoSteerData[sdHeaderHi]     = 127; // PGN - 32766
            autoSteerData[sdHeaderLo]     = 254;
            autoSteerData[sdRelayLo]      = 0;
            autoSteerData[sdSpeed]        = 0;
            autoSteerData[sdDistanceHi]   = 125; // PGN - 32020
            autoSteerData[sdDistanceLo]   = 20;
            autoSteerData[sdSteerAngleHi] = 125; // PGN - 32020
            autoSteerData[sdSteerAngleLo] = 20;
            autoSteerData[sdYouTurnByte]  = 0;
            mf.AutoSteerDataOutToPort();

            autoSteerSettings[ssHeaderHi]        = 127;// PGN - 32764 as header
            autoSteerSettings[ssHeaderLo]        = 252;
            autoSteerSettings[ssKp]              = Properties.Settings.Default.setAS_Kp;
            autoSteerSettings[ssKi]              = Properties.Settings.Default.setAS_Ki;
            autoSteerSettings[ssKd]              = Properties.Settings.Default.setAS_Kd;
            autoSteerSettings[ssKo]              = Properties.Settings.Default.setAS_Ko;
            autoSteerSettings[ssSteerOffset]     = Properties.Settings.Default.setAS_steerAngleOffset;
            autoSteerSettings[ssMinPWM]          = Properties.Settings.Default.setAS_minSteerPWM;
            autoSteerSettings[ssMaxIntegral]     = Properties.Settings.Default.setAS_maxIntegral;
            autoSteerSettings[ssCountsPerDegree] = Properties.Settings.Default.setAS_countsPerDegree;
            mf.AutoSteerSettingsOutToPort();

            machineControlData[cnHeaderHi]     = 127; // PGN - 32758
            machineControlData[cnHeaderLo]     = 246;
            machineControlData[cnPedalControl] = 0;
            machineControlData[cnSpeed]        = 0;
            machineControlData[cnRelayLo]      = 0;
            machineControlData[cnYouTurn]      = 0;
            machineControlData[6] = 0;
            machineControlData[7] = 0;
            machineControlData[8] = 0;
            machineControlData[9] = 0;
        }