Add first exception handler to firmware