Subversion Repositories FlightCtrl

Rev

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

Rev 108 Rev 117
Line 105... Line 105...
105
        case 6:
105
        case 6:
106
            accumulate_AccHoch =  (signed int) ADC - NeutralAccZ;
106
            accumulate_AccHoch =  (signed int) ADC - NeutralAccZ;
107
            accumulate_AccHoch += abs(Aktuell_ay) / 4 + abs(Aktuell_ax) / 4;
107
            accumulate_AccHoch += abs(Aktuell_ay) / 4 + abs(Aktuell_ax) / 4;
108
            if(accumulate_AccHoch > 1)
108
            if(accumulate_AccHoch > 1)
109
             {
109
             {
110
              if(NeutralAccZ < 800) NeutralAccZ+= 0.02;
110
            if(NeutralAccZ < 800) NeutralAccZ+= 0.02;
111
             }  
111
             }  
112
             else if(accumulate_AccHoch < -1)
112
             else if(accumulate_AccHoch < -1)
113
             {
113
             {
114
              if(NeutralAccZ > 600) NeutralAccZ-= 0.02;
114
              if(NeutralAccZ > 600) NeutralAccZ-= 0.02;
115
             }
115
             }