First review of code fix by Dan.
Delta angle is back ! needed as the other version was wasting
computation time. and missing abs(delta_angle)..
EN pin is for each H-bridge, and only one.
Code is still missing a detection function for when rudder angle is
changed to opposite direction of movement, to prevent oscillations in
rudder (May be wasted effort to add)