%[z1]=subz1(zs1,zSAm1,zSBp1,zpTS,zsTS); function[z1]=subz1(zs1,zSAm1,zSBp1,zpTS,zsTS) z1=zeros(4); z1(1,1)=zs1; z1(2,2)=zSAm1; z1(3,3)=zSBp1; z1(4,4)=zpTS+zsTS;