Main code updated + a feature demo

BETA - Untested with some know errors
The robot arm program was further organised. Also set to only print its
position when the position changes. A feature demo was created
showcasing the new features (encoder, button, force resistor)