Вы на Си прерывание ведь умеете делать? Вот сделайте и посмотрите листинг( включите опцию чтоб компилятор делал отдельный ассемблерный файл или между Си-строк помещал ассемблерные мнемоники), как компилятор оформляет этот обработчик.И по образу и подобию сделайте свой.