More addidtions and changed indentation to ChibiOS standard