EMI: Implement head limits.

This commit is contained in:
Joni Vähämäki 2014-06-26 16:34:05 +03:00
parent 3adbd1fdcf
commit 23a99a9f2b
10 changed files with 69 additions and 12 deletions

View file

@ -52,6 +52,16 @@ Angle &Angle::clampDegrees(float mag) {
return *this;
}
Angle &Angle::clampDegrees(float min, float max) {
_degrees = getDegrees(-180.f);
if (_degrees >= max)
setDegrees(max);
if (_degrees <= min)
setDegrees(min);
return *this;
}
void Angle::setDegrees(float degrees) {
_degrees = degrees;
}