mirror of
https://github.com/ravinrabbid/DonCon2040.git
synced 2024-11-20 11:47:07 +01:00
Add ssd1306 display driver
This commit is contained in:
Frederik Walk
parent
9becbf9e6a
commit
390d44777b
@ -29,6 +29,7 @@ target_link_libraries(
|
|||||||
hardware_adc
|
hardware_adc
|
||||||
pico_multicore
|
pico_multicore
|
||||||
pio_ws2812
|
pio_ws2812
|
||||||
|
pico_ssd1306
|
||||||
mcp23017)
|
mcp23017)
|
||||||
|
|
||||||
pico_enable_stdio_usb(${PROJECT_NAME} 1)
|
pico_enable_stdio_usb(${PROJECT_NAME} 1)
|
||||||
|
|||||||
BIN
assets/idle_screen.bmp
Normal file
BIN
assets/idle_screen.bmp
Normal file
Binary file not shown.
|
After Width: | Height: | Size: 1.1 KiB |
BIN
assets/idle_screen.xcf
Normal file
BIN
assets/idle_screen.xcf
Normal file
Binary file not shown.
@ -2,12 +2,29 @@
|
|||||||
#define _GLOBALCONFIGURATION_H_
|
#define _GLOBALCONFIGURATION_H_
|
||||||
|
|
||||||
#include "peripherals/Controller.h"
|
#include "peripherals/Controller.h"
|
||||||
|
#include "peripherals/Display.h"
|
||||||
#include "peripherals/Drum.h"
|
#include "peripherals/Drum.h"
|
||||||
#include "peripherals/StatusLed.h"
|
#include "peripherals/StatusLed.h"
|
||||||
|
|
||||||
#include "hardware/i2c.h"
|
#include "hardware/i2c.h"
|
||||||
|
|
||||||
namespace Doncon::Config::Default {
|
namespace Doncon::Config {
|
||||||
|
|
||||||
|
struct I2c {
|
||||||
|
uint8_t sda_pin;
|
||||||
|
uint8_t scl_pin;
|
||||||
|
i2c_inst_t *block;
|
||||||
|
uint speed_hz;
|
||||||
|
};
|
||||||
|
|
||||||
|
namespace Default {
|
||||||
|
|
||||||
|
const I2c i2c_config = {
|
||||||
|
6, // SDA Pin
|
||||||
|
7, // SCL Pin
|
||||||
|
i2c1, // Block
|
||||||
|
1000000, // Speed
|
||||||
|
};
|
||||||
|
|
||||||
const Peripherals::Drum::Config drum_config = {
|
const Peripherals::Drum::Config drum_config = {
|
||||||
// Pin config
|
// Pin config
|
||||||
@ -23,12 +40,9 @@ const Peripherals::Drum::Config drum_config = {
|
|||||||
};
|
};
|
||||||
|
|
||||||
const Peripherals::Buttons::Config button_config = {
|
const Peripherals::Buttons::Config button_config = {
|
||||||
// I2C config
|
// I2c config
|
||||||
{
|
{
|
||||||
6, // SDA Pin
|
i2c_config.block, // Block
|
||||||
7, // SCL Pin
|
|
||||||
i2c1, // Block
|
|
||||||
1000000, // Speed
|
|
||||||
0x20, // Address
|
0x20, // Address
|
||||||
},
|
},
|
||||||
|
|
||||||
@ -69,6 +83,12 @@ const Peripherals::StatusLed::Config led_config = {
|
|||||||
255, // Brightness
|
255, // Brightness
|
||||||
};
|
};
|
||||||
|
|
||||||
} // namespace Doncon::Config::Default
|
const Peripherals::Display::Config display_config = {
|
||||||
|
i2c_config.block, // Block
|
||||||
|
0x3C, // Address
|
||||||
|
};
|
||||||
|
|
||||||
|
} // namespace Default
|
||||||
|
} // namespace Doncon::Config
|
||||||
|
|
||||||
#endif // _GLOBALCONFIGURATION_H_
|
#endif // _GLOBALCONFIGURATION_H_
|
||||||
@ -3,6 +3,7 @@
|
|||||||
|
|
||||||
#include "utils/InputState.h"
|
#include "utils/InputState.h"
|
||||||
|
|
||||||
|
#include "hardware/i2c.h"
|
||||||
#include <mcp23017/Mcp23017.h>
|
#include <mcp23017/Mcp23017.h>
|
||||||
|
|
||||||
#include <map>
|
#include <map>
|
||||||
@ -14,12 +15,8 @@ namespace Doncon::Peripherals {
|
|||||||
class Buttons {
|
class Buttons {
|
||||||
public:
|
public:
|
||||||
struct Config {
|
struct Config {
|
||||||
|
|
||||||
struct {
|
struct {
|
||||||
uint8_t sda_pin;
|
|
||||||
uint8_t scl_pin;
|
|
||||||
i2c_inst_t *block;
|
i2c_inst_t *block;
|
||||||
uint speed_hz;
|
|
||||||
uint8_t address;
|
uint8_t address;
|
||||||
} i2c;
|
} i2c;
|
||||||
|
|
||||||
|
|||||||
45
include/peripherals/Display.h
Normal file
45
include/peripherals/Display.h
Normal file
@ -0,0 +1,45 @@
|
|||||||
|
#ifndef _PERIPHERALS_DISPLAY_H_
|
||||||
|
#define _PERIPHERALS_DISPLAY_H_
|
||||||
|
|
||||||
|
#include <ssd1306/ssd1306.h>
|
||||||
|
|
||||||
|
#include "hardware/i2c.h"
|
||||||
|
|
||||||
|
#include <memory>
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
namespace Doncon::Peripherals {
|
||||||
|
|
||||||
|
class Display {
|
||||||
|
public:
|
||||||
|
struct Config {
|
||||||
|
i2c_inst_t *i2c_block;
|
||||||
|
uint8_t i2c_address;
|
||||||
|
};
|
||||||
|
|
||||||
|
private:
|
||||||
|
enum class State {
|
||||||
|
Idle,
|
||||||
|
Menu,
|
||||||
|
};
|
||||||
|
|
||||||
|
Config m_config;
|
||||||
|
State m_state;
|
||||||
|
|
||||||
|
ssd1306_t m_display;
|
||||||
|
|
||||||
|
void drawIdleScreen();
|
||||||
|
void drawMenuScreen();
|
||||||
|
|
||||||
|
public:
|
||||||
|
Display(const Config &config);
|
||||||
|
|
||||||
|
void showIdle();
|
||||||
|
void showMenu();
|
||||||
|
|
||||||
|
void update();
|
||||||
|
};
|
||||||
|
|
||||||
|
} // namespace Doncon::Peripherals
|
||||||
|
|
||||||
|
#endif // _PERIPHERALS_DISPLAY_H_
|
||||||
@ -1,2 +1,3 @@
|
|||||||
add_subdirectory(pio_ws2812)
|
add_subdirectory(pio_ws2812)
|
||||||
|
add_subdirectory(pico_ssd1306)
|
||||||
add_subdirectory(mcp23017)
|
add_subdirectory(mcp23017)
|
||||||
10
libs/pico_ssd1306/CMakeLists.txt
Normal file
10
libs/pico_ssd1306/CMakeLists.txt
Normal file
@ -0,0 +1,10 @@
|
|||||||
|
file(GLOB pico_ssd1306_SOURCES src/*.c)
|
||||||
|
|
||||||
|
add_library(pico_ssd1306 STATIC ${pico_ssd1306_SOURCES})
|
||||||
|
|
||||||
|
target_include_directories(
|
||||||
|
pico_ssd1306
|
||||||
|
PUBLIC ${CMAKE_CURRENT_LIST_DIR}/include
|
||||||
|
PRIVATE ${CMAKE_CURRENT_LIST_DIR}/include/ssd1306)
|
||||||
|
|
||||||
|
target_link_libraries(pico_ssd1306 PUBLIC pico_stdlib hardware_i2c hardware_dma)
|
||||||
21
libs/pico_ssd1306/LICENSE
Normal file
21
libs/pico_ssd1306/LICENSE
Normal file
@ -0,0 +1,21 @@
|
|||||||
|
MIT License
|
||||||
|
|
||||||
|
Copyright (c) 2021 David Schramm
|
||||||
|
|
||||||
|
Permission is hereby granted, free of charge, to any person obtaining a copy
|
||||||
|
of this software and associated documentation files (the "Software"), to deal
|
||||||
|
in the Software without restriction, including without limitation the rights
|
||||||
|
to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
||||||
|
copies of the Software, and to permit persons to whom the Software is
|
||||||
|
furnished to do so, subject to the following conditions:
|
||||||
|
|
||||||
|
The above copyright notice and this permission notice shall be included in all
|
||||||
|
copies or substantial portions of the Software.
|
||||||
|
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||||||
|
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
||||||
|
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
||||||
|
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
||||||
|
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||||||
|
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
||||||
|
SOFTWARE.
|
||||||
110
libs/pico_ssd1306/include/ssd1306/font.h
Normal file
110
libs/pico_ssd1306/include/ssd1306/font.h
Normal file
@ -0,0 +1,110 @@
|
|||||||
|
#ifndef _inc_font
|
||||||
|
#define _inc_font
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Format
|
||||||
|
* <height>, <width>, <additional spacing per char>,
|
||||||
|
* <first ascii char>, <last ascii char>,
|
||||||
|
* <data>
|
||||||
|
*/
|
||||||
|
const uint8_t font_8x5[] =
|
||||||
|
{
|
||||||
|
8, 5, 1, 32, 126,
|
||||||
|
0x00, 0x00, 0x00, 0x00, 0x00,
|
||||||
|
0x00, 0x00, 0x5F, 0x00, 0x00,
|
||||||
|
0x00, 0x07, 0x00, 0x07, 0x00,
|
||||||
|
0x14, 0x7F, 0x14, 0x7F, 0x14,
|
||||||
|
0x24, 0x2A, 0x7F, 0x2A, 0x12,
|
||||||
|
0x23, 0x13, 0x08, 0x64, 0x62,
|
||||||
|
0x36, 0x49, 0x56, 0x20, 0x50,
|
||||||
|
0x00, 0x08, 0x07, 0x03, 0x00,
|
||||||
|
0x00, 0x1C, 0x22, 0x41, 0x00,
|
||||||
|
0x00, 0x41, 0x22, 0x1C, 0x00,
|
||||||
|
0x2A, 0x1C, 0x7F, 0x1C, 0x2A,
|
||||||
|
0x08, 0x08, 0x3E, 0x08, 0x08,
|
||||||
|
0x00, 0x80, 0x70, 0x30, 0x00,
|
||||||
|
0x08, 0x08, 0x08, 0x08, 0x08,
|
||||||
|
0x00, 0x00, 0x60, 0x60, 0x00,
|
||||||
|
0x20, 0x10, 0x08, 0x04, 0x02,
|
||||||
|
0x3E, 0x51, 0x49, 0x45, 0x3E,
|
||||||
|
0x00, 0x42, 0x7F, 0x40, 0x00,
|
||||||
|
0x72, 0x49, 0x49, 0x49, 0x46,
|
||||||
|
0x21, 0x41, 0x49, 0x4D, 0x33,
|
||||||
|
0x18, 0x14, 0x12, 0x7F, 0x10,
|
||||||
|
0x27, 0x45, 0x45, 0x45, 0x39,
|
||||||
|
0x3C, 0x4A, 0x49, 0x49, 0x31,
|
||||||
|
0x41, 0x21, 0x11, 0x09, 0x07,
|
||||||
|
0x36, 0x49, 0x49, 0x49, 0x36,
|
||||||
|
0x46, 0x49, 0x49, 0x29, 0x1E,
|
||||||
|
0x00, 0x00, 0x14, 0x00, 0x00,
|
||||||
|
0x00, 0x40, 0x34, 0x00, 0x00,
|
||||||
|
0x00, 0x08, 0x14, 0x22, 0x41,
|
||||||
|
0x14, 0x14, 0x14, 0x14, 0x14,
|
||||||
|
0x00, 0x41, 0x22, 0x14, 0x08,
|
||||||
|
0x02, 0x01, 0x59, 0x09, 0x06,
|
||||||
|
0x3E, 0x41, 0x5D, 0x59, 0x4E,
|
||||||
|
0x7C, 0x12, 0x11, 0x12, 0x7C,
|
||||||
|
0x7F, 0x49, 0x49, 0x49, 0x36,
|
||||||
|
0x3E, 0x41, 0x41, 0x41, 0x22,
|
||||||
|
0x7F, 0x41, 0x41, 0x41, 0x3E,
|
||||||
|
0x7F, 0x49, 0x49, 0x49, 0x41,
|
||||||
|
0x7F, 0x09, 0x09, 0x09, 0x01,
|
||||||
|
0x3E, 0x41, 0x41, 0x51, 0x73,
|
||||||
|
0x7F, 0x08, 0x08, 0x08, 0x7F,
|
||||||
|
0x00, 0x41, 0x7F, 0x41, 0x00,
|
||||||
|
0x20, 0x40, 0x41, 0x3F, 0x01,
|
||||||
|
0x7F, 0x08, 0x14, 0x22, 0x41,
|
||||||
|
0x7F, 0x40, 0x40, 0x40, 0x40,
|
||||||
|
0x7F, 0x02, 0x1C, 0x02, 0x7F,
|
||||||
|
0x7F, 0x04, 0x08, 0x10, 0x7F,
|
||||||
|
0x3E, 0x41, 0x41, 0x41, 0x3E,
|
||||||
|
0x7F, 0x09, 0x09, 0x09, 0x06,
|
||||||
|
0x3E, 0x41, 0x51, 0x21, 0x5E,
|
||||||
|
0x7F, 0x09, 0x19, 0x29, 0x46,
|
||||||
|
0x26, 0x49, 0x49, 0x49, 0x32,
|
||||||
|
0x03, 0x01, 0x7F, 0x01, 0x03,
|
||||||
|
0x3F, 0x40, 0x40, 0x40, 0x3F,
|
||||||
|
0x1F, 0x20, 0x40, 0x20, 0x1F,
|
||||||
|
0x3F, 0x40, 0x38, 0x40, 0x3F,
|
||||||
|
0x63, 0x14, 0x08, 0x14, 0x63,
|
||||||
|
0x03, 0x04, 0x78, 0x04, 0x03,
|
||||||
|
0x61, 0x59, 0x49, 0x4D, 0x43,
|
||||||
|
0x00, 0x7F, 0x41, 0x41, 0x41,
|
||||||
|
0x02, 0x04, 0x08, 0x10, 0x20,
|
||||||
|
0x00, 0x41, 0x41, 0x41, 0x7F,
|
||||||
|
0x04, 0x02, 0x01, 0x02, 0x04,
|
||||||
|
0x40, 0x40, 0x40, 0x40, 0x40,
|
||||||
|
0x00, 0x03, 0x07, 0x08, 0x00,
|
||||||
|
0x20, 0x54, 0x54, 0x78, 0x40,
|
||||||
|
0x7F, 0x28, 0x44, 0x44, 0x38,
|
||||||
|
0x38, 0x44, 0x44, 0x44, 0x28,
|
||||||
|
0x38, 0x44, 0x44, 0x28, 0x7F,
|
||||||
|
0x38, 0x54, 0x54, 0x54, 0x18,
|
||||||
|
0x00, 0x08, 0x7E, 0x09, 0x02,
|
||||||
|
0x18, 0xA4, 0xA4, 0x9C, 0x78,
|
||||||
|
0x7F, 0x08, 0x04, 0x04, 0x78,
|
||||||
|
0x00, 0x44, 0x7D, 0x40, 0x00,
|
||||||
|
0x20, 0x40, 0x40, 0x3D, 0x00,
|
||||||
|
0x7F, 0x10, 0x28, 0x44, 0x00,
|
||||||
|
0x00, 0x41, 0x7F, 0x40, 0x00,
|
||||||
|
0x7C, 0x04, 0x78, 0x04, 0x78,
|
||||||
|
0x7C, 0x08, 0x04, 0x04, 0x78,
|
||||||
|
0x38, 0x44, 0x44, 0x44, 0x38,
|
||||||
|
0xFC, 0x18, 0x24, 0x24, 0x18,
|
||||||
|
0x18, 0x24, 0x24, 0x18, 0xFC,
|
||||||
|
0x7C, 0x08, 0x04, 0x04, 0x08,
|
||||||
|
0x48, 0x54, 0x54, 0x54, 0x24,
|
||||||
|
0x04, 0x04, 0x3F, 0x44, 0x24,
|
||||||
|
0x3C, 0x40, 0x40, 0x20, 0x7C,
|
||||||
|
0x1C, 0x20, 0x40, 0x20, 0x1C,
|
||||||
|
0x3C, 0x40, 0x30, 0x40, 0x3C,
|
||||||
|
0x44, 0x28, 0x10, 0x28, 0x44,
|
||||||
|
0x4C, 0x90, 0x90, 0x90, 0x7C,
|
||||||
|
0x44, 0x64, 0x54, 0x4C, 0x44,
|
||||||
|
0x00, 0x08, 0x36, 0x41, 0x00,
|
||||||
|
0x00, 0x00, 0x77, 0x00, 0x00,
|
||||||
|
0x00, 0x41, 0x36, 0x08, 0x00,
|
||||||
|
0x02, 0x01, 0x02, 0x04, 0x02,
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif
|
||||||
266
libs/pico_ssd1306/include/ssd1306/ssd1306.h
Normal file
266
libs/pico_ssd1306/include/ssd1306/ssd1306.h
Normal file
@ -0,0 +1,266 @@
|
|||||||
|
/*
|
||||||
|
MIT License
|
||||||
|
|
||||||
|
Copyright (c) 2021 David Schramm
|
||||||
|
|
||||||
|
Permission is hereby granted, free of charge, to any person obtaining a copy
|
||||||
|
of this software and associated documentation files (the "Software"), to deal
|
||||||
|
in the Software without restriction, including without limitation the rights
|
||||||
|
to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
||||||
|
copies of the Software, and to permit persons to whom the Software is
|
||||||
|
furnished to do so, subject to the following conditions:
|
||||||
|
|
||||||
|
The above copyright notice and this permission notice shall be included in all
|
||||||
|
copies or substantial portions of the Software.
|
||||||
|
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||||||
|
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
||||||
|
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
||||||
|
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
||||||
|
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||||||
|
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
||||||
|
SOFTWARE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @file ssd1306.h
|
||||||
|
*
|
||||||
|
* simple driver for ssd1306 displays
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _inc_ssd1306
|
||||||
|
#define _inc_ssd1306
|
||||||
|
#include <hardware/i2c.h>
|
||||||
|
#include <pico/stdlib.h>
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
extern "C" {
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief defines commands used in ssd1306
|
||||||
|
*/
|
||||||
|
typedef enum {
|
||||||
|
SET_CONTRAST = 0x81,
|
||||||
|
SET_ENTIRE_ON = 0xA4,
|
||||||
|
SET_NORM_INV = 0xA6,
|
||||||
|
SET_DISP = 0xAE,
|
||||||
|
SET_MEM_ADDR = 0x20,
|
||||||
|
SET_COL_ADDR = 0x21,
|
||||||
|
SET_PAGE_ADDR = 0x22,
|
||||||
|
SET_DISP_START_LINE = 0x40,
|
||||||
|
SET_SEG_REMAP = 0xA0,
|
||||||
|
SET_MUX_RATIO = 0xA8,
|
||||||
|
SET_COM_OUT_DIR = 0xC0,
|
||||||
|
SET_DISP_OFFSET = 0xD3,
|
||||||
|
SET_COM_PIN_CFG = 0xDA,
|
||||||
|
SET_DISP_CLK_DIV = 0xD5,
|
||||||
|
SET_PRECHARGE = 0xD9,
|
||||||
|
SET_VCOM_DESEL = 0xDB,
|
||||||
|
SET_CHARGE_PUMP = 0x8D
|
||||||
|
} ssd1306_command_t;
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief holds the configuration
|
||||||
|
*/
|
||||||
|
typedef struct {
|
||||||
|
uint8_t width; /**< width of display */
|
||||||
|
uint8_t height; /**< height of display */
|
||||||
|
uint8_t pages; /**< stores pages of display (calculated on initialization*/
|
||||||
|
uint8_t address; /**< i2c address of display*/
|
||||||
|
i2c_inst_t *i2c_i; /**< i2c connection instance */
|
||||||
|
bool external_vcc; /**< whether display uses external vcc */
|
||||||
|
uint8_t *buffer; /**< display buffer */
|
||||||
|
size_t bufsize; /**< buffer size */
|
||||||
|
int dma_channel; /**< dma channel id for writing */
|
||||||
|
uint16_t *dma_buffer; /**< buffer for dma transfer */
|
||||||
|
} ssd1306_t;
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief initialize display
|
||||||
|
*
|
||||||
|
* @param[in] p : pointer to instance of ssd1306_t
|
||||||
|
* @param[in] width : width of display
|
||||||
|
* @param[in] height : heigth of display
|
||||||
|
* @param[in] address : i2c address of display
|
||||||
|
* @param[in] i2c_instance : instance of i2c connection
|
||||||
|
*
|
||||||
|
* @return bool.
|
||||||
|
* @retval true for Success
|
||||||
|
* @retval false if initialization failed
|
||||||
|
*/
|
||||||
|
bool ssd1306_init(ssd1306_t *p, uint16_t width, uint16_t height, uint8_t address, i2c_inst_t *i2c_instance);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief deinitialize display
|
||||||
|
*
|
||||||
|
* @param[in] p : instance of display
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
void ssd1306_deinit(ssd1306_t *p);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief turn off display
|
||||||
|
*
|
||||||
|
* @param[in] p : instance of display
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
void ssd1306_poweroff(ssd1306_t *p);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief turn on display
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
|
||||||
|
*/
|
||||||
|
void ssd1306_poweron(ssd1306_t *p);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief set contrast of display
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
@param[in] val : contrast
|
||||||
|
|
||||||
|
*/
|
||||||
|
void ssd1306_contrast(ssd1306_t *p, uint8_t val);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief set invert display
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
@param[in] inv : inv==0: disable inverting, inv!=0: invert
|
||||||
|
|
||||||
|
*/
|
||||||
|
void ssd1306_invert(ssd1306_t *p, uint8_t inv);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief display buffer, should be called on change
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
|
||||||
|
*/
|
||||||
|
void ssd1306_show(ssd1306_t *p);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief clear display buffer
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
|
||||||
|
*/
|
||||||
|
void ssd1306_clear(ssd1306_t *p);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief draw pixel on buffer
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
@param[in] x : x position
|
||||||
|
@param[in] y : y position
|
||||||
|
*/
|
||||||
|
void ssd1306_draw_pixel(ssd1306_t *p, uint32_t x, uint32_t y);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief draw pixel on buffer
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
@param[in] x1 : x position of starting point
|
||||||
|
@param[in] y1 : y position of starting point
|
||||||
|
@param[in] x2 : x position of end point
|
||||||
|
@param[in] y2 : y position of end point
|
||||||
|
*/
|
||||||
|
void ssd1306_draw_line(ssd1306_t *p, int32_t x1, int32_t y1, int32_t x2, int32_t y2);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief draw filled square at given position with given size
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
@param[in] x : x position of starting point
|
||||||
|
@param[in] y : y position of starting point
|
||||||
|
@param[in] width : width of square
|
||||||
|
@param[in] height : height of square
|
||||||
|
*/
|
||||||
|
void ssd1306_draw_square(ssd1306_t *p, uint32_t x, uint32_t y, uint32_t width, uint32_t height);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief draw empty square at given position with given size
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
@param[in] x : x position of starting point
|
||||||
|
@param[in] y : y position of starting point
|
||||||
|
@param[in] width : width of square
|
||||||
|
@param[in] height : height of square
|
||||||
|
*/
|
||||||
|
void ssd13606_draw_empty_square(ssd1306_t *p, uint32_t x, uint32_t y, uint32_t width, uint32_t height);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief draw monochrome bitmap with offset
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
@param[in] data : image data (whole file)
|
||||||
|
@param[in] size : size of image data in bytes
|
||||||
|
@param[in] x_offset : offset of horizontal coordinate
|
||||||
|
@param[in] y_offset : offset of vertical coordinate
|
||||||
|
*/
|
||||||
|
void ssd1306_bmp_show_image_with_offset(ssd1306_t *p, const uint8_t *data, const long size, uint32_t x_offset,
|
||||||
|
uint32_t y_offset);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief draw monochrome bitmap
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
@param[in] data : image data (whole file)
|
||||||
|
@param[in] size : size of image data in bytes
|
||||||
|
*/
|
||||||
|
void ssd1306_bmp_show_image(ssd1306_t *p, const uint8_t *data, const long size);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief draw char with given font
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
@param[in] x : x starting position of char
|
||||||
|
@param[in] y : y starting position of char
|
||||||
|
@param[in] scale : scale font to n times of original size (default should be 1)
|
||||||
|
@param[in] font : pointer to font
|
||||||
|
@param[in] c : character to draw
|
||||||
|
*/
|
||||||
|
void ssd1306_draw_char_with_font(ssd1306_t *p, uint32_t x, uint32_t y, uint32_t scale, const uint8_t *font, char c);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief draw char with builtin font
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
@param[in] x : x starting position of char
|
||||||
|
@param[in] y : y starting position of char
|
||||||
|
@param[in] scale : scale font to n times of original size (default should be 1)
|
||||||
|
@param[in] c : character to draw
|
||||||
|
*/
|
||||||
|
void ssd1306_draw_char(ssd1306_t *p, uint32_t x, uint32_t y, uint32_t scale, char c);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief draw string with given font
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
@param[in] x : x starting position of text
|
||||||
|
@param[in] y : y starting position of text
|
||||||
|
@param[in] scale : scale font to n times of original size (default should be 1)
|
||||||
|
@param[in] font : pointer to font
|
||||||
|
@param[in] s : text to draw
|
||||||
|
*/
|
||||||
|
void ssd1306_draw_string_with_font(ssd1306_t *p, uint32_t x, uint32_t y, uint32_t scale, const uint8_t *font,
|
||||||
|
const char *s);
|
||||||
|
|
||||||
|
/**
|
||||||
|
@brief draw string with builtin font
|
||||||
|
|
||||||
|
@param[in] p : instance of display
|
||||||
|
@param[in] x : x starting position of text
|
||||||
|
@param[in] y : y starting position of text
|
||||||
|
@param[in] scale : scale font to n times of original size (default should be 1)
|
||||||
|
@param[in] s : text to draw
|
||||||
|
*/
|
||||||
|
void ssd1306_draw_string(ssd1306_t *p, uint32_t x, uint32_t y, uint32_t scale, const char *s);
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif
|
||||||
282
libs/pico_ssd1306/src/ssd1306.c
Normal file
282
libs/pico_ssd1306/src/ssd1306.c
Normal file
@ -0,0 +1,282 @@
|
|||||||
|
/*
|
||||||
|
|
||||||
|
MIT License
|
||||||
|
|
||||||
|
Copyright (c) 2021 David Schramm
|
||||||
|
|
||||||
|
Permission is hereby granted, free of charge, to any person obtaining a copy
|
||||||
|
of this software and associated documentation files (the "Software"), to deal
|
||||||
|
in the Software without restriction, including without limitation the rights
|
||||||
|
to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
||||||
|
copies of the Software, and to permit persons to whom the Software is
|
||||||
|
furnished to do so, subject to the following conditions:
|
||||||
|
|
||||||
|
The above copyright notice and this permission notice shall be included in all
|
||||||
|
copies or substantial portions of the Software.
|
||||||
|
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||||||
|
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
||||||
|
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
||||||
|
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
||||||
|
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||||||
|
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
||||||
|
SOFTWARE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <hardware/i2c.h>
|
||||||
|
#include <pico/binary_info.h>
|
||||||
|
#include <pico/stdlib.h>
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
#include "font.h"
|
||||||
|
#include "ssd1306.h"
|
||||||
|
|
||||||
|
inline static void swap(int32_t *a, int32_t *b) {
|
||||||
|
int32_t *t = a;
|
||||||
|
*a = *b;
|
||||||
|
*b = *t;
|
||||||
|
}
|
||||||
|
|
||||||
|
inline static void fancy_write(i2c_inst_t *i2c, uint8_t addr, const uint8_t *src, size_t len, char *name) {
|
||||||
|
switch (i2c_write_blocking(i2c, addr, src, len, false)) {
|
||||||
|
case PICO_ERROR_GENERIC:
|
||||||
|
printf("[%s] addr not acknowledged!\n", name);
|
||||||
|
break;
|
||||||
|
case PICO_ERROR_TIMEOUT:
|
||||||
|
printf("[%s] timeout!\n", name);
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
// printf("[%s] wrote successfully %lu bytes!\n", name, len);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
inline static void ssd1306_write(ssd1306_t *p, uint8_t val) {
|
||||||
|
uint8_t d[2] = {0x00, val};
|
||||||
|
fancy_write(p->i2c_i, p->address, d, 2, "ssd1306_write");
|
||||||
|
}
|
||||||
|
|
||||||
|
bool ssd1306_init(ssd1306_t *p, uint16_t width, uint16_t height, uint8_t address, i2c_inst_t *i2c_instance) {
|
||||||
|
p->width = width;
|
||||||
|
p->height = height;
|
||||||
|
p->pages = height / 8;
|
||||||
|
p->address = address;
|
||||||
|
|
||||||
|
p->i2c_i = i2c_instance;
|
||||||
|
|
||||||
|
p->bufsize = (p->pages) * (p->width);
|
||||||
|
if ((p->buffer = malloc(p->bufsize + 1)) == NULL) {
|
||||||
|
p->bufsize = 0;
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
++(p->buffer);
|
||||||
|
|
||||||
|
// from https://github.com/makerportal/rpi-pico-ssd1306
|
||||||
|
uint8_t cmds[] = {
|
||||||
|
SET_DISP,
|
||||||
|
// timing and driving scheme
|
||||||
|
SET_DISP_CLK_DIV, 0x80, SET_MUX_RATIO, height - 1, SET_DISP_OFFSET, 0x00,
|
||||||
|
// resolution and layout
|
||||||
|
SET_DISP_START_LINE,
|
||||||
|
// charge pump
|
||||||
|
SET_CHARGE_PUMP, p->external_vcc ? 0x10 : 0x14,
|
||||||
|
SET_SEG_REMAP | 0x01, // column addr 127 mapped to SEG0
|
||||||
|
SET_COM_OUT_DIR | 0x08, // scan from COM[N] to COM0
|
||||||
|
SET_COM_PIN_CFG, width > 2 * height ? 0x02 : 0x12,
|
||||||
|
// display
|
||||||
|
SET_CONTRAST, 0xff, SET_PRECHARGE, p->external_vcc ? 0x22 : 0xF1, SET_VCOM_DESEL,
|
||||||
|
0x30, // or 0x40?
|
||||||
|
SET_ENTIRE_ON, // output follows RAM contents
|
||||||
|
SET_NORM_INV, // not inverted
|
||||||
|
SET_DISP | 0x01,
|
||||||
|
// address setting
|
||||||
|
SET_MEM_ADDR,
|
||||||
|
0x00, // horizontal
|
||||||
|
};
|
||||||
|
|
||||||
|
for (size_t i = 0; i < sizeof(cmds); ++i)
|
||||||
|
ssd1306_write(p, cmds[i]);
|
||||||
|
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
inline void ssd1306_deinit(ssd1306_t *p) { free(p->buffer - 1); }
|
||||||
|
|
||||||
|
inline void ssd1306_poweroff(ssd1306_t *p) { ssd1306_write(p, SET_DISP | 0x00); }
|
||||||
|
|
||||||
|
inline void ssd1306_poweron(ssd1306_t *p) { ssd1306_write(p, SET_DISP | 0x01); }
|
||||||
|
|
||||||
|
inline void ssd1306_contrast(ssd1306_t *p, uint8_t val) {
|
||||||
|
ssd1306_write(p, SET_CONTRAST);
|
||||||
|
ssd1306_write(p, val);
|
||||||
|
}
|
||||||
|
|
||||||
|
inline void ssd1306_invert(ssd1306_t *p, uint8_t inv) { ssd1306_write(p, SET_NORM_INV | (inv & 1)); }
|
||||||
|
|
||||||
|
inline void ssd1306_clear(ssd1306_t *p) { memset(p->buffer, 0, p->bufsize); }
|
||||||
|
|
||||||
|
void ssd1306_clear_pixel(ssd1306_t *p, uint32_t x, uint32_t y) {
|
||||||
|
if (x >= p->width || y >= p->height)
|
||||||
|
return;
|
||||||
|
|
||||||
|
p->buffer[x + p->width * (y >> 3)] &= ~(0x1 << (y & 0x07));
|
||||||
|
}
|
||||||
|
|
||||||
|
void ssd1306_draw_pixel(ssd1306_t *p, uint32_t x, uint32_t y) {
|
||||||
|
if (x >= p->width || y >= p->height)
|
||||||
|
return;
|
||||||
|
|
||||||
|
p->buffer[x + p->width * (y >> 3)] |= 0x1 << (y & 0x07); // y>>3==y/8 && y&0x7==y%8
|
||||||
|
}
|
||||||
|
|
||||||
|
void ssd1306_draw_line(ssd1306_t *p, int32_t x1, int32_t y1, int32_t x2, int32_t y2) {
|
||||||
|
if (x1 > x2) {
|
||||||
|
swap(&x1, &x2);
|
||||||
|
swap(&y1, &y2);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (x1 == x2) {
|
||||||
|
if (y1 > y2)
|
||||||
|
swap(&y1, &y2);
|
||||||
|
for (int32_t i = y1; i <= y2; ++i)
|
||||||
|
ssd1306_draw_pixel(p, x1, i);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
float m = (float)(y2 - y1) / (float)(x2 - x1);
|
||||||
|
|
||||||
|
for (int32_t i = x1; i <= x2; ++i) {
|
||||||
|
float y = m * (float)(i - x1) + (float)y1;
|
||||||
|
ssd1306_draw_pixel(p, i, (uint32_t)y);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void ssd1306_draw_square(ssd1306_t *p, uint32_t x, uint32_t y, uint32_t width, uint32_t height) {
|
||||||
|
for (uint32_t i = 0; i < width; ++i)
|
||||||
|
for (uint32_t j = 0; j < height; ++j)
|
||||||
|
ssd1306_draw_pixel(p, x + i, y + j);
|
||||||
|
}
|
||||||
|
|
||||||
|
void ssd1306_draw_empty_square(ssd1306_t *p, uint32_t x, uint32_t y, uint32_t width, uint32_t height) {
|
||||||
|
ssd1306_draw_line(p, x, y, x + width, y);
|
||||||
|
ssd1306_draw_line(p, x, y + height, x + width, y + height);
|
||||||
|
ssd1306_draw_line(p, x, y, x, y + height);
|
||||||
|
ssd1306_draw_line(p, x + width, y, x + width, y + height);
|
||||||
|
}
|
||||||
|
|
||||||
|
void ssd1306_draw_char_with_font(ssd1306_t *p, uint32_t x, uint32_t y, uint32_t scale, const uint8_t *font, char c) {
|
||||||
|
if (c < font[3] || c > font[4])
|
||||||
|
return;
|
||||||
|
|
||||||
|
uint32_t parts_per_line = (font[0] >> 3) + ((font[0] & 7) > 0);
|
||||||
|
for (uint8_t w = 0; w < font[1]; ++w) { // width
|
||||||
|
uint32_t pp = (c - font[3]) * font[1] * parts_per_line + w * parts_per_line + 5;
|
||||||
|
for (uint32_t lp = 0; lp < parts_per_line; ++lp) {
|
||||||
|
uint8_t line = font[pp];
|
||||||
|
|
||||||
|
for (int8_t j = 0; j < 8; ++j, line >>= 1) {
|
||||||
|
if (line & 1)
|
||||||
|
ssd1306_draw_square(p, x + w * scale, y + ((lp << 3) + j) * scale, scale, scale);
|
||||||
|
}
|
||||||
|
|
||||||
|
++pp;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void ssd1306_draw_string_with_font(ssd1306_t *p, uint32_t x, uint32_t y, uint32_t scale, const uint8_t *font,
|
||||||
|
const char *s) {
|
||||||
|
for (int32_t x_n = x; *s; x_n += (font[1] + font[2]) * scale) {
|
||||||
|
ssd1306_draw_char_with_font(p, x_n, y, scale, font, *(s++));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void ssd1306_draw_char(ssd1306_t *p, uint32_t x, uint32_t y, uint32_t scale, char c) {
|
||||||
|
ssd1306_draw_char_with_font(p, x, y, scale, font_8x5, c);
|
||||||
|
}
|
||||||
|
|
||||||
|
void ssd1306_draw_string(ssd1306_t *p, uint32_t x, uint32_t y, uint32_t scale, const char *s) {
|
||||||
|
ssd1306_draw_string_with_font(p, x, y, scale, font_8x5, s);
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline uint32_t ssd1306_bmp_get_val(const uint8_t *data, const size_t offset, uint8_t size) {
|
||||||
|
switch (size) {
|
||||||
|
case 1:
|
||||||
|
return data[offset];
|
||||||
|
case 2:
|
||||||
|
return data[offset] | (data[offset + 1] << 8);
|
||||||
|
case 4:
|
||||||
|
return data[offset] | (data[offset + 1] << 8) | (data[offset + 2] << 16) | (data[offset + 3] << 24);
|
||||||
|
default:
|
||||||
|
__builtin_unreachable();
|
||||||
|
}
|
||||||
|
__builtin_unreachable();
|
||||||
|
}
|
||||||
|
|
||||||
|
void ssd1306_bmp_show_image_with_offset(ssd1306_t *p, const uint8_t *data, const long size, uint32_t x_offset,
|
||||||
|
uint32_t y_offset) {
|
||||||
|
if (size < 54) // data smaller than header
|
||||||
|
return;
|
||||||
|
|
||||||
|
const uint32_t bfOffBits = ssd1306_bmp_get_val(data, 10, 4);
|
||||||
|
const uint32_t biSize = ssd1306_bmp_get_val(data, 14, 4);
|
||||||
|
const int32_t biWidth = (int32_t)ssd1306_bmp_get_val(data, 18, 4);
|
||||||
|
const int32_t biHeight = (int32_t)ssd1306_bmp_get_val(data, 22, 4);
|
||||||
|
const uint16_t biBitCount = (uint16_t)ssd1306_bmp_get_val(data, 28, 2);
|
||||||
|
const uint32_t biCompression = ssd1306_bmp_get_val(data, 30, 4);
|
||||||
|
|
||||||
|
if (biBitCount != 1) // image not monochrome
|
||||||
|
return;
|
||||||
|
|
||||||
|
if (biCompression != 0) // image compressed
|
||||||
|
return;
|
||||||
|
|
||||||
|
const int table_start = 14 + biSize;
|
||||||
|
uint8_t color_val = 0;
|
||||||
|
|
||||||
|
for (uint8_t i = 0; i < 2; ++i) {
|
||||||
|
if (!((data[table_start + i * 4] << 16) | (data[table_start + i * 4 + 1] << 8) |
|
||||||
|
data[table_start + i * 4 + 2])) {
|
||||||
|
color_val = i;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t bytes_per_line = (biWidth / 8) + (biWidth & 7 ? 1 : 0);
|
||||||
|
if (bytes_per_line & 3)
|
||||||
|
bytes_per_line = (bytes_per_line ^ (bytes_per_line & 3)) + 4;
|
||||||
|
|
||||||
|
const uint8_t *img_data = data + bfOffBits;
|
||||||
|
|
||||||
|
int step = biHeight > 0 ? -1 : 1;
|
||||||
|
int border = biHeight > 0 ? -1 : biHeight;
|
||||||
|
for (int32_t y = biHeight > 0 ? biHeight - 1 : 0; y != border; y += step) {
|
||||||
|
for (int32_t x = 0; x < biWidth; ++x) {
|
||||||
|
if (((img_data[x >> 3] >> (7 - (x & 7))) & 1) == color_val)
|
||||||
|
ssd1306_draw_pixel(p, x_offset + x, y_offset + y);
|
||||||
|
}
|
||||||
|
img_data += bytes_per_line;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
inline void ssd1306_bmp_show_image(ssd1306_t *p, const uint8_t *data, const long size) {
|
||||||
|
ssd1306_bmp_show_image_with_offset(p, data, size, 0, 0);
|
||||||
|
}
|
||||||
|
|
||||||
|
void ssd1306_show(ssd1306_t *p) {
|
||||||
|
uint8_t payload[] = {SET_COL_ADDR, 0, p->width - 1, SET_PAGE_ADDR, 0, p->pages - 1};
|
||||||
|
if (p->width == 64) {
|
||||||
|
payload[1] += 32;
|
||||||
|
payload[2] += 32;
|
||||||
|
}
|
||||||
|
|
||||||
|
for (size_t i = 0; i < sizeof(payload); ++i)
|
||||||
|
ssd1306_write(p, payload[i]);
|
||||||
|
|
||||||
|
*(p->buffer - 1) = 0x40;
|
||||||
|
|
||||||
|
fancy_write(p->i2c_i, p->address, p->buffer - 1, p->bufsize + 1, "ssd1306_show");
|
||||||
|
}
|
||||||
@ -1,4 +1,5 @@
|
|||||||
#include "peripherals/Controller.h"
|
#include "peripherals/Controller.h"
|
||||||
|
#include "peripherals/Display.h"
|
||||||
#include "peripherals/Drum.h"
|
#include "peripherals/Drum.h"
|
||||||
#include "peripherals/StatusLed.h"
|
#include "peripherals/StatusLed.h"
|
||||||
#include "usb/usb_driver.h"
|
#include "usb/usb_driver.h"
|
||||||
@ -19,9 +20,16 @@ queue_t controller_input_queue;
|
|||||||
void core1_task() {
|
void core1_task() {
|
||||||
multicore_lockout_victim_init();
|
multicore_lockout_victim_init();
|
||||||
|
|
||||||
|
gpio_set_function(Config::Default::i2c_config.sda_pin, GPIO_FUNC_I2C);
|
||||||
|
gpio_set_function(Config::Default::i2c_config.scl_pin, GPIO_FUNC_I2C);
|
||||||
|
gpio_pull_up(Config::Default::i2c_config.sda_pin);
|
||||||
|
gpio_pull_up(Config::Default::i2c_config.scl_pin);
|
||||||
|
i2c_init(Config::Default::i2c_config.block, Config::Default::i2c_config.speed_hz);
|
||||||
|
|
||||||
Utils::InputState input_state;
|
Utils::InputState input_state;
|
||||||
Peripherals::Buttons buttons(Config::Default::button_config);
|
Peripherals::Buttons buttons(Config::Default::button_config);
|
||||||
Peripherals::StatusLed led(Config::Default::led_config);
|
Peripherals::StatusLed led(Config::Default::led_config);
|
||||||
|
Peripherals::Display display(Config::Default::display_config);
|
||||||
|
|
||||||
while (true) {
|
while (true) {
|
||||||
buttons.updateInputState(input_state);
|
buttons.updateInputState(input_state);
|
||||||
@ -33,6 +41,7 @@ void core1_task() {
|
|||||||
}
|
}
|
||||||
|
|
||||||
led.update();
|
led.update();
|
||||||
|
display.update();
|
||||||
|
|
||||||
// sleep_ms(1);
|
// sleep_ms(1);
|
||||||
}
|
}
|
||||||
|
|||||||
@ -1,6 +1,5 @@
|
|||||||
#include "peripherals/Controller.h"
|
#include "peripherals/Controller.h"
|
||||||
|
|
||||||
#include "hardware/gpio.h"
|
|
||||||
#include "pico/time.h"
|
#include "pico/time.h"
|
||||||
|
|
||||||
namespace Doncon::Peripherals {
|
namespace Doncon::Peripherals {
|
||||||
@ -49,12 +48,6 @@ void Buttons::socdClean(Utils::InputState &input_state) {
|
|||||||
}
|
}
|
||||||
|
|
||||||
Buttons::Buttons(const Config &config) : m_config(config), m_socd_state{Id::DOWN, Id::RIGHT} {
|
Buttons::Buttons(const Config &config) : m_config(config), m_socd_state{Id::DOWN, Id::RIGHT} {
|
||||||
i2c_init(m_config.i2c.block, m_config.i2c.speed_hz);
|
|
||||||
gpio_set_function(m_config.i2c.sda_pin, GPIO_FUNC_I2C);
|
|
||||||
gpio_set_function(m_config.i2c.scl_pin, GPIO_FUNC_I2C);
|
|
||||||
gpio_pull_up(m_config.i2c.sda_pin);
|
|
||||||
gpio_pull_up(m_config.i2c.scl_pin);
|
|
||||||
|
|
||||||
m_mcp23017 = std::make_unique<Mcp23017>(m_config.i2c.address, m_config.i2c.block);
|
m_mcp23017 = std::make_unique<Mcp23017>(m_config.i2c.address, m_config.i2c.block);
|
||||||
m_mcp23017->setDirection(0xFFFF); // All inputs
|
m_mcp23017->setDirection(0xFFFF); // All inputs
|
||||||
m_mcp23017->setPullup(0xFFFF); // All on
|
m_mcp23017->setPullup(0xFFFF); // All on
|
||||||
|
|||||||
115
src/peripherals/Display.cpp
Normal file
115
src/peripherals/Display.cpp
Normal file
@ -0,0 +1,115 @@
|
|||||||
|
#include "peripherals/Display.h"
|
||||||
|
|
||||||
|
#include "hardware/gpio.h"
|
||||||
|
#include "pico/time.h"
|
||||||
|
|
||||||
|
#include <array>
|
||||||
|
#include <list>
|
||||||
|
#include <numeric>
|
||||||
|
#include <string>
|
||||||
|
|
||||||
|
namespace Doncon::Peripherals {
|
||||||
|
|
||||||
|
static const std::array<uint8_t, 1154> idle_screen = {
|
||||||
|
0x42, 0x4d, 0x82, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x82, 0x00, 0x00, 0x00, 0x6c, 0x00, 0x00, 0x00, 0x80,
|
||||||
|
0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00, 0x01, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x04, 0x00, 0x00,
|
||||||
|
0x23, 0x2e, 0x00, 0x00, 0x23, 0x2e, 0x00, 0x00, 0x02, 0x00, 0x00, 0x00, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff,
|
||||||
|
0x00, 0x00, 0xff, 0x00, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x42, 0x47, 0x52, 0x73, 0x00, 0x00,
|
||||||
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
||||||
|
0x00, 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00, 0x00,
|
||||||
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0x00, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xe0, 0x07, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xfe, 0x1f, 0xf8, 0x7f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xf9, 0xff, 0xff,
|
||||||
|
0x9f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xe7, 0xff, 0xff, 0xe7, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x9f, 0xff, 0xff, 0xf9, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x3f, 0xff, 0xff, 0xfc, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xfe, 0xff, 0xf0, 0x0f, 0xff, 0x7f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xfd, 0xff, 0x07, 0xe0, 0xff, 0xbf, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfb, 0xfc, 0x7f,
|
||||||
|
0xfe, 0x3f, 0xdf, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xf7, 0xf9, 0xff, 0xff, 0x9f, 0xef,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xef, 0xe3, 0xff, 0xff, 0xc7, 0xf7, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xcf, 0xcf, 0xff, 0xff, 0xf3, 0xf3, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xdf, 0x9f, 0xff, 0xff, 0xf9, 0xfb, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xbf, 0x3f, 0xff, 0xff, 0xfc, 0xfd, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xbf, 0x7f,
|
||||||
|
0xff, 0xff, 0xfe, 0xfd, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x7e, 0x7f, 0xff, 0xff, 0xfe,
|
||||||
|
0x7e, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x7c, 0xff, 0xff, 0xff, 0xff, 0x3e, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfe, 0xfd, 0xff, 0xff, 0xff, 0xff, 0xbf, 0x7f, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xfe, 0xf9, 0xff, 0xff, 0xff, 0xff, 0x9f, 0x7f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xfe, 0xfb, 0xff, 0xff, 0xff, 0xff, 0xdf, 0x7f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfe, 0xfb,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xdf, 0x7f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfd, 0xfb, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xdf, 0xbf, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfd, 0xf3, 0xff, 0xff, 0xff, 0xff, 0xcf, 0xbf,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfd, 0xf7, 0xff, 0xff, 0xff, 0xff, 0xef, 0xbf, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xfd, 0xf7, 0xff, 0xff, 0xff, 0xff, 0xef, 0xbf, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xfd, 0xf7, 0xff, 0xff, 0xff, 0xff, 0xef, 0xbf, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfd,
|
||||||
|
0xf7, 0xff, 0xff, 0xff, 0xff, 0xef, 0xbf, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfd, 0xf7, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xef, 0xbf, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfd, 0xf7, 0xff, 0xff, 0xff, 0xff, 0xef,
|
||||||
|
0xbf, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfd, 0xf3, 0xff, 0xff, 0xff, 0xff, 0xcf, 0xbf, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfd, 0xfb, 0xff, 0xff, 0xff, 0xff, 0xdf, 0xbf, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xfe, 0xfb, 0xff, 0xff, 0xff, 0xff, 0xdf, 0x7f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xfe, 0xfb, 0xff, 0xff, 0xff, 0xff, 0xdf, 0x7f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfe, 0xf9, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0x9f, 0x7f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfe, 0xfd, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xbf, 0x7f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x7c, 0xff, 0xff, 0xff, 0xff, 0x3e, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x7e, 0x7f, 0xff, 0xff, 0xfe, 0x7e, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xbf, 0x7f, 0xff, 0xff, 0xfe, 0xfd, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xbf, 0x3f, 0xff, 0xff, 0xfc, 0xfd, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xdf,
|
||||||
|
0x9f, 0xff, 0xff, 0xf9, 0xfb, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xcf, 0xcf, 0xff, 0xff,
|
||||||
|
0xf3, 0xf3, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xef, 0xe3, 0xff, 0xff, 0xc7, 0xf7, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xf7, 0xf9, 0xff, 0xff, 0x9f, 0xef, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xfb, 0xfc, 0x7f, 0xfe, 0x3f, 0xdf, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xfd, 0xff, 0x07, 0xe0, 0xff, 0xbf, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xfe, 0xff, 0xf0, 0x0f, 0xff, 0x7f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x3f, 0xff,
|
||||||
|
0xff, 0xfc, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x9f, 0xff, 0xff, 0xf9, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xe7, 0xff, 0xff, 0xe7, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xf9, 0xff, 0xff, 0x9f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xfe, 0x1f, 0xf8, 0x7f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xe0, 0x07, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
||||||
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff,
|
||||||
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
|
||||||
|
|
||||||
|
Display::Display(const Config &config) : m_config(config), m_state(State::Idle) {
|
||||||
|
m_display.external_vcc = false;
|
||||||
|
ssd1306_init(&m_display, 128, 64, m_config.i2c_address, m_config.i2c_block);
|
||||||
|
ssd1306_clear(&m_display);
|
||||||
|
}
|
||||||
|
|
||||||
|
void Display::showIdle() { m_state = State::Idle; }
|
||||||
|
void Display::showMenu() { m_state = State::Menu; }
|
||||||
|
|
||||||
|
void Display::drawIdleScreen() {
|
||||||
|
// Background
|
||||||
|
ssd1306_bmp_show_image(&m_display, idle_screen.data(), idle_screen.size());
|
||||||
|
}
|
||||||
|
|
||||||
|
void Display::drawMenuScreen() {}
|
||||||
|
|
||||||
|
void Display::update() {
|
||||||
|
static const uint32_t interval_ms = 17; // Limit to ~60fps
|
||||||
|
static uint32_t start_ms = 0;
|
||||||
|
|
||||||
|
if (to_ms_since_boot(get_absolute_time()) - start_ms < interval_ms) {
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
start_ms += interval_ms;
|
||||||
|
|
||||||
|
ssd1306_clear(&m_display);
|
||||||
|
|
||||||
|
switch (m_state) {
|
||||||
|
case State::Idle:
|
||||||
|
drawIdleScreen();
|
||||||
|
break;
|
||||||
|
case State::Menu:
|
||||||
|
drawMenuScreen();
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
ssd1306_show(&m_display);
|
||||||
|
};
|
||||||
|
|
||||||
|
} // namespace Doncon::Peripherals
|
||||||
Loading…
Reference in New Issue
Block a user