Lettura encoder ottici

[filosofo]

Scusa, flz
grazie per la segnalazione
ma ieri su questo sito ho visto qualcosa ma era solo in verilog di cui non capisco una mazza.
http://www.fpga4fun.com/QuadratureDecoder.html

ecco il codice:

Code: Select all

module quad(clk, quadA, quadB, count);
input clk, quadA, quadB;
output [7:0] count;

reg quadA_delayed, quadB_delayed;
always @(posedge clk) quadA_delayed <= quadA;
always @(posedge clk) quadB_delayed <= quadB;

wire count_enable = quadA ^ quadA_delayed ^ quadB ^ quadB_delayed;
wire count_direction = quadA ^ quadB_delayed;

reg [7:0] count;
always @(posedge clk)
begin
   if(count_enable)
   begin
     if(count_direction) count<=count+1; else count<=count-1;
   end
end

endmodule

questo poi mi sembra il conteggio vero e proprio ed io invece ho necessità di iniziare con il filtro d'ingresso dei canali a e b.

comunque grazie lo stesso

[flz47655]

Non mi intendo di Encoder ottici, posso provare ad aiutarti però devi scrivere cosa vuoi ottenere dal filtro di ingresso

[filosofo]

Ho visto all'oscilloscopio che i segnali dell'encoder A e B non sono perfettamente puliti (vibrano) e allora leggendo tra la letteratura sugli encoder, ho visto che è necessario essere certi del livello di ogni canale e sopratutto della transizione.
Per fare questo ho visto che è necessario che il segnale di un canale venga combinato con il clock di modo che ogni impulso conti almeno 3 cicli di clock prima che venga elaborato e passato al modulo decoder quadratura... (tipo un antirimbalzo nei pulsanti).
Così facendo si dovrebbe migliorare l'immunità al rumore causato dalle vibrazioni del motore durante il movimento.

In sintesi questo è quello che dovrebbe fare il filtro....

Cmq grazie per l'interesse

[deluca]

Filosofo, ti mostro un code su come implementare un filtro digitale per l'encoder sotto torchio.
Certo questa non è la via giusta per imparare..... ma da qui puoi prendere il via per partire con il tuo progetto.
Vedremo cosa saprai fare

Code: Select all

----------------------------------------------------
-- Encoder Digital filter 
-- G. De Luca - INFN-LNS
-- 27/12/2010
-- non per usi commerciali - solo per studio
----------------------------------------------------

LIBRARY ieee ;
USE ieee.std_logic_1164.all;

ENTITY digital_filter IS
 PORT (
      CHA       : IN std_logic;
      CHB      : IN std_logic;
      Clk      : IN std_logic;
      RST      : IN std_logic;
      CHA_filt : OUT std_logic;
      CHB_filt   : OUT std_logic
      );
END digital_filter;

ARCHITECTURE arch_digital_filter OF digital_filter IS

SIGNAL  temp_CHA: std_logic;     
SIGNAL  temp_CHB: std_logic;       

