te comento, el codigo que te mande es una de las primeras versiones, que como vos decir no contempla ningun promedio para amortiguar las pequeñas oscilaciones!!, en otra vesion (que luego te voy a mandar) tengo hecho un peuqño vector que suma cinco valores y realiza el promedio de los mismos!!
con respecto al código, no recuerdo bien pero el delay de 40 ms hace que se realizen 25 mediciones por segundo, si tenes en cuenta un cristal de 4 mhz y que la frecuencia de incremento del contador es de 1mhz.
lo que te muetro aqui debajo son algunos valores de prueba, en donde, partiendo desde la horizontal nos movemos por los dos ejes hasta las verticales termiando en la horizontal
se muetran los siguientes valores en el sig orden
asin (acx) asin(acy) T1x T1y T2