Extract the code to set the column and page ranges into two helper
functions.

Signed-off-by: Geert Uytterhoeven <ge...@linux-m68k.org>
Acked-by: Sam Ravnborg <s...@ravnborg.org>
---
v2:
  - Use two separate helpers instead of a single combined helper,
  - Add Acked-by.
---
 drivers/video/fbdev/ssd1307fb.c | 57 +++++++++++++++++++++------------
 1 file changed, 37 insertions(+), 20 deletions(-)

diff --git a/drivers/video/fbdev/ssd1307fb.c b/drivers/video/fbdev/ssd1307fb.c
index 6d7bd025bca1a175..86eb9c99a783f0da 100644
--- a/drivers/video/fbdev/ssd1307fb.c
+++ b/drivers/video/fbdev/ssd1307fb.c
@@ -152,6 +152,40 @@ static inline int ssd1307fb_write_cmd(struct i2c_client 
*client, u8 cmd)
        return ret;
 }
 
+static int ssd1307fb_set_col_range(struct ssd1307fb_par *par, u8 col_start,
+                                  u8 cols)
+{
+       u8 col_end = col_start + cols - 1;
+       int ret;
+
+       ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SET_COL_RANGE);
+       if (ret < 0)
+               return ret;
+
+       ret = ssd1307fb_write_cmd(par->client, col_start);
+       if (ret < 0)
+               return ret;
+
+       return ssd1307fb_write_cmd(par->client, col_end);
+}
+
+static int ssd1307fb_set_page_range(struct ssd1307fb_par *par, u8 page_start,
+                                   u8 pages)
+{
+       u8 page_end = page_start + pages - 1;
+       int ret;
+
+       ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SET_PAGE_RANGE);
+       if (ret < 0)
+               return ret;
+
+       ret = ssd1307fb_write_cmd(par->client, page_start);
+       if (ret < 0)
+               return ret;
+
+       return ssd1307fb_write_cmd(par->client, page_end);
+}
+
 static int ssd1307fb_update_display(struct ssd1307fb_par *par)
 {
        struct ssd1307fb_array *array;
@@ -462,30 +496,13 @@ static int ssd1307fb_init(struct ssd1307fb_par *par)
                return ret;
 
        /* Set column range */
-       ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SET_COL_RANGE);
-       if (ret < 0)
-               return ret;
-
-       ret = ssd1307fb_write_cmd(par->client, par->col_offset);
-       if (ret < 0)
-               return ret;
-
-       ret = ssd1307fb_write_cmd(par->client, par->col_offset + par->width - 
1);
+       ret = ssd1307fb_set_col_range(par, par->col_offset, par->width);
        if (ret < 0)
                return ret;
 
        /* Set page range */
-       ret = ssd1307fb_write_cmd(par->client, SSD1307FB_SET_PAGE_RANGE);
-       if (ret < 0)
-               return ret;
-
-       ret = ssd1307fb_write_cmd(par->client, par->page_offset);
-       if (ret < 0)
-               return ret;
-
-       ret = ssd1307fb_write_cmd(par->client,
-                                 par->page_offset +
-                                 DIV_ROUND_UP(par->height, 8) - 1);
+       ret = ssd1307fb_set_page_range(par, par->page_offset,
+                                      DIV_ROUND_UP(par->height, 8));
        if (ret < 0)
                return ret;
 
-- 
2.25.1

Reply via email to