- /*
- * 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
|