/* * This file is subject to the terms of the GFX License. If a copy of * the license was not distributed with this file, you can obtain one at: * * http://ugfx.org/license.html */ #include "gfx.h" #if GFX_USE_GDISP # define GDISP_DRIVER_VMT GDISPVMT_ST7565_QMK # include "gdisp_lld_config.h" # include "src/gdisp/gdisp_driver.h" # include "board_st7565.h" /*===========================================================================*/ /* Driver local definitions. */ /*===========================================================================*/ # ifndef GDISP_SCREEN_HEIGHT # define GDISP_SCREEN_HEIGHT LCD_HEIGHT # endif # ifndef GDISP_SCREEN_WIDTH # define GDISP_SCREEN_WIDTH LCD_WIDTH # endif # ifndef GDISP_INITIAL_CONTRAST # define GDISP_INITIAL_CONTRAST 35 # endif # ifndef GDISP_INITIAL_BACKLIGHT # define GDISP_INITIAL_BACKLIGHT 100 # endif # define GDISP_FLG_NEEDFLUSH (GDISP_FLG_DRIVER << 0) # include "st7565.h" /*===========================================================================*/ /* Driver config defaults for backward compatibility. */ /*===========================================================================*/ # ifndef ST7565_LCD_BIAS # define ST7565_LCD_BIAS ST7565_LCD_BIAS_7 # endif # ifndef ST7565_ADC # define ST7565_ADC ST7565_ADC_NORMAL # endif # ifndef ST7565_COM_SCAN # define ST7565_COM_SCAN ST7565_COM_SCAN_INC # endif # ifndef ST7565_PAGE_ORDER # define ST7565_PAGE_ORDER 0, 1, 2, 3, 4, 5, 6, 7 # endif /*===========================================================================*/ /* Driver local functions. */ /*===========================================================================*/ // Some common routines and macros # define RAM(g) ((gU8 *)g->priv) # define write_cmd2(g, cmd1, cmd2) \ { \ write_cmd(g, cmd1); \ write_cmd(g, cmd2); \ } # define write_cmd3(g, cmd1, cmd2, cmd3) \ { \ write_cmd(g, cmd1); \ write_cmd(g, cmd2); \ write_cmd(g, cmd3); \ } // Some common routines and macros # define delay(us) gfxSleepMicroseconds(us) # define delay_ms(ms) gfxSleepMilliseconds(ms) # define xyaddr(x, y) ((x) + ((y) >> 3) * GDISP_SCREEN_WIDTH) # define xybit(y) (1 << ((y)&7)) /*===========================================================================*/ /* Driver exported functions. */ /*===========================================================================*/ /* * As this controller can't update on a pixel boundary we need to maintain the * the entire display surface in memory so that we can do the necessary bit * operations. Fortunately it is a small display in monochrome. * 64 * 128 / 8 = 1024 bytes. */ LLDSPEC bool_t gdisp_lld_init(GDisplay *g) { // The private area is the display surface. g->priv = gfxAlloc(GDISP_SCREEN_HEIGHT * GDISP_SCREEN_WIDTH / 8); if (!g->priv) { return gFalse; } // Initialise the board interface init_board(g); // Hardware reset setpin_reset(g, TRUE); gfxSleepMilliseconds(20); setpin_reset(g, FALSE); gfxSleepMilliseconds(20); acquire_bus(g); write_cmd(g, ST7565_LCD_BIAS); write_cmd(g, ST7565_ADC); write_cmd(g, ST7565_COM_SCAN); write_cmd(g, ST7565_START_LINE | 0); write_cmd2(g, ST7565_CONTRAST, GDISP_INITIAL_CONTRAST * 64 / 101); write_cmd(g, ST7565_RESISTOR_RATIO | 0x1); // turn on voltage converter (VC=1, VR=0, VF=0) write_cmd(g, ST7565_POWER_CONTROL | 0x04); delay_ms(50); // turn on voltage regulator (VC=1, VR=1, VF=0) write_cmd(g, ST7565_POWER_CONTROL | 0x06); delay_ms(50); // turn on voltage follower (VC=1, VR=1, VF=1) write_cmd(g, ST7565_POWER_CONTROL | 0x07); delay_ms(50); write_cmd(g, ST7565_DISPLAY_ON); write_cmd(g, ST7565_ALLON_NORMAL); write_cmd(g, ST7565_INVERT_DISPLAY); // Disable Inversion of display. write_cmd(g, ST7565_RMW); // Finish Init post_init_board(g); // Release the bus release_bus(g); /* Initialise the GDISP structure */ g->g.Width = GDISP_SCREEN_WIDTH; g->g.Height = GDISP_SCREEN_HEIGHT; g->g.Orientation = GDISP_ROTATE_0; g->g.Powermode = powerOff; g->g.Backlight = GDISP_INITIAL_BACKLIGHT; g->g.Contrast = GDISP_INITIAL_CONTRAST; return TRUE; } # if GDISP_HARDWARE_FLUSH LLDSPEC void gdisp_lld_flush(GDisplay *g) { unsigned p; // Don't flush if we don't need it. if (!(g->flags & GDISP_FLG_NEEDFLUSH)) return; acquire_bus(g); gU8 pagemap[] = {ST7565_PAGE_ORDER}; for (p = 0; p < sizeof(pagemap); p++) { write_cmd(g, ST7565_PAGE | pagemap[p]); write_cmd(g, ST7565_COLUMN_MSB | 0); write_cmd(g, ST7565_COLUMN_LSB | 0); write_cmd(g, ST7565_RMW); write_data(g, RAM(g) + (p * GDISP_SCREEN_WIDTH), GDISP_SCREEN_WIDTH); } release_bus(g); g->flags &= ~GDISP_FLG_NEEDFLUSH; } # endif # if GDISP_HARDWARE_DRAWPIXEL LLDSPEC void gdisp_lld_draw_pixel(GDisplay *g) { coord_t x, y; switch (g->g.Orientation) { default: case GDISP_ROTATE_0: x = g->p.x; y = g->p.y; break; case GDISP_ROTATE_90: x = g->p.y; y = GDISP_SCREEN_HEIGHT - 1 - g->p.x; break; case GDISP_ROTATE_180: x = GDISP_SCREEN_WIDTH - 1 - g->p.x; y = GDISP_SCREEN_HEIGHT - 1 - g->p.y; break; case GDISP_ROTATE_270: x = GDISP_SCREEN_HEIGHT - 1 - g->p.y; y = g->p.x; break; } if (gdispColor2Native(g->p.color) != Black) RAM(g)[xyaddr(x, y)] |= xybit(y); else RAM(g)[xyaddr(x, y)] &= ~xybit(y); g->flags |= GDISP_FLG_NEEDFLUSH; } # endif # if GDISP_HARDWARE_PIXELREAD LLDSPEC color_t gdisp_lld_get_pixel_color(GDisplay *g) { coord_t x, y; switch (g->g.Orientation) { default: case GDISP_ROTATE_0: x = g->p.x; y = g->p.y; break; case GDISP_ROTATE_90: x = g->p.y; y = GDISP_SCREEN_HEIGHT - 1 - g->p.x; break; case GDISP_ROTATE_180: x = GDISP_SCREEN_WIDTH - 1 - g->p.x; y = GDISP_SCREEN_HEIGHT - 1 - g->p.y; break; case GDISP_ROTATE_270: x = GDISP_SCREEN_HEIGHT - 1 - g->p.y; y = g->p.x; break; } return (RAM(g)[xyaddr(x, y)] & xybit(y)) ? White : Black; } # endif # if GDISP_HARDWARE_BITFILLS LLDSPEC void gdisp_lld_blit_area(GDisplay *g) { uint8_t *buffer = (uint8_t *)g->p.ptr; int linelength = g->p.cx; for (int i = 0; i < g->p.cy; i++) { unsigned dstx = g->p.x; unsigned dsty = g->p.y + i; unsigned srcx = g->p.x1; unsigned srcy = g->p.y1 + i; unsigned srcbit = srcy * g->p.x2 + srcx; for (int j = 0; j < linelength; j++) { uint8_t src = buffer[srcbit / 8]; uint8_t bit = 7 - (srcbit % 8); uint8_t bitset = (src >> bit) & 1; uint8_t *dst = &(RAM(g)[xyaddr(dstx, dsty)]); if (bitset) { *dst |= xybit(dsty); } else { *dst &= ~xybit(dsty); } dstx++; srcbit++; } } g->flags |= GDISP_FLG_NEEDFLUSH; } # endif # if GDISP_NEED_CONTROL && GDISP_HARDWARE_CONTROL LLDSPEC void gdisp_lld_control(GDisplay *g) { switch (g->p.x) { case GDISP_CONTROL_POWER: if (g->g.Powermode == (powermode_t)g->p.ptr) return; switch ((powermode_t)g->p.ptr) { case powerOff: case powerSleep: case powerDeepSleep: acquire_bus(g); write_cmd(g, ST7565_DISPLAY_OFF); release_bus(g); break; case powerOn: acquire_bus(g); write_cmd(g, ST7565_DISPLAY_ON); release_bus(g); break; default: return; } g->g.Powermode = (powermode_t)g->p.ptr; return; case GDISP_CONTROL_ORIENTATION: if (g->g.Orientation == (orientation_t)g->p.ptr) return; switch ((orientation_t)g->p.ptr) { /* Rotation is handled by the drawing routines */ case GDISP_ROTATE_0: case GDISP_ROTATE_180: g->g.Height = GDISP_SCREEN_HEIGHT; g->g.Width = GDISP_SCREEN_WIDTH; break; case GDISP_ROTATE_90: case GDISP_ROTATE_270: g->g.Height = GDISP_SCREEN_WIDTH; g->g.Width = GDISP_SCREEN_HEIGHT; break; default: return; } g->g.Orientation = (orientation_t)g->p.ptr; return; case GDISP_CONTROL_CONTRAST: if ((unsigned)g->p.ptr > 100) g->p.ptr = (void *)100; acquire_bus(g); write_cmd2(g, ST7565_CONTRAST, ((((unsigned)g->p.ptr) << 6) / 101) & 0x3F); release_bus(g); g->g.Contrast = (unsigned)g->p.ptr; return; } } # endif // GDISP_NEED_CONTROL #endif // GFX_USE_GDISP