Hi Rick,
On Thu, Jan 07, 2010 at 09:23:24AM -0700, Rick L. Vinyard Jr. wrote:
>
> This is a driver for the Logitech G13 gamepad, and contains three key
> parts. Through the USB reports the device identifies itself as a HID, and as
> a result this driver is under the HID framework.
>
> There are two primary sub-components to this driver; an input device and a
> framebuffer device.
>
> Although identified as a HID, the device does not support standard HID
> input messages. As a result, a sub-input device is allocated and
> registered separately in g13_probe(). The raw events are monitored and
> key presses/joystick activity is reported through the input device after
> referencing an indexed keymap.
Finally had some time to look through the patch, comments below.
>
> Additionally, this device contains a 160x43 monochrome LCD display. A
> registered framebuffer device manages this display. The design of this
> portion of the driver was based on the design of the hecubafb driver with
> deferred framebuffer I/O since there is no real memory to map.
>
> Changes since 0.0.2:
> - Moved the module out of the logitech objs to build on its own
>
> - Added dependency on FB_DEFFERRED_IO
>
> - Added explanation as to why the load image is used and how to view it
> outside the code.
>
> - Changed the load image to text "G13" with default penguins resized,
> cleaned up and inverted from framebuffer monochrome penguin logo.
>
> - Cleaned up the raw event callback by moving the key event processing to a
> separate function.
>
> - Removed several of the line breaks introduced to accomodate 80-column lines
> to improve readability.
>
> - Reordeded event processing and utility functions to eliminate the need for
> a g13_set_mled() prototype.
>
> - Removed nonstd flag from framebuffer screeninfo structure
>
> Signed-off-by: Rick L. Vinyard, Jr <rvinyard@xxxxxxxxxxx>
> ---
> diff --git a/drivers/hid/Kconfig b/drivers/hid/Kconfig
> index 24d90ea..548dd4a 100644
> --- a/drivers/hid/Kconfig
> +++ b/drivers/hid/Kconfig
> @@ -183,6 +183,20 @@ config LOGIRUMBLEPAD2_FF
> Say Y here if you want to enable force feedback support for Logitech
> Rumblepad 2 devices.
>
> +config HID_LOGITECH_G13
> + tristate "Logitech G13 gameboard support"
> + depends on FB
> + depends on FB_DEFERRED_IO
> + select FB_SYS_FILLRECT
> + select FB_SYS_COPYAREA
> + select FB_SYS_IMAGEBLIT
> + select FB_SYS_FOPS
> + help
> + This provides support for Logitech G13 gameboard
> + devices. This includes support for the device
> + as a keypad input with mappable keys as well as
> + a framebuffer for the LCD display.
> +
> config HID_MICROSOFT
> tristate "Microsoft" if EMBEDDED
> depends on USB_HID
> diff --git a/drivers/hid/Makefile b/drivers/hid/Makefile
> index 0de2dff..d39dc5b 100644
> --- a/drivers/hid/Makefile
> +++ b/drivers/hid/Makefile
> @@ -31,6 +31,7 @@ obj-$(CONFIG_HID_GYRATION) += hid-gyration.o
> obj-$(CONFIG_HID_KENSINGTON) += hid-kensington.o
> obj-$(CONFIG_HID_KYE) += hid-kye.o
> obj-$(CONFIG_HID_LOGITECH) += hid-logitech.o
> +obj-$(CONFIG_HID_LOGITECH_G13) += hid-g13.o
> obj-$(CONFIG_HID_MICROSOFT) += hid-microsoft.o
> obj-$(CONFIG_HID_MONTEREY) += hid-monterey.o
> obj-$(CONFIG_HID_NTRIG) += hid-ntrig.o
> diff --git a/drivers/hid/hid-core.c b/drivers/hid/hid-core.c
> index 80792d3..eeae383 100644
> --- a/drivers/hid/hid-core.c
> +++ b/drivers/hid/hid-core.c
> @@ -1325,6 +1325,7 @@ static const struct hid_device_id hid_blacklist[] = {
> { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_MOMO_WHEEL2) },
> { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_G25_WHEEL) },
> { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_RUMBLEPAD2) },
> + { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_G13) },
> { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_SPACETRAVELLER) },
> { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_SPACENAVIGATOR) },
> { HID_USB_DEVICE(USB_VENDOR_ID_MICROSOFT, USB_DEVICE_ID_SIDEWINDER_GV) },
> diff --git a/drivers/hid/hid-g13.c b/drivers/hid/hid-g13.c
> new file mode 100644
> index 0000000..63c3044
> --- /dev/null
> +++ b/drivers/hid/hid-g13.c
> @@ -0,0 +1,1598 @@
> +/***************************************************************************
> + * Copyright (C) 2009 by Rick L. Vinyard, Jr. *
> + * rvinyard@xxxxxxxxxxx *
> + * *
> + * This program is free software: you can redistribute it and/or modify *
> + * it under the terms of the GNU General Public License as published by *
> + * the Free Software Foundation, either version 2 of the License, or *
> + * (at your option) any later version. *
> + * *
> + * This driver is distributed in the hope that it will be useful, but *
> + * WITHOUT ANY WARRANTY; without even the implied warranty of *
> + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU *
> + * General Public License for more details. *
> + * *
> + * You should have received a copy of the GNU General Public License *
> + * along with this software. If not see <http://www.gnu.org/licenses/>. *
> + ***************************************************************************/
> +#include <linux/fb.h>
> +#include <linux/hid.h>
> +#include <linux/init.h>
> +#include <linux/input.h>
> +#include <linux/mm.h>
> +#include <linux/sysfs.h>
> +#include <linux/uaccess.h>
> +#include <linux/usb.h>
> +#include <linux/vmalloc.h>
> +
> +#include "hid-ids.h"
> +#include "usbhid/usbhid.h"
> +
> +#define G13_NAME "Logitech G13"
> +
> +/* Key defines */
> +#define G13_KEYS 35
> +#define G13_KEYMAP_SIZE (G13_KEYS*3)
> +
> +/* G1-G22 indices */
> +#define G13_G1 0
> +#define G13_G2 1
> +#define G13_G3 2
> +#define G13_G4 3
> +#define G13_G5 4
> +#define G13_G6 5
> +#define G13_G7 6
> +#define G13_G8 7
> +#define G13_G9 8
> +#define G13_G10 9
> +#define G13_G11 10
> +#define G13_G12 11
> +#define G13_G13 12
> +#define G13_G14 13
> +#define G13_G15 14
> +#define G13_G16 15
> +#define G13_G17 16
> +#define G13_G18 17
> +#define G13_G19 18
> +#define G13_G20 19
> +#define G13_G21 20
> +#define G13_G22 21
> +#define G13_FUNC 22
> +#define G13_LCD1 23
> +#define G13_LCD2 24
> +#define G13_LCD3 25
> +#define G13_LCD4 26
> +#define G13_M1 27
> +#define G13_M2 28
> +#define G13_M3 29
> +#define G13_MR 30
> +#define G13_BTN_LEFT 31
> +#define G13_BTN_DOWN 32
> +#define G13_BTN_STICK 33
> +#define G13_LIGHT 34
> +
> +/* Framebuffer defines */
> +#define G13FB_NAME "g13fb"
> +#define G13FB_WIDTH (160)
> +#define G13FB_LINE_LENGTH (160/8)
> +#define G13FB_HEIGHT (43)
> +#define G13FB_SIZE (G13FB_LINE_LENGTH*G13FB_HEIGHT)
> +
> +#define G13FB_UPDATE_RATE_LIMIT (20)
> +#define G13FB_UPDATE_RATE_DEFAULT (10)
> +
> +/*
> + * The native G13 format uses vertical bits. Therefore the number of bytes
> + * needed to represent the first column is 43/8 (rows/bits) rounded up.
> + * Additionally, the format requires a padding of 32 bits in front of the
> + * image data.
> + *
> + * Therefore the vbitmap size must be:
> + * 160 * ceil(43/8) + 32 = 160 * 6 + 32 = 992
> + */
> +#define G13_VBITMAP_SIZE (992)
> +
> +/* Backlight defaults */
> +#define G13_DEFAULT_RED (0)
> +#define G13_DEFAULT_GREEN (255)
> +#define G13_DEFAULT_BLUE (0)
> +
> +/* Per device data structure */
> +struct g13_data {
> + /* HID reports */
> + struct hid_device *hdev;
> + struct hid_report *backlight_report;
> + struct hid_report *start_input_report;
> + struct hid_report *report_4;
> + struct hid_report *mled_report;
> + struct input_dev *input_dev;
> +
> + char *name;
> + int ready;
> + int ready2;
> + u32 keycode[G13_KEYMAP_SIZE];
> + u8 rgb[3];
> + u8 mled;
> + u8 curkeymap;
> + u8 emit_msc_raw;
> + u8 keymap_switching;
> +
> + /* Framebuffer stuff */
> + u8 fb_update_rate;
> + u8 *fb_vbitmap;
> + u8 *fb_bitmap;
> + struct fb_info *fb_info;
> + struct fb_deferred_io fb_defio;
> +
> + /* Housekeeping stuff */
> + rwlock_t lock;
> +};
> +
> +/* Convenience macros */
> +#define hid_get_g13data(hdev) \
> + ((hdev == NULL) ? NULL : (struct g13_data *)(hid_get_drvdata(hdev)))
> +
> +#define input_get_hdev(idev) \
> + ((idev == NULL) ? NULL : (struct hid_device *)(input_get_drvdata(idev)))
> +
> +#define input_get_g13data(idev) (hid_get_g13data(input_get_hdev(idev)))
I wonder whether these NULL tests are helpful or if they will simply
mask potential bugs in the driver. For example - when (in this
particular driver) input_get_drvdata would return NULL? You set it
before registering the device so any input device method will have it
set. I'd remove them.
> +
> +static unsigned int g13_default_key_map[G13_KEYS] = {
const.
> + /* first row g1 - g7 */
> + KEY_F1, KEY_F2, KEY_F3, KEY_F4, KEY_F5, KEY_F6, KEY_F7,
> + /* second row g8 - g11 */
> + KEY_UNKNOWN, KEY_UNKNOWN, KEY_BACK, KEY_UP,
> + /* second row g12 - g13 */
> + KEY_FORWARD, KEY_UNKNOWN, KEY_UNKNOWN,
> + /* third row g15 - g19 */
> + KEY_UNKNOWN, KEY_LEFT, KEY_DOWN, KEY_RIGHT, KEY_UNKNOWN,
> + /* fourth row g20 - g22 */
> + KEY_BACKSPACE, KEY_ENTER, KEY_SPACE,
> + /* next, light left, light center left, light center right, light right */
> + BTN_0, BTN_1, BTN_2, BTN_3, BTN_4,
> + /* M1, M2, M3, MR */
> + KEY_RESERVED, KEY_RESERVED, KEY_RESERVED, KEY_RESERVED,
> + /* button left, button down, button stick, light */
> + BTN_LEFT, BTN_RIGHT, BTN_MIDDLE, KEY_RESERVED,
> +};
> +
> +/* Framebuffer visual structures */
> +static struct fb_fix_screeninfo g13fb_fix = {
> + .id = G13FB_NAME,
> + .type = FB_TYPE_PACKED_PIXELS,
> + .visual = FB_VISUAL_MONO01,
> + .xpanstep = 0,
> + .ypanstep = 0,
> + .ywrapstep = 0,
> + .line_length = G13FB_LINE_LENGTH,
> + .accel = FB_ACCEL_NONE,
> +};
> +
> +static struct fb_var_screeninfo g13fb_var = {
> + .xres = G13FB_WIDTH,
> + .yres = G13FB_HEIGHT,
> + .xres_virtual = G13FB_WIDTH,
> + .yres_virtual = G13FB_HEIGHT,
> + .bits_per_pixel = 1,
> +};
> +
> +/*
> + * This is a default logo to be loaded upon driver initialization
> + * replacing the default Logitech G13 image loaded on device
> + * initialization. This is to provide the user a cue that the
> + * Linux driver is loaded and ready.
> + *
> + * This logo contains the text G13 in the center with two penguins
> + * on each side of the text. The penguins are a 40x40 rendition of
> + * the default framebuffer 80x80 monochrome image scaled down and
> + * cleaned up to retain something that looks a little better than
> + * a simple scaling.
> + *
> + * This logo is a simple xbm image created in GIMP and exported.
> + * To view the image copy the following two #defines plus the
> + * g13_lcd_bits to an ASCII text file and save with extension
> + * .xbm, then open with GIMP or any other graphical editor
> + * such as eog that recognizes the .xbm format.
> + */
> +#define g13_lcd_width 160
> +#define g13_lcd_height 43
> +static unsigned char g13_lcd_bits[] = {
> + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0f, 0x00,
> + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x3c, 0x00, 0x00, 0x00, 0xc0, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc3, 0x01, 0x00,
> + 0x00, 0x20, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00, 0x80, 0x00, 0x02, 0x00, 0x00, 0x20, 0x10, 0x01,
> + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0x80, 0x40, 0x04, 0x00, 0x00, 0x10, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x00, 0x04, 0x00,
> + 0x00, 0x10, 0x00, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00, 0x40, 0x00, 0x08, 0x00, 0x00, 0xd0, 0x18, 0x02,
> + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0x40, 0x63, 0x08, 0x00, 0x00, 0xd0, 0x1c, 0x02, 0x00, 0xf0, 0xff, 0xff,
> + 0x83, 0xff, 0x01, 0xf8, 0xff, 0xff, 0x03, 0x00, 0x40, 0x73, 0x08, 0x00,
> + 0x00, 0x10, 0x25, 0x02, 0x00, 0xf8, 0xff, 0xff, 0x83, 0xff, 0x01, 0xf8,
> + 0xff, 0xff, 0x07, 0x00, 0x40, 0x94, 0x08, 0x00, 0x00, 0x10, 0x20, 0x02,
> + 0x00, 0xfc, 0xff, 0xff, 0x83, 0xff, 0x01, 0xf8, 0xff, 0xff, 0x0f, 0x00,
> + 0x40, 0x80, 0x08, 0x00, 0x00, 0xd0, 0x1e, 0x02, 0x00, 0xfe, 0xff, 0xff,
> + 0x83, 0xff, 0x01, 0xf8, 0xff, 0xff, 0x1f, 0x00, 0x40, 0x7b, 0x08, 0x00,
> + 0x00, 0xd0, 0x27, 0x02, 0x00, 0xfe, 0xff, 0xff, 0x83, 0xff, 0x01, 0xf8,
> + 0xff, 0xff, 0x1f, 0x00, 0x40, 0x9f, 0x08, 0x00, 0x00, 0x90, 0x1b, 0x02,
> + 0x00, 0x3e, 0x00, 0x00, 0x00, 0xf0, 0x01, 0x00, 0x00, 0x00, 0x1f, 0x00,
> + 0x40, 0x6e, 0x08, 0x00, 0x00, 0x10, 0x24, 0x02, 0x00, 0x3e, 0x00, 0x00,
> + 0x00, 0xf0, 0x01, 0x00, 0x00, 0x00, 0x1f, 0x00, 0x40, 0x90, 0x08, 0x00,
> + 0x00, 0x48, 0x3b, 0x05, 0x00, 0x3e, 0x00, 0x00, 0x00, 0xf0, 0x01, 0x00,
> + 0x00, 0x00, 0x1f, 0x00, 0x20, 0xed, 0x14, 0x00, 0x00, 0xc8, 0x7c, 0x08,
> + 0x00, 0x3e, 0x00, 0x00, 0x00, 0xf0, 0x01, 0x00, 0x00, 0x00, 0x1f, 0x00,
> + 0x20, 0xf3, 0x21, 0x00, 0x00, 0xe4, 0x7f, 0x10, 0x00, 0x3e, 0x00, 0x00,
> + 0x00, 0xf0, 0x01, 0x00, 0x00, 0x00, 0x1f, 0x00, 0x90, 0xff, 0x41, 0x00,
> + 0x00, 0xe2, 0xff, 0x20, 0x00, 0x3e, 0x00, 0x00, 0x00, 0xf0, 0x01, 0x00,
> + 0x00, 0x00, 0x1f, 0x00, 0x88, 0xff, 0x83, 0x00, 0x00, 0xc2, 0x9c, 0x40,
> + 0x00, 0x3e, 0xf8, 0xff, 0x07, 0xf0, 0x01, 0xf8, 0xff, 0xff, 0x1f, 0x00,
> + 0x08, 0x73, 0x02, 0x01, 0x00, 0xf1, 0x3e, 0x41, 0x00, 0x3e, 0xf8, 0xff,
> + 0x07, 0xf0, 0x01, 0xf8, 0xff, 0xff, 0x0f, 0x00, 0xc4, 0xfb, 0x04, 0x01,
> + 0x00, 0xf1, 0x7f, 0x40, 0x00, 0x3e, 0xf8, 0xff, 0x07, 0xf0, 0x01, 0xf8,
> + 0xff, 0xff, 0x07, 0x00, 0xc4, 0xff, 0x01, 0x01, 0x80, 0xf8, 0xff, 0x89,
> + 0x00, 0x3e, 0xf8, 0xff, 0x07, 0xf0, 0x01, 0xf8, 0xff, 0xff, 0x0f, 0x00,
> + 0xe2, 0xff, 0x27, 0x02, 0x80, 0xf8, 0xff, 0x93, 0x00, 0x3e, 0xf8, 0xff,
> + 0x07, 0xf0, 0x01, 0xf8, 0xff, 0xff, 0x0f, 0x00, 0xe2, 0xff, 0x4f, 0x02,
> + 0x40, 0xfc, 0xff, 0x93, 0x00, 0x3e, 0x00, 0xc0, 0x07, 0xf0, 0x01, 0x00,
> + 0x00, 0x00, 0x1f, 0x00, 0xf1, 0xff, 0x4f, 0x02, 0x40, 0xfc, 0xff, 0x13,
> + 0x01, 0x3e, 0x00, 0xc0, 0x07, 0xf0, 0x01, 0x00, 0x00, 0x00, 0x1f, 0x00,
> + 0xf1, 0xff, 0x4f, 0x04, 0x20, 0x7c, 0xff, 0x13, 0x01, 0x3e, 0x00, 0xc0,
> + 0x07, 0xf0, 0x01, 0x00, 0x00, 0x00, 0x1f, 0x80, 0xf0, 0xfd, 0x4f, 0x04,
> + 0x20, 0x7c, 0xff, 0x13, 0x01, 0x3e, 0x00, 0xc0, 0x07, 0xf0, 0x01, 0x00,
> + 0x00, 0x00, 0x1f, 0x80, 0xf0, 0xfd, 0x4f, 0x04, 0x20, 0x7c, 0xff, 0x3b,
> + 0x01, 0x3e, 0x00, 0xc0, 0x07, 0xf0, 0x01, 0x00, 0x00, 0x00, 0x1f, 0x80,
> + 0xf0, 0xfd, 0xef, 0x04, 0xa0, 0xfc, 0xff, 0x00, 0x01, 0x3e, 0x00, 0xc0,
> + 0x07, 0xf0, 0x01, 0x00, 0x00, 0x00, 0x1f, 0x80, 0xf2, 0xff, 0x03, 0x04,
> + 0xc0, 0xfb, 0x7f, 0x83, 0x00, 0xfe, 0xff, 0xff, 0x87, 0xff, 0x7f, 0xf8,
> + 0xff, 0xff, 0x1f, 0x00, 0xef, 0xff, 0x0d, 0x02, 0xe0, 0xe7, 0x7f, 0xc7,
> + 0x00, 0xfe, 0xff, 0xff, 0x87, 0xff, 0x7f, 0xf8, 0xff, 0xff, 0x1f, 0x80,
> + 0x9f, 0xff, 0x1d, 0x03, 0xf0, 0xc7, 0x7f, 0xff, 0x00, 0xfc, 0xff, 0xff,
> + 0x87, 0xff, 0x7f, 0xf8, 0xff, 0xff, 0x0f, 0xc0, 0x1f, 0xff, 0xfd, 0x03,
> + 0xf8, 0xcf, 0x7f, 0xff, 0x03, 0xfc, 0xff, 0xff, 0x87, 0xff, 0x7f, 0xf8,
> + 0xff, 0xff, 0x0f, 0xe0, 0x3f, 0xff, 0xfd, 0x0f, 0xf8, 0xcf, 0x7f, 0xff,
> + 0x03, 0xf0, 0xff, 0xff, 0x87, 0xff, 0x7f, 0xf8, 0xff, 0xff, 0x03, 0xe0,
> + 0x3f, 0xff, 0xfd, 0x0f, 0xfc, 0xef, 0x7f, 0xff, 0x07, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf0, 0xbf, 0xff, 0xfd, 0x1f,
> + 0xfc, 0xdf, 0x9f, 0xff, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0xf0, 0x7f, 0x7f, 0xfe, 0x0f, 0xfc, 0x3f, 0x80, 0xff,
> + 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf0,
> + 0xff, 0x00, 0xfe, 0x07, 0xf8, 0x3f, 0x80, 0x7f, 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xe0, 0xff, 0x00, 0xfe, 0x01,
> + 0xc0, 0xdf, 0x7f, 0x3f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00, 0x7f, 0xff, 0xfd, 0x00, 0x00, 0x1c, 0x00, 0x1f,
> + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0x70, 0x00, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
> + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
> +
> +
> +/* Send the current framebuffer vbitmap as an interrupt message */
> +static int g13_fb_vbitmap_send(struct hid_device *hdev)
> +{
> + struct usb_interface *intf;
> + struct usb_device *usbdev;
> + struct g13_data *data = hid_get_g13data(hdev);
> +
> + /* Get the usb device to send the image on */
> + intf = to_usb_interface(hdev->dev.parent);
> + usbdev = interface_to_usbdev(intf);
> +
> + return usb_interrupt_msg(usbdev, usb_sndintpipe(usbdev, 0x02),
> + data->fb_vbitmap, G13_VBITMAP_SIZE,
> + NULL, USB_CTRL_SET_TIMEOUT*2);
> +}
> +
> +/* Update fb_vbitmap from the screen_base and send to the device */
> +static void g13_fb_update(struct g13_data *data)
> +{
> + int row;
> + int col;
> + int bit;
> + u8 *u;
> + size_t offset;
> + u8 temp;
> +
> + /* Clear the vbitmap and set the necessary magic number */
> + memset(data->fb_vbitmap, 0x00, G13_VBITMAP_SIZE);
> + data->fb_vbitmap[0] = 0x03;
> +
> + /*
> + * Translate the XBM format screen_base into the format needed by the
> + * G13. This format places the pixels in a vertical rather than
> + * horizontal format. Assuming a grid with 0,0 in the upper left corner
> + * and 159,42 in the lower right corner, the first byte contains the
> + * pixels 0,0 through 0,7 and the second byte contains the pixels 1,0
> + * through 1,7. Within the byte, bit 0 represents 0,0; bit 1 0,1; etc.
> + *
> + * This loop operates in reverse to shift the lower bits into their
> + * respective positions, shifting the lower rows into the higher bits.
> + *
> + * The offset is calculated for every 8 rows and is adjusted by 32 since
> + * that is what the G13 image message expects.
> + */
> + for (row = G13FB_HEIGHT-1; row >= 0; row--) {
> + offset = 32 + row/8 * G13FB_WIDTH;
> + u = data->fb_vbitmap + offset;
> + /*
> + * Iterate across the screen_base columns to get the
> + * individual bits
> + */
> + for (col = 0; col < G13FB_LINE_LENGTH; col++) {
> + /*
> + * We will work with a temporary value since we don't
> + * want to modify screen_base as we shift each bit
> + * downward.
> + */
> + temp = data->fb_bitmap[row * G13FB_LINE_LENGTH + col];
> +
> + /*
> + * For each bit in the pixel row we will shift it onto
> + * the appropriate by by shift the g13 byte up by 1 and
> + * simply doing a bitwise or of the low byte
> + */
> + for (bit = 0; bit < 8; bit++) {
> + /*Shift the g13 byte up by 1 for this new row*/
> + u[bit] <<= 1;
> + /* Bring in the new pixel of temp */
> + u[bit] |= (temp & 0x01);
> + /*
> + * Shift temp down so the low pixel is ready
> + * for the next byte
> + */
> + temp >>= 1;
> + }
> +
> + /*
> + * The last byte represented 8 vertical pixels so we'll
> + * jump ahead 8
> + */
> + u += 8;
> + }
> + }
> +
> + /*
> + * Now that we have translated screen_base into a format expected by
> + * the g13 let's send out the vbitmap
> + */
> + g13_fb_vbitmap_send(data->hdev);
> +
> +}
> +
> +/* Callback from deferred IO workqueue */
> +static void g13_fb_deferred_io(struct fb_info *info, struct list_head *pagelist)
> +{
> + g13_fb_update(info->par);
> +}
> +
> +/* Stub to call the system default and update the image on the g13 */
> +static void g13_fb_fillrect(struct fb_info *info,
> + const struct fb_fillrect *rect)
> +{
> + struct g13_data *par = info->par;
> +
> + sys_fillrect(info, rect);
> +
> + g13_fb_update(par);
> +}
> +
> +/* Stub to call the system default and update the image on the g13 */
> +static void g13_fb_copyarea(struct fb_info *info,
> + const struct fb_copyarea *area)
> +{
> + struct g13_data *par = info->par;
> +
> + sys_copyarea(info, area);
> +
> + g13_fb_update(par);
> +}
> +
> +/* Stub to call the system default and update the image on the g13 */
> +static void g13_fb_imageblit(struct fb_info *info, const struct fb_image *image)
> +{
> + struct g13_data *par = info->par;
> +
> + sys_imageblit(info, image);
> +
> + g13_fb_update(par);
> +}
> +
> +/*
> + * this is the slow path from userspace. they can seek and write to
> + * the fb. it's inefficient to do anything less than a full screen draw
> + */
> +static ssize_t g13_fb_write(struct fb_info *info, const char __user *buf,
> + size_t count, loff_t *ppos)
> +{
> + struct g13_data *par = info->par;
> + unsigned long p = *ppos;
> + void *dst;
> + int err = 0;
> + unsigned long total_size;
> +
> + if (info->state != FBINFO_STATE_RUNNING)
> + return -EPERM;
> +
> + total_size = info->fix.smem_len;
> +
> + if (p > total_size)
> + return -EFBIG;
> +
> + if (count > total_size) {
> + err = -EFBIG;
> + count = total_size;
> + }
> +
> + if (count + p > total_size) {
> + if (!err)
> + err = -ENOSPC;
> +
> + count = total_size - p;
> + }
> +
> + dst = (void __force *)(info->screen_base + p);
> +
> + if (copy_from_user(dst, buf, count))
> + err = -EFAULT;
> +
> + if (!err)
> + *ppos += count;
> +
> + g13_fb_update(par);
> +
> + return (err) ? err : count;
> +}
> +
> +static struct fb_ops g13fb_ops = {
const?
> + .owner = THIS_MODULE,
> + .fb_read = fb_sys_read,
> + .fb_write = g13_fb_write,
> + .fb_fillrect = g13_fb_fillrect,
> + .fb_copyarea = g13_fb_copyarea,
> + .fb_imageblit = g13_fb_imageblit,
> +};
> +
> +/*
> + * The "fb_node" attribute
> + */
> +static ssize_t g13_fb_node_show(struct device *dev,
> + struct device_attribute *attr,
> + char *buf)
> +{
> + unsigned fb_node;
> + struct g13_data *data = dev_get_drvdata(dev);
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + fb_node = data->fb_info->node;
> +
> + return sprintf(buf, "%u\n", fb_node);
> +}
> +
> +static DEVICE_ATTR(fb_node, 0444, g13_fb_node_show, NULL);
> +
> +
> +/*
> + * The "fb_update_rate" attribute
> + */
> +static ssize_t g13_fb_update_rate_show(struct device *dev,
> + struct device_attribute *attr,
> + char *buf)
> +{
> + unsigned fb_update_rate;
> + struct g13_data *data = dev_get_drvdata(dev);
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + fb_update_rate = data->fb_update_rate;
> +
> + return sprintf(buf, "%u\n", fb_update_rate);
> +}
> +
> +static ssize_t g13_set_fb_update_rate(struct hid_device *hdev,
> + unsigned fb_update_rate)
> +{
> + struct g13_data *data = hid_get_g13data(hdev);
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + if (fb_update_rate > G13FB_UPDATE_RATE_LIMIT)
> + data->fb_update_rate = G13FB_UPDATE_RATE_LIMIT;
> + else if (fb_update_rate == 0)
> + data->fb_update_rate = 1;
> + else
> + data->fb_update_rate = fb_update_rate;
> +
> + data->fb_defio.delay = HZ / data->fb_update_rate;
> +
> + return 0;
> +}
> +
> +static ssize_t g13_fb_update_rate_store(struct device *dev,
> + struct device_attribute *attr,
> + const char *buf, size_t count)
> +{
> + struct hid_device *hdev;
> + int i;
> + unsigned u;
> + ssize_t set_result;
> +
> + /* Get the hid associated with the device */
> + hdev = container_of(dev, struct hid_device, dev);
> +
> + /* If we have an invalid pointer we'll return ENODATA */
> + if (hdev == NULL || &(hdev->dev) != dev)
> + return -ENODATA;
> +
> + i = sscanf(buf, "%u", &u);
> + if (i != 1) {
> + printk(KERN_ERR "unrecognized input: %s", buf);
> + return -1;
> + }
> +
> + set_result = g13_set_fb_update_rate(hdev, u);
> +
> + if (set_result < 0)
> + return set_result;
> +
> + return count;
> +}
> +
> +static DEVICE_ATTR(fb_update_rate, 0666,
> + g13_fb_update_rate_show,
> + g13_fb_update_rate_store);
> +
> +
> +/*
> + * The "mled" attribute
> + * on or off for each of the four M led's (M1 M2 M3 MR)
> + */
> +static ssize_t g13_mled_show(struct device *dev,
> + struct device_attribute *attr,
> + char *buf)
> +{
> + unsigned mled;
> + struct g13_data *data = dev_get_drvdata(dev);
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + mled = data->mled;
> +
> + return sprintf(buf, "%u\n", mled);
> +}
> +
> +static ssize_t g13_set_mled(struct hid_device *hdev, unsigned mled)
int. It does not return size but error code.
> +{
> + struct g13_data *data = hid_get_g13data(hdev);
> +
> + if (data == NULL || data->mled_report == NULL)
> + return -ENODATA;
> +
> + data->mled_report->field[0]->value[0] = mled&0x0F;
> + data->mled_report->field[0]->value[1] = 0x00;
> + data->mled_report->field[0]->value[2] = 0x00;
> + data->mled_report->field[0]->value[3] = 0x00;
> +
> + usbhid_submit_report(hdev, data->mled_report, USB_DIR_OUT);
> +
> + data->mled = mled;
> +
> + return 0;
> +}
> +
> +static ssize_t g13_mled_store(struct device *dev,
> + struct device_attribute *attr,
> + const char *buf, size_t count)
> +{
> + struct hid_device *hdev;
> + int i;
> + unsigned m[4];
> + unsigned mled;
> + ssize_t set_result;
> +
> + /* Get the hid associated with the device */
> + hdev = container_of(dev, struct hid_device, dev);
> +
> + /* If we have an invalid pointer we'll return ENODATA */
> + if (hdev == NULL || &(hdev->dev) != dev)
> + return -ENODATA;
> +
> + i = sscanf(buf, "%u %u %u %u", m, m+1, m+2, m+3);
> + if (!(i == 4 || i == 1)) {
> + printk(KERN_ERR "unrecognized input: %s", buf);
> + return -1;
> + }
> +
> + if (i == 1)
> + mled = m[0];
> + else
> + mled = (m[0] ? 1 : 0) | (m[1] ? 2 : 0) |
> + (m[2] ? 4 : 0) | (m[3] ? 8 : 0);
> +
> + set_result = g13_set_mled(hdev, mled);
> +
> + if (set_result < 0)
> + return set_result;
> +
> + return count;
> +}
> +
> +static DEVICE_ATTR(mled, 0666, g13_mled_show, g13_mled_store);
Like other people said, you should be using LED framework - uiserspace
can still control LED state, but in a standard way.
> +
> +static int g13_input_setkeycode(struct input_dev *dev,
> + int scancode,
> + int keycode)
> +{
> + int old_keycode;
> + int i;
> + struct g13_data *data = input_get_g13data(dev);
> +
> + if (data == NULL)
> + return -EINVAL;
> +
> + if (scancode >= dev->keycodemax)
> + return -EINVAL;
> +
> + if (!dev->keycodesize)
> + return -EINVAL;
> +
> + if (dev->keycodesize < sizeof(keycode) &&
> + (keycode >> (dev->keycodesize * 8)))
> + return -EINVAL;
> +
> + write_lock(&data->lock);
> +
> + old_keycode = data->keycode[scancode];
> + data->keycode[scancode] = keycode;
> +
> + clear_bit(old_keycode, dev->keybit);
> + set_bit(keycode, dev->keybit);
> +
> + for (i = 0; i < dev->keycodemax; i++) {
> + if (data->keycode[i] == old_keycode) {
> + set_bit(old_keycode, dev->keybit);
> + break; /* Setting the bit twice is useless, so break */
> + }
> + }
> +
> + write_unlock(&data->lock);
> +
> + return 0;
> +}
> +
> +static int g13_input_getkeycode(struct input_dev *dev,
> + int scancode,
> + int *keycode)
> +{
> + struct g13_data *data = input_get_g13data(dev);
> +
> + if (!dev->keycodesize)
> + return -EINVAL;
> +
> + if (scancode >= dev->keycodemax)
> + return -EINVAL;
> +
> + read_lock(&data->lock);
> +
> + *keycode = data->keycode[scancode];
> +
> + read_unlock(&data->lock);
> +
> + return 0;
> +}
Default input core methods should cover this, no?
> +
> +
> +/*
> + * The "keymap" attribute
> + */
> +static ssize_t g13_keymap_index_show(struct device *dev,
> + struct device_attribute *attr,
> + char *buf)
> +{
> + struct g13_data *data = dev_get_drvdata(dev);
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + return sprintf(buf, "%u\n", data->curkeymap);
> +}
> +
> +static ssize_t g13_set_keymap_index(struct hid_device *hdev, unsigned k)
> +{
> + struct g13_data *data = hid_get_g13data(hdev);
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + if (k > 2)
> + return -EINVAL;
> +
> + data->curkeymap = k;
What if you change keymap while a key is pressed and new keymap does not
have anything in that position? The key may get "stuck" for a bit...
> +
> + if (data->keymap_switching)
> + g13_set_mled(hdev, 1<<k);
> +
> + return 0;
> +}
> +
> +static ssize_t g13_keymap_index_store(struct device *dev,
> + struct device_attribute *attr,
> + const char *buf, size_t count)
> +{
> + struct hid_device *hdev;
> + int i;
> + unsigned k;
> + ssize_t set_result;
> +
> + /* Get the hid associated with the device */
> + hdev = container_of(dev, struct hid_device, dev);
> +
> + /* If we have an invalid pointer we'll return ENODATA */
> + if (hdev == NULL || &(hdev->dev) != dev)
> + return -ENODATA;
> +
> + i = sscanf(buf, "%u", &k);
> + if (i != 1) {
> + printk(KERN_ERR "unrecognized input: %s", buf);
> + return -1;
> + }
> +
> + set_result = g13_set_keymap_index(hdev, k);
> +
> + if (set_result < 0)
> + return set_result;
> +
> + return count;
> +}
> +
> +static DEVICE_ATTR(keymap_index, 0666,
> + g13_keymap_index_show,
> + g13_keymap_index_store);
> +
> +/*
> + * The "keycode" attribute
> + */
> +static ssize_t g13_keymap_show(struct device *dev,
> + struct device_attribute *attr,
> + char *buf)
> +{
> + int i;
> + int offset = 0;
> + int result;
> +
> + struct g13_data *data = dev_get_drvdata(dev);
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + for (i = 0; i < G13_KEYMAP_SIZE; i++) {
> + result = sprintf(buf+offset,
> + "0x%03x 0x%04x\n",
> + i, data->keycode[i]);
> + if (result < 0)
> + return -EINVAL;
> + offset += result;
> + }
> +
> + return offset+1;
> +}
> +
> +static ssize_t g13_keymap_store(struct device *dev,
> + struct device_attribute *attr,
> + const char *buf, size_t count)
> +{
> + struct hid_device *hdev;
> + int scanned;
> + int consumed;
> + int scancd;
> + int keycd;
> + int set_result;
> + int set = 0;
> + int gkey;
> + int index;
> + int good;
> + struct g13_data *data;
> +
> + /* Get the hid associated with the device */
> + hdev = container_of(dev, struct hid_device, dev);
> +
> + /* If we have an invalid pointer we'll return ENODATA */
> + if (hdev == NULL || &(hdev->dev) != dev)
> + return -ENODATA;
> +
> + /* Now, let's get the data structure */
> + data = hid_get_g13data(hdev);
> + if (data == NULL)
> + return -ENODATA;
> +
> + do {
> + good = 0;
> +
> + /* Look for scancode keycode pair in hex */
> + scanned = sscanf(buf, "%x %x%n", &scancd, &keycd, &consumed);
> + if (scanned == 2) {
> + buf += consumed;
> + set_result = g13_input_setkeycode(data->input_dev, scancd, keycd);
> + if (set_result < 0)
> + return set_result;
> + set++;
> + good = 1;
> + } else {
> + /*
> + * Look for Gkey keycode pair and assign to current
> + * keymap
> + */
> + scanned = sscanf(buf, "G%d %x%n", &gkey, &keycd, &consumed);
> + if (scanned == 2 && gkey > 0 && gkey <= G13_KEYS) {
> + buf += consumed;
> + scancd = data->curkeymap * G13_KEYS + gkey - 1;
> + set_result = g13_input_setkeycode(data->input_dev, scancd, keycd);
> + if (set_result < 0)
> + return set_result;
> + set++;
> + good = 1;
> + } else {
> + /*
> + * Look for Gkey-index keycode pair and assign
> + * to indexed keymap
> + */
> + scanned = sscanf(buf, "G%d-%d %x%n", &gkey, &index, &keycd, &consumed);
> + if (scanned == 3 &&
> + gkey > 0 && gkey <= G13_KEYS &&
> + index >= 0 && index <= 2) {
> + buf += consumed;
> + scancd = index * G13_KEYS + gkey - 1;
> + set_result = g13_input_setkeycode(data->input_dev, scancd, keycd);
> + if (set_result < 0)
> + return set_result;
> + set++;
> + good = 1;
> + }
> + }
> + }
> +
> + } while (good);
> +
> + if (set == 0) {
> + printk(KERN_ERR "unrecognized keycode input: %s", buf);
> + return -1;
> + }
> +
> + return count;
> +}
> +
> +static DEVICE_ATTR(keymap, 0666, g13_keymap_show, g13_keymap_store);
>
No. Just use EVIOCSKEYCODE.
> +/*
> + * The "emit_msc_raw" attribute
> + */
> +static ssize_t g13_emit_msc_raw_show(struct device *dev,
> + struct device_attribute *attr,
> + char *buf)
> +{
> + struct g13_data *data = dev_get_drvdata(dev);
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + return sprintf(buf, "%u\n", data->emit_msc_raw);
> +}
> +
> +static ssize_t g13_set_emit_msc_raw(struct hid_device *hdev, unsigned k)
> +{
> + struct g13_data *data = hid_get_g13data(hdev);
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + data->emit_msc_raw = k;
> +
> + return 0;
> +}
> +
> +static ssize_t g13_emit_msc_raw_store(struct device *dev,
> + struct device_attribute *attr,
> + const char *buf, size_t count)
> +{
> + struct hid_device *hdev;
> + int i;
> + unsigned k;
> + ssize_t set_result;
> +
> + /* Get the hid associated with the device */
> + hdev = container_of(dev, struct hid_device, dev);
> +
> + /* If we have an invalid pointer we'll return ENODATA */
> + if (hdev == NULL || &(hdev->dev) != dev)
> + return -ENODATA;
> +
> + i = sscanf(buf, "%u", &k);
> + if (i != 1) {
> + printk(KERN_ERR "unrecognized input: %s", buf);
> + return -1;
> + }
> +
> + set_result = g13_set_emit_msc_raw(hdev, k);
> +
> + if (set_result < 0)
> + return set_result;
> +
> + return count;
> +}
> +
> +static DEVICE_ATTR(emit_msc_raw, 0666,
> + g13_emit_msc_raw_show,
> + g13_emit_msc_raw_store);
> +
I do no see the need for this attribute, simply emit MSC_RAW always.
> +
> +/*
> + * The "keymap_switching" attribute
> + */
> +static ssize_t g13_keymap_switching_show(struct device *dev,
> + struct device_attribute *attr,
> + char *buf)
> +{
> + struct g13_data *data = dev_get_drvdata(dev);
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + return sprintf(buf, "%u\n", data->keymap_switching);
> +}
> +
> +static ssize_t g13_set_keymap_switching(struct hid_device *hdev, unsigned k)
> +{
> + struct g13_data *data = hid_get_g13data(hdev);
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + data->keymap_switching = k;
> +
> + if (data->keymap_switching)
> + g13_set_mled(hdev, 1<<(data->curkeymap));
> +
> + return 0;
> +}
> +
> +static ssize_t g13_keymap_switching_store(struct device *dev,
> + struct device_attribute *attr,
> + const char *buf, size_t count)
> +{
> + struct hid_device *hdev;
> + int i;
> + unsigned k;
> + ssize_t set_result;
> +
> + /* Get the hid associated with the device */
> + hdev = container_of(dev, struct hid_device, dev);
> +
> + /* If we have an invalid pointer we'll return ENODATA */
> + if (hdev == NULL || &(hdev->dev) != dev)
> + return -ENODATA;
> +
> + i = sscanf(buf, "%u", &k);
> + if (i != 1) {
> + printk(KERN_ERR "unrecognized input: %s", buf);
> + return -1;
> + }
> +
> + set_result = g13_set_keymap_switching(hdev, k);
> +
> + if (set_result < 0)
> + return set_result;
> +
> + return count;
> +}
> +
> +static DEVICE_ATTR(keymap_switching, 0666,
> + g13_keymap_switching_show,
> + g13_keymap_switching_store);
Hmm, attributes that are changing device state are usually 0644.
> +
> +
> +static ssize_t g13_name_show(struct device *dev,
> + struct device_attribute *attr,
> + char *buf)
> +{
> + struct g13_data *data = dev_get_drvdata(dev);
> + int result;
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + if (data->name == NULL) {
> + buf[0] = 0x00;
> + return 1;
> + }
> +
> + read_lock(&data->lock);
> + result = sprintf(buf, "%s", data->name);
> + read_unlock(&data->lock);
> +
> + return result;
> +}
> +
> +static ssize_t g13_name_store(struct device *dev,
> + struct device_attribute *attr,
> + const char *buf, size_t count)
> +{
> + struct g13_data *data = dev_get_drvdata(dev);
> + size_t limit = count;
> + char *end;
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + write_lock(&data->lock);
> +
> + if (data->name != NULL) {
> + kfree(data->name);
> + data->name = NULL;
> + }
> +
> + end = strpbrk(buf, "\n\r");
> + if (end != NULL)
> + limit = end - buf;
> +
> + if (end != buf) {
> +
> + if (limit > 100)
> + limit = 100;
> +
> + data->name = kzalloc(limit+1, GFP_KERNEL);
> +
> + strncpy(data->name, buf, limit);
> + }
> +
> + write_unlock(&data->lock);
> +
> + return count;
> +}
> +
> +static DEVICE_ATTR(name, 0666, g13_name_show, g13_name_store);
What this attribute is for?
> +
> +/*
> + * The "rgb" attribute
> + * red green blue
> + * each with values 0 - 255 (black - full intensity)
> + */
> +static ssize_t g13_rgb_show(struct device *dev,
> + struct device_attribute *attr,
> + char *buf)
> +{
> + unsigned r, g, b;
> + struct g13_data *data = dev_get_drvdata(dev);
> +
> + if (data == NULL)
> + return -ENODATA;
> +
> + r = data->rgb[0];
> + g = data->rgb[1];
> + b = data->rgb[2];
> +
> + return sprintf(buf, "%u %u %u\n", r, g, b);
> +}
> +
> +static ssize_t g13_set_rgb(struct hid_device *hdev,
> + unsigned r, unsigned g, unsigned b)
> +{
> + struct g13_data *data = hid_get_g13data(hdev);
> +
> + if (data == NULL || data->backlight_report == NULL)
> + return -ENODATA;
> +
> + data->backlight_report->field[0]->value[0] = r;
> + data->backlight_report->field[0]->value[1] = g;
> + data->backlight_report->field[0]->value[2] = b;
> + data->backlight_report->field[0]->value[3] = 0x00;
> +
> + usbhid_submit_report(hdev, data->backlight_report, USB_DIR_OUT);
> +
> + data->rgb[0] = r;
> + data->rgb[1] = g;
> + data->rgb[2] = b;
> +
> + return 0;
> +}
> +
> +static ssize_t g13_rgb_store(struct device *dev,
> + struct device_attribute *attr,
> + const char *buf, size_t count)
> +{
> + struct hid_device *hdev;
> + int i;
> + unsigned r;
> + unsigned g;
> + unsigned b;
> + ssize_t set_result;
> +
> + /* Get the hid associated with the device */
> + hdev = container_of(dev, struct hid_device, dev);
> +
> + /* If we have an invalid pointer we'll return ENODATA */
> + if (hdev == NULL || &(hdev->dev) != dev)
> + return -ENODATA;
> +
> + i = sscanf(buf, "%u %u %u", &r, &g, &b);
> + if (i != 3) {
> + printk(KERN_ERR "unrecognized input: %s", buf);
> + return -1;
> + }
> +
> + set_result = g13_set_rgb(hdev, r, g, b);
> +
> + if (set_result < 0)
> + return set_result;
> +
> + return count;
> +}
> +
> +static DEVICE_ATTR(rgb, 0666, g13_rgb_show, g13_rgb_store);
> +
> +/*
> + * Create a group of attributes so that we can create and destroy them all
> + * at once.
> + */
> +static struct attribute *g13_attrs[] = {
> + &dev_attr_name.attr,
> + &dev_attr_rgb.attr,
> + &dev_attr_mled.attr,
> + &dev_attr_keymap_index.attr,
> + &dev_attr_emit_msc_raw.attr,
> + &dev_attr_keymap_switching.attr,
> + &dev_attr_keymap.attr,
> + &dev_attr_fb_update_rate.attr,
> + &dev_attr_fb_node.attr,
> + NULL, /* need to NULL terminate the list of attributes */
> +};
> +
> +/*
> + * An unnamed attribute group will put all of the attributes directly in
> + * the kobject directory. If we specify a name, a subdirectory will be
> + * created for the attributes with the directory being the name of the
> + * attribute group.
> + */
> +static struct attribute_group g13_attr_group = {
> + .attrs = g13_attrs,
> +};
> +
> +static struct fb_deferred_io g13_fb_defio = {
> + .delay = HZ / G13FB_UPDATE_RATE_DEFAULT,
> + .deferred_io = g13_fb_deferred_io,
> +};
> +
> +static void g13_raw_event_process_input(struct hid_device *hdev,
> + struct g13_data *g13data,
> + u8 *raw_data)
> +{
> + struct input_dev *idev = g13data->input_dev;
> + unsigned int code;
> + int value;
> + int i;
> + int mask;
> + int offset;
> + u8 val;
> +
> + g13data->ready2 = 1;
> +
> + if (idev == NULL)
> + return;
> +
> + if (g13data->curkeymap < 3)
> + offset = G13_KEYS * g13data->curkeymap;
> + else
> + offset = 0;
> +
> + for (i = 0, mask = 0x01; i < 8; i++, mask <<= 1) {
> + /* Keys G1 through G8 */
> + code = g13data->keycode[i+offset];
> + value = raw_data[3] & mask;
> + if (g13data->keycode[i] != KEY_RESERVED)
> + input_report_key(idev, code, value);
> + input_event(idev, EV_MSC, MSC_SCAN, i);
That means these MSC_SCAN events are emitted _always_. Not sure if that
is too useful. If you were to detect the state change and emit MSC_SCAN
for changed keys, that would be better.
> +
> + /* Keys G9 through G16 */
> + code = g13data->keycode[i+8+offset];
> + value = raw_data[4] & mask;
> + if (g13data->keycode[i+8] != KEY_RESERVED)
> + input_report_key(idev, code, value);
> + input_event(idev, EV_MSC, MSC_SCAN, i+8);
> +
> + /* Keys G17 through G22 */
> + code = g13data->keycode[i+16+offset];
> + value = raw_data[5] & mask;
> + if (i <= 5 && g13data->keycode[i+16] != KEY_RESERVED)
> + input_report_key(idev, code, value);
> + input_event(idev, EV_MSC, MSC_SCAN, i+16);
> +
> + /* Keys FUNC through M3 */
> + code = g13data->keycode[i+22+offset];
> + value = raw_data[6] & mask;
> + if (g13data->keycode[i+22] != KEY_RESERVED)
> + input_report_key(idev, code, value);
> + input_event(idev, EV_MSC, MSC_SCAN, i+22);
> +
> + /* Keys MR through LIGHT */
> + code = g13data->keycode[i+30+offset];
> + value = raw_data[7] & mask;
> + if (i <= 4 && g13data->keycode[i+30] != KEY_RESERVED)
> + input_report_key(idev, code, value);
> + input_event(idev, EV_MSC, MSC_SCAN, i+30);
> + }
> +
> + if (g13data->emit_msc_raw) {
> + /*
> + * Outputs an MSC_RAW value with the low four
> + * bits = M1-MR, Low bit = M1
> + */
> + val = raw_data[6] >> 5;
> + val |= (raw_data[7] & 0x01 << 3);
> + input_event(idev, EV_MSC, MSC_RAW, val);
> + }
> +
> + if (g13data->keymap_switching) {
> + if (raw_data[6] & 0x20) {
> + g13data->curkeymap = 0;
> + g13_set_mled(hdev, 0x01);
> + } else if (raw_data[6] & 0x40) {
> + g13data->curkeymap = 1;
> + g13_set_mled(hdev, 0x02);
> + } else if (raw_data[6] & 0x80) {
> + g13data->curkeymap = 2;
> + g13_set_mled(hdev, 0x04);
> + }
> + }
> +
> + input_report_abs(idev, ABS_X, raw_data[1]);
> + input_report_abs(idev, ABS_Y, raw_data[2]);
> + input_sync(idev);
> +}
> +
> +static int g13_raw_event(struct hid_device *hdev,
> + struct hid_report *report,
> + u8 *raw_data, int size)
> +{
> + /*
> + * On initialization receive a 258 byte message with
> + * data = 6 0 255 255 255 255 255 255 255 255 ...
> + */
> + struct g13_data *g13data;
> + g13data = dev_get_drvdata(&hdev->dev);
> +
> + if (g13data == NULL)
> + return 1;
> +
> + switch (report->id) {
> + case 6:
> + g13data->ready = 1;
> + break;
> + case 1:
> + g13_raw_event_process_input(hdev, g13data, raw_data);
> + break;
> + default:
> + return 0;
> + }
> +
> + return 1;
> +}
> +
> +static void g13_initialize_keymap(struct g13_data *data)
> +{
> + int i;
> +
> + write_lock(&data->lock);
Why do you take this lock? What else could be accessing the structure at
this point?
> +
> + for (i = 0; i < G13_KEYS; i++) {
> + data->keycode[i] = g13_default_key_map[i];
> + set_bit(data->keycode[i], data->input_dev->keybit);
> + }
> +
> + clear_bit(0, data->input_dev->keybit);
Use KEY_RESERVED instead of 0 so readers know what is going on. Also no
need to use locked variants, __set_bit and __clear_bit should suffice.
> +
> + write_unlock(&data->lock);
> +
> +}
> +
> +static int g13_probe(struct hid_device *hdev,
> + const struct hid_device_id *id)
> +{
> + int error;
> + struct g13_data *data;
> + int i;
> + struct list_head *feature_report_list =
> + &hdev->report_enum[HID_FEATURE_REPORT].report_list;
> + struct hid_report *report;
> +
> + dev_dbg(&hdev->dev, "Logitech G13 HID hardware probe...");
> +
> + /*
> + * Let's allocate the g13 data structure, set some reasonable
> + * defaults, and associate it with the device
> + */
> + data = kzalloc(sizeof(struct g13_data), GFP_KERNEL);
> + if (data == NULL) {
> + dev_err(&hdev->dev, "can't allocate space for Logitech G13 device attributes\n");
> + error = -ENOMEM;
> + goto err_no_cleanup;
> + }
> +
> + rwlock_init(&data->lock);
rwlock is usually slower than spinlock... There is a handful of places
where use of rwlock is warranted.
> +
> + data->hdev = hdev;
> +
> + data->fb_bitmap = vmalloc(G13FB_SIZE);
> + if (data->fb_bitmap == NULL) {
> + dev_err(&hdev->dev, G13_NAME ": ERROR: can't get a free page for framebuffer\n");
> + error = -ENOMEM;
> + goto err_cleanup_data;
> + }
> + memcpy(data->fb_bitmap, g13_lcd_bits, G13FB_SIZE);
> +
> + data->fb_vbitmap = kmalloc(sizeof(u8) * G13_VBITMAP_SIZE, GFP_KERNEL);
> + if (data->fb_vbitmap == NULL) {
> + dev_err(&hdev->dev, G13_NAME ": ERROR: can't alloc vbitmap image buffer\n");
> + error = -ENOMEM;
> + goto err_cleanup_fb_bitmap;
> + }
> +
> + hid_set_drvdata(hdev, data);
> +
> + dbg_hid("Preparing to parse " G13_NAME " hid reports\n");
> +
> + /* Parse the device reports and start it up */
> + error = hid_parse(hdev);
> + if (error) {
> + dev_err(&hdev->dev, G13_NAME " device report parse failed\n");
> + error = -EINVAL;
> + goto err_cleanup_fb_vbitmap;
> + }
> +
> + mdelay(10);
Why is this needed?
> +
> + error = hid_hw_start(hdev, HID_CONNECT_DEFAULT | HID_CONNECT_HIDINPUT_FORCE);
> + if (error) {
> + dev_err(&hdev->dev, G13_NAME " hardware start failed\n");
> + error = -EINVAL;
> + goto err_cleanup_fb_vbitmap;
> + }
> +
> + dbg_hid(G13_NAME " claimed: %d\n", hdev->claimed);
> +
> + error = hdev->ll_driver->open(hdev);
> + if (error) {
> + dev_err(&hdev->dev, G13_NAME " failed to open input interrupt pipe for key and joystick events\n");
> + error = -EINVAL;
> + goto err_cleanup_fb_vbitmap;
> + }
> +
> + /* Set up the input device for the key I/O */
> + data->input_dev = input_allocate_device();
> + if (data->input_dev == NULL) {
> + dev_err(&hdev->dev, G13_NAME " error initializing the input device");
> + error = -ENOMEM;
> + goto err_cleanup_fb_vbitmap;
> + }
> +
> + input_set_drvdata(data->input_dev, hdev);
> +
> + data->input_dev->name = G13_NAME;
> + data->input_dev->phys = hdev->phys;
> + data->input_dev->uniq = hdev->uniq;
> + data->input_dev->id.bustype = hdev->bus;
> + data->input_dev->id.vendor = hdev->vendor;
> + data->input_dev->id.product = hdev->product;
> + data->input_dev->id.version = hdev->version;
> + data->input_dev->dev.parent = hdev->dev.parent;
> + data->input_dev->keycode = data->keycode;
> + data->input_dev->keycodemax = G13_KEYMAP_SIZE;
> + data->input_dev->keycodesize = sizeof(u32);
> + data->input_dev->setkeycode = g13_input_setkeycode;
> + data->input_dev->getkeycode = g13_input_getkeycode;
> +
> + input_set_capability(data->input_dev, EV_ABS, ABS_X);
> + input_set_capability(data->input_dev, EV_ABS, ABS_Y);
> + input_set_capability(data->input_dev, EV_MSC, MSC_SCAN);
> + input_set_capability(data->input_dev, EV_KEY, KEY_UNKNOWN);
> + data->input_dev->evbit[0] |= BIT_MASK(EV_REP);
> +
> + /* 4 center values */
> + input_set_abs_params(data->input_dev, ABS_X, 0, 0xff, 0, 4);
> + input_set_abs_params(data->input_dev, ABS_Y, 0, 0xff, 0, 4);
> +
> + g13_initialize_keymap(data);
> +
> + error = input_register_device(data->input_dev);
> + if (error) {
> + dev_err(&hdev->dev, G13_NAME " error registering the input device");
> + error = -EINVAL;
> + goto err_cleanup_input_dev;
> + }
> +
> + /* Set up the framebuffer device */
> + data->fb_update_rate = G13FB_UPDATE_RATE_DEFAULT;
> + data->fb_info = framebuffer_alloc(0, &hdev->dev);
> + if (data->fb_info == NULL) {
> + dev_err(&hdev->dev, G13_NAME " failed to allocate a framebuffer\n");
> + goto err_cleanup_input_dev;
> + }
> +
> + dbg_hid(KERN_INFO G13_NAME " allocated framebuffer\n");
> +
> + data->fb_defio = g13_fb_defio;
> + data->fb_info->fbdefio = &data->fb_defio;
> +
> + dbg_hid(KERN_INFO G13_NAME " allocated deferred IO structure\n");
> +
> + data->fb_info->screen_base = (char __force __iomem *) data->fb_bitmap;
> + data->fb_info->fbops = &g13fb_ops;
> + data->fb_info->var = g13fb_var;
> + data->fb_info->fix = g13fb_fix;
> + data->fb_info->fix.smem_len = G13FB_SIZE;
> + data->fb_info->par = data;
> + data->fb_info->flags = FBINFO_FLAG_DEFAULT;
> +
> + fb_deferred_io_init(data->fb_info);
> +
> + if (register_framebuffer(data->fb_info) < 0)
> + goto err_cleanup_fb;
> +
> + /* Add the sysfs attributes */
> + error = sysfs_create_group(&(hdev->dev.kobj), &g13_attr_group);
> + if (error) {
> + dev_err(&hdev->dev, "Logitech G13 failed to create sysfs group attributes\n");
> + goto err_cleanup_fb;
> + }
> +
> + dbg_hid("Waiting for G13 to activate\n");
> +
> + if (list_empty(feature_report_list)) {
> + dev_err(&hdev->dev, "no feature report found\n");
> + error = -ENODEV;
> + goto err_cleanup_fb;
> + }
> + dbg_hid("G13 feature report found\n");
> +
> + list_for_each_entry(report, feature_report_list, list) {
> + switch (report->id) {
> + case 0x04:
> + data->report_4 = report;
> + break;
> + case 0x05:
> + data->mled_report = report;
> + break;
> + case 0x06:
> + data->start_input_report = report;
> + break;
> + case 0x07:
> + data->backlight_report = report;
> + break;
> + default:
> + break;
> + }
> + dbg_hid("G13 Feature report: id=%u type=%u size=%u maxfield=%u report_count=%u\n",
> + report->id, report->type, report->size,
> + report->maxfield, report->field[0]->report_count);
> + }
> +
> + dbg_hid("Found all reports\n");
> +
> + for (i = 0; i < 20; i++) {
> + if (data->ready && data->ready2)
> + break;
> + mdelay(10);
> + }
Consider using completion?
> +
> + if (!(data->ready && data->ready2))
> + printk(KERN_ERR "G13 hasn't responded yet, forging ahead with initialization\n");
> + else
> + dbg_hid("G13 initialized\n");
> +
> + /*
> + * Set the initial color and load the linux logo
> + * We're going to ignore the error values. If there is an error at this
> + * point we'll forge ahead.
> + */
> +
> + dbg_hid("Set default color\n");
> +
> + error = g13_set_rgb(hdev, G13_DEFAULT_RED, G13_DEFAULT_GREEN, G13_DEFAULT_BLUE);
And...?
> +
> + usbhid_submit_report(hdev, data->start_input_report, USB_DIR_IN);
> +
> + g13_fb_update(data);
> +
> + dbg_hid("G13 activated and initialized\n");
> +
> + /* Everything went well */
> + return 0;
> +
> +err_cleanup_fb:
> + framebuffer_release(data->fb_info);
input device was registered here so you need to unregister it (and
suppress call to input_free_device below).
> +
> +err_cleanup_input_dev:
> + input_free_device(data->input_dev);
> +
> +err_cleanup_fb_vbitmap:
> + kfree(data->fb_vbitmap);
> +
> +err_cleanup_fb_bitmap:
> + vfree(data->fb_bitmap);
> +
> +err_cleanup_data:
> + /* Make sure we clean up the allocated data structure */
> + kfree(data);
> +
> +err_no_cleanup:
> +
> + hid_set_drvdata(hdev, NULL);
> +
I do not see sysfs group being destroyed.
> + return error;
> +}
> +
> +static void g13_remove(struct hid_device *hdev)
> +{
> + struct g13_data *data;
> +
> + hdev->ll_driver->close(hdev);
> +
> + hid_hw_stop(hdev);
> +
> + /* Get the internal g13 data buffer */
> + data = hid_get_drvdata(hdev);
> +
> + /* Clean up the buffer */
> + if (data != NULL) {
Can it ever be NULL?
> + write_lock(&data->lock);
Why?
> + input_unregister_device(data->input_dev);
> + kfree(data->name);
> + write_unlock(&data->lock);
> + if (data->fb_info != NULL) {
> + fb_deferred_io_cleanup(data->fb_info);
> + unregister_framebuffer(data->fb_info);
> + framebuffer_release(data->fb_info);
> + }
> + vfree(data->fb_bitmap);
> + kfree(data->fb_vbitmap);
> + kfree(data);
> + }
> +
I do not see sysfs group being destroyed.
> +}
> +
> +static const struct hid_device_id g13_devices[] = {
> + { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_G13)
> + },
> + { }
> +};
> +MODULE_DEVICE_TABLE(hid, g13_devices);
> +
> +static struct hid_driver g13_driver = {
> + .name = "hid-g13",
> + .id_table = g13_devices,
> + .probe = g13_probe,
> + .remove = g13_remove,
> + .raw_event = g13_raw_event,
> +};
> +
> +static int __init g13_init(void)
> +{
> + return hid_register_driver(&g13_driver);
> +}
> +
> +static void __exit g13_exit(void)
> +{
> + hid_unregister_driver(&g13_driver);
> +}
> +
> +module_init(g13_init);
> +module_exit(g13_exit);
> +MODULE_DESCRIPTION("Logitech G13 HID Driver");
> +MODULE_AUTHOR("Rick L Vinyard Jr (rvinyard@xxxxxxxxxxx)");
> +MODULE_LICENSE("GPL");
> diff --git a/drivers/hid/hid-ids.h b/drivers/hid/hid-ids.h
> index 3839340..f3e27d3 100644
> --- a/drivers/hid/hid-ids.h
> +++ b/drivers/hid/hid-ids.h
> @@ -295,6 +295,7 @@
> #define USB_DEVICE_ID_LOGITECH_EXTREME_3D 0xc215
> #define USB_DEVICE_ID_LOGITECH_RUMBLEPAD2 0xc218
> #define USB_DEVICE_ID_LOGITECH_RUMBLEPAD2_2 0xc219
> +#define USB_DEVICE_ID_LOGITECH_G13 0xc21c
> #define USB_DEVICE_ID_LOGITECH_WINGMAN_F3D 0xc283
> #define USB_DEVICE_ID_LOGITECH_FORCE3D_PRO 0xc286
> #define USB_DEVICE_ID_LOGITECH_WHEEL 0xc294
Thanks.
--
Dmitry
--
To unsubscribe from this list: send the line "unsubscribe linux-input" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
