Đọc tốc độ dùng QEI

[chuaai]

em đang muốn sử dụng QEI của pic 18F4431 để đọc tốc độ động cơ code em viết như sau:

// QEI int
QEICON = 0b10111000;
MAXCNTL=0xFF;
MAXCNTH=0xFF;
POSCNTH = 0x00;
POSCNTL = 0x00;

CVM1 =make16(POSCNTH, POSCNTL);
POSCNTH = 0x00;
POSCNTL = 0x00;

LCD_putcmd(0xc0);
LCD_display(CVM1);

nhưng không chạy, có ai biết cấu hình và đọc như thế nào không giúp em 1 tay với (em mắc 2 pha động cơ vào QEA và QEB, còn chân INDEX thì em ko sử dụng và cũng ko rõ chức năng của nó lắm)
Mong sự dụng đỡ của mọi người