Get the LCD port working with dynamic addressing. DONE
See if I can find a different MQTT library as the one we have now is only able to use QOS 0 which does not guarantee message delivery. During testing I have found messages missing which makes telemetry less reliable. Alternatively I could include a sequence number in each message so that it is clear when data has gone missing.
Make the robot API which will control access to all of the underlying libraries. This will be key to any plans for future robot tinkering or making this a generic platform.
Move functions to their own libraries to clean up code base.