How to model a Longitudinal stanley controller

How do i model the controller?

I wanted to use the controller but it gives me an error when it is moving in the reverse direction. And its one of the restrictions of this controller. So i was trying to model the controller by breaking it down.