Based on JCW glcdlib for ST7565 LCD's, adapted for Vatronix LCD - View it on GitHub