3D Spring System in Simulink

Question

0 个投票

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,

Get a distance between 2 objects. Initial distance is 0.3[m] (z=-0.3).
Calculate the deformation of spring, supporsing natural length as 0.25 [m].
Calculate the spring force.
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!