Refactor position update. Fix bugs in position update.
Merge pull request #45 from valleyjo/av/fix_position_updates

Refactor position update. Fix bugs in position update.