Thank you again!
Only today I managed to adapt this code to my hardware and it works very fast!