linux-imx

/*

 * Helpers for matrix keyboard bindings

 *

 * Copyright (C) 2012 Google, Inc

 *

 * Author:

 *  Olof Johansson <olof@lixom.net>

 *

 * This software is licensed under the terms of the GNU General Public

 * License version 2, as published by the Free Software Foundation, and

 * may be copied, distributed, and modified under those terms.

 *

 * This program 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.

 */

​

#include <linux/device.h>

#include <linux/export.h>

#include <linux/gfp.h>

#include <linux/input.h>

#include <linux/input/matrix_keypad.h>

#include <linux/kernel.h>

#include <linux/module.h>

#include <linux/property.h>

#include <linux/slab.h>

#include <linux/types.h>

​

static bool matrix_keypad_map_key(struct input_dev *input_dev,

                  unsigned int rows, unsigned int cols,

                  unsigned int row_shift, unsigned int key)

{

    unsigned short *keymap = input_dev->keycode;

    unsigned int row = KEY_ROW(key);

    unsigned int col = KEY_COL(key);

    unsigned short code = KEY_VAL(key);

​

    if (row >= rows || col >= cols) {

        dev_err(input_dev->dev.parent,

            "%s: invalid keymap entry 0x%x (row: %d, col: %d, rows: %d, cols: %d)\n",

            __func__, key, row, col, rows, cols);

        return false;

    }

​

    keymap[MATRIX_SCAN_CODE(row, col, row_shift)] = code;

    __set_bit(code, input_dev->keybit);

​

    return true;

}

​

/**

 * matrix_keypad_parse_properties() - Read properties of matrix keypad

 *

 * @dev: Device containing properties

 * @rows: Returns number of matrix rows

 * @cols: Returns number of matrix columns

 * @return 0 if OK, <0 on error

 */

int matrix_keypad_parse_properties(struct device *dev,

                   unsigned int *rows, unsigned int *cols)

{

    *rows = *cols = 0;

​

    device_property_read_u32(dev, "keypad,num-rows", rows);

    device_property_read_u32(dev, "keypad,num-columns", cols);

​

    if (!*rows || !*cols) {

        dev_err(dev, "number of keypad rows/columns not specified\n");

        return -EINVAL;

    }

​

    return 0;

}

EXPORT_SYMBOL_GPL(matrix_keypad_parse_properties);

​

static int matrix_keypad_parse_keymap(const char *propname,

                      unsigned int rows, unsigned int cols,

                      struct input_dev *input_dev)

{

    struct device *dev = input_dev->dev.parent;

    unsigned int row_shift = get_count_order(cols);

    unsigned int max_keys = rows << row_shift;

    u32 *keys;

    int i;

    int size;

    int retval;

​

    if (!propname)

        propname = "linux,keymap";

​

    size = device_property_read_u32_array(dev, propname, NULL, 0);