神经网络用于机器手臂的控制.doc

1、神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078神经网络用于机器手臂的控制机械手是一种高度非线性、强耦合、时变的系统,对它的控制基本为两种:基于精确数学模型的传统控制和与模型无关的智能控制。由于机械手系统的复杂性,其精确的数学模型难以建立,使应用传统的控制手段对其进行的控制效果欠佳。常用的智能控制手段如模糊控制、人工神经网络等又有各自的局限性。一般说来,模糊逻辑方法虽然长于表达近似与定性的知识,却通常无学习能力;神经网络具有学习能力,但内部知识的表达方式又是不清楚的,这样神经网络在每次学习时只能从任意初始条件开始,不能利用必要的初始经验或知

2、识,收敛速度慢,易陷入局部极限;而由于缺乏学习能力,模糊逻辑方法只能主观或试凑地选择隶属函数和模糊规则,不能根据积累的经验自动地改善系统的性能。上世纪 70年代,J.S.Albus 根据神经生理学小脑皮层的结构特点,提出了一种小脑模型关联控制(cerebellar model articulation controller),即 CMCA 神经网络,是一种类似于 Perceptron 的相联记忆方法,与模糊逻辑不但是相互补充的,而且也是相互结合的。首先它用连接主义来表达模糊逻辑控制器,引入了学习机制,也带来了两者结合的诸多优点,如存储容量的减小,泛化能力的增加,以及连接主义结构的容错性等。其次

3、,在 CMAC 的分布表达中,一个值由散布于许多计算单元的活性模式表示,每个计算单元又涉及许多不同值的表达,因此每个计算单元都有一个感受野(receptive field),即它表达的所有值的集合,这相当于每个计算单元都对应一个模糊集合,或者说感受野相当于隶属函数,这正是它们能够有机结合的一个基础。1CMAC 的优越性神经网络可分为全局逼近神经网络和局部逼近神经网络,如果网络的一个和多个连接权系数或自适应可调参数,在输入空间的每一点对任何一个输出都有影响,则称该神经网络为全局逼近网络。如 BP 网络,每一次样本学习都需要重新调整网络的所有权值,收敛速度慢,易陷入局部最小,很难满足控制系统的实时

4、性要求;若对输入空间的某个局部区域,只有少数几个连接权影响网络的输出,则称该网络为局部逼近网络,从而使局部逼近网络具有学习速度快的优点。CMAC、RBF以及某些模糊神经网络是局部逼近网络。CMAC 比其他神经网络的优越性体现在:(1) CMAC 神经网络把信息存储在局部的结构上,在保证函数逼近的前提下,学神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078习速度快。(2) CMAC 函数逼近器对学习数据出现的次序不敏感,因此,CMAC 在时变、非线性系统控制中得到广泛应用。(3) CMAC 结构简单,易于硬件实现和软件实现。因此,CMAC 已被

