Translation from ShiftLCD from C++ to C on an atmega8