[Feature] More metrics

[contagon]

The metric computation needs to be majorly updated, it needs relative (windowed) trajectory error added. Probably needs to be a bit more generic to reduce computations as well

[contagon]

Closed in #26