Hi @TheCamusean ! Thank you for sharing your awesome work!! Do you have an example of Algorithm 4 in the paper with a full robot arm? Thank you, Juan