Giao tiep CMPS03 vơi ATmega16 Codevision

[qttc.sc]

Chào các bác trong diễn đàn!
Em đang làm giao tiếp giữa một con la bàn CMPS03. đọc và hiển thị giá trị của nó lên LCD 16x2 sử dụng vi điều khiển AVR ATmega16, trình biên dịch là codevision, giao tiế em sử dụng là I2C trên chân 2,3 của la bàn. sau một hồi đọc và viết chương trình thì kết quả em thu được là.. màn hình LCD nhảy loan xạ, một loạt các giá trị cứ lặp đi lặp lại. em ko hiểu ý nghĩa của chúng, tìm tài liệu trên mạng thì cũng không biết mình sai ở đâu trong code. vậy kính mong các bạn xem giùm và chỉ cho em lỗi ở đâu trong đoạn code mà em sử dụng
Thank các bác!

#include <mega16.h>
#include <delay.h>

// I2C Bus functions
#asm
.equ __i2c_port=0x1B ;PORTA
.equ __sda_bit=6
.equ __scl_bit=7
#endasm
#include <i2c.h>

// Alphanumeric LCD Module functions
#asm
.equ __lcd_port=0x15 ;PORTC
#endasm
#include <lcd.h>

// Declare your global variables here

int MAKEWORD(char a, char b);
int cmps03_read(unsigned char mode);
void lcd_display(int number, char x, char y);

void main(void)
{
PORTA=0x00;
DDRA=0xC0;

TIMSK=0x00;

i2c_init();

lcd_init(16);

lcd_gotoxy(12,1);lcd_putsf("TEST");

while (1)
{
lcd_display(cmps03_read(1),0,0);
delay_ms(300);
};
}

int cmps03_read(unsigned char mode)
{
unsigned char a,b;
if (mode==1)
{
i2c_start();
i2c_write(0x0C);
i2c_write(0x01);

i2c_start();
i2c_write(0xC1);
a = i2c_read(0);
i2c_stop();

return a;
}
else if(mode==2)
{
i2c_start();
i2c_write(0x0C);
i2c_write(0x02);

i2c_start();
i2c_write(0xC1);
a = i2c_read(1);
b = i2c_read(0);
i2c_stop();

return MAKEWORD(a,b);
}
else
{
return -1;
}
}
int MAKEWORD(unsigned char a, unsigned char b)
{
int word = 0;
word = a * 0xFF + b;
return word;
}
void lcd_display(int number, char x, char y)
{
char a,b,c,d;

a=number/1000;
b=number%1000/100;
c=number%100/10;
d=number%10;

lcd_gotoxy(x,y);
lcd_putchar(a+48);
lcd_putchar(b+48);
lcd_putchar(c+48);
lcd_putchar(d+48);
}

P/s: giá trị điện trở em sử dụng để treo trên 2 chân giao tiếp là 4k7. đây cũng là điều em băn khoăn vì mỗi nơi em tham khảo lại cho một giá trị điện trở khác nhau, Các bác chỉ giùm em giá trị đúng với!!!.