Metrics (Fixes Issues #96 #97 #98)

Metrics implementation with the default servo implementation.