simple\cntrl.m ......\dlink.m ......\dlinkplot.m ......\input.m ......\twolinkcompensation.slx simple