Initial upload of code

Now with support for dancing robots and LCD displays