Update NaoControl.cpp