-Added all 6 joint visualizations
-Works with dummy robot rest interface