Added skeleton tracking

. I turned off the the color sensor for now to display the skeleton
tracking part
. Also I'm only displaying the upper body joints and bones cause we
don't need the rest.
. We should talk about how to structure our code sometime... as well