Added ability to reset kinfu. Just publish Empty message on /reset_kinfu.