RoboidControl/RoboidControl-cpp
RoboidControl/RoboidControl-cpp
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Improve servo angle limits

Browse Source
This commit is contained in:
Pascal Serrarens 2024-09-25 11:28:31 +02:00
parent 9a5fcf5798
commit b662348236
3 changed files with 4 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
LinearAlgebra

@ -1 +1 @@
Subproject commit 9eca3189918ecfbaae462427619c263f636b6d9d Subproject commit 95a6fb3a4b5eca70dee33381611e5df9d28fdcee

3
ServoMotor.cpp
View File

@ -11,8 +11,7 @@ ServoMotor::ServoMotor()
} }
void ServoMotor::SetTargetAngle(Angle16 angle) { void ServoMotor::SetTargetAngle(Angle16 angle) {
angle = Angle16::Degrees(Float::Clamp(angle.InDegrees(), minAngle.InDegrees(), angle = Angle16::Clamp(angle, minAngle, maxAngle);
maxAngle.InDegrees()));
if (maxSpeed == 0.0F) { if (maxSpeed == 0.0F) {
SetAngle(angle); SetAngle(angle);

4
ServoMotor.h
View File

@ -11,8 +11,8 @@ class ServoMotor : public Thing {
ServoMotor(); ServoMotor();
Vector3 rotationAxis = Vector3::up; Vector3 rotationAxis = Vector3::up;
Angle minAngle = Angle::Degrees(-90); Angle16 minAngle = Angle16::Degrees(-90);
Angle maxAngle = Angle::Degrees(90); Angle16 maxAngle = Angle16::Degrees(90);
enum ControlMode { Position, Velocity }; enum ControlMode { Position, Velocity };
ControlMode controlMode = ControlMode::Position; ControlMode controlMode = ControlMode::Position;