| 18 | |
| 19 | |
| 20 | uint32_t AverageAngle::add(float alpha, float length) |
| 21 | { |
| 22 | if (_type == AverageAngle::DEGREES ) |
| 23 | { |
| 24 | alpha *= DEG_TO_RAD; // (PI / 180.0); |
| 25 | } |
| 26 | else if (_type == AverageAngle::GRADIANS ) |
| 27 | { |
| 28 | alpha *= GRAD_TO_RAD; // (PI / 200.0); |
| 29 | } |
| 30 | _sumx += (cos(alpha) * length); |
| 31 | _sumy += (sin(alpha) * length); |
| 32 | _count++; |
| 33 | return _count; |
| 34 | } |
| 35 | |
| 36 | |
| 37 | void AverageAngle::reset() |