# include "scicos_block4.h" # include "../machine.h" #include <stdio.h> #if WIN32 #define NULL 0 #endif extern int C2F(dlacpy)(); extern int C2F(dgeev)(); extern int C2F(dlaset)(); extern int C2F(issymmetric)(); extern int C2F(dsyev)(); typedef struct { double *LA; double *L0; double *LVR; double *LW; double *LWR; double *LWI; double *dwork; double *dwork1; } mat_vps_struct ; void mat_vpv(scicos_block *block,int flag) { double *u; double *y1; double *y2; double *y3; double *y4; int nu; int info; int i,j,lwork,lwork1,ii,ij,ij1,ji; int symmetric; mat_vps_struct *ptr; nu =GetInPortRows(block,1); u=GetRealInPortPtrs(block,1); y1=GetRealOutPortPtrs(block,1); y2=GetImagOutPortPtrs(block,1); y3=GetRealOutPortPtrs(block,2); y4=GetImagOutPortPtrs(block,2); lwork1=4*nu; lwork=3*nu-1; /*init : initialization*/ if (flag==4) {if((*(block->work)=(mat_vps_struct*) scicos_malloc(sizeof(mat_vps_struct)))==NULL) {set_block_error(-16); return;} ptr=*(block->work); if((ptr->LA=(double*) scicos_malloc(sizeof(double)*(nu*nu)))==NULL) {set_block_error(-16); scicos_free(ptr); return;} if((ptr->L0=(double*) scicos_malloc(sizeof(double)))==NULL) {set_block_error(-16); scicos_free(ptr->LA); scicos_free(ptr); return;} if((ptr->LVR=(double*) scicos_malloc(sizeof(double)*(nu*nu)))==NULL) {set_block_error(-16); scicos_free(ptr->L0); scicos_free(ptr->LA); scicos_free(ptr); return;} if((ptr->LW=(double*) scicos_malloc(sizeof(double)*(nu*nu)))==NULL) {set_block_error(-16); scicos_free(ptr->LVR); scicos_free(ptr->L0); scicos_free(ptr->LA); scicos_free(ptr); return;} if((ptr->LWR=(double*) scicos_malloc(sizeof(double)*(nu*1)))==NULL) {set_block_error(-16); scicos_free(ptr->LW); scicos_free(ptr->LVR); scicos_free(ptr->L0); scicos_free(ptr->LA); scicos_free(ptr); return;} if((ptr->LWI=(double*) scicos_malloc(sizeof(double)*(nu*1)))==NULL) {set_block_error(-16); scicos_free(ptr->LWR); scicos_free(ptr->LW); scicos_free(ptr->LVR); scicos_free(ptr->L0); scicos_free(ptr->LA); scicos_free(ptr); return;} if((ptr->dwork=(double*) scicos_malloc(sizeof(double)*lwork))==NULL) {set_block_error(-16); scicos_free(ptr->LWI); scicos_free(ptr->LWR); scicos_free(ptr->LW); scicos_free(ptr->LVR); scicos_free(ptr->L0); scicos_free(ptr->LA); scicos_free(ptr); return;} if((ptr->dwork1=(double*) scicos_malloc(sizeof(double)*lwork1))==NULL) {set_block_error(-16); scicos_free(ptr->dwork); scicos_free(ptr->LWI); scicos_free(ptr->LWR); scicos_free(ptr->LW); scicos_free(ptr->LVR); scicos_free(ptr->L0); scicos_free(ptr->LA); scicos_free(ptr); return;} } /* Terminaison */ else if (flag==5) {ptr=*(block->work); if(ptr->dwork1!=NULL){ scicos_free(ptr->LA); scicos_free(ptr->L0); scicos_free(ptr->LVR); scicos_free(ptr->LW); scicos_free(ptr->LWI); scicos_free(ptr->LWR); scicos_free(ptr->dwork); scicos_free(ptr->dwork1); scicos_free(ptr); return;} } else { ptr=*(block->work); C2F(dlacpy)("F",&nu,&nu,u,&nu,ptr->LA,&nu); symmetric=1; for (j=0;j<nu;j++) {for (i=j;i<nu;i++) {ij=i+j*nu; ji=j+i*nu; if (i!=j) {if (*(ptr->LA+ij)==*(ptr->LA+ji)) symmetric*= 1; else { symmetric*=0;break;}}}} if (symmetric==1) {C2F(dsyev)("V","U",&nu,ptr->LA,&nu,ptr->LW,ptr->dwork,&lwork,&info); if (info!=0) {if (flag!=6) {set_block_error(-7); return; }} for (i=0;i<nu;i++) {ii=i+i*nu; *(y1+ii)=*(ptr->LW+i); } C2F(dlacpy)("F",&nu,&nu,ptr->LA,&nu,y3,&nu); } else {C2F(dgeev)("N","V",&nu,ptr->LA,&nu,ptr->LWR,ptr->LWI,ptr->dwork1,&nu,ptr->LVR,&nu,ptr->dwork1,&lwork1,&info); if (info!=0) {if (flag!=6) {set_block_error(-7); return; }} *(ptr->L0)=0; C2F(dlaset)("F",&nu,&nu,ptr->L0,ptr->L0,y1,&nu); C2F(dlaset)("F",&nu,&nu,ptr->L0,ptr->L0,y2,&nu); for (i=0;i<nu;i++) {ii=i+i*nu; *(y1+ii)=*(ptr->LWR+i); *(y2+ii)=*(ptr->LWI+i); } for (j=0;j<nu;j++) {if (*(ptr->LWI+j)==0) for (i=0;i<nu;i++) {ij=i+(j)*nu; *(y3+ij)=*(ptr->LVR +ij); *(y4+ij)=0;} else{ for (i=0;i<nu;i++) {ij=i+(j)*nu; ij1=i+(j+1)*nu; *(y3+ij)=*(ptr->LVR +ij); *(y4+ij)=*(ptr->LVR +ij1); *(y3+ij1)=*(ptr->LVR +ij); *(y4+ij1)=-(*(ptr->LVR +ij1));} j++;} } } } }