I would appreciate if you can show me the actual lines of Arduino code that are required.
I will be happy to post the code that I use, based on what I've already posted.
However, I am not interested in trying to adapt it to your approach to steering, because I don't think your approach will work with PID. A jerky or nonlinear response can be fatal for PID controllers.