Added dynamic nodes to end of links
Added joint breakpoints