This repository was archived by the owner on Feb 25, 2021. It is now read-only.
File tree 1 file changed +4
-4
lines changed
1 file changed +4
-4
lines changed Original file line number Diff line number Diff line change @@ -547,14 +547,14 @@ void sensorWorkerSteeringPoller( void* z ) {
547
547
// just for the human, nicer names
548
548
float wheelbase = steerConfig.wheelAngleFirstArmLenght ;
549
549
float trackWidth = steerConfig.wheelAngleSecondArmLenght ;
550
- bool negativeAngel = wheelAngleTmp < 0 ;
550
+ bool negativeAngle = wheelAngleTmp < 0 ;
551
551
float mathAngle = abs (wheelAngleTmp) * PI / 180 ;
552
552
553
553
// calculate the distance of the adjacent side of the triangle (turning point rear axle <-> turn circle center)
554
554
float distance = wheelbase / tan ( mathAngle );
555
555
// add or substract half the trackWidth
556
- if ( ( negativeAngel && steerConfig.wheelAngleSensorType == SteerConfig::WheelAngleSensorType::AckermannLeft )
557
- || ( ! negativeAngel && steerConfig.wheelAngleSensorType == SteerConfig::WheelAngleSensorType::AckermannRight ) ) {
556
+ if ( ( negativeAngle && steerConfig.wheelAngleSensorType == SteerConfig::WheelAngleSensorType::AckermannLeft )
557
+ || ( ! negativeAngle && steerConfig.wheelAngleSensorType == SteerConfig::WheelAngleSensorType::AckermannRight ) ) {
558
558
distance += trackWidth / 2 ;
559
559
} else {
560
560
distance -= trackWidth / 2 ;
@@ -564,7 +564,7 @@ void sensorWorkerSteeringPoller( void* z ) {
564
564
mathAngle = atan (wheelbase / distance);
565
565
566
566
// convert back to degrees and add go back to negative/positive
567
- if (negativeAngel ) {
567
+ if (negativeAngle ) {
568
568
wheelAngleTmp = mathAngle * 180 / PI * -1 ;
569
569
} else {
570
570
wheelAngleTmp = mathAngle * 180 / PI;
You can’t perform that action at this time.
0 commit comments