Fixed Metric rectifiction

- metric rectification library fixed
- rectification seems to work properly
- missing scale and rotation reconstruction