changed rad change so it isn't spinning for hours

This commit is contained in:
Mees Roelofsz
2024-10-01 13:24:34 +02:00
parent aa2e141db6
commit 163e7d4b7c

View File

@@ -462,11 +462,11 @@ long double CKobuki::gyroToRad(signed short GyroAngle) {
long double ret;
if (GyroAngle < 0) {
ret = GyroAngle + 36000;
ret = GyroAngle + 360;
} else {
ret = GyroAngle;
}
return (long double)ret * PI / 18000.0;
return (long double)ret * PI / 180.0;
}
long CKobuki::loop(void *user_data, TKobukiData &Kobuki_data) {