1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/module.h>
15#include <linux/init.h>
16#include <linux/interrupt.h>
17#include <linux/miscdevice.h>
18#include <linux/fs.h>
19#include <linux/proc_fs.h>
20#include <linux/seq_file.h>
21#include <linux/compat.h>
22#include <linux/slab.h>
23#include <linux/atomic.h>
24#include <linux/uaccess.h>
25#include <linux/hw_random.h>
26#include <linux/debugfs.h>
27#include <asm/debug.h>
28
29#include "zcrypt_debug.h"
30#include "zcrypt_api.h"
31
32#include "zcrypt_msgtype6.h"
33#include "zcrypt_msgtype50.h"
34
35
36
37
38
39static ssize_t online_show(struct device *dev,
40 struct device_attribute *attr,
41 char *buf)
42{
43 struct zcrypt_queue *zq = to_ap_queue(dev)->private;
44
45 return snprintf(buf, PAGE_SIZE, "%d\n", zq->online);
46}
47
48static ssize_t online_store(struct device *dev,
49 struct device_attribute *attr,
50 const char *buf, size_t count)
51{
52 struct zcrypt_queue *zq = to_ap_queue(dev)->private;
53 struct zcrypt_card *zc = zq->zcard;
54 int online;
55
56 if (sscanf(buf, "%d\n", &online) != 1 || online < 0 || online > 1)
57 return -EINVAL;
58
59 if (online && !zc->online)
60 return -EINVAL;
61 zq->online = online;
62
63 ZCRYPT_DBF(DBF_INFO, "queue=%02x.%04x online=%d\n",
64 AP_QID_CARD(zq->queue->qid),
65 AP_QID_QUEUE(zq->queue->qid),
66 online);
67
68 if (!online)
69 ap_flush_queue(zq->queue);
70 return count;
71}
72
73static DEVICE_ATTR_RW(online);
74
75static ssize_t load_show(struct device *dev,
76 struct device_attribute *attr,
77 char *buf)
78{
79 struct zcrypt_queue *zq = to_ap_queue(dev)->private;
80
81 return snprintf(buf, PAGE_SIZE, "%d\n", atomic_read(&zq->load));
82}
83
84static DEVICE_ATTR_RO(load);
85
86static struct attribute *zcrypt_queue_attrs[] = {
87 &dev_attr_online.attr,
88 &dev_attr_load.attr,
89 NULL,
90};
91
92static const struct attribute_group zcrypt_queue_attr_group = {
93 .attrs = zcrypt_queue_attrs,
94};
95
96void zcrypt_queue_force_online(struct zcrypt_queue *zq, int online)
97{
98 zq->online = online;
99 if (!online)
100 ap_flush_queue(zq->queue);
101}
102
103struct zcrypt_queue *zcrypt_queue_alloc(size_t max_response_size)
104{
105 struct zcrypt_queue *zq;
106
107 zq = kzalloc(sizeof(struct zcrypt_queue), GFP_KERNEL);
108 if (!zq)
109 return NULL;
110 zq->reply.message = kmalloc(max_response_size, GFP_KERNEL);
111 if (!zq->reply.message)
112 goto out_free;
113 zq->reply.length = max_response_size;
114 INIT_LIST_HEAD(&zq->list);
115 kref_init(&zq->refcount);
116 return zq;
117
118out_free:
119 kfree(zq);
120 return NULL;
121}
122EXPORT_SYMBOL(zcrypt_queue_alloc);
123
124void zcrypt_queue_free(struct zcrypt_queue *zq)
125{
126 kfree(zq->reply.message);
127 kfree(zq);
128}
129EXPORT_SYMBOL(zcrypt_queue_free);
130
131static void zcrypt_queue_release(struct kref *kref)
132{
133 struct zcrypt_queue *zq =
134 container_of(kref, struct zcrypt_queue, refcount);
135 zcrypt_queue_free(zq);
136}
137
138void zcrypt_queue_get(struct zcrypt_queue *zq)
139{
140 kref_get(&zq->refcount);
141}
142EXPORT_SYMBOL(zcrypt_queue_get);
143
144int zcrypt_queue_put(struct zcrypt_queue *zq)
145{
146 return kref_put(&zq->refcount, zcrypt_queue_release);
147}
148EXPORT_SYMBOL(zcrypt_queue_put);
149
150
151
152
153
154
155
156int zcrypt_queue_register(struct zcrypt_queue *zq)
157{
158 struct zcrypt_card *zc;
159 int rc;
160
161 spin_lock(&zcrypt_list_lock);
162 zc = zq->queue->card->private;
163 zcrypt_card_get(zc);
164 zq->zcard = zc;
165 zq->online = 1;
166
167 ZCRYPT_DBF(DBF_INFO, "queue=%02x.%04x register online=1\n",
168 AP_QID_CARD(zq->queue->qid), AP_QID_QUEUE(zq->queue->qid));
169
170 list_add_tail(&zq->list, &zc->zqueues);
171 zcrypt_device_count++;
172 spin_unlock(&zcrypt_list_lock);
173
174 rc = sysfs_create_group(&zq->queue->ap_dev.device.kobj,
175 &zcrypt_queue_attr_group);
176 if (rc)
177 goto out;
178 get_device(&zq->queue->ap_dev.device);
179
180 if (zq->ops->rng) {
181 rc = zcrypt_rng_device_add();
182 if (rc)
183 goto out_unregister;
184 }
185 return 0;
186
187out_unregister:
188 sysfs_remove_group(&zq->queue->ap_dev.device.kobj,
189 &zcrypt_queue_attr_group);
190 put_device(&zq->queue->ap_dev.device);
191out:
192 spin_lock(&zcrypt_list_lock);
193 list_del_init(&zq->list);
194 spin_unlock(&zcrypt_list_lock);
195 zcrypt_card_put(zc);
196 return rc;
197}
198EXPORT_SYMBOL(zcrypt_queue_register);
199
200
201
202
203
204
205
206void zcrypt_queue_unregister(struct zcrypt_queue *zq)
207{
208 struct zcrypt_card *zc;
209
210 ZCRYPT_DBF(DBF_INFO, "queue=%02x.%04x unregister\n",
211 AP_QID_CARD(zq->queue->qid), AP_QID_QUEUE(zq->queue->qid));
212
213 zc = zq->zcard;
214 spin_lock(&zcrypt_list_lock);
215 list_del_init(&zq->list);
216 zcrypt_device_count--;
217 spin_unlock(&zcrypt_list_lock);
218 zcrypt_card_put(zc);
219 if (zq->ops->rng)
220 zcrypt_rng_device_remove();
221 sysfs_remove_group(&zq->queue->ap_dev.device.kobj,
222 &zcrypt_queue_attr_group);
223 put_device(&zq->queue->ap_dev.device);
224 zcrypt_queue_put(zq);
225}
226EXPORT_SYMBOL(zcrypt_queue_unregister);
227