Basic simulation and visualization work.

The code now depends on the new changes to shapes in pydy.viz that allow
geometry to be specified as symbols and expressions. The segments can output
visualization frames. An example simulation has been added.