finally fixed package structure issues
more structural improvements
added a robot positioning service wrt graph. not a hundred percent sure if it works as expected, need more debugging