implemented bug0 and fixed errors in Map
theta overflow check
Pledge added, minor changes to Bug0
changed theta calculation, meter/centimeter
no way counter changed
Branch MovementAlgorithm merged with master