# include "scicos_block4.h" # include "../machine.h" #include <stdio.h> #if WIN32 #define NULL 0 #endif extern int C2F(zgeev)(); extern int C2F(zheev)(); typedef struct { double *LA; double *LX; double *LVR; double *dwork; double *rwork; double *dwork1; double *rwork1; } mat_vps_struct ; void matz_vps(scicos_block *block,int flag) { double *ur,*ui; double *yr,*yi; int nu; int info; int i,lwork,lwork1,j,ij,ji,rw; int hermitien; mat_vps_struct *ptr; nu =GetInPortRows(block,1); ur=GetRealInPortPtrs(block,1); ui=GetImagInPortPtrs(block,1); yr=GetRealOutPortPtrs(block,1); yi=GetImagOutPortPtrs(block,1); lwork1=2*nu; lwork=2*nu-1; rw=3*nu-2; /*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)*(2*nu*nu)))==NULL) {set_block_error(-16); scicos_free(ptr); return;} if((ptr->LX=(double*) scicos_malloc(sizeof(double)*(2*nu)))==NULL) {set_block_error(-16); scicos_free(ptr->LA); scicos_free(ptr); return;} if((ptr->LVR=(double*) scicos_malloc(sizeof(double)*(2*nu*nu)))==NULL) {set_block_error(-16); scicos_free(ptr->LX); scicos_free(ptr->LA); scicos_free(ptr); return;} if((ptr->dwork=(double*) scicos_malloc(sizeof(double)*2*lwork))==NULL) {set_block_error(-16); scicos_free(ptr->LVR); scicos_free(ptr->LX); scicos_free(ptr->LA); scicos_free(ptr); return;} if((ptr->rwork=(double*) scicos_malloc(sizeof(double)*2*rw))==NULL) {set_block_error(-16); scicos_free(ptr->dwork); scicos_free(ptr->LVR); scicos_free(ptr->LX); scicos_free(ptr->LA); scicos_free(ptr); return;} if((ptr->dwork1=(double*) scicos_malloc(sizeof(double)*2*lwork1))==NULL) {set_block_error(-16); scicos_free(ptr->rwork); scicos_free(ptr->dwork); scicos_free(ptr->LVR); scicos_free(ptr->LX); scicos_free(ptr->LA); scicos_free(ptr); return;} if((ptr->rwork1=(double*) scicos_malloc(sizeof(double)*2*lwork1))==NULL) {set_block_error(-16); scicos_free(ptr->dwork1); scicos_free(ptr->rwork); scicos_free(ptr->dwork); scicos_free(ptr->LVR); scicos_free(ptr->LX); scicos_free(ptr->LA); scicos_free(ptr); return;} } /* Terminaison */ else if (flag==5) {ptr=*(block->work); if((ptr->rwork1)!=NULL) { scicos_free(ptr->LA); scicos_free(ptr->LX); scicos_free(ptr->LVR); scicos_free(ptr->rwork); scicos_free(ptr->rwork1); scicos_free(ptr->dwork); scicos_free(ptr->dwork1); scicos_free(ptr); return;} } else { ptr=*(block->work); for (i=0;i<(nu*nu);i++) {ptr->LA[2*i]=ur[i]; ptr->LA[2*i+1]=ui[i];} hermitien=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+2*ij)==*(ptr->LA+2*ji))&&(*(ptr->LA+2*ij+1)==-(*(ptr->LA+2*ji+1)))) hermitien*= 1; else { hermitien*=0;break;}}}} if (hermitien==1) {C2F(zheev)("N","U",&nu,ptr->LA,&nu,yr,ptr->dwork,&lwork,ptr->rwork,&info); if (info!=0) {if (flag!=6) {set_block_error(-7); return; }} } else {C2F(zgeev)("N","N",&nu,ptr->LA,&nu,ptr->LX,ptr->dwork1,&nu,ptr->LVR,&nu,ptr->dwork1,&lwork1,ptr->rwork1,&info); if (info!=0) {if (flag!=6) {set_block_error(-7); return; }} for (i=0;i<nu;i++) {*(yr+i)=*(ptr->LX+2*i); *(yi+i)=*(ptr->LX+2*i+1);} } } }