#include "ltp305.hpp" #include #include "dotfont.hpp" namespace pimoroni { bool LTP305::init() { set_brightness(DEFAULT_BRIGHTNESS); clear(); return true; } i2c_inst_t* LTP305::get_i2c() const { return i2c->get_i2c(); } int LTP305::get_address() const { return address; } int LTP305::get_sda() const { return i2c->get_sda(); } int LTP305::get_scl() const { return i2c->get_scl(); } void LTP305::set_brightness(uint8_t brightness, bool update) { brightness = std::min((uint8_t)MAX_BRIGHTNESS, brightness); if(update) i2c->reg_write_uint8(address, CMD_BRIGHTNESS, brightness); } void LTP305::set_decimal(bool left, bool right) { if(left) buf_matrix_left[7 + BUFFER_CMD] |= 0b01000000; else buf_matrix_left[7 + BUFFER_CMD] &= 0b10111111; if(right) buf_matrix_right[6 + BUFFER_CMD] |= 0b10000000; else buf_matrix_right[6 + BUFFER_CMD] &= 0b01111111; } void LTP305::set_pixel(uint8_t x, uint8_t y, bool c) { // Left Matrix if(x < 5) { if(c) buf_matrix_left[x + BUFFER_CMD] |= (0b1 << y); else buf_matrix_left[x + BUFFER_CMD] &= ~(0b1 << y); } // Right Matrix else { x -= 5; if(c) buf_matrix_right[y + BUFFER_CMD] |= (0b1 << x); else buf_matrix_right[y + BUFFER_CMD] &= ~(0b1 << x); } } void LTP305::set_character(uint8_t x, uint16_t ch) { std::map::const_iterator it = dotfont.find(ch); if(it != dotfont.end()) { DotChar dchar = it->second; for(uint8_t cx = 0; cx < DOT_CHAR_WIDTH; cx++) { for(uint8_t cy = 0; cy < HEIGHT; cy++) { uint8_t c = dchar.data[cx] & (0b1 << cy); set_pixel(x + cx, cy, c); } } } } void LTP305::set_image(const uint8_t *image, uint16_t image_width, uint16_t image_height, uint16_t offset_x, uint16_t offset_y, bool wrap, bool bg, uint8_t on_level, uint8_t padding) { for(uint8_t y = 0; y < HEIGHT; y++) { for(uint8_t x = 0; x < WIDTH; x++) { bool p = bg; uint16_t i_x = x + offset_x; uint16_t i_y = y + offset_y; if(x >= 5) i_x += padding; if(wrap) { while(i_x >= image_width) { i_x -= image_width; } while(i_y >= image_height) { i_y -= image_height; } } if((i_x < image_width) && (i_y < image_height)) { p = (image[(i_y * image_width) + i_x] >= on_level); } set_pixel(x, y, p); } } } void LTP305::clear() { for(uint8_t i = 0; i < BUFFER_LENGTH; i++) { buf_matrix_left[i + 1] = 0x00; buf_matrix_right[i + 1] = 0x00; } } void LTP305::show() { i2c->write_blocking(address, buf_matrix_left, BUFFER_CMD + BUFFER_LENGTH, false); i2c->write_blocking(address, buf_matrix_right, BUFFER_CMD + BUFFER_LENGTH, false); i2c->reg_write_uint8(address, CMD_MODE, MODE); i2c->reg_write_uint8(address, CMD_OPTIONS, OPTS); i2c->reg_write_uint8(address, CMD_BRIGHTNESS, brightness); i2c->reg_write_uint8(address, CMD_UPDATE, 0x01); } }