Mercurial > hg > beaglert
diff examples/airharp/MassSpringDamper.cpp @ 300:dbeed520b014 prerelease
Renamed projects to examples
author | Giulio Moro <giuliomoro@yahoo.it> |
---|---|
date | Fri, 27 May 2016 13:58:20 +0100 |
parents | projects/airharp/MassSpringDamper.cpp@40badaff5729 |
children |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/examples/airharp/MassSpringDamper.cpp Fri May 27 13:58:20 2016 +0100 @@ -0,0 +1,59 @@ +/* + * + * Simple 1-Dimensional Mass Spring Damper + * + * Christian Heinrichs 04/2015 + * + */ + +#include "MassSpringDamper.h" + +MassSpringDamper::MassSpringDamper(float mass, float spring, float damp) { + + _dt = 1.0/44100.0; + _mass = mass; + _spring = spring; + _damp = damp; + _position = 0; + _velocity = 0; + +} + +void MassSpringDamper::setup() { + +} + +double MassSpringDamper::update(float inForce) { + + // 1. calculate spring/damper forces using current position and velocity + + double out = (_position * (double)_spring * -1) + (_velocity * (double)_damp * -1); + + // 2. apply external force + + out += inForce; + + // 3. derive acceleration (a = f/m) + + out /= (double)_mass; + + // 4. derive velocity (v = a*dt) + + out *= _dt; + + // 5. apply previous velocity + + out += _velocity; + + // 6. save current velocity state for next iteration + + _velocity = out; + + // 7. derive new position (x[n] = x[n-1] + v[n]) and save for next iteration + + out += _position; + _position = out; + + return out; + +}