Remove unused functions
Simplify make_cs_to_XYZ_matrix