Claw gets further when zeroing.

- Claw now roughly finds out where it is.
- The state feedback loop now has a Correct method which takes the
  measurement to use.
6 files changed