modified to use KDL parser for composing the KDL chain; works now up until the breakpoint