MIT Cloth system(step 3), fix pendulum bug, add drawing and system switching