1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
|
/* Copyright 2022 The ChromiumOS Authors
* Use of this source code is governed by a BSD-style license that can be
* found in the LICENSE file.
*/
#define DT_DRV_COMPAT cros_ec_kb_raw_emul
#include <zephyr/logging/log.h>
LOG_MODULE_REGISTER(emul_kb_raw);
#include <zephyr/device.h>
#include <zephyr/drivers/emul.h>
#include <drivers/cros_kb_raw.h>
#include <keyboard_raw.h>
struct kb_raw_emul_data {
int active_column;
int *matrix;
};
struct kb_raw_emul_cfg {
/** Label of the I2C device being emulated */
const char *dev_label;
/** Pointer to run-time data */
struct kb_raw_emul_data *data;
/** Number of emulated keyboard rows. */
int rows;
/** Number of emulated keyboard columns. */
int cols;
};
/**
* @brief Set up a new kn_raw emulator
*
* @param device Device node.
*
* @return 0 indicating success (always)
*/
static int kb_raw_emul_init(const struct device *dev)
{
const struct kb_raw_emul_cfg *cfg = dev->config;
struct kb_raw_emul_data *data = dev->data;
memset(data->matrix, 0, sizeof(int) * cfg->cols);
return 0;
}
static int emul_kb_raw_init(const struct device *dev)
{
ARG_UNUSED(dev);
return 0;
}
static int emul_kb_raw_enable_interrupt(const struct device *dev, int enable)
{
ARG_UNUSED(dev);
ARG_UNUSED(enable);
return 0;
}
static int emul_kb_raw_read_rows(const struct device *dev)
{
struct kb_raw_emul_data *data = dev->data;
if (data->active_column == KEYBOARD_COLUMN_ALL)
return 0;
if (data->active_column == KEYBOARD_COLUMN_NONE)
return 0;
return data->matrix[data->active_column];
}
static int emul_kb_raw_drive_column(const struct device *dev, int col)
{
const struct kb_raw_emul_cfg *cfg = dev->config;
struct kb_raw_emul_data *data = dev->data;
if (col >= cfg->cols)
return -EINVAL;
data->active_column = col;
return 0;
}
int emul_kb_raw_set_kbstate(const struct device *dev, uint8_t row, uint8_t col,
int pressed)
{
const struct kb_raw_emul_cfg *cfg = dev->config;
struct kb_raw_emul_data *data = dev->data;
if (col >= cfg->cols || row >= cfg->rows)
return -EINVAL;
if (pressed)
data->matrix[col] |= 1 << row;
else
data->matrix[col] &= ~(1 << row);
return 0;
}
void emul_kb_raw_reset(const struct device *dev)
{
const struct kb_raw_emul_cfg *cfg = dev->config;
struct kb_raw_emul_data *data = dev->data;
for (int col = 0; col < cfg->cols; col++) {
data->matrix[col] = 0;
}
}
static const struct cros_kb_raw_driver_api emul_kb_raw_driver_api = {
.init = emul_kb_raw_init,
.drive_colum = emul_kb_raw_drive_column,
.read_rows = emul_kb_raw_read_rows,
.enable_interrupt = emul_kb_raw_enable_interrupt,
};
#define KB_RAW_EMUL(n) \
static int kb_raw_emul_matrix_##n[DT_INST_PROP(n, cols)]; \
static struct kb_raw_emul_data kb_raw_emul_data_##n = { \
.matrix = kb_raw_emul_matrix_##n, \
}; \
\
static const struct kb_raw_emul_cfg kb_raw_emul_cfg_##n = { \
.dev_label = DT_NODE_FULL_NAME(DT_DRV_INST(n)), \
.data = &kb_raw_emul_data_##n, \
.rows = DT_INST_PROP(n, rows), \
.cols = DT_INST_PROP(n, cols), \
}; \
DEVICE_DT_INST_DEFINE(n, kb_raw_emul_init, NULL, \
&kb_raw_emul_data_##n, &kb_raw_emul_cfg_##n, \
PRE_KERNEL_1, \
CONFIG_KERNEL_INIT_PRIORITY_DEFAULT, \
&emul_kb_raw_driver_api)
DT_INST_FOREACH_STATUS_OKAY(KB_RAW_EMUL);
|
