c++ double integral working. Very fast!