Implemented the coordinate system transform functions fully, will test soon