public TorquePI()
{
Loop = new PIDLoop();
}
public TorquePI()
{
Loop = new PIDLoop();
Ts = 2; /* FIXME: use high pass filter to measure output noise and decrease this value when no noise, and increase when it oscillates */
TorqueAdjust = new MovingAverage();
}