Write a class that can take a setpoint and impedance gains as an input and generates torque commands as an output.
Write a class that can take a setpoint and impedance gains as an input and generates torque commands as an output.