altos/telelco-v3.0: Add contrast setting

[fw/altos] / src / drivers / ao_st7565.c

diff --git a/src/drivers/ao_st7565.c b/src/drivers/ao_st7565.c
index 6893ccd41e4741c506eee35b7bd57c4225200c71..261ed857b16d840ce7fcd7acc46178845cc5bcbb 100644 (file)
--- a/src/drivers/ao_st7565.c
+++ b/src/drivers/ao_st7565.c
@@ -82,12 +82,23 @@ ao_st7565_data(const void *base, uint16_t len)
        ao_st7565_stop();
 }
 
-static void
+static uint8_t brightness;
+
+void
 ao_st7565_set_brightness(uint8_t val)
 {
+       if (val > 63)
+               val = 63;
+       brightness = val;
        ao_st7565_instruction_param(ST7565_ELECTRONIC_VOLUME_SET, val);
 }
 
+uint8_t
+ao_st7565_get_brightness(void)
+{
+       return brightness;
+}
+
 static bool setup_done;
 
 static void