Cours:Elen4 TNS TP TpsReel

Retour à la page du cours

TP6 - Temps réel : bloc Gnuradio en Python / démodulation / PID Numérique

Le but de ce TP est double :

• réaliser des implémentations temps réel de filtre IIR en créant un bloc Gnuradio qui execute un traitement codé en Python
• et étudier l'implémentation d'un PID numérique sous forme d'un filtre IIR.

Dans les deux cas, un système temps réel sera considéré :

• à intervalles de temps (réguliers ou non), une valeur x(n) rentre dans le système
• le travail consiste à calculer y(n) avec l'équation au différences du filtre, à partir de la valeur x(n) et de ses versions précédentes x(n-1) et x(n-2) (et aussi y(n-1), y(n-2)) qu'il est donc nécessaire de stocker.
• La notion de temps réel implique que y(n) doit être calculer avant qu'une nouvelle valeurs de x(n) ne rentre dans le système.

Bloc Gnuradio en Python

Nous allons implémenter un filtre IIR dans gnuradio, en écrivant le traitement dans un bloc Python.

Filtre moyenneur

a) Dans un premier temps, prendre connaissance du tutoriel suivant : wiki Gnuradio - Creating Your First Block

b) Nous allons écrire un filtre simple, qui implémente un simple moyenneur :

import numpy as np
from gnuradio import gr

class blk(gr.sync_block):  
    def __init__(self):  # Pas de paramètres
        gr.sync_block.__init__(
            self,
            name="Filtre moyenneur",  
            in_sig=[np.float32],
            out_sig=[np.float32]
        )
        self.xn1 = 0 # initialisation d'un attribut pour stocker x(n-1)

    def work(self, input_items, output_items):
        xn = input_items[0][0] # On ne "consomme" qu'un seul échantillon en entrée
        yn = (xn + self.xn1) / 2
        self.xn1 = xn
        output_items[0][0] = yn # On ne produit donc également qu'un seul échantillon en sortie
        return 1 # On retourne le nombre de valeurs consomées

Filtre IIR : démodulation

En reprenant le signal modulé en amplitude et la fonction de transfert du filtre passe-bas du TP précédent :

• Obtenir l'équation aux différence du filtre, ie écrire y(n)= en fonction de x(n), x(n-1), x(n-2), y(n-1) et y(n-2).
• Créer un nouveau bloc Python dans le module monModule :
  • de type sync
  • une entrée en np.float32
  • une sortie en np.float32
• Écrire le code permettant d'obtenir y(n) dans la méthode work() :
  • x(n) est donné par in[0][0]
  • il sera nécessaire de stocker dans des attributs les valeurs de x(n-1), x(n-2), y(n-1) et y(n-2).

a) Réaliser cette implémentation du passe-bas et contrôler que la démodulation est identique à celle obtenue au TP 5.

b) Modifier votre code pour implémenter le filtre complet de démodulation.

Approximation de PID par filtre numérique linéaire

Cette partie sera travaillée dans un notebook Jupyter.

Rappels PID

• Principe

• Définition mathématique, la sortie du controleur PID u(t) est donnée par:

PID numérique "classique"

On considère que le temps est discrétisé : t = n.dt où dt est l'intervalle de temps entre deux valeurs.

• En approximant grossièrement l'intégrale et la dérivée
  
  • La dérivée est calculée par D = (e(n)-e(n-1))/dt
  • L'intégrale est approximée en cumulant progressivement : I = I + e(n).dt

C'est ainsi que vous avez implémenté vos PID jusqu'ici.

Voici un notebook exemple à explorer sur deux modélisations : asservissement de 1) température et de 2) position z d'un drone : TNS_TP6_starter.ipynb.zip

a) Ki = Kd = 0 => chercher le meilleur Kp => erreur statique.

b) Kd = 0 => l'introduction du terme integral permet de corriger cette erreur statique.

c) Le terme dérivatif n'est pas nécessaire pour la température

d) Mais l'est pour asservir la position z du drone.

PID numérique avec un filtre numérique linéaire

• Cherchons la fonction de transfert du filtre continu d'un PID.

En partant de l'équation différentielle

On applique la transformée de Laplace (dérivée => multiplication par s ; intégrale => division par s) :

Le terme dérivatif étant très sensible au bruit, on lui applique généralement un filtre passe bas (w0/(w0+s)) :

• Approximation de la fonction de transfert pour obtenir un filtre numérique
  • backward euler
  • et transformée bilinéaire

• Implémentation du Filtre : classe FilterController
• Application sur l'asservissement d'altitude d'un drone