Update to recent IDE1.5.6-r2

The code is for Arduino 022. I convert it to 1.5.6-r2.