Add encoder sensor readings, and use a better JSON library