/* vco_c subroutine * Voltage Controled Oscillator computation * * Copyright (C) 2007-2009 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; }