Resolverauswertung in VHDL

Hallo,

bin gerade dabei für ein Projekt die Resolverauswertung auf einem FPGA
zu realisieren. Über die feldorientierte Regelung regel ich eine PMSM.
Für die Regelung wird die Lage des Rotors sowie die Drehzahl benötigt.
Es wird mit einem SinCos Geber als Resolver gearbeitet.
Das bedeutet ich gebe mein Excitation Signal auf den Resolver und er
gibt mir Usin und Ucos zurück. Im Prinzip wie ein
Drehtransformator.Diese Signale digitalisiere ich mir über einen ADC
und will dann die Signale im FPGA verarbeiten.
Nun habe ich ein bißchen über das Verfahren Angle Tracking Observer
gefunden, das mir die Lage und die Drehzahl berechnet.
Doch leider komme ich nicht ganz dahinter, wie ich die Struktur
programmieren soll.
Vielleicht hat jemand schon Erfahrung mit diesem Verfahren und kann mir
weiterhelfen.
Vielen Dank

Gruß
Patrick