This issue has been figured out by David Basta.
Basically, there is one git commit flipped the sign with respect to paper writing.
feedback controller has been also flipped into positive sign.
This issue remains mysterious currently, still under investigation.