Base work

Calculation for distance returns pretty accurately, but need to work on
checking orientation/acceleration, as the values aren't very logical.