Arbeitest du wirklich mit 1MHz Takt?
Hier gehört wohl 16 hin #define LCD_DISP_LENGTH 8 hat aber mit dem init nichts zu tun.
Sonst sehe ich nichts was falsch sein könnte.