Fixed compile bug (removed iCub_Joint from old code)