Arduino Side code, needs debugging