new PID 2dLQ implementation to fix bug 54540