Add input pins readback to arduino firmware