Refactor rotation cost functions in optimiser

Give Rotation struct members more descriptive names.
Overload to allow application of Rotation struct to points.
Perform cost calculations on samples directly.