Properly accounting for model scope necessary to look for the link name in the model, e.g. iCub::l_arm (as in model iCub (feet_fixed)) vs. l_arm alone
Added initial code to draw line/arrow on the point of applied force