modified collision_dynamic.py for both arm against torso