Routine bas-niveau
fr - eng


vco_c - routines de calcul pour vco

Module

Contenu du fichier


/* vco_c subroutine
 * Voltage Controled Oscillator computation
 *
 * Copyright (C) 2007-2011 Alan Layec
 *
 * This file is part of modnumlib.
 *
 * modnumlib 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.
 *
 * modnumlib 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 modnumlib; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
 *
 */

/* REVISION HISTORY :
 * $Log$
 */

#include "modnum_lib.h"

/* vcoy_c : routine de calcul de l'angle instantanné d'un oscillateur
 *          controlé en tension
 *
 *  theta = err + h*omega \
 *              + h/2 * (kv * u + w__n + u__n) \
 *              + phi__n
 *
 * Entrées :
 * n       : nbre d'oscillateur        (scalaire)
 * u       : tension d'entrée          (vecteur de taille n)
 * h       : pas d'intégration         (scalaire)
 * omega   : pulsation libre           (scalaire)
 * kv      : gain sensibilité          (scalaire)
 * w__n    : échantillon de bruit      (vecteur de taille n)
 * phi__n  : phase additionnelle       (vecteur de taille n)
 * err     : état précédent de l'angle
 *           instantanné               (vecteur de taille n)
 * u__n    : tension d'entrée à l'état
 *           précédent                 (vecteur de taille n)
 *
 * Sorties :
 * theta : angle instantanné           (vecteur de taille n)
 *
 * Etats :
 *
 *
 */

void vcoy_c(int *n, double *u, double *h, double *omega, double *kv, \
            double *w__n, double *phi__n, double *err, double *u__n, \
            double *theta)
{
 /*déclaration*/
 int i;
 double f__u;

 for(i=0;i<(*n);i++) {
   f__u = (*kv) * u[i] + w__n[i];

   /* compute theta */
   theta[i] = err[i] + \
              (*h)*(*omega) + \
              ((*h)/2) * (f__u + u__n[i]) + \
              phi__n[i];
 }

 return;
}


/* vcoz_c : routine de calcul de l'angle instantanné d'un oscillateur
 *          controlé en tension
 *
 *  theta = err + h*omega \
 *              + h/2 * (kv * u + w__n + u__n) \
 *              + phi__n
 *
 * Entrées :
 * n         : nbre d'oscillateur      (scalaire)
 * u         : tension d'entrée        (vecteur de taille n)
 * h         : pas d'intégration       (scalaire)
 * omega     : pulsation libre         (scalaire)
 * kv        : gain sensibilité        (scalaire)
 * cross_val : phase additionnelle     (scalaire)
 * w__n      : échantillon de bruit    (vecteur de taille n)
 * phi__n    : phase additionnelle     (vecteur de taille n)
 *
 * Etats :
 * u__n    : tension d'entrée à l'état
 *           précédent                 (vecteur de taille n)
 * err     : état précédent de l'angle
 *           instantanné               (vecteur de taille n)
 * theta : angle instantanné           (vecteur de taille n)
 *
 *
 */

void vcoz_c(int *n, double *u, double *h, double *omega, double *kv, \
            double *cross_val, double *w__n, double *phi__n, \
            double *err, double *u__n, double *theta)
{
 /*déclaration*/
 int i;
 double f__u;

 for(i=0;i<(*n);i++) {
   f__u = (*kv) * u[i] + w__n[i];

   /* compute theta */
   theta[i] = err[i] + \
              (*h)*(*omega) + \
              ((*h)/2) * (f__u + u__n[i]) + \
              phi__n[i];

   /* store input */
   u__n[i] = f__u;

   err[i] = theta[i] - phi__n[i];

   if( err[i] >= (*cross_val)) {
     err[i] = err[i] - (*cross_val);
   }

 }

 return;
}

Auteurs

A. Layec A. Layec