468 lines
11 KiB
C
468 lines
11 KiB
C
/*
|
|
* Copyright (c) 2018 PHYTEC Messtechnik GmbH
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
#define DT_DRV_COMPAT solomon_ssd1306fb
|
|
|
|
#include <logging/log.h>
|
|
LOG_MODULE_REGISTER(ssd1306, CONFIG_DISPLAY_LOG_LEVEL);
|
|
|
|
#include <string.h>
|
|
#include <device.h>
|
|
#include <init.h>
|
|
#include <drivers/gpio.h>
|
|
#include <drivers/i2c.h>
|
|
|
|
#include "ssd1306_regs.h"
|
|
#include <display/cfb.h>
|
|
|
|
#if DT_INST_PROP(0, segment_remap) == 1
|
|
#define SSD1306_PANEL_SEGMENT_REMAP true
|
|
#else
|
|
#define SSD1306_PANEL_SEGMENT_REMAP false
|
|
#endif
|
|
|
|
#if DT_INST_PROP(0, com_invdir) == 1
|
|
#define SSD1306_PANEL_COM_INVDIR true
|
|
#else
|
|
#define SSD1306_PANEL_COM_INVDIR false
|
|
#endif
|
|
|
|
#if DT_INST_PROP(0, com_sequential) == 1
|
|
#define SSD1306_COM_PINS_HW_CONFIG SSD1306_SET_PADS_HW_SEQUENTIAL
|
|
#else
|
|
#define SSD1306_COM_PINS_HW_CONFIG SSD1306_SET_PADS_HW_ALTERNATIVE
|
|
#endif
|
|
|
|
#define SSD1306_PANEL_NUMOF_PAGES (DT_INST_PROP(0, height) / 8)
|
|
#define SSD1306_CLOCK_DIV_RATIO 0x0
|
|
#define SSD1306_CLOCK_FREQUENCY 0x8
|
|
#define SSD1306_PANEL_VCOM_DESEL_LEVEL 0x20
|
|
#define SSD1306_PANEL_PUMP_VOLTAGE SSD1306_SET_PUMP_VOLTAGE_90
|
|
|
|
#ifndef SSD1306_ADDRESSING_MODE
|
|
#define SSD1306_ADDRESSING_MODE (SSD1306_SET_MEM_ADDRESSING_HORIZONTAL)
|
|
#endif
|
|
|
|
struct ssd1306_data {
|
|
const struct device *reset;
|
|
const struct device *i2c;
|
|
uint8_t contrast;
|
|
uint8_t scan_mode;
|
|
};
|
|
|
|
static inline int ssd1306_reg_read(struct ssd1306_data *driver,
|
|
uint8_t reg, uint8_t * const val)
|
|
{
|
|
return i2c_reg_read_byte(driver->i2c,
|
|
DT_INST_REG_ADDR(0),
|
|
reg, val);
|
|
}
|
|
|
|
static inline int ssd1306_reg_write(struct ssd1306_data *driver,
|
|
uint8_t reg, uint8_t val)
|
|
{
|
|
return i2c_reg_write_byte(driver->i2c,
|
|
DT_INST_REG_ADDR(0),
|
|
reg, val);
|
|
}
|
|
|
|
static inline int ssd1306_reg_update(struct ssd1306_data *driver, uint8_t reg,
|
|
uint8_t mask, uint8_t val)
|
|
{
|
|
return i2c_reg_update_byte(driver->i2c,
|
|
DT_INST_REG_ADDR(0),
|
|
reg, mask, val);
|
|
}
|
|
|
|
static inline int ssd1306_set_panel_orientation(const struct device *dev)
|
|
{
|
|
struct ssd1306_data *driver = dev->data;
|
|
uint8_t cmd_buf[] = {
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
(SSD1306_PANEL_SEGMENT_REMAP ?
|
|
SSD1306_SET_SEGMENT_MAP_REMAPED :
|
|
SSD1306_SET_SEGMENT_MAP_NORMAL),
|
|
SSD1306_CONTROL_LAST_BYTE_CMD,
|
|
(SSD1306_PANEL_COM_INVDIR ?
|
|
SSD1306_SET_COM_OUTPUT_SCAN_FLIPPED :
|
|
SSD1306_SET_COM_OUTPUT_SCAN_NORMAL)
|
|
};
|
|
|
|
return i2c_write(driver->i2c, cmd_buf, sizeof(cmd_buf),
|
|
DT_INST_REG_ADDR(0));
|
|
}
|
|
|
|
static inline int ssd1306_set_timing_setting(const struct device *dev)
|
|
{
|
|
struct ssd1306_data *driver = dev->data;
|
|
uint8_t cmd_buf[] = {
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_CLOCK_DIV_RATIO,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
(SSD1306_CLOCK_FREQUENCY << 4) | SSD1306_CLOCK_DIV_RATIO,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_CHARGE_PERIOD,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
DT_INST_PROP(0, prechargep),
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_VCOM_DESELECT_LEVEL,
|
|
SSD1306_CONTROL_LAST_BYTE_CMD,
|
|
SSD1306_PANEL_VCOM_DESEL_LEVEL
|
|
};
|
|
|
|
return i2c_write(driver->i2c, cmd_buf, sizeof(cmd_buf),
|
|
DT_INST_REG_ADDR(0));
|
|
}
|
|
|
|
static inline int ssd1306_set_hardware_config(const struct device *dev)
|
|
{
|
|
struct ssd1306_data *driver = dev->data;
|
|
uint8_t cmd_buf[] = {
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_START_LINE,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_DISPLAY_OFFSET,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
DT_INST_PROP(0, display_offset),
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_PADS_HW_CONFIG,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_COM_PINS_HW_CONFIG,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_MULTIPLEX_RATIO,
|
|
SSD1306_CONTROL_LAST_BYTE_CMD,
|
|
DT_INST_PROP(0, multiplex_ratio)
|
|
};
|
|
|
|
return i2c_write(driver->i2c, cmd_buf, sizeof(cmd_buf),
|
|
DT_INST_REG_ADDR(0));
|
|
}
|
|
|
|
static inline int ssd1306_set_charge_pump(const struct device *dev)
|
|
{
|
|
struct ssd1306_data *driver = dev->data;
|
|
uint8_t cmd_buf[] = {
|
|
#if defined(CONFIG_SSD1306_DEFAULT)
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_CHARGE_PUMP_ON,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_CHARGE_PUMP_ON_ENABLED,
|
|
#endif
|
|
#if defined(CONFIG_SSD1306_SH1106_COMPATIBLE)
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SH1106_SET_DCDC_MODE,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SH1106_SET_DCDC_ENABLED,
|
|
#endif
|
|
SSD1306_CONTROL_LAST_BYTE_CMD,
|
|
SSD1306_PANEL_PUMP_VOLTAGE,
|
|
};
|
|
|
|
return i2c_write(driver->i2c, cmd_buf, sizeof(cmd_buf),
|
|
DT_INST_REG_ADDR(0));
|
|
}
|
|
|
|
static int ssd1306_resume(const struct device *dev)
|
|
{
|
|
struct ssd1306_data *driver = dev->data;
|
|
/* set display on */
|
|
return ssd1306_reg_write(driver, SSD1306_CONTROL_LAST_BYTE_CMD,
|
|
SSD1306_DISPLAY_ON);
|
|
}
|
|
|
|
static int ssd1306_suspend(const struct device *dev)
|
|
{
|
|
struct ssd1306_data *driver = dev->data;
|
|
/* set display on */
|
|
return ssd1306_reg_write(driver, SSD1306_CONTROL_LAST_BYTE_CMD,
|
|
SSD1306_DISPLAY_OFF);
|
|
}
|
|
|
|
static int ssd1306_write(const struct device *dev, const uint16_t x, const uint16_t y,
|
|
const struct display_buffer_descriptor *desc,
|
|
const void *buf)
|
|
{
|
|
struct ssd1306_data *driver = dev->data;
|
|
size_t buf_len;
|
|
|
|
if (desc->pitch < desc->width) {
|
|
LOG_ERR("Pitch is smaller then width");
|
|
return -1;
|
|
}
|
|
|
|
buf_len = MIN(desc->buf_size, desc->height * desc->width / 8);
|
|
if (buf == NULL || buf_len == 0U) {
|
|
LOG_ERR("Display buffer is not available");
|
|
return -1;
|
|
}
|
|
|
|
if (desc->pitch > desc->width) {
|
|
LOG_ERR("Unsupported mode");
|
|
return -1;
|
|
}
|
|
|
|
if ((y & 0x7) != 0U) {
|
|
LOG_ERR("Unsupported origin");
|
|
return -1;
|
|
}
|
|
|
|
LOG_DBG("x %u, y %u, pitch %u, width %u, height %u, buf_len %u",
|
|
x, y, desc->pitch, desc->width, desc->height, buf_len);
|
|
|
|
#if defined(CONFIG_SSD1306_DEFAULT)
|
|
uint8_t cmd_buf[] = {
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_MEM_ADDRESSING_MODE,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_ADDRESSING_MODE,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_COLUMN_ADDRESS,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
x,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
(x + desc->width - 1),
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_PAGE_ADDRESS,
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
y/8,
|
|
SSD1306_CONTROL_LAST_BYTE_CMD,
|
|
((y + desc->height)/8 - 1)
|
|
};
|
|
|
|
if (i2c_write(driver->i2c, cmd_buf, sizeof(cmd_buf),
|
|
DT_INST_REG_ADDR(0))) {
|
|
LOG_ERR("Failed to write command");
|
|
return -1;
|
|
}
|
|
|
|
return i2c_burst_write(driver->i2c,
|
|
DT_INST_REG_ADDR(0),
|
|
SSD1306_CONTROL_LAST_BYTE_DATA,
|
|
(uint8_t *)buf, buf_len);
|
|
|
|
#elif defined(CONFIG_SSD1306_SH1106_COMPATIBLE)
|
|
uint8_t x_offset = x + DT_INST_PROP(0, segment_offset);
|
|
uint8_t cmd_buf[] = {
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_LOWER_COL_ADDRESS |
|
|
(x_offset & SSD1306_SET_LOWER_COL_ADDRESS_MASK),
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_HIGHER_COL_ADDRESS |
|
|
((x_offset >> 4) & SSD1306_SET_LOWER_COL_ADDRESS_MASK),
|
|
SSD1306_CONTROL_LAST_BYTE_CMD,
|
|
SSD1306_SET_PAGE_START_ADDRESS | (y / 8)
|
|
};
|
|
uint8_t *buf_ptr = (uint8_t *)buf;
|
|
|
|
for (uint8_t n = 0; n < desc->height / 8; n++) {
|
|
cmd_buf[sizeof(cmd_buf) - 1] =
|
|
SSD1306_SET_PAGE_START_ADDRESS | (n + (y / 8));
|
|
LOG_HEXDUMP_DBG(cmd_buf, sizeof(cmd_buf), "cmd_buf");
|
|
|
|
if (i2c_write(driver->i2c, cmd_buf, sizeof(cmd_buf),
|
|
DT_INST_REG_ADDR(0))) {
|
|
return -1;
|
|
}
|
|
|
|
if (i2c_burst_write(driver->i2c,
|
|
DT_INST_REG_ADDR(0),
|
|
SSD1306_CONTROL_LAST_BYTE_DATA,
|
|
buf_ptr, desc->width)) {
|
|
return -1;
|
|
}
|
|
|
|
buf_ptr = buf_ptr + desc->width;
|
|
if (buf_ptr > ((uint8_t *)buf + buf_len)) {
|
|
LOG_ERR("Exceeded buffer length");
|
|
return -1;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ssd1306_read(const struct device *dev, const uint16_t x,
|
|
const uint16_t y,
|
|
const struct display_buffer_descriptor *desc,
|
|
void *buf)
|
|
{
|
|
LOG_ERR("Unsupported");
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
static void *ssd1306_get_framebuffer(const struct device *dev)
|
|
{
|
|
LOG_ERR("Unsupported");
|
|
return NULL;
|
|
}
|
|
|
|
static int ssd1306_set_brightness(const struct device *dev,
|
|
const uint8_t brightness)
|
|
{
|
|
LOG_WRN("Unsupported");
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
static int ssd1306_set_contrast(const struct device *dev, const uint8_t contrast)
|
|
{
|
|
struct ssd1306_data *driver = dev->data;
|
|
uint8_t cmd_buf[] = {
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_CONTRAST_CTRL,
|
|
SSD1306_CONTROL_LAST_BYTE_CMD,
|
|
contrast,
|
|
};
|
|
|
|
return i2c_write(driver->i2c, cmd_buf, sizeof(cmd_buf),
|
|
DT_INST_REG_ADDR(0));
|
|
}
|
|
|
|
static void ssd1306_get_capabilities(const struct device *dev,
|
|
struct display_capabilities *caps)
|
|
{
|
|
memset(caps, 0, sizeof(struct display_capabilities));
|
|
caps->x_resolution = DT_INST_PROP(0, width);
|
|
caps->y_resolution = DT_INST_PROP(0, height);
|
|
caps->supported_pixel_formats = PIXEL_FORMAT_MONO10;
|
|
caps->current_pixel_format = PIXEL_FORMAT_MONO10;
|
|
caps->screen_info = SCREEN_INFO_MONO_VTILED;
|
|
}
|
|
|
|
static int ssd1306_set_orientation(const struct device *dev,
|
|
const enum display_orientation
|
|
orientation)
|
|
{
|
|
LOG_ERR("Unsupported");
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
static int ssd1306_set_pixel_format(const struct device *dev,
|
|
const enum display_pixel_format pf)
|
|
{
|
|
if (pf == PIXEL_FORMAT_MONO10) {
|
|
return 0;
|
|
}
|
|
LOG_ERR("Unsupported");
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
static int ssd1306_init_device(const struct device *dev)
|
|
{
|
|
struct ssd1306_data *driver = dev->data;
|
|
|
|
uint8_t cmd_buf[] = {
|
|
SSD1306_CONTROL_BYTE_CMD,
|
|
SSD1306_SET_ENTIRE_DISPLAY_OFF,
|
|
SSD1306_CONTROL_LAST_BYTE_CMD,
|
|
#ifdef CONFIG_SSD1306_REVERSE_MODE
|
|
SSD1306_SET_REVERSE_DISPLAY,
|
|
#else
|
|
SSD1306_SET_NORMAL_DISPLAY,
|
|
#endif
|
|
};
|
|
|
|
#if DT_INST_NODE_HAS_PROP(0, reset_gpios)
|
|
k_sleep(SSD1306_RESET_DELAY);
|
|
gpio_pin_set(driver->reset,
|
|
DT_INST_GPIO_PIN(0, reset_gpios), 1);
|
|
k_sleep(SSD1306_RESET_DELAY);
|
|
gpio_pin_set(driver->reset,
|
|
DT_INST_GPIO_PIN(0, reset_gpios), 0);
|
|
#endif
|
|
|
|
/* Turn display off */
|
|
if (ssd1306_reg_write(driver, SSD1306_CONTROL_LAST_BYTE_CMD,
|
|
SSD1306_DISPLAY_OFF)) {
|
|
return -EIO;
|
|
}
|
|
|
|
if (ssd1306_set_timing_setting(dev)) {
|
|
return -EIO;
|
|
}
|
|
|
|
if (ssd1306_set_hardware_config(dev)) {
|
|
return -EIO;
|
|
}
|
|
|
|
if (ssd1306_set_panel_orientation(dev)) {
|
|
return -EIO;
|
|
}
|
|
|
|
if (ssd1306_set_charge_pump(dev)) {
|
|
return -EIO;
|
|
}
|
|
|
|
if (i2c_write(driver->i2c, cmd_buf, sizeof(cmd_buf),
|
|
DT_INST_REG_ADDR(0))) {
|
|
return -EIO;
|
|
}
|
|
|
|
if (ssd1306_set_contrast(dev, CONFIG_SSD1306_DEFAULT_CONTRAST)) {
|
|
return -EIO;
|
|
}
|
|
|
|
ssd1306_resume(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ssd1306_init(const struct device *dev)
|
|
{
|
|
struct ssd1306_data *driver = dev->data;
|
|
|
|
LOG_DBG("");
|
|
|
|
driver->i2c = device_get_binding(DT_INST_BUS_LABEL(0));
|
|
if (driver->i2c == NULL) {
|
|
LOG_ERR("Failed to get pointer to %s device!",
|
|
DT_INST_BUS_LABEL(0));
|
|
return -EINVAL;
|
|
}
|
|
|
|
#if DT_INST_NODE_HAS_PROP(0, reset_gpios)
|
|
driver->reset = device_get_binding(
|
|
DT_INST_GPIO_LABEL(0, reset_gpios));
|
|
if (driver->reset == NULL) {
|
|
LOG_ERR("Failed to get pointer to %s device!",
|
|
DT_INST_GPIO_LABEL(0, reset_gpios));
|
|
return -EINVAL;
|
|
}
|
|
|
|
gpio_pin_configure(driver->reset,
|
|
DT_INST_GPIO_PIN(0, reset_gpios),
|
|
GPIO_OUTPUT_INACTIVE |
|
|
DT_INST_GPIO_FLAGS(0, reset_gpios));
|
|
#endif
|
|
|
|
if (ssd1306_init_device(dev)) {
|
|
LOG_ERR("Failed to initialize device!");
|
|
return -EIO;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct ssd1306_data ssd1306_driver;
|
|
|
|
static struct display_driver_api ssd1306_driver_api = {
|
|
.blanking_on = ssd1306_suspend,
|
|
.blanking_off = ssd1306_resume,
|
|
.write = ssd1306_write,
|
|
.read = ssd1306_read,
|
|
.get_framebuffer = ssd1306_get_framebuffer,
|
|
.set_brightness = ssd1306_set_brightness,
|
|
.set_contrast = ssd1306_set_contrast,
|
|
.get_capabilities = ssd1306_get_capabilities,
|
|
.set_pixel_format = ssd1306_set_pixel_format,
|
|
.set_orientation = ssd1306_set_orientation,
|
|
};
|
|
|
|
DEVICE_AND_API_INIT(ssd1306, DT_INST_LABEL(0), ssd1306_init,
|
|
&ssd1306_driver, NULL,
|
|
POST_KERNEL, CONFIG_APPLICATION_INIT_PRIORITY,
|
|
&ssd1306_driver_api);
|