Computational routine
eng


int_trap_m title

File content


/* 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;

    }

  }

}