make it stable

Tried to implement more precise calibration with respect to having a
depth offset as well. Failed so far. But I need to move on, so tabling
this one for now.
At least I got it back into a stable state :)