Reads in sdf worlds and natively generates 3D visualizer.

The addRobotFromSDF.m command works with basic functionality (does not yet support include which is important in many of the files that we will be supplied) in of itself. The file runCinderBlocks.m runs into errors when executing constructVisualizer on the resultant object. This is because a struct is added in model.body element which cannot be solved into something a visualizer can use. This change occurs in removeFixedJoints in RigidBodyManipulator.m. 
i accidentally pushed this to RobotLocomotion instead of my fork.  it’s not ready for code review yet.  :)

On Dec 15, 2014, at 11:56 AM, Andres Valenzuela <notifications@github.com> wrote:

> In systems/plants/RigidBodyGeometry.m:
> 
> > +              end
> > +              filename = fullfile(path,[name,ext]);
> > +            end
> > +            
> > +            obj = RigidBodyMesh(GetFullPath(filename));
> > +            obj.scale = scale;
> > +          case 'capsule'
> > +            r = parseParamString(model,robotnum,char(thisNode.getAttribute('radius')));
> > +            l = parseParamString(model,robotnum,char(thisNode.getAttribute('length')));
> > +            obj = RigidBodyCapsule(r,l);  % l/2
> > +        end
> > +        obj.T = T;
> > +      end
> > +    end
> > +    
> > +    function obj = parse_URDF_or_SDF_Node(node,x0,rpy,model,robotnum,options)
> This should be parseURDFOrSDFNode according to the style guide
> 
> —
> Reply to this email directly or view it on GitHub.
>