WIP: Added co-ord functions to ReferenceFrame

A few functions that aim at assisting the user in dealing with co-ordinates of points in a ReferenceFrame with respect ot a predefined (but editable) origin.