In line 298 of probability_mapper.py, your intend to create a normal continuous random variable based on the reading and its standard deviation, however the standard deviation that you provide has different units than the reading provided.
Such std devs are interpolations of TOF_STD_DEV/INFRARED_STD_DEV, which are not in millimeter units, but actually are decimal fractions of the actual measured distances. (e.g. for a TOF reading between 0 and 0.05 meters, there is a std_dev of 12.6% of the actual reading).
Refer to: https://cyberbotics.com/doc/reference/distancesensor#lookup-table