Fix broken routing on Arduino

Bad logic broke routing