Debugging lcd.c

I realized all (most?) opcodes are correct and problem is something to do with timing in step_lcd function