Each robot should have flange, and tool0 should be a child of flange not the last robot link. See [REP-0199](http://gavanderhoorn.github.io/rep/rep-0199.html). Related: #21