Thanks:

Many thanks to Markus Gaugusch who corrected and improved my C++ code!