Subversion Repositories NaviCtrl

Rev

Rev 338 | Rev 340 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 338 Rev 339
Line 155... Line 155...
155
        // initiate new compass communication
155
        // initiate new compass communication
156
        switch(Compass_Device)
156
        switch(Compass_Device)
157
        {
157
        {
158
                case COMPASS_MK3MAG:
158
                case COMPASS_MK3MAG:
159
                        MK3MAG_Update();
159
                        MK3MAG_Update();
-
 
160
                        DebugOut.Analog[24] = MagVector.X;
-
 
161
                        DebugOut.Analog[25] = MagVector.Y;
-
 
162
                        DebugOut.Analog[26] = MagVector.Z;
160
                        break;
163
                        break;
161
                case COMPASS_NCMAG:
164
                case COMPASS_NCMAG:
162
                        NCMAG_Update();
165
                        NCMAG_Update();
-
 
166
                        DebugOut.Analog[24] = MagRawVector.X;
-
 
167
                        DebugOut.Analog[25] = MagRawVector.Y;
-
 
168
                        DebugOut.Analog[26] = MagRawVector.Z;
163
                default:
169
                default:
164
                        break;
170
                        break;
165
        }
171
        }
166
        DebugOut.Analog[24] = MagVector.X;
-
 
167
        DebugOut.Analog[25] = MagVector.Y;
-
 
168
        DebugOut.Analog[26] = MagVector.Z;
-
 
169
    if(!((old.X == MagVector.X) || (old.Y == MagVector.Y) || (old.Z == MagVector.Z))) check_value_counter = 0; // Values are normally changing
172
    if(!((old.X == MagVector.X) || (old.Y == MagVector.Y) || (old.Z == MagVector.Z))) check_value_counter = 0; // Values are normally changing
Line 170... Line 173...
170
 
173
 
171
        if(check_value_counter > 5000)
174
        if(check_value_counter > 5000)
172
         {
175
         {