Connect q and qRef to ThermoEstimator to estimate joint torque from error