(irtdyna.l, test-irt-motion.l) Fix bug of :cog-convergence-check and add test codes