Added and adapted also p5 and p0 code

I readded the code for the scanner boards, adding the bin’s stepper to be controlled by the p0.