Subversion Repositories FlightCtrl

Rev

Rev 308 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 308 Rev 309
Line 138... Line 138...
138
        cos_nick = cos_f(MM3.NickGrad);
138
        cos_nick = cos_f(MM3.NickGrad);
139
        sin_roll = sin_f(MM3.RollGrad);
139
        sin_roll = sin_f(MM3.RollGrad);
140
        cos_roll = cos_f(MM3.RollGrad);      
140
        cos_roll = cos_f(MM3.RollGrad);      
Line 141... Line 141...
141
       
141
       
142
    // Neigungskompensation
142
    // Neigungskompensation
143
        x_corr = (cos_nick * MM3.x_axis) + (((sin_roll *  MM3.y_axis) - (cos_roll * MM3.z_axis)) * sin_nick);
143
        x_corr = (cos_nick * MM3.x_axis) - (((sin_roll *  MM3.y_axis) - (cos_roll * MM3.z_axis)) * sin_nick);
Line 144... Line 144...
144
        y_corr = ((cos_roll * MM3.y_axis) + (sin_roll * MM3.z_axis));
144
        y_corr = ((cos_roll * MM3.y_axis) + (sin_roll * MM3.z_axis));
145
       
145