1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0+
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright IBM Corp. 2001, 2018
4*4882a593Smuzhiyun * Author(s): Robert Burroughs
5*4882a593Smuzhiyun * Eric Rossman (edrossma@us.ibm.com)
6*4882a593Smuzhiyun *
7*4882a593Smuzhiyun * Hotplug & misc device support: Jochen Roehrig (roehrig@de.ibm.com)
8*4882a593Smuzhiyun * Major cleanup & driver split: Martin Schwidefsky <schwidefsky@de.ibm.com>
9*4882a593Smuzhiyun * Ralph Wuerthner <rwuerthn@de.ibm.com>
10*4882a593Smuzhiyun * MSGTYPE restruct: Holger Dengler <hd@linux.vnet.ibm.com>
11*4882a593Smuzhiyun */
12*4882a593Smuzhiyun
13*4882a593Smuzhiyun #include <linux/module.h>
14*4882a593Smuzhiyun #include <linux/init.h>
15*4882a593Smuzhiyun #include <linux/err.h>
16*4882a593Smuzhiyun #include <linux/delay.h>
17*4882a593Smuzhiyun #include <linux/slab.h>
18*4882a593Smuzhiyun #include <linux/atomic.h>
19*4882a593Smuzhiyun #include <linux/uaccess.h>
20*4882a593Smuzhiyun #include <linux/mod_devicetable.h>
21*4882a593Smuzhiyun
22*4882a593Smuzhiyun #include "ap_bus.h"
23*4882a593Smuzhiyun #include "zcrypt_api.h"
24*4882a593Smuzhiyun #include "zcrypt_error.h"
25*4882a593Smuzhiyun #include "zcrypt_msgtype6.h"
26*4882a593Smuzhiyun #include "zcrypt_cex2c.h"
27*4882a593Smuzhiyun #include "zcrypt_cca_key.h"
28*4882a593Smuzhiyun #include "zcrypt_ccamisc.h"
29*4882a593Smuzhiyun
30*4882a593Smuzhiyun #define CEX2C_MIN_MOD_SIZE 16 /* 128 bits */
31*4882a593Smuzhiyun #define CEX2C_MAX_MOD_SIZE 256 /* 2048 bits */
32*4882a593Smuzhiyun #define CEX3C_MIN_MOD_SIZE 16 /* 128 bits */
33*4882a593Smuzhiyun #define CEX3C_MAX_MOD_SIZE 512 /* 4096 bits */
34*4882a593Smuzhiyun #define CEX2C_MAX_XCRB_MESSAGE_SIZE (12*1024)
35*4882a593Smuzhiyun #define CEX2C_CLEANUP_TIME (15*HZ)
36*4882a593Smuzhiyun
37*4882a593Smuzhiyun MODULE_AUTHOR("IBM Corporation");
38*4882a593Smuzhiyun MODULE_DESCRIPTION("CEX2C/CEX3C Cryptographic Coprocessor device driver, " \
39*4882a593Smuzhiyun "Copyright IBM Corp. 2001, 2018");
40*4882a593Smuzhiyun MODULE_LICENSE("GPL");
41*4882a593Smuzhiyun
42*4882a593Smuzhiyun static struct ap_device_id zcrypt_cex2c_card_ids[] = {
43*4882a593Smuzhiyun { .dev_type = AP_DEVICE_TYPE_CEX2C,
44*4882a593Smuzhiyun .match_flags = AP_DEVICE_ID_MATCH_CARD_TYPE },
45*4882a593Smuzhiyun { .dev_type = AP_DEVICE_TYPE_CEX3C,
46*4882a593Smuzhiyun .match_flags = AP_DEVICE_ID_MATCH_CARD_TYPE },
47*4882a593Smuzhiyun { /* end of list */ },
48*4882a593Smuzhiyun };
49*4882a593Smuzhiyun
50*4882a593Smuzhiyun MODULE_DEVICE_TABLE(ap, zcrypt_cex2c_card_ids);
51*4882a593Smuzhiyun
52*4882a593Smuzhiyun static struct ap_device_id zcrypt_cex2c_queue_ids[] = {
53*4882a593Smuzhiyun { .dev_type = AP_DEVICE_TYPE_CEX2C,
54*4882a593Smuzhiyun .match_flags = AP_DEVICE_ID_MATCH_QUEUE_TYPE },
55*4882a593Smuzhiyun { .dev_type = AP_DEVICE_TYPE_CEX3C,
56*4882a593Smuzhiyun .match_flags = AP_DEVICE_ID_MATCH_QUEUE_TYPE },
57*4882a593Smuzhiyun { /* end of list */ },
58*4882a593Smuzhiyun };
59*4882a593Smuzhiyun
60*4882a593Smuzhiyun MODULE_DEVICE_TABLE(ap, zcrypt_cex2c_queue_ids);
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun /*
63*4882a593Smuzhiyun * CCA card additional device attributes
64*4882a593Smuzhiyun */
cca_serialnr_show(struct device * dev,struct device_attribute * attr,char * buf)65*4882a593Smuzhiyun static ssize_t cca_serialnr_show(struct device *dev,
66*4882a593Smuzhiyun struct device_attribute *attr,
67*4882a593Smuzhiyun char *buf)
68*4882a593Smuzhiyun {
69*4882a593Smuzhiyun struct cca_info ci;
70*4882a593Smuzhiyun struct ap_card *ac = to_ap_card(dev);
71*4882a593Smuzhiyun struct zcrypt_card *zc = ac->private;
72*4882a593Smuzhiyun
73*4882a593Smuzhiyun memset(&ci, 0, sizeof(ci));
74*4882a593Smuzhiyun
75*4882a593Smuzhiyun if (ap_domain_index >= 0)
76*4882a593Smuzhiyun cca_get_info(ac->id, ap_domain_index, &ci, zc->online);
77*4882a593Smuzhiyun
78*4882a593Smuzhiyun return scnprintf(buf, PAGE_SIZE, "%s\n", ci.serial);
79*4882a593Smuzhiyun }
80*4882a593Smuzhiyun
81*4882a593Smuzhiyun static struct device_attribute dev_attr_cca_serialnr =
82*4882a593Smuzhiyun __ATTR(serialnr, 0444, cca_serialnr_show, NULL);
83*4882a593Smuzhiyun
84*4882a593Smuzhiyun static struct attribute *cca_card_attrs[] = {
85*4882a593Smuzhiyun &dev_attr_cca_serialnr.attr,
86*4882a593Smuzhiyun NULL,
87*4882a593Smuzhiyun };
88*4882a593Smuzhiyun
89*4882a593Smuzhiyun static const struct attribute_group cca_card_attr_grp = {
90*4882a593Smuzhiyun .attrs = cca_card_attrs,
91*4882a593Smuzhiyun };
92*4882a593Smuzhiyun
93*4882a593Smuzhiyun /*
94*4882a593Smuzhiyun * CCA queue additional device attributes
95*4882a593Smuzhiyun */
cca_mkvps_show(struct device * dev,struct device_attribute * attr,char * buf)96*4882a593Smuzhiyun static ssize_t cca_mkvps_show(struct device *dev,
97*4882a593Smuzhiyun struct device_attribute *attr,
98*4882a593Smuzhiyun char *buf)
99*4882a593Smuzhiyun {
100*4882a593Smuzhiyun int n = 0;
101*4882a593Smuzhiyun struct cca_info ci;
102*4882a593Smuzhiyun struct zcrypt_queue *zq = to_ap_queue(dev)->private;
103*4882a593Smuzhiyun static const char * const cao_state[] = { "invalid", "valid" };
104*4882a593Smuzhiyun static const char * const new_state[] = { "empty", "partial", "full" };
105*4882a593Smuzhiyun
106*4882a593Smuzhiyun memset(&ci, 0, sizeof(ci));
107*4882a593Smuzhiyun
108*4882a593Smuzhiyun cca_get_info(AP_QID_CARD(zq->queue->qid),
109*4882a593Smuzhiyun AP_QID_QUEUE(zq->queue->qid),
110*4882a593Smuzhiyun &ci, zq->online);
111*4882a593Smuzhiyun
112*4882a593Smuzhiyun if (ci.new_aes_mk_state >= '1' && ci.new_aes_mk_state <= '3')
113*4882a593Smuzhiyun n = scnprintf(buf, PAGE_SIZE, "AES NEW: %s 0x%016llx\n",
114*4882a593Smuzhiyun new_state[ci.new_aes_mk_state - '1'],
115*4882a593Smuzhiyun ci.new_aes_mkvp);
116*4882a593Smuzhiyun else
117*4882a593Smuzhiyun n = scnprintf(buf, PAGE_SIZE, "AES NEW: - -\n");
118*4882a593Smuzhiyun
119*4882a593Smuzhiyun if (ci.cur_aes_mk_state >= '1' && ci.cur_aes_mk_state <= '2')
120*4882a593Smuzhiyun n += scnprintf(buf + n, PAGE_SIZE - n,
121*4882a593Smuzhiyun "AES CUR: %s 0x%016llx\n",
122*4882a593Smuzhiyun cao_state[ci.cur_aes_mk_state - '1'],
123*4882a593Smuzhiyun ci.cur_aes_mkvp);
124*4882a593Smuzhiyun else
125*4882a593Smuzhiyun n += scnprintf(buf + n, PAGE_SIZE - n, "AES CUR: - -\n");
126*4882a593Smuzhiyun
127*4882a593Smuzhiyun if (ci.old_aes_mk_state >= '1' && ci.old_aes_mk_state <= '2')
128*4882a593Smuzhiyun n += scnprintf(buf + n, PAGE_SIZE - n,
129*4882a593Smuzhiyun "AES OLD: %s 0x%016llx\n",
130*4882a593Smuzhiyun cao_state[ci.old_aes_mk_state - '1'],
131*4882a593Smuzhiyun ci.old_aes_mkvp);
132*4882a593Smuzhiyun else
133*4882a593Smuzhiyun n += scnprintf(buf + n, PAGE_SIZE - n, "AES OLD: - -\n");
134*4882a593Smuzhiyun
135*4882a593Smuzhiyun if (ci.new_apka_mk_state >= '1' && ci.new_apka_mk_state <= '3')
136*4882a593Smuzhiyun n += scnprintf(buf + n, PAGE_SIZE - n,
137*4882a593Smuzhiyun "APKA NEW: %s 0x%016llx\n",
138*4882a593Smuzhiyun new_state[ci.new_apka_mk_state - '1'],
139*4882a593Smuzhiyun ci.new_apka_mkvp);
140*4882a593Smuzhiyun else
141*4882a593Smuzhiyun n += scnprintf(buf + n, PAGE_SIZE - n, "APKA NEW: - -\n");
142*4882a593Smuzhiyun
143*4882a593Smuzhiyun if (ci.cur_apka_mk_state >= '1' && ci.cur_apka_mk_state <= '2')
144*4882a593Smuzhiyun n += scnprintf(buf + n, PAGE_SIZE - n,
145*4882a593Smuzhiyun "APKA CUR: %s 0x%016llx\n",
146*4882a593Smuzhiyun cao_state[ci.cur_apka_mk_state - '1'],
147*4882a593Smuzhiyun ci.cur_apka_mkvp);
148*4882a593Smuzhiyun else
149*4882a593Smuzhiyun n += scnprintf(buf + n, PAGE_SIZE - n, "APKA CUR: - -\n");
150*4882a593Smuzhiyun
151*4882a593Smuzhiyun if (ci.old_apka_mk_state >= '1' && ci.old_apka_mk_state <= '2')
152*4882a593Smuzhiyun n += scnprintf(buf + n, PAGE_SIZE - n,
153*4882a593Smuzhiyun "APKA OLD: %s 0x%016llx\n",
154*4882a593Smuzhiyun cao_state[ci.old_apka_mk_state - '1'],
155*4882a593Smuzhiyun ci.old_apka_mkvp);
156*4882a593Smuzhiyun else
157*4882a593Smuzhiyun n += scnprintf(buf + n, PAGE_SIZE - n, "APKA OLD: - -\n");
158*4882a593Smuzhiyun
159*4882a593Smuzhiyun return n;
160*4882a593Smuzhiyun }
161*4882a593Smuzhiyun
162*4882a593Smuzhiyun static struct device_attribute dev_attr_cca_mkvps =
163*4882a593Smuzhiyun __ATTR(mkvps, 0444, cca_mkvps_show, NULL);
164*4882a593Smuzhiyun
165*4882a593Smuzhiyun static struct attribute *cca_queue_attrs[] = {
166*4882a593Smuzhiyun &dev_attr_cca_mkvps.attr,
167*4882a593Smuzhiyun NULL,
168*4882a593Smuzhiyun };
169*4882a593Smuzhiyun
170*4882a593Smuzhiyun static const struct attribute_group cca_queue_attr_grp = {
171*4882a593Smuzhiyun .attrs = cca_queue_attrs,
172*4882a593Smuzhiyun };
173*4882a593Smuzhiyun
174*4882a593Smuzhiyun /**
175*4882a593Smuzhiyun * Large random number detection function. Its sends a message to a CEX2C/CEX3C
176*4882a593Smuzhiyun * card to find out if large random numbers are supported.
177*4882a593Smuzhiyun * @ap_dev: pointer to the AP device.
178*4882a593Smuzhiyun *
179*4882a593Smuzhiyun * Returns 1 if large random numbers are supported, 0 if not and < 0 on error.
180*4882a593Smuzhiyun */
zcrypt_cex2c_rng_supported(struct ap_queue * aq)181*4882a593Smuzhiyun static int zcrypt_cex2c_rng_supported(struct ap_queue *aq)
182*4882a593Smuzhiyun {
183*4882a593Smuzhiyun struct ap_message ap_msg;
184*4882a593Smuzhiyun unsigned long long psmid;
185*4882a593Smuzhiyun unsigned int domain;
186*4882a593Smuzhiyun struct {
187*4882a593Smuzhiyun struct type86_hdr hdr;
188*4882a593Smuzhiyun struct type86_fmt2_ext fmt2;
189*4882a593Smuzhiyun struct CPRBX cprbx;
190*4882a593Smuzhiyun } __packed *reply;
191*4882a593Smuzhiyun struct {
192*4882a593Smuzhiyun struct type6_hdr hdr;
193*4882a593Smuzhiyun struct CPRBX cprbx;
194*4882a593Smuzhiyun char function_code[2];
195*4882a593Smuzhiyun short int rule_length;
196*4882a593Smuzhiyun char rule[8];
197*4882a593Smuzhiyun short int verb_length;
198*4882a593Smuzhiyun short int key_length;
199*4882a593Smuzhiyun } __packed *msg;
200*4882a593Smuzhiyun int rc, i;
201*4882a593Smuzhiyun
202*4882a593Smuzhiyun ap_init_message(&ap_msg);
203*4882a593Smuzhiyun ap_msg.msg = (void *) get_zeroed_page(GFP_KERNEL);
204*4882a593Smuzhiyun if (!ap_msg.msg)
205*4882a593Smuzhiyun return -ENOMEM;
206*4882a593Smuzhiyun
207*4882a593Smuzhiyun rng_type6CPRB_msgX(&ap_msg, 4, &domain);
208*4882a593Smuzhiyun
209*4882a593Smuzhiyun msg = ap_msg.msg;
210*4882a593Smuzhiyun msg->cprbx.domain = AP_QID_QUEUE(aq->qid);
211*4882a593Smuzhiyun
212*4882a593Smuzhiyun rc = ap_send(aq->qid, 0x0102030405060708ULL, ap_msg.msg, ap_msg.len);
213*4882a593Smuzhiyun if (rc)
214*4882a593Smuzhiyun goto out_free;
215*4882a593Smuzhiyun
216*4882a593Smuzhiyun /* Wait for the test message to complete. */
217*4882a593Smuzhiyun for (i = 0; i < 2 * HZ; i++) {
218*4882a593Smuzhiyun msleep(1000 / HZ);
219*4882a593Smuzhiyun rc = ap_recv(aq->qid, &psmid, ap_msg.msg, 4096);
220*4882a593Smuzhiyun if (rc == 0 && psmid == 0x0102030405060708ULL)
221*4882a593Smuzhiyun break;
222*4882a593Smuzhiyun }
223*4882a593Smuzhiyun
224*4882a593Smuzhiyun if (i >= 2 * HZ) {
225*4882a593Smuzhiyun /* Got no answer. */
226*4882a593Smuzhiyun rc = -ENODEV;
227*4882a593Smuzhiyun goto out_free;
228*4882a593Smuzhiyun }
229*4882a593Smuzhiyun
230*4882a593Smuzhiyun reply = ap_msg.msg;
231*4882a593Smuzhiyun if (reply->cprbx.ccp_rtcode == 0 && reply->cprbx.ccp_rscode == 0)
232*4882a593Smuzhiyun rc = 1;
233*4882a593Smuzhiyun else
234*4882a593Smuzhiyun rc = 0;
235*4882a593Smuzhiyun out_free:
236*4882a593Smuzhiyun free_page((unsigned long) ap_msg.msg);
237*4882a593Smuzhiyun return rc;
238*4882a593Smuzhiyun }
239*4882a593Smuzhiyun
240*4882a593Smuzhiyun /**
241*4882a593Smuzhiyun * Probe function for CEX2C/CEX3C card devices. It always accepts the
242*4882a593Smuzhiyun * AP device since the bus_match already checked the hardware type.
243*4882a593Smuzhiyun * @ap_dev: pointer to the AP card device.
244*4882a593Smuzhiyun */
zcrypt_cex2c_card_probe(struct ap_device * ap_dev)245*4882a593Smuzhiyun static int zcrypt_cex2c_card_probe(struct ap_device *ap_dev)
246*4882a593Smuzhiyun {
247*4882a593Smuzhiyun /*
248*4882a593Smuzhiyun * Normalized speed ratings per crypto adapter
249*4882a593Smuzhiyun * MEX_1k, MEX_2k, MEX_4k, CRT_1k, CRT_2k, CRT_4k, RNG, SECKEY
250*4882a593Smuzhiyun */
251*4882a593Smuzhiyun static const int CEX2C_SPEED_IDX[] = {
252*4882a593Smuzhiyun 1000, 1400, 2400, 1100, 1500, 2600, 100, 12};
253*4882a593Smuzhiyun static const int CEX3C_SPEED_IDX[] = {
254*4882a593Smuzhiyun 500, 700, 1400, 550, 800, 1500, 80, 10};
255*4882a593Smuzhiyun
256*4882a593Smuzhiyun struct ap_card *ac = to_ap_card(&ap_dev->device);
257*4882a593Smuzhiyun struct zcrypt_card *zc;
258*4882a593Smuzhiyun int rc = 0;
259*4882a593Smuzhiyun
260*4882a593Smuzhiyun zc = zcrypt_card_alloc();
261*4882a593Smuzhiyun if (!zc)
262*4882a593Smuzhiyun return -ENOMEM;
263*4882a593Smuzhiyun zc->card = ac;
264*4882a593Smuzhiyun ac->private = zc;
265*4882a593Smuzhiyun switch (ac->ap_dev.device_type) {
266*4882a593Smuzhiyun case AP_DEVICE_TYPE_CEX2C:
267*4882a593Smuzhiyun zc->user_space_type = ZCRYPT_CEX2C;
268*4882a593Smuzhiyun zc->type_string = "CEX2C";
269*4882a593Smuzhiyun zc->speed_rating = CEX2C_SPEED_IDX;
270*4882a593Smuzhiyun zc->min_mod_size = CEX2C_MIN_MOD_SIZE;
271*4882a593Smuzhiyun zc->max_mod_size = CEX2C_MAX_MOD_SIZE;
272*4882a593Smuzhiyun zc->max_exp_bit_length = CEX2C_MAX_MOD_SIZE;
273*4882a593Smuzhiyun break;
274*4882a593Smuzhiyun case AP_DEVICE_TYPE_CEX3C:
275*4882a593Smuzhiyun zc->user_space_type = ZCRYPT_CEX3C;
276*4882a593Smuzhiyun zc->type_string = "CEX3C";
277*4882a593Smuzhiyun zc->speed_rating = CEX3C_SPEED_IDX;
278*4882a593Smuzhiyun zc->min_mod_size = CEX3C_MIN_MOD_SIZE;
279*4882a593Smuzhiyun zc->max_mod_size = CEX3C_MAX_MOD_SIZE;
280*4882a593Smuzhiyun zc->max_exp_bit_length = CEX3C_MAX_MOD_SIZE;
281*4882a593Smuzhiyun break;
282*4882a593Smuzhiyun default:
283*4882a593Smuzhiyun zcrypt_card_free(zc);
284*4882a593Smuzhiyun return -ENODEV;
285*4882a593Smuzhiyun }
286*4882a593Smuzhiyun zc->online = 1;
287*4882a593Smuzhiyun
288*4882a593Smuzhiyun rc = zcrypt_card_register(zc);
289*4882a593Smuzhiyun if (rc) {
290*4882a593Smuzhiyun ac->private = NULL;
291*4882a593Smuzhiyun zcrypt_card_free(zc);
292*4882a593Smuzhiyun return rc;
293*4882a593Smuzhiyun }
294*4882a593Smuzhiyun
295*4882a593Smuzhiyun if (ap_test_bit(&ac->functions, AP_FUNC_COPRO)) {
296*4882a593Smuzhiyun rc = sysfs_create_group(&ap_dev->device.kobj,
297*4882a593Smuzhiyun &cca_card_attr_grp);
298*4882a593Smuzhiyun if (rc) {
299*4882a593Smuzhiyun zcrypt_card_unregister(zc);
300*4882a593Smuzhiyun ac->private = NULL;
301*4882a593Smuzhiyun zcrypt_card_free(zc);
302*4882a593Smuzhiyun }
303*4882a593Smuzhiyun }
304*4882a593Smuzhiyun
305*4882a593Smuzhiyun return rc;
306*4882a593Smuzhiyun }
307*4882a593Smuzhiyun
308*4882a593Smuzhiyun /**
309*4882a593Smuzhiyun * This is called to remove the CEX2C/CEX3C card driver information
310*4882a593Smuzhiyun * if an AP card device is removed.
311*4882a593Smuzhiyun */
zcrypt_cex2c_card_remove(struct ap_device * ap_dev)312*4882a593Smuzhiyun static void zcrypt_cex2c_card_remove(struct ap_device *ap_dev)
313*4882a593Smuzhiyun {
314*4882a593Smuzhiyun struct ap_card *ac = to_ap_card(&ap_dev->device);
315*4882a593Smuzhiyun struct zcrypt_card *zc = to_ap_card(&ap_dev->device)->private;
316*4882a593Smuzhiyun
317*4882a593Smuzhiyun if (ap_test_bit(&ac->functions, AP_FUNC_COPRO))
318*4882a593Smuzhiyun sysfs_remove_group(&ap_dev->device.kobj, &cca_card_attr_grp);
319*4882a593Smuzhiyun if (zc)
320*4882a593Smuzhiyun zcrypt_card_unregister(zc);
321*4882a593Smuzhiyun }
322*4882a593Smuzhiyun
323*4882a593Smuzhiyun static struct ap_driver zcrypt_cex2c_card_driver = {
324*4882a593Smuzhiyun .probe = zcrypt_cex2c_card_probe,
325*4882a593Smuzhiyun .remove = zcrypt_cex2c_card_remove,
326*4882a593Smuzhiyun .ids = zcrypt_cex2c_card_ids,
327*4882a593Smuzhiyun .flags = AP_DRIVER_FLAG_DEFAULT,
328*4882a593Smuzhiyun };
329*4882a593Smuzhiyun
330*4882a593Smuzhiyun /**
331*4882a593Smuzhiyun * Probe function for CEX2C/CEX3C queue devices. It always accepts the
332*4882a593Smuzhiyun * AP device since the bus_match already checked the hardware type.
333*4882a593Smuzhiyun * @ap_dev: pointer to the AP card device.
334*4882a593Smuzhiyun */
zcrypt_cex2c_queue_probe(struct ap_device * ap_dev)335*4882a593Smuzhiyun static int zcrypt_cex2c_queue_probe(struct ap_device *ap_dev)
336*4882a593Smuzhiyun {
337*4882a593Smuzhiyun struct ap_queue *aq = to_ap_queue(&ap_dev->device);
338*4882a593Smuzhiyun struct zcrypt_queue *zq;
339*4882a593Smuzhiyun int rc;
340*4882a593Smuzhiyun
341*4882a593Smuzhiyun zq = zcrypt_queue_alloc(CEX2C_MAX_XCRB_MESSAGE_SIZE);
342*4882a593Smuzhiyun if (!zq)
343*4882a593Smuzhiyun return -ENOMEM;
344*4882a593Smuzhiyun zq->queue = aq;
345*4882a593Smuzhiyun zq->online = 1;
346*4882a593Smuzhiyun atomic_set(&zq->load, 0);
347*4882a593Smuzhiyun ap_rapq(aq->qid);
348*4882a593Smuzhiyun rc = zcrypt_cex2c_rng_supported(aq);
349*4882a593Smuzhiyun if (rc < 0) {
350*4882a593Smuzhiyun zcrypt_queue_free(zq);
351*4882a593Smuzhiyun return rc;
352*4882a593Smuzhiyun }
353*4882a593Smuzhiyun if (rc)
354*4882a593Smuzhiyun zq->ops = zcrypt_msgtype(MSGTYPE06_NAME,
355*4882a593Smuzhiyun MSGTYPE06_VARIANT_DEFAULT);
356*4882a593Smuzhiyun else
357*4882a593Smuzhiyun zq->ops = zcrypt_msgtype(MSGTYPE06_NAME,
358*4882a593Smuzhiyun MSGTYPE06_VARIANT_NORNG);
359*4882a593Smuzhiyun ap_queue_init_state(aq);
360*4882a593Smuzhiyun ap_queue_init_reply(aq, &zq->reply);
361*4882a593Smuzhiyun aq->request_timeout = CEX2C_CLEANUP_TIME;
362*4882a593Smuzhiyun aq->private = zq;
363*4882a593Smuzhiyun rc = zcrypt_queue_register(zq);
364*4882a593Smuzhiyun if (rc) {
365*4882a593Smuzhiyun aq->private = NULL;
366*4882a593Smuzhiyun zcrypt_queue_free(zq);
367*4882a593Smuzhiyun return rc;
368*4882a593Smuzhiyun }
369*4882a593Smuzhiyun
370*4882a593Smuzhiyun if (ap_test_bit(&aq->card->functions, AP_FUNC_COPRO)) {
371*4882a593Smuzhiyun rc = sysfs_create_group(&ap_dev->device.kobj,
372*4882a593Smuzhiyun &cca_queue_attr_grp);
373*4882a593Smuzhiyun if (rc) {
374*4882a593Smuzhiyun zcrypt_queue_unregister(zq);
375*4882a593Smuzhiyun aq->private = NULL;
376*4882a593Smuzhiyun zcrypt_queue_free(zq);
377*4882a593Smuzhiyun }
378*4882a593Smuzhiyun }
379*4882a593Smuzhiyun
380*4882a593Smuzhiyun return rc;
381*4882a593Smuzhiyun }
382*4882a593Smuzhiyun
383*4882a593Smuzhiyun /**
384*4882a593Smuzhiyun * This is called to remove the CEX2C/CEX3C queue driver information
385*4882a593Smuzhiyun * if an AP queue device is removed.
386*4882a593Smuzhiyun */
zcrypt_cex2c_queue_remove(struct ap_device * ap_dev)387*4882a593Smuzhiyun static void zcrypt_cex2c_queue_remove(struct ap_device *ap_dev)
388*4882a593Smuzhiyun {
389*4882a593Smuzhiyun struct ap_queue *aq = to_ap_queue(&ap_dev->device);
390*4882a593Smuzhiyun struct zcrypt_queue *zq = aq->private;
391*4882a593Smuzhiyun
392*4882a593Smuzhiyun if (ap_test_bit(&aq->card->functions, AP_FUNC_COPRO))
393*4882a593Smuzhiyun sysfs_remove_group(&ap_dev->device.kobj, &cca_queue_attr_grp);
394*4882a593Smuzhiyun if (zq)
395*4882a593Smuzhiyun zcrypt_queue_unregister(zq);
396*4882a593Smuzhiyun }
397*4882a593Smuzhiyun
398*4882a593Smuzhiyun static struct ap_driver zcrypt_cex2c_queue_driver = {
399*4882a593Smuzhiyun .probe = zcrypt_cex2c_queue_probe,
400*4882a593Smuzhiyun .remove = zcrypt_cex2c_queue_remove,
401*4882a593Smuzhiyun .ids = zcrypt_cex2c_queue_ids,
402*4882a593Smuzhiyun .flags = AP_DRIVER_FLAG_DEFAULT,
403*4882a593Smuzhiyun };
404*4882a593Smuzhiyun
zcrypt_cex2c_init(void)405*4882a593Smuzhiyun int __init zcrypt_cex2c_init(void)
406*4882a593Smuzhiyun {
407*4882a593Smuzhiyun int rc;
408*4882a593Smuzhiyun
409*4882a593Smuzhiyun rc = ap_driver_register(&zcrypt_cex2c_card_driver,
410*4882a593Smuzhiyun THIS_MODULE, "cex2card");
411*4882a593Smuzhiyun if (rc)
412*4882a593Smuzhiyun return rc;
413*4882a593Smuzhiyun
414*4882a593Smuzhiyun rc = ap_driver_register(&zcrypt_cex2c_queue_driver,
415*4882a593Smuzhiyun THIS_MODULE, "cex2cqueue");
416*4882a593Smuzhiyun if (rc)
417*4882a593Smuzhiyun ap_driver_unregister(&zcrypt_cex2c_card_driver);
418*4882a593Smuzhiyun
419*4882a593Smuzhiyun return rc;
420*4882a593Smuzhiyun }
421*4882a593Smuzhiyun
zcrypt_cex2c_exit(void)422*4882a593Smuzhiyun void zcrypt_cex2c_exit(void)
423*4882a593Smuzhiyun {
424*4882a593Smuzhiyun ap_driver_unregister(&zcrypt_cex2c_queue_driver);
425*4882a593Smuzhiyun ap_driver_unregister(&zcrypt_cex2c_card_driver);
426*4882a593Smuzhiyun }
427*4882a593Smuzhiyun
428*4882a593Smuzhiyun module_init(zcrypt_cex2c_init);
429*4882a593Smuzhiyun module_exit(zcrypt_cex2c_exit);
430