5、越来越多的学者所关注,并得到广泛的应用。2CMAC 模型结构CMAC 的模型结构如图 1 所以，它的工作过程是一系列映射。输入状态空间S 的维数由对象决定。一般来说，输入是模拟量，需要进行量化，然后才能送入存储区 A，状态空间中的每一点将同时激活 A 中的 c 个单元。网络输出F（s i）为 c 个对应单元中的值（即权 wi）累加的结果，如对应 s1输入单眼有c4 个，则 41)(isFFig1 CMAC 结构模型可把 c 看作是信号检测单元的感受野大小，其值与泛化能力有关，所以有时称c 为范化参数。如果输入 S 有 m 个分量（输入向量时 m 维的） ，而每一分量有 q 个量化等级，神经网络

6、课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078则 S 的可能状态有 qm个，它们都要映射到 A 中，并有其对应的（权）值。在 S中比较接近的那些样本在 A 中会出现交叠，如图 1 中 s2与 s3，它们有两个权时交叠的，从而其输出 F（s 2）和 F（s 3）也较相近，这可起到泛化的作用， ，对S 中相距很远的矢量这种泛化是不起作用的。如果用 Hamming 距离 d 表示si，s j的差异程度，则在 A 存储区内交叠的单元数约为 cd ij，cd ij0 的那些交叠区可以看作聚类的领域。这样，输入空间 S 中相近的向量映射后产生聚类。对一些实际

7、系统，q m往往很大，例如 10 维输入，每个量化为 100 个等级，则输入空间有 100 个可能的状态，这个需要 A 中至少有 100 个权与其对应。由于绝大数学习问题并不要包含所有状态，所以实际上不需要那么多的地址单元。A 只是一个虚拟地址，可把 A 的地址通过散列编码映射到一个小的多的物理地址 Ap中，且在 Ap中每一个状态也有 c 个地址与之对应，输出仍满足 ijwsF)(但在 Ap中 c 个单元是随机的，w i可通过学习得到，S 到 Ap部分是非线性映射，而 Ap到输出 F 是线性映射。3工作原理图 2 画出了一个较详细的二维输入，一维输出的 CMAC 模型，下面对每一部作分析。（1

8、） S 到 M 的映射神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078Fig2 CMAC 的工作原理图输入为二维， ，量化感知器 M 也分为两组 ， ，图 2TsS),(21 1中 M 的每一小格是一个感知器，感知器的个数是量化的级数， 和 的量1M化级数不一定相同，对任意输入 或 ，在 M 上可找到其对应的感知器，为泛12化需要，在对应量化周围 c 格感知器同时被激励。如表 1 所以，c4，a，b，c，l 表示感知器编号， 表示输入一个模拟对应的量化s值。任一量化值将引起 c 个感知器激活为 1，每个感知器也可对应于 c 个输入量 。例如

9、 是 25 之间， 为 1 的个数与聚类范围 c 相同，c 可由认为sem选择，表 1 中 c4，shijic 可以很大，例如从 10100。希望 S 中靠近的值在中也较近。把表中 为 1 的值表示为 a，b，c，后，可把表 1 整理化为表 2，其中每一 S 值与 4 个感知器对应。可以看出输入空间中相近的在输出 中也接近，且有smjiijiij msd表 1 感知器的激活情况 表 2 与各 对应的激活感知s器例如对两个接近的量 5 和 4 来说，ss145sdij， gfem,5435m可见 54ij神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 10303

10、19078一般情况下，输入是多维的，以二维情况为例，设 量化为 5 级， 量化1s2s为 7 级，它们分别用大写和小写字母表示，如表 3 和表 4 所示。表 3 表 2 与各 对应的激活感知器 表 4 表 2 与各 对应的激活感知器1s 2s在一般情况下 TinisS),(21则 映射为MSiniiimsMS21（2） M 到 A 的映射M 到 A 的映射是通过滚动组合得到的。其原则还是输入空间相近的矢量在输出空间也相近，如果输入感知器的兴奋元为 c 个，不管输入是多少维，A 中地址也对应 c 个。以二维 c4 情况为例，映射如表 5，用与的关系组合后，得到 A 的地址表 5 所示。 （下图为

11、表 5）神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078在表中， 和 组合成 ，每个 中含 c 个单元，在 A 中同样有 c 个1s2A单元被激励。在表 5 中，每一组合 Ae，Cf，都代表 A 中的一个地址，正如前面所说，这样的地址共有 个，数量很大，但实际能被激励的地址是非常稀mq疏的，可使用杂散技术把很大的 A 空间压缩到较小的实际空间 中去。p（3） A 到 的映射p杂散技术是将分布稀疏，占用较大存储空间的数据作为一个伪随机发生器的变量，产生一个占用空间小的随机地址，用于存放 A 中的数据。实现这一个压缩的最简单方法是将 A 中 的

12、地址除以一个大的质数，所得余数就作为一个伪随机码，表示为 中的地址。用杂散技术会带来冲撞问题，即 A 中不同的地p址在 中却被映射到同一个地址，若映射的随机性很强，将减少冲撞的概率，pA但仍不可避免。在 CMAC 中，我们忽略这种冲撞，因为冲撞部强烈时，可将其看作一种随机扰动，通过学习算法的迭代过程，可逐步将影响减小，而不影响输出结果。（4） 到 F 的映射pA网络输出为 ， 存于 的 个地址中，因为经 的Aiiws)(ipA AS变化后，有 个地址被选中，如不考虑冲撞，在中 也有 个地址对应， p由于使用杂散技术，在 中这 个地址是随机分布的。输出是这 个地址p中所存的权值的叠加，对应某一输

13、入样本，总可通过调整权值，达到应有的输神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078出值。4学习算法CMAC 的学习采用误差纠正算法，如图 3 所示。权值修正公式为Anwi)(1(为应有输出，0iiisFi0c，为综合聚类神经元数Aiis)(修正方法可以用每个样本修正一次的方法，也可用所有样本都输入一轮后在修正的批学习方法。Fig3 CMAC 的学习算法5程序作业算法的思路来此书本，为了验证所做算法的正确性，首先使用一个一维的进行验证。通过选择可以使用 CMAC 算法对一个正弦波形进行逼近。见程序一。（程序见附录）神经网络课程设计 神经网

14、络用于机器手臂的控制张建文 1030319100 张卜南 1030319078Fig1.1主要是通过图像来看 CMAC 的效果，通过多次对权值的修改，达到最好的效果。下面分别是三次网络的训练的逼近图。Fig1.1 是训练三次的结果 Fig1.2是它的权值分布，Fig2.1 也是训练五次的结果，Fig2.2 是它的权值分布，Fig3.1是训练九次的结果，Fig3.2 是它的权值分布：(其中显示的 SSe 是 21 个点上的误差的和均方根)神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078Fig 1.2 权值分布epoch = 1 SSE = 0

15、.926epoch = 2 SSE = 0.231epoch = 3 SSE = 0.058神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078Fig2.1Fig2.2 权值分布epoch = 1 SSE = 0.926epoch = 2 SSE = 0.231epoch = 3 SSE = 0.058epoch = 4 SSE = 0.014epoch = 5 SSE = 0.004神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078Fig3.1Fig3.2 权值分布epoch = 1 SSE

16、 = 0.926epoch = 2 SSE = 0.231epoch = 3 SSE = 0.058epoch = 4 SSE = 0.014epoch = 5 SSE = 0.004神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078epoch = 6 SSE = 0.001epoch = 7 SSE = 0.000epoch = 8 SSE = 0.000从上述可以看出在第六次训练的时候在规定的误差精度权值的分布已经很好的满足条件。同时可以看出 cmac 算法的优越性，在很少次数训练仍然可以达到很好的效果，从三次权值分布可以看出，权值分布形

17、状大致是一样的，可以看出在很少的步骤就可以达到效果，所不同的就是精度问题。而精度可以从误差 SSE 看出。在实际程序中同时还使用 cmac 算法对波形为阶梯波形以及脉冲波形进行训练。应用程序可以得到相应的训练结果（如下图）梯形波形神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078权值分布脉冲波形神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078权值分布从各个不通的波形可以看出所做算法的正确性，最后按照实验要求对机器人控制的模拟.同样按照课本上的思路，由于它是五维的输入，算法相对复杂一些。 （

18、见附录程序二）课程设计要求以及原理请看神经网络与模糊控制P151-156 的详细说明。其中最主要的部分通过 cmac 控制器实现，具体的学习原理可以看前面的具体叙述。神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078同样通过图形观察训练情况如图：训练一次的情况：误差和的均方根是：SSE=5.0533e-005神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078训练第二次情况：SSE=5.0439e-006训练第三次SSE = 4.7503e-006神经网络课程设计 神经网络用于机器手臂的控制张

19、建文 1030319100 张卜南 1030319078训练第四次SSE =5.0070e-006四次训练以后的权值分布神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078在机器人控制,使用了书上的学习步长为 0.00001,但是在实际使用中,效果不是很好,收敛太慢,在实际学习中使用的学习步长是 0.1,效果比较明显,然而当学习步长为 0.5,1.0 的时候算法变得不收敛,在本程序中可以在 matlab 的环境对这几种学习步长进行比较.可以具体运行程序观察。6不足对学习步长得确定没有通过具体的分析，是通过猜测估计得到.而算法的实现很重要的一节是

20、其鲁棒性的测试，但是由于时间问题没有对它的鲁棒性进行分析。这是很大的不足之处。7补充在算法中求对物理地址的实际映射使用的算法有很多。本程序还使用了来自网络的算法。同样可以得到书上算法的效果，但在实验中没有具体分析各个算法不同之处。希望在将来里能更深入的研究。附录程序一function cmac1d()% A single input single output CMAC networkhelp cmac1dclf resetpausetime = 0.1;P = -1:0.1:1;P3 = -1:0.005:1;% INITIALIZE iprange = 256;disp(sprintf(i

21、prange is %d,iprange);width=1;c=10;beta=0.5;memreq = c*ceil(iprange/width);s = sprintf(number of weights required is %d,memreq);disp(s);memsize=0;% INITIALISE WEIGHTS% =神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078if memsize = 0wts = zeros(memreq,1);elsewts = zeros(memsize,1);end% PLOT CMAC OU

22、TPUTwts,netout = modcmac(wts,(2.0)*64,1,1.0,1.0,iprange,c,width,memsize);for k=1:401wts,op(k) = opcmac(wts,(P3(k)+2.0)*64,1,iprange,c,width,memsize);end;plot(P3,op,r);axis(-1.0,1.0,-2.0,2.0);title(CMAC output after one training example);xlabel(Input Vector P);ylabel(Network Output);disp(any key to c

23、ontinue);pause%Define the associated twenty-one 1-element targets.z = menu(select target function, .damped sinusoid, .step, .impulse);disp()if z = 1T = -.9602 -.5770 -.0729 .3771 .6405 .6600 .4609 .1336 -.2013 -.4344 -.5000 -.3930 -.1647 .0988 .3072 .3960 .3449 .1816 -.0312 -.2189 -.3201;elseif z =

24、2T = 0 0 0 0 0 0 0 0 0 0 1 1 1 1 1 1 1 1 1 1 1;elseT = 0 0 0 0 0 0 0 0 0 0 1 0 0 0 0 0 0 0 0 0 0;endend神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078plot(P,T,+);title(Training Vectors);xlabel(Input Vector P);ylabel(Target Vector T);hold on% PLOT INITIALif memsize = 0wts = zeros(memreq,1);elsewt

25、s = zeros(memsize,1);endfor i=1:401wts,op(i) = opcmac(wts,(P3(i)+2.0)*64,1,iprange,c,width,memsize);endplot(P3,op,m);title(Function Approximation);xlabel(Input Vector P);ylabel(Target + Network -);h = get(gca,Children);h = h(1);hold onpause2(pausetime);% TRAIN THE NETWORK%=% TRAINING PARAMETERSmax_e

26、poch = input(enter maximum number of training epochs );epoch = 1;SSE = 1;while (epoch 0.02)for i = 1:21wts,netout = modcmac(wts,(P(i)+2.0)*64,1,T(i),beta,iprange,c,width,memsize);endfor k=1:401wts,op(k) = opcmac(wts,(P3(k)+2.0)*64,1,iprange,c,width,memsize);end for i = 1:21wts,p=opcmac(wts,(P(i)+2.0

27、)*64,1,iprange,c,width,memsize);神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078neterr(i) = T(i) - p;endSSE = sumsqr(neterr);fprintf(epoch = %d SSE = %5.3fn,epoch,SSE);delete(h);h = plot(P3,op,m);drawnowpause2(pausetime);epoch = epoch + 1;endenddisp(any key to continue);pausehold offbar(wts,r)tit

28、le(Network Weights);xlabel(Weight Number);ylabel(Weight Value);if memsize = 0set(gca,xlim,0 memreq);elseset(gca,xlim,0 memsize);endfunction wts,op=opcmac(wts,ip,ipdim,iprange,c,width,memsize)% OP = OPCMAC(WTS,IP,IPRANGE,C,WIDTH,MEMSIZE)HASH=12345;addrs=zeros(c,1);quantisation=ceil(iprange/width);off

29、set=width/c;ofs=0;op=0;for i=1:caddress=0;shift=1.0;for j=1:ipdim%address=address+rem(ceil(ip(j)+ofs)/width),quantisation)*shift;address=address+ceil(ip(j)/width)*shift;shift=shift*quantisation;end;% address=address+shift*i;if memsize0神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078addrs(i)=ceil(

30、rem(log(address+1)*HASH),memsize);else%addrs(i)=ceil(rem(address,c*ceil(iprange/width); memreq = c*ceil(iprange/width);addrs(i)=ceil(rem(address,memreq); end;ofs=ofs+offset;op=op+wts(addrs(i);end;function wts,mod=modcmac(wts,ip,ipdim,target,beta,iprange,c,width,memsize)addrs=zeros(c,1);quantisation=

31、ceil(iprange/width);offset=width/c;ofs=0;sum=0.0;for i=1:caddress=0;shift=1.0;for j=1:ipdimaddress=address+ceil(ip(j)/width)*shift;shift=shift*quantisation;end;address=address+shift*i;if memsize0addrs(i)=ceil(rem(log(address+1)*HASH),memsize);elsememreq = c*ceil(iprange/width);addrs(i)=ceil(rem(addr

32、ess,memreq);end;ofs=ofs+offset;sum=sum+wts(addrs(i);end;delta=beta*(target-sum)/c;for i=1:cwts(addrs(i)=wts(addrs(i)+delta;end;mod=sum+delta*c;程序二function robot()% neural networks housework神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078%use cmac simulink 2D robotic operation% CMAC operates as a

33、form of lookup table. Note, however,% that it generalises, i.e. is capable of producing outputs% in response to inputs not previously experienced.%5 dim input 3 dim outputhelp robot;clf reset;pausetime=0.1;quantisation=200;c=40;memsize=3080;pausez = menu(select step of studying, .0.00001, .0.1,.0.5,

34、.1.0);if z=1seta=0.00001;else if z=2seta=0.1;elseif z=3seta=0.5;elseif z=4seta=1.0;end;end;end;end;disp()%seta=0.1;l=0.5 0.5 0.5;ipdim=5;disp(sprintf(quantisation is; %d,quantisation);disp(sprintf(acceptive field is: %d,c);disp(sprintf(memsize is : %d,memsize);iprange=360;width=iprange/200;% data in

35、itial xd=zeros(200,2);神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078disp(any key to continue);pausez = menu(select target function, .Circle, .Line);disp()if z = 1for t=1:200xd(t,1)=0.5-0.25*cos(0.5*pi*0.02*(t-1);xd(t,2)=0.25+0.25*sin(0.5*pi*0.02*(t-1);end;elsefor t=1:200%xd(t,1)=0.5-0.25*cos(0.

36、5*pi*0.02*(t-1);%xd(t,2)=0.25+0.25*sin(0.5*pi*0.02*(t-1);xd(t,1)=0.5-0.0025*t;xd(t,2)=0.0025*t;end;end;k=1:200;hold off;plot(xd(k,1),xd(k,2);hold on;deta=-9.14 69.87 131.58;x=l(1)*cos(deta(1)*2*pi/360)+l(2)*cos(deta(1)+deta(2)*2*pi/360)+l(3)*cos(deta(1)+deta(2)+deta(3)*2*pi/360) .l(1)*sin(deta(1)*2*

37、pi/360)+l(2)*sin(deta(1)+deta(2)*2*pi/360)+l(3)*sin(deta(1)+deta(2)+deta(3)*2*pi/360);jmat=-l(1)*sin(deta(1)*2*pi/360)-l(2)*sin(deta(1)+deta(2)*2*pi/360)-l(3)*sin(deta(1)+deta(2)+deta(3)*2*pi/360) .-l(2)*sin(deta(1)+deta(2)*2*pi/360)-l(3)*sin(deta(1)+deta(2)+deta(3)*2*pi/360) .-l(3)*sin(deta(1)+deta

38、(2)+deta(3)*2*pi/360); .l(1)*cos(deta(1)*2*pi/360)+l(2)*cos(deta(1)+deta(2)*2*pi/360)+l(3)*cos(deta(1)+deta(2)+deta(3)*2*pi/360) .l(2)*cos(deta(1)+deta(2)*2*pi/360)+l(3)*cos(deta(1)+deta(2)+deta(3)*2*pi/360) .l(3)*cos(deta(1)+deta(2)+deta(3)*2*pi/360) ;wts=zeros(memsize,3);% weight stacksse=1;神经网络课程

39、设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078%sse=|Et| addrs=zeros(c,3);epcoh = input(enter number of training epochs );%epcoh=4;for p=1:epcohdisp(any key to continue);pausek=1:200;hold off;plot(xd(k,1),xd(k,2);hold on;for t=1:200delta_x=xd(t)-x;ip=deta 360*delta_x+90 90 90 0 0;HASH=123456;offset=wi

40、dth/c;ofs=0;seta_delta=0 0 0;for i=1:caddress=0;shift=1;for j=1:ipdimaddress=address+(rem(ceil(ip(j)+ofs)/width),quantisation)*shift;%address=address+(ceil(ip(j)/width)*shift;shift=shift*quantisation;end;address=address+shift*i;for j=1:3addrs(i,j)=ceil(rem(log(address+1)*HASH),memsize);%addrs(i,j)=m

41、od(address,memsize);end;ofs=ofs+offset;for j=1:3seta_delta(j)=seta_delta(j)+wts(addrs(i,j),j);end;end;deta=deta+seta_delta;x=l(1)*cos(deta(1)*2*pi/360)+l(2)*cos(deta(1)+deta(2)*2*pi/360)+l(3)*cos(deta(1)+deta(2)+deta(3)*2*pi/360) .l(1)*sin(deta(1)*2*pi/360)+l(2)*sin(deta(1)+deta(2)*2*pi/360)+l(3)*si

42、n(deta(1)+deta(2)+deta(3)*2*pi/360);jmat=-l(1)*sin(deta(1)*2*pi/360)-l(2)*sin(deta(1)+deta(2)*2*pi/360)-神经网络课程设计 神经网络用于机器手臂的控制张建文 1030319100 张卜南 1030319078l(3)*sin(deta(1)+deta(2)+deta(3)*2*pi/360) .-l(2)*sin(deta(1)+deta(2)*2*pi/360)-l(3)*sin(deta(1)+deta(2)+deta(3)*2*pi/360) .-l(3)*sin(deta(1)+det

43、a(2)+deta(3)*2*pi/360); .l(1)*cos(deta(1)*2*pi/360)+l(2)*cos(deta(1)+deta(2)*2*pi/360)+l(3)*cos(deta(1)+deta(2)+deta(3)*2*pi/360) .l(2)*cos(deta(1)+deta(2)*2*pi/360)+l(3)*cos(deta(1)+deta(2)+deta(3)*2*pi/360) .l(3)*cos(deta(1)+deta(2)+deta(3)*2*pi/360) ;Et=xd(t)-x;seta_delta=seta_delta-0.1*(-300*Et*

44、jmat+seta_delta);deta=deta+seta_delta;x=l(1)*cos(deta(1)*2*pi/360)+l(2)*cos(deta(1)+deta(2)*2*pi/360)+l(3)*cos(deta(1)+deta(2)+deta(3)*2*pi/360) .l(1)*sin(deta(1)*2*pi/360)+l(2)*sin(deta(1)+deta(2)*2*pi/360)+l(3)*sin(deta(1)+deta(2)+deta(3)*2*pi/360);jmat=-l(1)*sin(deta(1)*2*pi/360)-l(2)*sin(deta(1)

45、+deta(2)*2*pi/360)-l(3)*sin(deta(1)+deta(2)+deta(3)*2*pi/360) .-l(2)*sin(deta(1)+deta(2)*2*pi/360)-l(3)*sin(deta(1)+deta(2)+deta(3)*2*pi/360) .-l(3)*sin(deta(1)+deta(2)+deta(3)*2*pi/360); .l(1)*cos(deta(1)*2*pi/360)+l(2)*cos(deta(1)+deta(2)*2*pi/360)+l(3)*cos(deta(1)+deta(2)+deta(3)*2*pi/360) .l(2)*

46、cos(deta(1)+deta(2)*2*pi/360)+l(3)*cos(deta(1)+deta(2)+deta(3)*2*pi/360) .l(3)*cos(deta(1)+deta(2)+deta(3)*2*pi/360) ;Et=xd(t)-x;temp=Et*jmat;for i=1:cfor j=1:3wts(addrs(i,j),j)=wts(addrs(i,j),j)+seta*temp(j);end;end;if(rem(t,10)=0)temp1=l(1)*cos(deta(1)*2*pi/360),l(1)*sin(deta(1)*2*pi/360);temp2=l(1)*cos(deta(1)*