True scale tacking and mapping using downward looking camera and rangefinder

[Razbotics]

According to algorithm the median scene depth is calculated and used for scale. I want to know if we can replace median scene depth with measurements from rangefinder and obtain true scale tracking and mapping. In this below reference here is the region where median scene depth is calculated is this the correct region for modification or more modification is needed?

ORB_SLAM/src/Tracking.cc

Line 439 in ce19965

float medianDepth = pKFini->ComputeSceneMedianDepth(2);

It will be really appreciated if I get some help for the modifications.