Linux kernel mirror (for testing)
git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
tjh.dev
kernel
os
linux
1/*
2 * Helpers for open firmware matrix keyboard bindings
3 *
4 * Copyright (C) 2012 Google, Inc
5 *
6 * Author:
7 * Olof Johansson <olof@lixom.net>
8 *
9 * This software is licensed under the terms of the GNU General Public
10 * License version 2, as published by the Free Software Foundation, and
11 * may be copied, distributed, and modified under those terms.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 */
19
20#include <linux/kernel.h>
21#include <linux/types.h>
22#include <linux/input.h>
23#include <linux/of.h>
24#include <linux/input/matrix_keypad.h>
25#include <linux/export.h>
26#include <linux/gfp.h>
27#include <linux/slab.h>
28
29struct matrix_keymap_data *
30matrix_keyboard_of_fill_keymap(struct device_node *np,
31 const char *propname)
32{
33 struct matrix_keymap_data *kd;
34 u32 *keymap;
35 int proplen, i;
36 const __be32 *prop;
37
38 if (!np)
39 return NULL;
40
41 if (!propname)
42 propname = "linux,keymap";
43
44 prop = of_get_property(np, propname, &proplen);
45 if (!prop)
46 return NULL;
47
48 if (proplen % sizeof(u32)) {
49 pr_warn("Malformed keymap property %s in %s\n",
50 propname, np->full_name);
51 return NULL;
52 }
53
54 kd = kzalloc(sizeof(*kd), GFP_KERNEL);
55 if (!kd)
56 return NULL;
57
58 kd->keymap = keymap = kzalloc(proplen, GFP_KERNEL);
59 if (!kd->keymap) {
60 kfree(kd);
61 return NULL;
62 }
63
64 kd->keymap_size = proplen / sizeof(u32);
65
66 for (i = 0; i < kd->keymap_size; i++) {
67 u32 tmp = be32_to_cpup(prop + i);
68 int key_code, row, col;
69
70 row = (tmp >> 24) & 0xff;
71 col = (tmp >> 16) & 0xff;
72 key_code = tmp & 0xffff;
73 keymap[i] = KEY(row, col, key_code);
74 }
75
76 return kd;
77}
78EXPORT_SYMBOL_GPL(matrix_keyboard_of_fill_keymap);
79
80void matrix_keyboard_of_free_keymap(const struct matrix_keymap_data *kd)
81{
82 if (kd) {
83 kfree(kd->keymap);
84 kfree(kd);
85 }
86}
87EXPORT_SYMBOL_GPL(matrix_keyboard_of_free_keymap);