Temporary experiments with encoders
Some errors fixed
Changes in encoders interrupts