Added comIK Test
Updated Animate2D function to plot COM