^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /***************************************************************************
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright (C) 2010-2012 by Bruno Prémont <bonbons@linux-vserver.org> *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Based on Logitech G13 driver (v0.4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Copyright (C) 2009 by Rick L. Vinyard, Jr. <rvinyard@cs.nmsu.edu> *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) ***************************************************************************/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/hid.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/vmalloc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/fb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include "hid-picolcd.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) /* Framebuffer
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) * The PicoLCD use a Topway LCD module of 256x64 pixel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) * This display area is tiled over 4 controllers with 8 tiles
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) * each. Each tile has 8x64 pixel, each data byte representing
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) * a 1-bit wide vertical line of the tile.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) * The display can be updated at a tile granularity.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) * Chip 1 Chip 2 Chip 3 Chip 4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) * +----------------+----------------+----------------+----------------+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) * | Tile 1 | Tile 1 | Tile 1 | Tile 1 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) * +----------------+----------------+----------------+----------------+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) * | Tile 2 | Tile 2 | Tile 2 | Tile 2 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) * +----------------+----------------+----------------+----------------+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) * ...
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) * +----------------+----------------+----------------+----------------+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) * | Tile 8 | Tile 8 | Tile 8 | Tile 8 |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) * +----------------+----------------+----------------+----------------+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) #define PICOLCDFB_NAME "picolcdfb"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define PICOLCDFB_WIDTH (256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define PICOLCDFB_HEIGHT (64)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define PICOLCDFB_SIZE (PICOLCDFB_WIDTH * PICOLCDFB_HEIGHT / 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define PICOLCDFB_UPDATE_RATE_LIMIT 10
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define PICOLCDFB_UPDATE_RATE_DEFAULT 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) /* Framebuffer visual structures */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) static const struct fb_fix_screeninfo picolcdfb_fix = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) .id = PICOLCDFB_NAME,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) .type = FB_TYPE_PACKED_PIXELS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) .visual = FB_VISUAL_MONO01,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) .xpanstep = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) .ypanstep = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) .ywrapstep = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) .line_length = PICOLCDFB_WIDTH / 8,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) .accel = FB_ACCEL_NONE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) static const struct fb_var_screeninfo picolcdfb_var = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) .xres = PICOLCDFB_WIDTH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) .yres = PICOLCDFB_HEIGHT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) .xres_virtual = PICOLCDFB_WIDTH,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) .yres_virtual = PICOLCDFB_HEIGHT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) .width = 103,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) .height = 26,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) .bits_per_pixel = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) .grayscale = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) .red = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) .offset = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) .length = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) .msb_right = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) .green = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) .offset = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) .length = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) .msb_right = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) .blue = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) .offset = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) .length = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) .msb_right = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) .transp = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) .offset = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) .length = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) .msb_right = 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) /* Send a given tile to PicoLCD */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) static int picolcd_fb_send_tile(struct picolcd_data *data, u8 *vbitmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) int chip, int tile)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) struct hid_report *report1, *report2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) u8 *tdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) report1 = picolcd_out_report(REPORT_LCD_CMD_DATA, data->hdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) if (!report1 || report1->maxfield != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) report2 = picolcd_out_report(REPORT_LCD_DATA, data->hdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) if (!report2 || report2->maxfield != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) spin_lock_irqsave(&data->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) if ((data->status & PICOLCD_FAILED)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) spin_unlock_irqrestore(&data->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) hid_set_field(report1->field[0], 0, chip << 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) hid_set_field(report1->field[0], 1, 0x02);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) hid_set_field(report1->field[0], 2, 0x00);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) hid_set_field(report1->field[0], 3, 0x00);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) hid_set_field(report1->field[0], 4, 0xb8 | tile);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) hid_set_field(report1->field[0], 5, 0x00);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) hid_set_field(report1->field[0], 6, 0x00);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) hid_set_field(report1->field[0], 7, 0x40);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) hid_set_field(report1->field[0], 8, 0x00);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) hid_set_field(report1->field[0], 9, 0x00);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) hid_set_field(report1->field[0], 10, 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) hid_set_field(report2->field[0], 0, (chip << 2) | 0x01);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) hid_set_field(report2->field[0], 1, 0x00);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) hid_set_field(report2->field[0], 2, 0x00);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) hid_set_field(report2->field[0], 3, 32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) tdata = vbitmap + (tile * 4 + chip) * 64;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) for (i = 0; i < 64; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) if (i < 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) hid_set_field(report1->field[0], 11 + i, tdata[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) hid_set_field(report2->field[0], 4 + i - 32, tdata[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) hid_hw_request(data->hdev, report1, HID_REQ_SET_REPORT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) hid_hw_request(data->hdev, report2, HID_REQ_SET_REPORT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) spin_unlock_irqrestore(&data->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) /* Translate a single tile*/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) static int picolcd_fb_update_tile(u8 *vbitmap, const u8 *bitmap, int bpp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) int chip, int tile)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) int i, b, changed = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) u8 tdata[64];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) u8 *vdata = vbitmap + (tile * 4 + chip) * 64;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) if (bpp == 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) for (b = 7; b >= 0; b--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) const u8 *bdata = bitmap + tile * 256 + chip * 8 + b * 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) for (i = 0; i < 64; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) tdata[i] <<= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) tdata[i] |= (bdata[i/8] >> (i % 8)) & 0x01;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) } else if (bpp == 8) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) for (b = 7; b >= 0; b--) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) const u8 *bdata = bitmap + (tile * 256 + chip * 8 + b * 32) * 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) for (i = 0; i < 64; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) tdata[i] <<= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) tdata[i] |= (bdata[i] & 0x80) ? 0x01 : 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) /* Oops, we should never get here! */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) WARN_ON(1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) for (i = 0; i < 64; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) if (tdata[i] != vdata[i]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) changed = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) vdata[i] = tdata[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) return changed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) void picolcd_fb_refresh(struct picolcd_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) if (data->fb_info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) schedule_delayed_work(&data->fb_info->deferred_work, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) /* Reconfigure LCD display */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) int picolcd_fb_reset(struct picolcd_data *data, int clear)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) struct hid_report *report = picolcd_out_report(REPORT_LCD_CMD, data->hdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) struct picolcd_fb_data *fbdata = data->fb_info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) int i, j;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) static const u8 mapcmd[8] = { 0x00, 0x02, 0x00, 0x64, 0x3f, 0x00, 0x64, 0xc0 };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) if (!report || report->maxfield != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) spin_lock_irqsave(&data->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) for (i = 0; i < 4; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) for (j = 0; j < report->field[0]->maxusage; j++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) if (j == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) hid_set_field(report->field[0], j, i << 2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) else if (j < sizeof(mapcmd))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) hid_set_field(report->field[0], j, mapcmd[j]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) hid_set_field(report->field[0], j, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) hid_hw_request(data->hdev, report, HID_REQ_SET_REPORT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) spin_unlock_irqrestore(&data->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) if (clear) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) memset(fbdata->vbitmap, 0, PICOLCDFB_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) memset(fbdata->bitmap, 0, PICOLCDFB_SIZE*fbdata->bpp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) fbdata->force = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) /* schedule first output of framebuffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) if (fbdata->ready)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) schedule_delayed_work(&data->fb_info->deferred_work, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) fbdata->ready = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) /* Update fb_vbitmap from the screen_base and send changed tiles to device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) static void picolcd_fb_update(struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) int chip, tile, n;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) struct picolcd_fb_data *fbdata = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) struct picolcd_data *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) mutex_lock(&info->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) spin_lock_irqsave(&fbdata->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) if (!fbdata->ready && fbdata->picolcd)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) picolcd_fb_reset(fbdata->picolcd, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) spin_unlock_irqrestore(&fbdata->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) * Translate the framebuffer into the format needed by the PicoLCD.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) * See display layout above.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) * Do this one tile after the other and push those tiles that changed.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) * Wait for our IO to complete as otherwise we might flood the queue!
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) n = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) for (chip = 0; chip < 4; chip++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) for (tile = 0; tile < 8; tile++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) if (!fbdata->force && !picolcd_fb_update_tile(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) fbdata->vbitmap, fbdata->bitmap,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) fbdata->bpp, chip, tile))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) n += 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) if (n >= HID_OUTPUT_FIFO_SIZE / 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) spin_lock_irqsave(&fbdata->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) data = fbdata->picolcd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) spin_unlock_irqrestore(&fbdata->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) mutex_unlock(&info->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) if (!data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) hid_hw_wait(data->hdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) mutex_lock(&info->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) n = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) spin_lock_irqsave(&fbdata->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) data = fbdata->picolcd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) spin_unlock_irqrestore(&fbdata->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) if (!data || picolcd_fb_send_tile(data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) fbdata->vbitmap, chip, tile))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) fbdata->force = false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) if (n) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) spin_lock_irqsave(&fbdata->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) data = fbdata->picolcd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) spin_unlock_irqrestore(&fbdata->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) mutex_unlock(&info->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) if (data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) hid_hw_wait(data->hdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) mutex_unlock(&info->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) /* Stub to call the system default and update the image on the picoLCD */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) static void picolcd_fb_fillrect(struct fb_info *info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) const struct fb_fillrect *rect)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) if (!info->par)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) sys_fillrect(info, rect);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) schedule_delayed_work(&info->deferred_work, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) /* Stub to call the system default and update the image on the picoLCD */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) static void picolcd_fb_copyarea(struct fb_info *info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) const struct fb_copyarea *area)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) if (!info->par)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) sys_copyarea(info, area);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) schedule_delayed_work(&info->deferred_work, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) /* Stub to call the system default and update the image on the picoLCD */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) static void picolcd_fb_imageblit(struct fb_info *info, const struct fb_image *image)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) if (!info->par)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) sys_imageblit(info, image);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) schedule_delayed_work(&info->deferred_work, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) * this is the slow path from userspace. they can seek and write to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) * the fb. it's inefficient to do anything less than a full screen draw
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) static ssize_t picolcd_fb_write(struct fb_info *info, const char __user *buf,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) size_t count, loff_t *ppos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) ssize_t ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) if (!info->par)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) ret = fb_sys_write(info, buf, count, ppos);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) if (ret >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) schedule_delayed_work(&info->deferred_work, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) static int picolcd_fb_blank(int blank, struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) /* We let fb notification do this for us via lcd/backlight device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) static void picolcd_fb_destroy(struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) struct picolcd_fb_data *fbdata = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) /* make sure no work is deferred */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) fb_deferred_io_cleanup(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) /* No thridparty should ever unregister our framebuffer! */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) WARN_ON(fbdata->picolcd != NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) vfree((u8 *)info->fix.smem_start);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) framebuffer_release(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) static int picolcd_fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) __u32 bpp = var->bits_per_pixel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) __u32 activate = var->activate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) /* only allow 1/8 bit depth (8-bit is grayscale) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) *var = picolcdfb_var;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) var->activate = activate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) if (bpp >= 8) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) var->bits_per_pixel = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) var->red.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) var->green.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) var->blue.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) var->bits_per_pixel = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) var->red.length = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) var->green.length = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) var->blue.length = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) static int picolcd_set_par(struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) struct picolcd_fb_data *fbdata = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) u8 *tmp_fb, *o_fb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) if (info->var.bits_per_pixel == fbdata->bpp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) /* switch between 1/8 bit depths */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) if (info->var.bits_per_pixel != 1 && info->var.bits_per_pixel != 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) o_fb = fbdata->bitmap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) tmp_fb = kmalloc_array(PICOLCDFB_SIZE, info->var.bits_per_pixel,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) if (!tmp_fb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) /* translate FB content to new bits-per-pixel */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) if (info->var.bits_per_pixel == 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) int i, b;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) for (i = 0; i < PICOLCDFB_SIZE; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) u8 p = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) for (b = 0; b < 8; b++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) p <<= 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) p |= o_fb[i*8+b] ? 0x01 : 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) tmp_fb[i] = p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) memcpy(o_fb, tmp_fb, PICOLCDFB_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) info->fix.visual = FB_VISUAL_MONO01;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) info->fix.line_length = PICOLCDFB_WIDTH / 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) memcpy(tmp_fb, o_fb, PICOLCDFB_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) for (i = 0; i < PICOLCDFB_SIZE * 8; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) o_fb[i] = tmp_fb[i/8] & (0x01 << (7 - i % 8)) ? 0xff : 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) info->fix.visual = FB_VISUAL_DIRECTCOLOR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) info->fix.line_length = PICOLCDFB_WIDTH;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) kfree(tmp_fb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) fbdata->bpp = info->var.bits_per_pixel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) static const struct fb_ops picolcdfb_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) .fb_destroy = picolcd_fb_destroy,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) .fb_read = fb_sys_read,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) .fb_write = picolcd_fb_write,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) .fb_blank = picolcd_fb_blank,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) .fb_fillrect = picolcd_fb_fillrect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) .fb_copyarea = picolcd_fb_copyarea,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) .fb_imageblit = picolcd_fb_imageblit,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) .fb_check_var = picolcd_fb_check_var,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) .fb_set_par = picolcd_set_par,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) /* Callback from deferred IO workqueue */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) static void picolcd_fb_deferred_io(struct fb_info *info, struct list_head *pagelist)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) picolcd_fb_update(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) static const struct fb_deferred_io picolcd_fb_defio = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) .delay = HZ / PICOLCDFB_UPDATE_RATE_DEFAULT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) .deferred_io = picolcd_fb_deferred_io,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) * The "fb_update_rate" sysfs attribute
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) static ssize_t picolcd_fb_update_rate_show(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) struct device_attribute *attr, char *buf)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) struct picolcd_data *data = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) struct picolcd_fb_data *fbdata = data->fb_info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) unsigned i, fb_update_rate = fbdata->update_rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) size_t ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) for (i = 1; i <= PICOLCDFB_UPDATE_RATE_LIMIT; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) if (ret >= PAGE_SIZE)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) else if (i == fb_update_rate)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) ret += scnprintf(buf+ret, PAGE_SIZE-ret, "[%u] ", i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) ret += scnprintf(buf+ret, PAGE_SIZE-ret, "%u ", i);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) if (ret > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) buf[min(ret, (size_t)PAGE_SIZE)-1] = '\n';
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) static ssize_t picolcd_fb_update_rate_store(struct device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) struct device_attribute *attr, const char *buf, size_t count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) struct picolcd_data *data = dev_get_drvdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) struct picolcd_fb_data *fbdata = data->fb_info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) unsigned u;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) if (count < 1 || count > 10)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) i = sscanf(buf, "%u", &u);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) if (i != 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) if (u > PICOLCDFB_UPDATE_RATE_LIMIT)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) return -ERANGE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) else if (u == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) u = PICOLCDFB_UPDATE_RATE_DEFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) fbdata->update_rate = u;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) data->fb_info->fbdefio->delay = HZ / fbdata->update_rate;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) return count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) static DEVICE_ATTR(fb_update_rate, 0664, picolcd_fb_update_rate_show,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) picolcd_fb_update_rate_store);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) /* initialize Framebuffer device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) int picolcd_init_framebuffer(struct picolcd_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) struct device *dev = &data->hdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) struct fb_info *info = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) struct picolcd_fb_data *fbdata = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) int i, error = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) u32 *palette;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) /* The extra memory is:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) * - 256*u32 for pseudo_palette
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) * - struct fb_deferred_io
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) info = framebuffer_alloc(256 * sizeof(u32) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) sizeof(struct fb_deferred_io) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) sizeof(struct picolcd_fb_data) +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) PICOLCDFB_SIZE, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) if (!info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) goto err_nomem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) info->fbdefio = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) *info->fbdefio = picolcd_fb_defio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) info->par += sizeof(struct fb_deferred_io);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) palette = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) info->par += 256 * sizeof(u32);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) for (i = 0; i < 256; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) palette[i] = i > 0 && i < 16 ? 0xff : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) info->pseudo_palette = palette;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) info->fbops = &picolcdfb_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) info->var = picolcdfb_var;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) info->fix = picolcdfb_fix;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) info->fix.smem_len = PICOLCDFB_SIZE*8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) info->flags = FBINFO_FLAG_DEFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) fbdata = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) spin_lock_init(&fbdata->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) fbdata->picolcd = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) fbdata->update_rate = PICOLCDFB_UPDATE_RATE_DEFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) fbdata->bpp = picolcdfb_var.bits_per_pixel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) fbdata->force = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) fbdata->vbitmap = info->par + sizeof(struct picolcd_fb_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) fbdata->bitmap = vmalloc(PICOLCDFB_SIZE*8);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) if (fbdata->bitmap == NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) dev_err(dev, "can't get a free page for framebuffer\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) goto err_nomem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) info->screen_base = (char __force __iomem *)fbdata->bitmap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) info->fix.smem_start = (unsigned long)fbdata->bitmap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) memset(fbdata->vbitmap, 0xff, PICOLCDFB_SIZE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) data->fb_info = info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) error = picolcd_fb_reset(data, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) dev_err(dev, "failed to configure display\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) goto err_cleanup;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) error = device_create_file(dev, &dev_attr_fb_update_rate);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) dev_err(dev, "failed to create sysfs attributes\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) goto err_cleanup;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) fb_deferred_io_init(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) error = register_framebuffer(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) dev_err(dev, "failed to register framebuffer\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) goto err_sysfs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) err_sysfs:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) device_remove_file(dev, &dev_attr_fb_update_rate);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) fb_deferred_io_cleanup(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) err_cleanup:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) data->fb_info = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) err_nomem:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) if (fbdata)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) vfree(fbdata->bitmap);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) framebuffer_release(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) void picolcd_exit_framebuffer(struct picolcd_data *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) struct fb_info *info = data->fb_info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) struct picolcd_fb_data *fbdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) if (!info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) device_remove_file(&data->hdev->dev, &dev_attr_fb_update_rate);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) fbdata = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) /* disconnect framebuffer from HID dev */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) spin_lock_irqsave(&fbdata->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) fbdata->picolcd = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) spin_unlock_irqrestore(&fbdata->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) /* make sure there is no running update - thus that fbdata->picolcd
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) * once obtained under lock is guaranteed not to get free() under
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) * the feet of the deferred work */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) flush_delayed_work(&info->deferred_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) data->fb_info = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) unregister_framebuffer(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags