Fixed push on rx_queue and pull on tx_queue (addresses were not taking head...

Fixed push on rx_queue and pull on tx_queue (addresses were not taking head and tail in account). Also rearrenged handler code since the inclusion of a new register was needed.

Signed-off-by: Israel B. Sant'Anna <ibsa14@inf.ufpr.br>