Fix Atlas geometry. I had gotten the wrong version of the meshes. These are from meshes_v3 which matches the urdf.
Remove unneeded debug output; add print #dofs.