kalmanNode.cpp adjustment