fafo/OpenMicroManipulator
17
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

updated firmware

Browse source
This commit is contained in:
0x23 2025-08-28 14:07:54 +02:00
parent 9891b8ed44
commit f17ca0c820
11 changed files with 273 additions and 56 deletions
Download patch file Download diff file Expand all files Collapse all files

9
firmware/MotionControllerRP/src/servo_control/servo_controller.h
View file

@ -50,15 +50,16 @@ class ServoController {
float motor_pos_to_field_angle(float motor_pos);
float motor_velocity_to_field_velocity(float v);
public:
LowpassFilter velocity_lowpass;
PIDController pos_controller;
PIDController velocity_controller;
private:
ENCODER_TYPE& encoder;
MOTOR_DRIVER_TYPE& motor_driver;
LookupTable enc_to_pos_lut;
LowpassFilter velocity_lowpass;
PIDController pos_controller;
PIDController velocity_controller;
float motor_pos = 0; // current motor position
float motor_pos_prev = 0; // previous motor position
float pos_error = 0; // current position error as computed by upate()