@Override public double[] latLngRadToECEF(double lat, double lng, double h) { // Then to sine and cosines: final double clat = Math.cos(lat), slat = MathUtil.cosToSin(lat, clat); final double clng = Math.cos(lng), slng = MathUtil.cosToSin(lng, clng); return new double[] { (EARTH_RADIUS + h) * clat * clng, (EARTH_RADIUS + h) * clat * slng, (EARTH_RADIUS + h) * slat }; }