Un piccolo consiglio, forse superfluo, per i calcoli nei PIC usate solo interi al massimo a 16 bit, se lavorate con calcoli a virgola mobile mi sa che la velocità non basta; tenete presente che in uscita ai servi al massimo usate 10 bit quindi un'alta precisione è inutile.