More work on anchors.

1. Created a generic system to register anchor calculation methods
2. Moved SAnchor outside CEmbodiedEntity to fix compilation issues
Merge branch 'multibody' of https://github.com/ilpincy/argos3 into multibody
More work on the anchors.

1. added the origin anchor
2. fixed compilation issues