Je crois que l'algo de Genlib est très performant, peut-être ça pourrait t'inspirer. Si ça te fait suer de lire du 68k, je veux bien essayer de te transcrire l'algo en c-like.
A moins que les fonctions fournies par ton matériel diffère trop d'un 68k pour être efficace.