HardFault bugfix