MATLAB: 3D Spring System in Simulink

simulink

Hi everyone,
I'm creating a spring system that moves in 3D space. Now I managed to create something like that but it won't move as expected.
I attach the project files which contains my model. I only calculate the spring force though the model has a dumper component.
In my model,
  1. Get a distance between 2 objects. Initial distance is 0.3[m] (z=-0.3).
  2. Calculate the deformation of spring, supporsing natural length as 0.25 [m].
  3. Calculate the spring force.
  4. Multiple force by vector, which is from the base to the follower. And multiple also by Rotation.
I refered to Example file of Simscape Multibody Contact Forces Library to create this spring system.
I expect equilibrium point as -0.25 and spring moves up at first. But in simulation, it moves down and equilibrium point is around z=-2.25.
Maybe I implement incorrectly, but I don't know which is wrong.
Thanks!

Best Answer

I managed to create 3D spring. Please refer to this link.