DRRT
DRRT copied to clipboard
Saturate
s
Hi your saturate function only contain serverl lines "nP.head(2) = cP.head(2) + ( nP.head(2) - cP.head(2) ) * delta / distance;
while(nP(2) < -2*PI) nP(2) += 2*PI;
while(nP(2) > 2*PI) nP(2) -= 2*PI;"
Is it un-complete?