Input | Node(Pos, Vel), Spring |
output | Node(Force) |
1 | |
2 | Node1 = NodetSpring [I].index1] |
3 | len = sqrt(PDir.x^2 + PDir.y^2 + PDir.z^2) |
4 | Stiffness = Ks * (len - RestLength) |
5 | SpringForce = Stiffness + Damping |
6 | Node1. AddF orce(SpringForce) |