Added fix for distance error in apriltags.cpp