for (int j=0; j<srv.response.tmsdb.size()-1; j++) {
Merge pull request #95 from irvs/issue93

update path planning every point of path