Swap h-bridge A/B bits and properly update STEPPING_PORT with invert_mask