added plotting notebook and results
Merge branch 'master' of https://github.com/cdlrpi/fmm-rigidbodies