Add Riccardo's Tests
Add Riccardo's Test. Code readibility slightly improved; minor performance improvements.
Merge pull request #2 from vitillo/master

Geometry benchmarks added.