Update KalTools.cpp