Added missing sqrt to distance calc in miabot wp control law.
Updated test waypoint files with reachable goal poses. Added cells.
Merge branch 'refactor' of https://github.com/leonard-lab/dcsl-matlab-api into refactor