Update to Arduino1.5 code