Посмотри ассемблерный вариан, что сгенерировала RIDE. Может и найдешь баг. Кстати, если RIDE получает значения триг. функций путём разложения в ряд -использовать их крайне накладно (имхо)
(«Телесистемы»: Конференция «Микроконтроллеры и их применение»)