update with colors etc, we now need to test it on physical robots