Only working on the right side. Made the following a bit more complex. Playing with kd and kp values, trying to keep distance.
Added missing ros files