Peripherals config from STM libraries and new filtering algorithme

BIG CHANGES