Subversion Repositories FlightCtrl

Rev

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

Rev 2045 Rev 2046
Line 32... Line 32...
32
      projection = MINPROJECTION;
32
      projection = MINPROJECTION;
33
    } else if (projection > -MINPROJECTION && projection < 0) {
33
    } else if (projection > -MINPROJECTION && projection < 0) {
34
      projection = -MINPROJECTION;
34
      projection = -MINPROJECTION;
35
    } else {
35
    } else {
36
    }
36
    }
37
    y = ((int32_t) throttle << (MATH_UNIT_FACTOR_LOG * 2 - 8)) / projection
37
    y = ((int32_t) throttle << (MATH_UNIT_FACTOR_LOG * 2 - 8)) / projection - throttle;
38
        - throttle;
-
 
39
  }
38
  }
40
  deltaThrottle = ((int32_t)y * effect) >> 6;
39
  deltaThrottle = ((int32_t)y * effect) >> 6;
41
  // debugOut.analog[8] = deltaThrottle;
40
  // debugOut.analog[8] = deltaThrottle;
42
  return throttle + deltaThrottle;
41
  return throttle + deltaThrottle;
43
}
42
}