add movement distance utility
add comments in header file of utility_distance, remove magic numbers in utility_distance
Merge branch 'movement_distance'

Conflicts:
	Makefile
Merge branch 'master' of github.com:Vandborg/SW505E14-Software