Fixed error in energy function for cartesian states - 3D Kepler motion examples now in agreement