Refactored cubes into their own class
Animate heads correctly
Cleaned up 3D visualization
Fixed visualizer controls