You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
500 lines
14 KiB
500 lines
14 KiB
/*
|
|
* This file is part of the Trezor project, https://trezor.io/
|
|
*
|
|
* Copyright (C) 2014 Pavol Rusnak <stick@satoshilabs.com>
|
|
*
|
|
* This library is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU Lesser General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This library is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU Lesser General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public License
|
|
* along with this library. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <libopencm3/stm32/gpio.h>
|
|
#include <libopencm3/stm32/spi.h>
|
|
|
|
#include <string.h>
|
|
|
|
#include "memzero.h"
|
|
#include "oled.h"
|
|
#include "util.h"
|
|
|
|
#define OLED_SETCONTRAST 0x81
|
|
#define OLED_DISPLAYALLON_RESUME 0xA4
|
|
#define OLED_DISPLAYALLON 0xA5
|
|
#define OLED_NORMALDISPLAY 0xA6
|
|
#define OLED_INVERTDISPLAY 0xA7
|
|
#define OLED_DISPLAYOFF 0xAE
|
|
#define OLED_DISPLAYON 0xAF
|
|
#define OLED_SETDISPLAYOFFSET 0xD3
|
|
#define OLED_SETCOMPINS 0xDA
|
|
#define OLED_SETVCOMDETECT 0xDB
|
|
#define OLED_SETDISPLAYCLOCKDIV 0xD5
|
|
#define OLED_SETPRECHARGE 0xD9
|
|
#define OLED_SETMULTIPLEX 0xA8
|
|
#define OLED_SETLOWCOLUMN 0x00
|
|
#define OLED_SETHIGHCOLUMN 0x10
|
|
#define OLED_SETSTARTLINE 0x40
|
|
#define OLED_MEMORYMODE 0x20
|
|
#define OLED_COMSCANINC 0xC0
|
|
#define OLED_COMSCANDEC 0xC8
|
|
#define OLED_SEGREMAP 0xA0
|
|
#define OLED_CHARGEPUMP 0x8D
|
|
|
|
#define SPI_BASE SPI1
|
|
#define OLED_DC_PORT GPIOB
|
|
#define OLED_DC_PIN GPIO0 // PB0 | Data/Command
|
|
#define OLED_CS_PORT GPIOA
|
|
#define OLED_CS_PIN GPIO4 // PA4 | SPI Select
|
|
#define OLED_RST_PORT GPIOB
|
|
#define OLED_RST_PIN GPIO1 // PB1 | Reset display
|
|
|
|
/* Trezor has a display of size OLED_WIDTH x OLED_HEIGHT (128x64).
|
|
* The contents of this display are buffered in _oledbuffer. This is
|
|
* an array of OLED_WIDTH * OLED_HEIGHT/8 bytes. At byte y*OLED_WIDTH + x
|
|
* it stores the column of pixels from (x,8y) to (x,8y+7); the LSB stores
|
|
* the top most pixel. The pixel (0,0) is the top left corner of the
|
|
* display.
|
|
*/
|
|
|
|
static uint8_t _oledbuffer[OLED_BUFSIZE];
|
|
|
|
/*
|
|
* macros to convert coordinate to bit position
|
|
*/
|
|
#define OLED_OFFSET(x, y) (OLED_BUFSIZE - 1 - (x) - ((y) / 8) * OLED_WIDTH)
|
|
#define OLED_MASK(x, y) (1 << (7 - (y) % 8))
|
|
|
|
/*
|
|
* Return the state of the pixel at x, y
|
|
*/
|
|
bool oledGetPixel(int x, int y) {
|
|
return _oledbuffer[OLED_OFFSET(x, y)] & OLED_MASK(x, y);
|
|
}
|
|
|
|
/*
|
|
* Draws a white pixel at x, y
|
|
*/
|
|
void oledDrawPixel(int x, int y) {
|
|
if ((x < 0) || (y < 0) || (x >= OLED_WIDTH) || (y >= OLED_HEIGHT)) {
|
|
return;
|
|
}
|
|
_oledbuffer[OLED_OFFSET(x, y)] |= OLED_MASK(x, y);
|
|
}
|
|
|
|
/*
|
|
* Clears pixel at x, y
|
|
*/
|
|
void oledClearPixel(int x, int y) {
|
|
if ((x < 0) || (y < 0) || (x >= OLED_WIDTH) || (y >= OLED_HEIGHT)) {
|
|
return;
|
|
}
|
|
_oledbuffer[OLED_OFFSET(x, y)] &= ~OLED_MASK(x, y);
|
|
}
|
|
|
|
/*
|
|
* Inverts pixel at x, y
|
|
*/
|
|
void oledInvertPixel(int x, int y) {
|
|
if ((x < 0) || (y < 0) || (x >= OLED_WIDTH) || (y >= OLED_HEIGHT)) {
|
|
return;
|
|
}
|
|
_oledbuffer[OLED_OFFSET(x, y)] ^= OLED_MASK(x, y);
|
|
}
|
|
|
|
#if !EMULATOR
|
|
/*
|
|
* Send a block of data via the SPI bus.
|
|
*/
|
|
static inline void SPISend(uint32_t base, const uint8_t *data, int len) {
|
|
delay(1);
|
|
for (int i = 0; i < len; i++) {
|
|
spi_send(base, data[i]);
|
|
}
|
|
while (!(SPI_SR(base) & SPI_SR_TXE))
|
|
;
|
|
while ((SPI_SR(base) & SPI_SR_BSY))
|
|
;
|
|
}
|
|
|
|
/*
|
|
* Initialize the display.
|
|
*/
|
|
void oledInit() {
|
|
static const uint8_t s[25] = {OLED_DISPLAYOFF,
|
|
OLED_SETDISPLAYCLOCKDIV,
|
|
0x80,
|
|
OLED_SETMULTIPLEX,
|
|
0x3F, // 128x64
|
|
OLED_SETDISPLAYOFFSET,
|
|
0x00,
|
|
OLED_SETSTARTLINE | 0x00,
|
|
OLED_CHARGEPUMP,
|
|
0x14,
|
|
OLED_MEMORYMODE,
|
|
0x00,
|
|
OLED_SEGREMAP | 0x01,
|
|
OLED_COMSCANDEC,
|
|
OLED_SETCOMPINS,
|
|
0x12, // 128x64
|
|
OLED_SETCONTRAST,
|
|
0xCF,
|
|
OLED_SETPRECHARGE,
|
|
0xF1,
|
|
OLED_SETVCOMDETECT,
|
|
0x40,
|
|
OLED_DISPLAYALLON_RESUME,
|
|
OLED_NORMALDISPLAY,
|
|
OLED_DISPLAYON};
|
|
|
|
gpio_clear(OLED_DC_PORT, OLED_DC_PIN); // set to CMD
|
|
gpio_set(OLED_CS_PORT, OLED_CS_PIN); // SPI deselect
|
|
|
|
// Reset the LCD
|
|
gpio_set(OLED_RST_PORT, OLED_RST_PIN);
|
|
delay(40);
|
|
gpio_clear(OLED_RST_PORT, OLED_RST_PIN);
|
|
delay(400);
|
|
gpio_set(OLED_RST_PORT, OLED_RST_PIN);
|
|
|
|
// init
|
|
gpio_clear(OLED_CS_PORT, OLED_CS_PIN); // SPI select
|
|
SPISend(SPI_BASE, s, 25);
|
|
gpio_set(OLED_CS_PORT, OLED_CS_PIN); // SPI deselect
|
|
|
|
oledClear();
|
|
oledRefresh();
|
|
}
|
|
#endif
|
|
|
|
/*
|
|
* Clears the display buffer (sets all pixels to black)
|
|
*/
|
|
void oledClear() { memzero(_oledbuffer, sizeof(_oledbuffer)); }
|
|
|
|
void oledInvertDebugLink() {
|
|
#if DEBUG_LINK
|
|
oledInvertPixel(OLED_WIDTH - 5, 0);
|
|
oledInvertPixel(OLED_WIDTH - 4, 0);
|
|
oledInvertPixel(OLED_WIDTH - 3, 0);
|
|
oledInvertPixel(OLED_WIDTH - 2, 0);
|
|
oledInvertPixel(OLED_WIDTH - 1, 0);
|
|
oledInvertPixel(OLED_WIDTH - 4, 1);
|
|
oledInvertPixel(OLED_WIDTH - 3, 1);
|
|
oledInvertPixel(OLED_WIDTH - 2, 1);
|
|
oledInvertPixel(OLED_WIDTH - 1, 1);
|
|
oledInvertPixel(OLED_WIDTH - 3, 2);
|
|
oledInvertPixel(OLED_WIDTH - 2, 2);
|
|
oledInvertPixel(OLED_WIDTH - 1, 2);
|
|
oledInvertPixel(OLED_WIDTH - 2, 3);
|
|
oledInvertPixel(OLED_WIDTH - 1, 3);
|
|
oledInvertPixel(OLED_WIDTH - 1, 4);
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* Refresh the display. This copies the buffer to the display to show the
|
|
* contents. This must be called after every operation to the buffer to
|
|
* make the change visible. All other operations only change the buffer
|
|
* not the content of the display.
|
|
*/
|
|
#if !EMULATOR
|
|
void oledRefresh() {
|
|
static const uint8_t s[3] = {OLED_SETLOWCOLUMN | 0x00,
|
|
OLED_SETHIGHCOLUMN | 0x00,
|
|
OLED_SETSTARTLINE | 0x00};
|
|
|
|
// draw triangle in upper right corner
|
|
oledInvertDebugLink();
|
|
|
|
gpio_clear(OLED_CS_PORT, OLED_CS_PIN); // SPI select
|
|
SPISend(SPI_BASE, s, 3);
|
|
gpio_set(OLED_CS_PORT, OLED_CS_PIN); // SPI deselect
|
|
|
|
gpio_set(OLED_DC_PORT, OLED_DC_PIN); // set to DATA
|
|
gpio_clear(OLED_CS_PORT, OLED_CS_PIN); // SPI select
|
|
SPISend(SPI_BASE, _oledbuffer, sizeof(_oledbuffer));
|
|
gpio_set(OLED_CS_PORT, OLED_CS_PIN); // SPI deselect
|
|
gpio_clear(OLED_DC_PORT, OLED_DC_PIN); // set to CMD
|
|
|
|
// return it back
|
|
oledInvertDebugLink();
|
|
}
|
|
#endif
|
|
|
|
const uint8_t *oledGetBuffer() { return _oledbuffer; }
|
|
|
|
void oledSetBuffer(uint8_t *buf) {
|
|
memcpy(_oledbuffer, buf, sizeof(_oledbuffer));
|
|
}
|
|
|
|
void oledDrawChar(int x, int y, char c, uint8_t font) {
|
|
if (x >= OLED_WIDTH || y >= OLED_HEIGHT || y <= -FONT_HEIGHT) {
|
|
return;
|
|
}
|
|
|
|
int zoom = (font & FONT_DOUBLE) ? 2 : 1;
|
|
int char_width = fontCharWidth(font & 0x7f, (uint8_t)c);
|
|
const uint8_t *char_data = fontCharData(font & 0x7f, (uint8_t)c);
|
|
|
|
if (x <= -char_width) {
|
|
return;
|
|
}
|
|
|
|
for (int xo = 0; xo < char_width; xo++) {
|
|
for (int yo = 0; yo < FONT_HEIGHT; yo++) {
|
|
if (char_data[xo] & (1 << (FONT_HEIGHT - 1 - yo))) {
|
|
if (zoom <= 1) {
|
|
oledDrawPixel(x + xo, y + yo);
|
|
} else {
|
|
oledBox(x + xo, y + yo * zoom, x + (xo + 1) - 1,
|
|
y + (yo + 1) * zoom - 1, true);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
static uint8_t convert_char(const char a) {
|
|
static char last_was_utf8 = 0;
|
|
|
|
uint8_t c = a;
|
|
|
|
// non-printable ASCII character
|
|
if (c < ' ') {
|
|
last_was_utf8 = 0;
|
|
return 0x7f;
|
|
}
|
|
|
|
// regular ASCII character
|
|
if (c < 0x80) {
|
|
last_was_utf8 = 0;
|
|
return c;
|
|
}
|
|
|
|
// UTF-8 handling: https://en.wikipedia.org/wiki/UTF-8#Description
|
|
|
|
// bytes 11xxxxxx are first bytes of UTF-8 characters
|
|
if (c >= 0xC0) {
|
|
last_was_utf8 = 1;
|
|
return 0x7f;
|
|
}
|
|
|
|
if (last_was_utf8) {
|
|
// bytes 10xxxxxx can be successive UTF-8 characters ...
|
|
return 0; // skip glyph
|
|
} else {
|
|
// ... or they are just non-printable ASCII characters
|
|
return 0x7f;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int oledStringWidth(const char *text, uint8_t font) {
|
|
if (!text) return 0;
|
|
int space = (font & FONT_DOUBLE) ? 2 : 1;
|
|
int l = 0;
|
|
for (; *text; text++) {
|
|
uint8_t c = convert_char(*text);
|
|
if (c) {
|
|
l += fontCharWidth(font & 0x7f, c) + space;
|
|
}
|
|
}
|
|
return l;
|
|
}
|
|
|
|
void oledDrawString(int x, int y, const char *text, uint8_t font) {
|
|
if (!text) return;
|
|
int l = 0;
|
|
int space = (font & FONT_DOUBLE) ? 2 : 1;
|
|
for (; *text; text++) {
|
|
uint8_t c = convert_char(*text);
|
|
if (c) {
|
|
oledDrawChar(x + l, y, c, font);
|
|
l += fontCharWidth(font & 0x7f, c) + space;
|
|
}
|
|
}
|
|
}
|
|
|
|
void oledDrawStringCenter(int x, int y, const char *text, uint8_t font) {
|
|
x = x - oledStringWidth(text, font) / 2;
|
|
oledDrawString(x, y, text, font);
|
|
}
|
|
|
|
void oledDrawStringRight(int x, int y, const char *text, uint8_t font) {
|
|
x -= oledStringWidth(text, font);
|
|
oledDrawString(x, y, text, font);
|
|
}
|
|
|
|
static void oled_draw_bitmap_flip(int x, int y, const BITMAP *bmp, bool flip) {
|
|
for (int i = 0; i < bmp->width; i++) {
|
|
int ii = flip ? (bmp->width - 1 - i) : i;
|
|
for (int j = 0; j < bmp->height; j++) {
|
|
if (bmp->data[(ii / 8) + j * bmp->width / 8] & (1 << (7 - ii % 8))) {
|
|
oledDrawPixel(x + i, y + j);
|
|
} else {
|
|
oledClearPixel(x + i, y + j);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void oledDrawBitmap(int x, int y, const BITMAP *bmp) {
|
|
oled_draw_bitmap_flip(x, y, bmp, false);
|
|
}
|
|
|
|
void oledDrawBitmapFlip(int x, int y, const BITMAP *bmp) {
|
|
oled_draw_bitmap_flip(x, y, bmp, true);
|
|
}
|
|
|
|
/*
|
|
* Inverts box between (x1,y1) and (x2,y2) inclusive.
|
|
*/
|
|
void oledInvert(int x1, int y1, int x2, int y2) {
|
|
x1 = MAX(x1, 0);
|
|
y1 = MAX(y1, 0);
|
|
x2 = MIN(x2, OLED_WIDTH - 1);
|
|
y2 = MIN(y2, OLED_HEIGHT - 1);
|
|
for (int x = x1; x <= x2; x++) {
|
|
for (int y = y1; y <= y2; y++) {
|
|
oledInvertPixel(x, y);
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Draw a filled rectangle.
|
|
*/
|
|
void oledBox(int x1, int y1, int x2, int y2, bool set) {
|
|
x1 = MAX(x1, 0);
|
|
y1 = MAX(y1, 0);
|
|
x2 = MIN(x2, OLED_WIDTH - 1);
|
|
y2 = MIN(y2, OLED_HEIGHT - 1);
|
|
for (int x = x1; x <= x2; x++) {
|
|
for (int y = y1; y <= y2; y++) {
|
|
set ? oledDrawPixel(x, y) : oledClearPixel(x, y);
|
|
}
|
|
}
|
|
}
|
|
|
|
void oledHLine(int y) {
|
|
if (y < 0 || y >= OLED_HEIGHT) {
|
|
return;
|
|
}
|
|
for (int x = 0; x < OLED_WIDTH; x++) {
|
|
oledDrawPixel(x, y);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Draw a rectangle frame.
|
|
*/
|
|
void oledFrame(int x1, int y1, int x2, int y2) {
|
|
for (int x = x1; x <= x2; x++) {
|
|
oledDrawPixel(x, y1);
|
|
oledDrawPixel(x, y2);
|
|
}
|
|
for (int y = y1 + 1; y < y2; y++) {
|
|
oledDrawPixel(x1, y);
|
|
oledDrawPixel(x2, y);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Animates the display, swiping the current contents out to the left.
|
|
* This clears the display.
|
|
*/
|
|
void oledSwipeLeft(void) {
|
|
for (int i = 0; i < OLED_WIDTH; i++) {
|
|
for (int j = 0; j < OLED_HEIGHT / 8; j++) {
|
|
for (int k = OLED_WIDTH - 1; k > 0; k--) {
|
|
_oledbuffer[j * OLED_WIDTH + k] = _oledbuffer[j * OLED_WIDTH + k - 1];
|
|
}
|
|
_oledbuffer[j * OLED_WIDTH] = 0;
|
|
}
|
|
oledRefresh();
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Animates the display, swiping the current contents out to the right.
|
|
* This clears the display.
|
|
*/
|
|
void oledSwipeRight(void) {
|
|
for (int i = 0; i < OLED_WIDTH / 4; i++) {
|
|
for (int j = 0; j < OLED_HEIGHT / 8; j++) {
|
|
for (int k = 0; k < OLED_WIDTH / 4 - 1; k++) {
|
|
_oledbuffer[k * 4 + 0 + j * OLED_WIDTH] =
|
|
_oledbuffer[k * 4 + 4 + j * OLED_WIDTH];
|
|
_oledbuffer[k * 4 + 1 + j * OLED_WIDTH] =
|
|
_oledbuffer[k * 4 + 5 + j * OLED_WIDTH];
|
|
_oledbuffer[k * 4 + 2 + j * OLED_WIDTH] =
|
|
_oledbuffer[k * 4 + 6 + j * OLED_WIDTH];
|
|
_oledbuffer[k * 4 + 3 + j * OLED_WIDTH] =
|
|
_oledbuffer[k * 4 + 7 + j * OLED_WIDTH];
|
|
}
|
|
_oledbuffer[j * OLED_WIDTH + OLED_WIDTH - 1] = 0;
|
|
_oledbuffer[j * OLED_WIDTH + OLED_WIDTH - 2] = 0;
|
|
_oledbuffer[j * OLED_WIDTH + OLED_WIDTH - 3] = 0;
|
|
_oledbuffer[j * OLED_WIDTH + OLED_WIDTH - 4] = 0;
|
|
}
|
|
oledRefresh();
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Mitigate SCA on lines y1-y2 by setting at least width pixels white
|
|
* Pixels grow from the outside (left/right border of the screen)
|
|
*/
|
|
void oledSCA(int y1, int y2, int width) {
|
|
y1 = MAX(y1, 0);
|
|
y2 = MIN(y2, OLED_HEIGHT - 1);
|
|
for (int y = y1; y <= y2; y++) {
|
|
int pix = 0;
|
|
for (int x = 0; x < OLED_WIDTH; x++) {
|
|
pix += oledGetPixel(x, y);
|
|
}
|
|
if (width > pix) {
|
|
pix = width - pix;
|
|
for (int x = 0; x < pix / 2; x++) {
|
|
oledDrawPixel(x, y);
|
|
}
|
|
for (int x = OLED_WIDTH - ((pix + 1) / 2); x < OLED_WIDTH; x++) {
|
|
oledDrawPixel(x, y);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Mitigate SCA on lines y1-y2 by setting at least width pixels white
|
|
* Pixels grow from the inside (from columns a/b to the right/left)
|
|
*/
|
|
void oledSCAInside(int y1, int y2, int width, int a, int b) {
|
|
y1 = MAX(y1, 0);
|
|
y2 = MIN(y2, OLED_HEIGHT - 1);
|
|
for (int y = y1; y <= y2; y++) {
|
|
int pix = 0;
|
|
for (int x = 0; x < OLED_WIDTH; x++) {
|
|
pix += oledGetPixel(x, y);
|
|
}
|
|
if (width > pix) {
|
|
pix = width - pix;
|
|
for (int x = a - pix / 2; x < a; x++) {
|
|
oledDrawPixel(x, y);
|
|
}
|
|
for (int x = b; x < b + (pix + 1) / 2; x++) {
|
|
oledDrawPixel(x, y);
|
|
}
|
|
}
|
|
}
|
|
}
|