BEGIN
---------------------------------------------------
Channel_A:PROCESS(CLK, RST)
 
  VARIABLE Afilter: std_logic_vector(0 to 3);
 
  BEGIN
    IF RST = '0' THEN
      Afilter := "0000";
      temp_CHA <= '0';
    ELSIF (CLK'event AND CLK = '1') THEN
        Afilter(1 to 3) := Afilter(0 to 2);
        Afilter(0) := CHA;
        IF Afilter(1 to 3) = "000" THEN
           temp_CHA <= '0';
        END IF;
        IF  Afilter(1 to 3) = "111" THEN
           temp_CHA <= '1';
        END IF;
    END IF;
  END PROCESS;
  CHA_filt <= temp_CHA;
--------------------------------------------------
Channel_B:PROCESS(CLK, RST)
 
  VARIABLE Bfilter: std_logic_vector(0 to 3);
 
  BEGIN
    IF RST = '0' THEN
      Bfilter := "0000";
      temp_CHB <= '0';
    ELSIF (CLK'event AND CLK = '1') THEN
        Bfilter(1 to 3) := Bfilter(0 to 2);
        Bfilter(0) := CHB;
        IF Bfilter(1 to 3) = "000" THEN
           temp_CHB <= '0';
        END IF;
        IF  Bfilter(1 to 3) = "111" THEN
           temp_CHB <= '1';
        END IF;
    END IF;
  END PROCESS;
  CHB_filt <= temp_CHB;
--------------------------------------------------
  END arch_digital_filter;


Come puoi vedere dalla dichiarazione di entity
il modulo ha 2 ingressi per i canali A e B da collegare all'encoder ,
2 uscite A e B filtrate, il segnale di clock su quale devi applicare la frequenza (non meno di qualche mhz),
e il reset (puoi anche omettere questo segnale se vuoi)

Ciao, fammi sapere

[flz47655]

Interessante, in pratica funziona così, l'ho sintetizzato anch'io per divertimento, grazie giovanni!

E' uno shift register di 4 bit dove sul primo elemento di memoria si copia il valore di ingresso e poi si shifta verso destra, se gli ultimi tre bit sono tutti 0 allora il risultato sarà 0, se sono tutti 1 il risultato sarà 1.

Facendo girare il tutto ad una frequenza superiore al segnale da filtrare si riesce a "campionarlo" diverse volte, una modifica che mi sono auto-proposto per esercizio è questa, il risultato è il bit più frequente negli ultimi 3 bit (es. se c'è 101 il risultato è 1, se c'è 001 il risultato è 0), magari filosofo potresti provare a fare anche tu la modifica per vedere se hai capito il codice

Ciao

[flz47655]

Ho provato anche per diletto a riscrivere il codice di Giovanni e a ridurlo di lunghezza ed evitare "ripetizioni"

Code: Select all

LIBRARY ieee ;
USE ieee.std_logic_1164.all;

ENTITY digital_filter IS
 PORT (      
      CH      : IN std_logic_vector(0 to 1);
      Clk     : IN std_logic;     
      CH_filt : OUT std_logic_vector(0 to 1)   
      );
END digital_filter;

ARCHITECTURE arch_digital_filter OF digital_filter IS

SIGNAL  temp_CH: std_logic_vector(0 to 1);

BEGIN
Channel:PROCESS(CLK) 
   VARIABLE filter: std_logic_vector(0 to 7);   
   BEGIN
    IF (CLK'event AND CLK = '1') THEN
       
    for i in 0 to 1 loop   
      filter((i*4)+1 to (i*4)+3) := filter((i*4) to (i*4)+2);   
      filter(i*4) := CH(i);      
      IF filter((i*4)+1 to (i*4)+3) = "000" THEN
         temp_CH(i) <= '0';
      END IF;
      IF  filter((i*4)+1 to (i*4)+3) = "111" THEN
         temp_CH(i) <= '1';
      END IF;
    end loop;
           
    END IF;
  END PROCESS;
 
  CH_filt <= temp_CH;
 
END arch_digital_filter;


Il vantaggio è che con poche modifiche è possibile aumentare il numero dei canali senza fare copia/incolla di codice VHDL che porterebbe a sorgenti lunghissimi con molti canali.

Una cosa che ho scoperto che mi manca in VHDL è la possibilità di creare delle stringhe da sostituire prima della compilazione, i #define del C per intenderci.

In questo caso mi servirebbero per definire il numero di canali e limitare quindi al cambiamento di un numero il cambiamento dei numeri di canali.

Avete qualche idea di un surrogato del #define?

Ciao e grazie a tutti

[flz47655]

Ho provato con constant ma diviene difficile utilizzarla all'interno dell'Entity, in tutto per cambiare il numero di canali col seguente codice sono necessarie 3 modifiche mentre vorrei arrivare ad 1 sola modifica.

Code: Select all

LIBRARY ieee ;
USE ieee.std_logic_1164.all;

ENTITY digital_filter IS
 PORT (      
      CH      : IN std_logic_vector(0 to 5);    -- for number of channels
      CH_filt : OUT std_logic_vector(0 to 5);    -- change CH and CH_filt
      Clk     : IN std_logic
      );   
END digital_filter;

ARCHITECTURE arch_digital_filter OF digital_filter IS
constant NUM_CHANNELS: integer := 5; -- NUM_CHANNELS base 0
SIGNAL  temp_CH: std_logic_vector(0 to NUM_CHANNELS);
BEGIN
Channel:PROCESS(CLK)     
   VARIABLE filter: std_logic_vector(0 to ((NUM_CHANNELS+1)*4)-1);   
   BEGIN
    IF (CLK'event AND CLK = '1') THEN       
       for i in 0 to NUM_CHANNELS loop   
         filter((i*4)+1 to (i*4)+3) := filter((i*4) to (i*4)+2);   
         filter(i*4) := CH(i);      
         IF filter((i*4)+1 to (i*4)+3) = "000" THEN
            temp_CH(i) <= '0';
         END IF;
         IF  filter((i*4)+1 to (i*4)+3) = "111" THEN
            temp_CH(i) <= '1';
         END IF;
       end loop;           
    END IF;
  END PROCESS; 
  CH_filt <= temp_CH;   
END arch_digital_filter;


[deluca]

Complimenti a flz per aver ottimizzato il codice del filtro.
Purtroppo però non è sempre consigliabile parametrizzare il codice e instanziare cicli for poichè in questo modo
il codice diventa meno leggibile.... (ti spiego perchè).

Se il codice è personale allora tutto questo può essere accettato.
ma se il codice deve essere usato in un contesto diverso è sempre bene esplicitare la descrizione dei vari processi
in quanto una descrizione hw iterativa con i cicli for non sempre semplifica la creazione di un Top Level Entiy
in quanto se si vuole crearlo in modalità schematic utilizzando moduli unitari il fatto di non avere una nomenclatura esplicita oggettiva
porta alla generazione di uno schema poco intelleggibile da parte di terze persone che collaborano al progetto (se si lavora in team).
ES: cosi non hai più CHA e CHB per ogni modulo, ma avrai una array di CH[x].
Trova il modo di esplicitare la nomenclatura... sulla descrizione dei PINs.


Comunque ..... ben fatto.

[flz47655]

Grazie

[Tedesco]

Ciao a tutti,
sono nuovo del forum e lo trovo molto interessante.

Per quanto riguarda l'ottimizzazione del codice del filtro sono completamente d'accordo con deluca.
Infatti per i linguaggi di descrizione dell'HW la leggibilità del codice è veramente molto importante, forse più che per gli altri linguaggi di programmazione in quanto la concorrenzialità dei processi potrebbe facilmente confondere il progettista.
Pertanto propongo come evoluzione del codice scritto in precedenza il segente:

Code: Select all

ENTITY digital_filter IS
   generic(
      NUM_CHANNELS   : integer := 5 -- NUM_CHANNELS+1 base 0
      );
   PORT (     
      CH      : IN std_logic_vector(0 to NUM_CHANNELS);    -- for number of channels
      CH_filt : OUT std_logic_vector(0 to NUM_CHANNELS);    -- change CH and CH_filt
      Clk     : IN std_logic
      );   
END digital_filter;

ARCHITECTURE arch_digital_filter OF digital_filter IS

SIGNAL  temp_CH         : std_logic_vector(0 to NUM_CHANNELS):=(others=>'0');

BEGIN

filtri:for i in 0 to NUM_CHANNELS generate
signal filter: std_logic_vector(0 to 3):=(others=>'0');
begin
   Channel:PROCESS(CLK)     
   BEGIN
      IF (CLK'event AND CLK = '1') THEN       
         filter(1 to 3)    <= filter(0 to 2);   
         filter(0)       <= CH(i);     
         IF filter(1 to 3) = "000" THEN
            temp_CH(i) <= '0';
         END IF;
         IF  filter(1 to 3) = "111" THEN
            temp_CH(i) <= '1';
         END IF;
      END IF;
   END PROCESS;
end generate;

CH_filt <= temp_CH;

END arch_digital_filter;


E' un pò più snello?
In questo modo per aumentare i canali basta solo modificare il valore nel generic in testa alla definizione dell'entity (1 modifica).
In VHDL purtroppo non sembra esistere un equivalente del #define del C. Si potrebbe creare una libreria da includere ad inizio progetto, ma è poco pratico in quanto deve essere ricompilato (da ModelSim per esempio, QuartusII o ISE Xilinx non lo permettono) ogni volta che si cambia qualche valore e sempre separatamente dalla compilazione del progetto. Quindi meglio il generic.

Un saluto a tutti,
e buona Pasqua.

[deluca]

Un Benvenuto a Tedesco,
e grazie in anticipo per il contributo che potresti dare a questo forum.

Colgo l'occasione per augurare a tutti una Buona Pasqua.

[flz47655]

Benvenuto Tedesco e grazie per il suggerimento, non ho ancora studiato i generics di VHDL ma è molto interessante l'esempio che hai fatto e di come possono essere usati in queste situazioni.

Buona pasqua a tutti
Ciao