Updated interrupt handeling, less assembly more C