Skip to main content
. Author manuscript; available in PMC: 2019 Dec 1.
Published in final edited form as: IEEE Control Syst. 2018 Nov 15;38(6):88–113. doi: 10.1109/MCS.2018.2866605
1.
Mq¨+Cq˙+N+AheelTλ=τexo+τhum
if aflat ≠ 0,
2.
q˙+=(IM1AflatT(AflatM1AflatT)1Aflat)q˙
if aflat = 0,
3.
Mq¨+Cq˙+N+AflatTλ=τexo+τhum
if |cp(q,q˙)|<lf,
4. q˙+=q˙, (q(1)+,q(2)+)T=G if |cp(q,q˙)|=lf,
5.
Mq¨+Cq˙+N+AtoeTλ=τexo+τhum
if h(q) ≠ 0,
6.
(q+,q˙+)=J(q,q˙)
if h(q) = 0,