Low level routine
fr -
eng
vco_c - vco computational routines
/* 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;
}
A. Layec