inverse dynamics for a tree works! This covers chains as well (but using kdl tree for chains)/ Maybe we should just rid ourselves from KDL::Chain specific implementaion. Need to check