/* Modnumlib Scicos interfacing function * Copyright (C) 2009-2011 Alan Layec * * This library is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public * License as published by the Free Software Foundation; either * version 2 of the License, or (at your option) any later version. * * This library is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * General Public License for more details. * * You should have received a copy of the GNU General Public * License along with this library; if not, write to the * Free Software Foundation, Inc., 59 Temple Place - Suite 330, * Boston, MA 02111-1307, USA. */ /* int_trap_m Scicos discrete integral by trapezoidal method block * Type 4 simulation function ver 1.0 - scicoslab 4.3 * 30 mai 2009 - INRIA - Author : A.Layec */ #include <scicos/scicos_block4.h> /* REVISION HISTORY : * $Log$ */ /* Cette fonction de simulation réalise une intégration discrète * du vecteur d'entrée par la méthode des trapèzes : * y[k]=h/2*(u[k]+u[k-1])+y[k-1] * où h est le pas d'intégration, y[k] la sortie, * et u[k] l'entrée * * entrée régulières : u[0..(mu*nu)-1] matrice entrée * sorties régulières : y[0..(mu*nu)-1] matrice sortie * entrée évènementielle : Instants de déclenchement * sortie évènementielle : néant. * état discret : oz_1[0..(mu*nu)-1] états de sortie discrets précédents * oz_2[0..(mu*nu)-1] états de l'entrée discrets précédents * * paramètre réel : rpar[0] pas d'intégration (scalaire) */ /*prototype*/ void int_trap_m(scicos_block *block,int flag) { /*déclaration des variables*/ void *y; void *u; void *oz_1,*oz_2; SCSREAL_COP *h; int i,nu,mu,typu; /*récupération de l'adresses des ports réguliers*/ u=GetInPortPtrs(block,1); y=GetOutPortPtrs(block,1); /*récupération de l'adresses des états discrets*/ oz_1=GetOzPtrs(block,1); oz_2=GetOzPtrs(block,2); /*Récupération de la taille du port d'entrée*/ mu=GetInPortRows(block,1); nu=GetInPortCols(block,1); /*Récupération du type du port d'entrée*/ typu=GetInType(block,1); /*récupération du pas d'intégration*/ h=GetRparPtrs(block); /*Le flag 1 calcule l'integrale et place le résultat dans le registre y[]*/ if (flag==1) { switch (typu) { case SCSREAL_N : for(i=0;i<nu*mu;i++) { *(((SCSREAL_COP *)y) + i) = (*(((SCSREAL_COP *)u) +i)+ \ *(((SCSREAL_COP *)oz_2) +i))*(*h/2) + \ *(((SCSREAL_COP *)oz_1) +i); } break; case SCSCOMPLEX_N : for(i=0;i<2*nu*mu;i++) { *(((SCSREAL_COP *)y) + i) = (*(((SCSREAL_COP *)u) +i)+ \ *(((SCSREAL_COP *)oz_2) +i))*(*h/2) + \ *(((SCSREAL_COP *)oz_1) +i); } break; case SCSINT32_N : for(i=0;i<nu*mu;i++) { *(((SCSINT32_COP *)y) + i) = (*(((SCSINT32_COP *)u) +i)+ \ *(((SCSINT32_COP *)oz_2) +i))*(*h/2) + \ *(((SCSINT32_COP *)oz_1) +i); } break; case SCSINT16_N : for(i=0;i<nu*mu;i++) { *(((SCSINT16_COP *)y) + i) = (*(((SCSINT16_COP *)u) +i)+ \ *(((SCSINT16_COP *)oz_2) +i))*(*h/2) + \ *(((SCSINT16_COP *)oz_1) +i); } break; case SCSINT8_N : for(i=0;i<nu*mu;i++) { *(((SCSINT8_COP *)y) + i) = (*(((SCSINT8_COP *)u) +i)+ \ *(((SCSINT8_COP *)oz_2) +i))*(*h/2) + \ *(((SCSINT8_COP *)oz_1) +i); } break; case SCSUINT32_N : for(i=0;i<nu*mu;i++) { *(((SCSUINT32_COP *)y) + i) = (*(((SCSUINT32_COP *)u) +i)+ \ *(((SCSUINT32_COP *)oz_2) +i))*(*h/2) + \ *(((SCSUINT32_COP *)oz_1) +i); } break; case SCSUINT16_N : for(i=0;i<nu*mu;i++) { *(((SCSUINT16_COP *)y) + i) = (*(((SCSUINT16_COP *)u) +i)+ \ *(((SCSUINT16_COP *)oz_2) +i))*(*h/2) + \ *(((SCSUINT16_COP *)oz_1) +i); } break; case SCSUINT8_N : for(i=0;i<nu*mu;i++) { *(((SCSUINT8_COP *)y) + i) = (*(((SCSUINT8_COP *)u) +i)+ \ *(((SCSUINT8_COP *)oz_2) +i))*(*h/2) + \ *(((SCSUINT8_COP *)oz_1) +i); } break; } } /*le flag 2 place l'état de sortie y dans z*/ else if ((flag==2)) { switch (typu) { case SCSREAL_N : for(i=0;i<nu*mu;i++) { *(((SCSREAL_COP *)oz_1) + i) = (*(((SCSREAL_COP *)u) +i)+ \ *(((SCSREAL_COP *)oz_2) +i))*(*h/2) + \ *(((SCSREAL_COP *)oz_1) +i); *(((SCSREAL_COP *)oz_2) + i) = *(((SCSREAL_COP *)u) +i); } break; case SCSCOMPLEX_N : for(i=0;i<2*nu*mu;i++) { *(((SCSREAL_COP *)oz_1) + i) = (*(((SCSREAL_COP *)u) +i)+ \ *(((SCSREAL_COP *)oz_2) +i))*(*h/2) + \ *(((SCSREAL_COP *)oz_1) +i); *(((SCSREAL_COP *)oz_2) + i) = *(((SCSREAL_COP *)u) +i); } break; case SCSINT32_N : for(i=0;i<nu*mu;i++) { *(((SCSINT32_COP *)oz_1) + i) = (*(((SCSINT32_COP *)u) +i)+ \ *(((SCSINT32_COP *)oz_2) +i))*(*h/2) + \ *(((SCSINT32_COP *)oz_1) +i); *(((SCSINT32_COP *)oz_2) + i) = *(((SCSINT32_COP *)u) +i); } break; case SCSINT16_N : for(i=0;i<nu*mu;i++) { *(((SCSINT16_COP *)oz_1) + i) = (*(((SCSINT16_COP *)u) +i)+ \ *(((SCSINT16_COP *)oz_2) +i))*(*h/2) + \ *(((SCSINT16_COP *)oz_1) +i); *(((SCSINT16_COP *)oz_2) + i) = *(((SCSINT16_COP *)u) +i); } break; case SCSINT8_N : for(i=0;i<nu*mu;i++) { *(((SCSINT8_COP *)oz_1) + i) = (*(((SCSINT8_COP *)u) +i)+ \ *(((SCSINT8_COP *)oz_2) +i))*(*h/2) + \ *(((SCSINT8_COP *)oz_1) +i); *(((SCSINT8_COP *)oz_2) + i) = *(((SCSINT8_COP *)u) +i); } break; case SCSUINT32_N : for(i=0;i<nu*mu;i++) { *(((SCSUINT32_COP *)oz_1) + i) = (*(((SCSUINT32_COP *)u) +i)+ \ *(((SCSUINT32_COP *)oz_2) +i))*(*h/2) + \ *(((SCSUINT32_COP *)oz_1) +i); *(((SCSUINT32_COP *)oz_2) + i) = *(((SCSUINT32_COP *)u) +i); } break; case SCSUINT16_N : for(i=0;i<nu*mu;i++) { *(((SCSUINT16_COP *)oz_1) + i) = (*(((SCSUINT16_COP *)u) +i)+ \ *(((SCSUINT16_COP *)oz_2) +i))*(*h/2) + \ *(((SCSUINT16_COP *)oz_1) +i); *(((SCSUINT16_COP *)oz_2) + i) = *(((SCSUINT16_COP *)u) +i); } break; case SCSUINT8_N : for(i=0;i<nu*mu;i++) { *(((SCSUINT8_COP *)oz_1) + i) = (*(((SCSUINT8_COP *)u) +i)+ \ *(((SCSUINT8_COP *)oz_2) +i))*(*h/2) + \ *(((SCSUINT8_COP *)oz_1) +i); *(((SCSUINT8_COP *)oz_2) + i) = *(((SCSUINT8_COP *)u) +i); } break; } } }