pub fn to_degrees(angles: &Joints) -> [f32; 6]
Convert joints that are array of f64’s in radians to array of f32’s in degrees