Fixed bug #8.
Merge branch 'master' into multibody
More work on anchors.

1. Made anchor method lookup O(1) by adding an index to the anchor
2. Moved the anchor definition from embodied_entity.h to physics_model.h to prevent circular dependencies