diff --git a/firmware/test/i2c/Makefile b/firmware/test/i2c/Makefile
index fd3b9ad6a8..4f004f8333 100644
--- a/firmware/test/i2c/Makefile
+++ b/firmware/test/i2c/Makefile
@@ -6,10 +6,11 @@ OC    = sh-elf-objcopy
 
 INCLUDES=-I../.. -I../../drivers
 
-CFLAGS = -g -Wall -m1 -nostdlib -Wstrict-prototypes -fschedule-insns -fno-builtin $(INCLUDES)
+CFLAGS = -g -Wall -m1 -nostdlib -Wstrict-prototypes -fschedule-insns -fno-builtin $(INCLUDES) -DDEBUG
 AFLAGS += -small -relax
 
-OBJS= crt0.o main.o ../../drivers/i2c.o ../../drivers/mas.o ../../debug.o
+OBJS= crt0.o main.o ../../drivers/i2c.o ../../drivers/mas.o ../../debug.o \
+	../../common/sprintf.o
 
 %.o: %.S
 	$(CC) -o $@ $(CFLAGS) $(INCLUDES) $(DEFS) -c $<
diff --git a/firmware/test/i2c/main.c b/firmware/test/i2c/main.c
index 4647394c0e..13eaacef7a 100644
--- a/firmware/test/i2c/main.c
+++ b/firmware/test/i2c/main.c
@@ -39,7 +39,7 @@ int main(void)
     debugf("Olle: %d\n", 7);
     
    i2c_init();
-   debug("I2C Init done\n");
+   debugf("I2C Init done\n");
    i=mas_readmem(MAS_BANK_D1,0xff6,(unsigned long*)buf,2);
    if (i) {
        debugf("Error - mas_readmem() returned %d\n", i);