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
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
|
/*
* Google LWIS Misc Utility Functions and Wrappers
*
* Copyright (c) 2018 Google, LLC
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation.
*/
#define pr_fmt(fmt) KBUILD_MODNAME "-util: " fmt
#include <linux/slab.h>
#include <uapi/linux/sched/types.h>
#include "lwis_util.h"
#include "lwis_device.h"
int lwis_device_single_register_write(struct lwis_device *lwis_dev, int bid, uint64_t offset,
uint64_t value, int access_size)
{
int ret = 0;
struct lwis_io_entry entry = {};
if (!lwis_dev) {
pr_err("lwis_device_single_register_write: lwis_dev is NULL\n");
return -ENODEV;
}
if (lwis_dev->vops.register_io == NULL) {
dev_err(lwis_dev->dev,
"lwis_device_single_register_write: register_io undefined\n");
return -EINVAL;
}
entry.type = LWIS_IO_ENTRY_WRITE;
entry.rw.offset = offset;
entry.rw.val = value;
entry.rw.bid = bid;
if (lwis_dev->vops.register_io_barrier) {
lwis_dev->vops.register_io_barrier(lwis_dev, /*use_read_barrier=*/false,
/*use_write_barrier=*/true);
}
ret = lwis_dev->vops.register_io(lwis_dev, &entry, access_size);
if (ret) {
dev_err(lwis_dev->dev,
"Register write bid %d offset 0x%llx value 0x%llx failed: %d", bid, offset,
value, ret);
}
return ret;
}
int lwis_device_single_register_read(struct lwis_device *lwis_dev, int bid, uint64_t offset,
uint64_t *value, int access_size)
{
int ret = -EINVAL;
struct lwis_io_entry entry = {};
if (!lwis_dev) {
pr_err("lwis_device_single_register_read: lwis_dev is NULL\n");
return -ENODEV;
}
if (lwis_dev->vops.register_io == NULL) {
dev_err(lwis_dev->dev, "lwis_device_single_register_read: register_io undefined\n");
return -EINVAL;
}
entry.type = LWIS_IO_ENTRY_READ;
entry.rw.offset = offset;
entry.rw.bid = bid;
ret = lwis_dev->vops.register_io(lwis_dev, &entry, access_size);
if (lwis_dev->vops.register_io_barrier) {
lwis_dev->vops.register_io_barrier(lwis_dev, /*use_read_barrier=*/true,
/*use_write_barrier=*/false);
}
if (!ret && value) {
*value = entry.rw.val;
}
return ret;
}
const char *lwis_device_type_to_string(int32_t type)
{
switch (type) {
case DEVICE_TYPE_TOP:
return "TOP";
case DEVICE_TYPE_I2C:
return "I2C";
case DEVICE_TYPE_IOREG:
return "IOREG";
case DEVICE_TYPE_SLC:
return "SLC";
case DEVICE_TYPE_TEST:
return "TEST";
case DEVICE_TYPE_UNKNOWN:
default:
return "UNKNOWN";
}
}
const char *trigger_condition_node_operator_to_string(int32_t type)
{
switch (type) {
case LWIS_TRIGGER_NODE_OPERATOR_AND:
return "AND";
case LWIS_TRIGGER_NODE_OPERATOR_OR:
return "OR";
case LWIS_TRIGGER_NODE_OPERATOR_NONE:
default:
return "NONE";
}
}
int lwis_create_kthread_workers(struct lwis_device *lwis_dev)
{
char t_name[LWIS_MAX_NAME_STRING_LEN];
if (!lwis_dev) {
pr_err("lwis_create_kthread_workers: lwis_dev is NULL\n");
return -ENODEV;
}
scnprintf(t_name, LWIS_MAX_NAME_STRING_LEN, "lwis_t_%s", lwis_dev->name);
kthread_init_worker(&lwis_dev->transaction_worker);
lwis_dev->transaction_worker_thread =
kthread_run(kthread_worker_fn, &lwis_dev->transaction_worker, t_name);
if (IS_ERR_OR_NULL(lwis_dev->transaction_worker_thread)) {
dev_err(lwis_dev->dev, "transaction kthread_run failed\n");
return -EINVAL;
}
return 0;
}
int lwis_set_kthread_priority(struct lwis_device *lwis_dev, struct task_struct *task, u32 priority)
{
int policy;
struct sched_param param;
int ret;
if (priority >= MAX_PRIO) {
dev_err(lwis_dev->dev, "transaction_thread_priority(%d) >= Max(%d)", priority,
MAX_PRIO);
return -EINVAL;
}
if (priority < MAX_RT_PRIO) {
policy = SCHED_FIFO;
param.sched_priority = MAX_RT_PRIO - priority;
} else {
policy = SCHED_NORMAL;
param.sched_priority = 0;
task->prio = priority;
task->static_prio = priority;
task->normal_prio = priority;
}
ret = sched_setscheduler(task, policy, ¶m);
if (ret) {
dev_err(lwis_dev->dev, "Failed to set kthread priority (%d)", ret);
return ret;
}
return 0;
}
|
