fill in distance field, update build
rework interfaces, moveit plugin further along