Realized that implementation has been correct for a while. Was using test case at equator with reference radius instead of WGS84 equatorial radius that the online reference implementation was using.