Skip to content

Instantly share code, notes, and snippets.

@rjlutz
Created June 7, 2017 16:25
Show Gist options
  • Star 0 You must be signed in to star a gist
  • Fork 0 You must be signed in to fork a gist
  • Save rjlutz/f3f628e24d1ed99730e80a72a37a6abf to your computer and use it in GitHub Desktop.
Save rjlutz/f3f628e24d1ed99730e80a72a37a6abf to your computer and use it in GitHub Desktop.
// de-emphasize transient forces
private float lowPass(float current, float gravity) {
// ALPHA indicates the influence level of past observations
return current * (1-ALPHA) + gravity * ALPHA;
}
// de-emphasize constant forces
private float highPass(float current, float gravity) {
return current - gravity;
}
private boolean inRange(float value, float target, float tol) {
return value >= target-tol && value <= target+tol;
}
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment