Gitiles
Code Review Sign In
gerrit-public.fairphone.software / kernel / msm / 832f8f0378ff1566f2a222352c7ad5df3f8d0d9d / . / drivers / s390 / crypto / z90hardware.c
blob: c215e088973625087daf5985afd5cb97e0794976 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]1/*
2 * linux/drivers/s390/crypto/z90hardware.c
3 *
4 * z90crypt 1.3.2
5 *
6 * Copyright (C) 2001, 2004 IBM Corporation
7 * Author(s): Robert Burroughs (burrough@us.ibm.com)
8 * Eric Rossman (edrossma@us.ibm.com)
9 *
10 * Hotplug & misc device support: Jochen Roehrig (roehrig@de.ibm.com)
11 *
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License as published by
14 * the Free Software Foundation; either version 2, or (at your option)
15 * any later version.
16 *
17 * This program is distributed in the hope that it will be useful,
18 * but WITHOUT ANY WARRANTY; without even the implied warranty of
19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
20 * GNU General Public License for more details.
21 *
22 * You should have received a copy of the GNU General Public License
23 * along with this program; if not, write to the Free Software
24 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
25 */
26
27#include <asm/uaccess.h>
28#include <linux/compiler.h>
29#include <linux/delay.h>
30#include <linux/init.h>
31#include <linux/module.h>
32#include "z90crypt.h"
33#include "z90common.h"
34
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]35#define VERSION_Z90HARDWARE_C "$Revision: 1.34 $"
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]36
37char z90hardware_version[] __initdata =
38 "z90hardware.o (" VERSION_Z90HARDWARE_C "/"
39 VERSION_Z90COMMON_H "/" VERSION_Z90CRYPT_H ")";
40
41struct cca_token_hdr {
42 unsigned char token_identifier;
43 unsigned char version;
44 unsigned short token_length;
45 unsigned char reserved[4];
46};
47
48#define CCA_TKN_HDR_ID_EXT 0x1E
49
50struct cca_private_ext_ME_sec {
51 unsigned char section_identifier;
52 unsigned char version;
53 unsigned short section_length;
54 unsigned char private_key_hash[20];
55 unsigned char reserved1[4];
56 unsigned char key_format;
57 unsigned char reserved2;
58 unsigned char key_name_hash[20];
59 unsigned char key_use_flags[4];
60 unsigned char reserved3[6];
61 unsigned char reserved4[24];
62 unsigned char confounder[24];
63 unsigned char exponent[128];
64 unsigned char modulus[128];
65};
66
67#define CCA_PVT_USAGE_ALL 0x80
68
69struct cca_public_sec {
70 unsigned char section_identifier;
71 unsigned char version;
72 unsigned short section_length;
73 unsigned char reserved[2];
74 unsigned short exponent_len;
75 unsigned short modulus_bit_len;
76 unsigned short modulus_byte_len;
77 unsigned char exponent[3];
78};
79
80struct cca_private_ext_ME {
81 struct cca_token_hdr pvtMEHdr;
82 struct cca_private_ext_ME_sec pvtMESec;
83 struct cca_public_sec pubMESec;
84};
85
86struct cca_public_key {
87 struct cca_token_hdr pubHdr;
88 struct cca_public_sec pubSec;
89};
90
91struct cca_pvt_ext_CRT_sec {
92 unsigned char section_identifier;
93 unsigned char version;
94 unsigned short section_length;
95 unsigned char private_key_hash[20];
96 unsigned char reserved1[4];
97 unsigned char key_format;
98 unsigned char reserved2;
99 unsigned char key_name_hash[20];
100 unsigned char key_use_flags[4];
101 unsigned short p_len;
102 unsigned short q_len;
103 unsigned short dp_len;
104 unsigned short dq_len;
105 unsigned short u_len;
106 unsigned short mod_len;
107 unsigned char reserved3[4];
108 unsigned short pad_len;
109 unsigned char reserved4[52];
110 unsigned char confounder[8];
111};
112
113#define CCA_PVT_EXT_CRT_SEC_ID_PVT 0x08
114#define CCA_PVT_EXT_CRT_SEC_FMT_CL 0x40
115
116struct cca_private_ext_CRT {
117 struct cca_token_hdr pvtCrtHdr;
118 struct cca_pvt_ext_CRT_sec pvtCrtSec;
119 struct cca_public_sec pubCrtSec;
120};
121
122struct ap_status_word {
123 unsigned char q_stat_flags;
124 unsigned char response_code;
125 unsigned char reserved[2];
126};
127
128#define AP_Q_STATUS_EMPTY 0x80
129#define AP_Q_STATUS_REPLIES_WAITING 0x40
130#define AP_Q_STATUS_ARRAY_FULL 0x20
131
132#define AP_RESPONSE_NORMAL 0x00
133#define AP_RESPONSE_Q_NOT_AVAIL 0x01
134#define AP_RESPONSE_RESET_IN_PROGRESS 0x02
135#define AP_RESPONSE_DECONFIGURED 0x03
136#define AP_RESPONSE_CHECKSTOPPED 0x04
137#define AP_RESPONSE_BUSY 0x05
138#define AP_RESPONSE_Q_FULL 0x10
139#define AP_RESPONSE_NO_PENDING_REPLY 0x10
140#define AP_RESPONSE_INDEX_TOO_BIG 0x11
141#define AP_RESPONSE_NO_FIRST_PART 0x13
142#define AP_RESPONSE_MESSAGE_TOO_BIG 0x15
143
144#define AP_MAX_CDX_BITL 4
145#define AP_RQID_RESERVED_BITL 4
146#define SKIP_BITL (AP_MAX_CDX_BITL + AP_RQID_RESERVED_BITL)
147
148struct type4_hdr {
149 unsigned char reserved1;
150 unsigned char msg_type_code;
151 unsigned short msg_len;
152 unsigned char request_code;
153 unsigned char msg_fmt;
154 unsigned short reserved2;
155};
156
157#define TYPE4_TYPE_CODE 0x04
158#define TYPE4_REQU_CODE 0x40
159
160#define TYPE4_SME_LEN 0x0188
161#define TYPE4_LME_LEN 0x0308
162#define TYPE4_SCR_LEN 0x01E0
163#define TYPE4_LCR_LEN 0x03A0
164
165#define TYPE4_SME_FMT 0x00
166#define TYPE4_LME_FMT 0x10
167#define TYPE4_SCR_FMT 0x40
168#define TYPE4_LCR_FMT 0x50
169
170struct type4_sme {
171 struct type4_hdr header;
172 unsigned char message[128];
173 unsigned char exponent[128];
174 unsigned char modulus[128];
175};
176
177struct type4_lme {
178 struct type4_hdr header;
179 unsigned char message[256];
180 unsigned char exponent[256];
181 unsigned char modulus[256];
182};
183
184struct type4_scr {
185 struct type4_hdr header;
186 unsigned char message[128];
187 unsigned char dp[72];
188 unsigned char dq[64];
189 unsigned char p[72];
190 unsigned char q[64];
191 unsigned char u[72];
192};
193
194struct type4_lcr {
195 struct type4_hdr header;
196 unsigned char message[256];
197 unsigned char dp[136];
198 unsigned char dq[128];
199 unsigned char p[136];
200 unsigned char q[128];
201 unsigned char u[136];
202};
203
204union type4_msg {
205 struct type4_sme sme;
206 struct type4_lme lme;
207 struct type4_scr scr;
208 struct type4_lcr lcr;
209};
210
211struct type84_hdr {
212 unsigned char reserved1;
213 unsigned char code;
214 unsigned short len;
215 unsigned char reserved2[4];
216};
217
218#define TYPE84_RSP_CODE 0x84
219
220struct type6_hdr {
221 unsigned char reserved1;
222 unsigned char type;
223 unsigned char reserved2[2];
224 unsigned char right[4];
225 unsigned char reserved3[2];
226 unsigned char reserved4[2];
227 unsigned char apfs[4];
228 unsigned int offset1;
229 unsigned int offset2;
230 unsigned int offset3;
231 unsigned int offset4;
232 unsigned char agent_id[16];
233 unsigned char rqid[2];
234 unsigned char reserved5[2];
235 unsigned char function_code[2];
236 unsigned char reserved6[2];
237 unsigned int ToCardLen1;
238 unsigned int ToCardLen2;
239 unsigned int ToCardLen3;
240 unsigned int ToCardLen4;
241 unsigned int FromCardLen1;
242 unsigned int FromCardLen2;
243 unsigned int FromCardLen3;
244 unsigned int FromCardLen4;
245};
246
247struct CPRB {
248 unsigned char cprb_len[2];
249 unsigned char cprb_ver_id;
250 unsigned char pad_000;
251 unsigned char srpi_rtcode[4];
252 unsigned char srpi_verb;
253 unsigned char flags;
254 unsigned char func_id[2];
255 unsigned char checkpoint_flag;
256 unsigned char resv2;
257 unsigned char req_parml[2];
258 unsigned char req_parmp[4];
259 unsigned char req_datal[4];
260 unsigned char req_datap[4];
261 unsigned char rpl_parml[2];
262 unsigned char pad_001[2];
263 unsigned char rpl_parmp[4];
264 unsigned char rpl_datal[4];
265 unsigned char rpl_datap[4];
266 unsigned char ccp_rscode[2];
267 unsigned char ccp_rtcode[2];
268 unsigned char repd_parml[2];
269 unsigned char mac_data_len[2];
270 unsigned char repd_datal[4];
271 unsigned char req_pc[2];
272 unsigned char res_origin[8];
273 unsigned char mac_value[8];
274 unsigned char logon_id[8];
275 unsigned char usage_domain[2];
276 unsigned char resv3[18];
277 unsigned char svr_namel[2];
278 unsigned char svr_name[8];
279};
280
281struct type6_msg {
282 struct type6_hdr header;
283 struct CPRB CPRB;
284};
285
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]286struct type86_hdr {
287 unsigned char reserved1;
288 unsigned char type;
289 unsigned char format;
290 unsigned char reserved2;
291 unsigned char reply_code;
292 unsigned char reserved3[3];
293};
294
295#define TYPE86_RSP_CODE 0x86
296#define TYPE86_FMT2 0x02
297
298struct type86_fmt2_msg {
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]299 struct type86_hdr header;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]300 unsigned char reserved[4];
301 unsigned char apfs[4];
302 unsigned int count1;
303 unsigned int offset1;
304 unsigned int count2;
305 unsigned int offset2;
306 unsigned int count3;
307 unsigned int offset3;
308 unsigned int count4;
309 unsigned int offset4;
310};
311
312static struct type6_hdr static_type6_hdr = {
313 0x00,
314 0x06,
315 {0x00,0x00},
316 {0x00,0x00,0x00,0x00},
317 {0x00,0x00},
318 {0x00,0x00},
319 {0x00,0x00,0x00,0x00},
320 0x00000058,
321 0x00000000,
322 0x00000000,
323 0x00000000,
324 {0x01,0x00,0x43,0x43,0x41,0x2D,0x41,0x50,
325 0x50,0x4C,0x20,0x20,0x20,0x01,0x01,0x01},
326 {0x00,0x00},
327 {0x00,0x00},
328 {0x50,0x44},
329 {0x00,0x00},
330 0x00000000,
331 0x00000000,
332 0x00000000,
333 0x00000000,
334 0x00000000,
335 0x00000000,
336 0x00000000,
337 0x00000000
338};
339
340static struct type6_hdr static_type6_hdrX = {
341 0x00,
342 0x06,
343 {0x00,0x00},
344 {0x00,0x00,0x00,0x00},
345 {0x00,0x00},
346 {0x00,0x00},
347 {0x00,0x00,0x00,0x00},
348 0x00000058,
349 0x00000000,
350 0x00000000,
351 0x00000000,
352 {0x43,0x41,0x00,0x00,0x00,0x00,0x00,0x00,
353 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
354 {0x00,0x00},
355 {0x00,0x00},
356 {0x50,0x44},
357 {0x00,0x00},
358 0x00000000,
359 0x00000000,
360 0x00000000,
361 0x00000000,
362 0x00000000,
363 0x00000000,
364 0x00000000,
365 0x00000000
366};
367
368static struct CPRB static_cprb = {
369 {0x70,0x00},
370 0x41,
371 0x00,
372 {0x00,0x00,0x00,0x00},
373 0x00,
374 0x00,
375 {0x54,0x32},
376 0x01,
377 0x00,
378 {0x00,0x00},
379 {0x00,0x00,0x00,0x00},
380 {0x00,0x00,0x00,0x00},
381 {0x00,0x00,0x00,0x00},
382 {0x00,0x00},
383 {0x00,0x00},
384 {0x00,0x00,0x00,0x00},
385 {0x00,0x00,0x00,0x00},
386 {0x00,0x00,0x00,0x00},
387 {0x00,0x00},
388 {0x00,0x00},
389 {0x00,0x00},
390 {0x00,0x00},
391 {0x00,0x00,0x00,0x00},
392 {0x00,0x00},
393 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
394 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
395 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
396 {0x00,0x00},
397 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
398 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
399 0x00,0x00},
400 {0x08,0x00},
401 {0x49,0x43,0x53,0x46,0x20,0x20,0x20,0x20}
402};
403
404struct function_and_rules_block {
405 unsigned char function_code[2];
406 unsigned char ulen[2];
407 unsigned char only_rule[8];
408};
409
410static struct function_and_rules_block static_pkd_function_and_rules = {
411 {0x50,0x44},
412 {0x0A,0x00},
413 {'P','K','C','S','-','1','.','2'}
414};
415
416static struct function_and_rules_block static_pke_function_and_rules = {
417 {0x50,0x4B},
418 {0x0A,0x00},
419 {'P','K','C','S','-','1','.','2'}
420};
421
422struct T6_keyBlock_hdr {
423 unsigned char blen[2];
424 unsigned char ulen[2];
425 unsigned char flags[2];
426};
427
428static struct T6_keyBlock_hdr static_T6_keyBlock_hdr = {
429 {0x89,0x01},
430 {0x87,0x01},
431 {0x00}
432};
433
434static struct CPRBX static_cprbx = {
435 0x00DC,
436 0x02,
437 {0x00,0x00,0x00},
438 {0x54,0x32},
439 {0x00,0x00,0x00,0x00},
440 0x00000000,
441 0x00000000,
442 0x00000000,
443 0x00000000,
444 0x00000000,
445 0x00000000,
446 0x00000000,
447 {0x00,0x00,0x00,0x00},
448 0x00000000,
449 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
450 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
451 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
452 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
453 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
454 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
455 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
456 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
457 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
458 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
459 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
460 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
461 0x0000,
462 0x0000,
463 0x00000000,
464 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
465 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
466 0x00,
467 0x00,
468 0x0000,
469 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
470 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
471 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
472 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00}
473};
474
475static struct function_and_rules_block static_pkd_function_and_rulesX_MCL2 = {
476 {0x50,0x44},
477 {0x00,0x0A},
478 {'P','K','C','S','-','1','.','2'}
479};
480
481static struct function_and_rules_block static_pke_function_and_rulesX_MCL2 = {
482 {0x50,0x4B},
483 {0x00,0x0A},
484 {'Z','E','R','O','-','P','A','D'}
485};
486
487static struct function_and_rules_block static_pkd_function_and_rulesX = {
488 {0x50,0x44},
489 {0x00,0x0A},
490 {'Z','E','R','O','-','P','A','D'}
491};
492
493static struct function_and_rules_block static_pke_function_and_rulesX = {
494 {0x50,0x4B},
495 {0x00,0x0A},
496 {'M','R','P',' ',' ',' ',' ',' '}
497};
498
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]499static unsigned char static_PKE_function_code[2] = {0x50, 0x4B};
500
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]501struct T6_keyBlock_hdrX {
502 unsigned short blen;
503 unsigned short ulen;
504 unsigned char flags[2];
505};
506
507static unsigned char static_pad[256] = {
5080x1B,0x7B,0x5D,0xB5,0x75,0x01,0x3D,0xFD,0x8D,0xD1,0xC7,0x03,0x2D,0x09,0x23,0x57,
5090x89,0x49,0xB9,0x3F,0xBB,0x99,0x41,0x5B,0x75,0x21,0x7B,0x9D,0x3B,0x6B,0x51,0x39,
5100xBB,0x0D,0x35,0xB9,0x89,0x0F,0x93,0xA5,0x0B,0x47,0xF1,0xD3,0xBB,0xCB,0xF1,0x9D,
5110x23,0x73,0x71,0xFF,0xF3,0xF5,0x45,0xFB,0x61,0x29,0x23,0xFD,0xF1,0x29,0x3F,0x7F,
5120x17,0xB7,0x1B,0xA9,0x19,0xBD,0x57,0xA9,0xD7,0x95,0xA3,0xCB,0xED,0x1D,0xDB,0x45,
5130x7D,0x11,0xD1,0x51,0x1B,0xED,0x71,0xE9,0xB1,0xD1,0xAB,0xAB,0x21,0x2B,0x1B,0x9F,
5140x3B,0x9F,0xF7,0xF7,0xBD,0x63,0xEB,0xAD,0xDF,0xB3,0x6F,0x5B,0xDB,0x8D,0xA9,0x5D,
5150xE3,0x7D,0x77,0x49,0x47,0xF5,0xA7,0xFD,0xAB,0x2F,0x27,0x35,0x77,0xD3,0x49,0xC9,
5160x09,0xEB,0xB1,0xF9,0xBF,0x4B,0xCB,0x2B,0xEB,0xEB,0x05,0xFF,0x7D,0xC7,0x91,0x8B,
5170x09,0x83,0xB9,0xB9,0x69,0x33,0x39,0x6B,0x79,0x75,0x19,0xBF,0xBB,0x07,0x1D,0xBD,
5180x29,0xBF,0x39,0x95,0x93,0x1D,0x35,0xC7,0xC9,0x4D,0xE5,0x97,0x0B,0x43,0x9B,0xF1,
5190x16,0x93,0x03,0x1F,0xA5,0xFB,0xDB,0xF3,0x27,0x4F,0x27,0x61,0x05,0x1F,0xB9,0x23,
5200x2F,0xC3,0x81,0xA9,0x23,0x71,0x55,0x55,0xEB,0xED,0x41,0xE5,0xF3,0x11,0xF1,0x43,
5210x69,0x03,0xBD,0x0B,0x37,0x0F,0x51,0x8F,0x0B,0xB5,0x89,0x5B,0x67,0xA9,0xD9,0x4F,
5220x01,0xF9,0x21,0x77,0x37,0x73,0x79,0xC5,0x7F,0x51,0xC1,0xCF,0x97,0xA1,0x75,0xAD,
5230x35,0x9D,0xD3,0xD3,0xA7,0x9D,0x5D,0x41,0x6F,0x65,0x1B,0xCF,0xA9,0x87,0x91,0x09
524};
525
526static struct cca_private_ext_ME static_pvt_me_key = {
527 {
528 0x1E,
529 0x00,
530 0x0183,
531 {0x00,0x00,0x00,0x00}
532 },
533
534 {
535 0x02,
536 0x00,
537 0x016C,
538 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
539 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
540 0x00,0x00,0x00,0x00},
541 {0x00,0x00,0x00,0x00},
542 0x00,
543 0x00,
544 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
545 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
546 0x00,0x00,0x00,0x00},
547 {0x80,0x00,0x00,0x00},
548 {0x00,0x00,0x00,0x00,0x00,0x00},
549 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
550 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
551 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
552 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
553 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
554 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
555 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
556 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
557 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
558 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
559 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
560 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
561 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
562 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
563 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
564 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
565 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
566 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
567 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
568 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
569 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
570 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00},
571 {0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
572 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
573 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
574 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
575 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
576 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
577 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
578 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
579 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
580 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
581 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
582 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
583 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
584 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
585 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,
586 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00}
587 },
588
589 {
590 0x04,
591 0x00,
592 0x000F,
593 {0x00,0x00},
594 0x0003,
595 0x0000,
596 0x0000,
597 {0x01,0x00,0x01}
598 }
599};
600
601static struct cca_public_key static_public_key = {
602 {
603 0x1E,
604 0x00,
605 0x0000,
606 {0x00,0x00,0x00,0x00}
607 },
608
609 {
610 0x04,
611 0x00,
612 0x0000,
613 {0x00,0x00},
614 0x0000,
615 0x0000,
616 0x0000,
617 {0x01,0x00,0x01}
618 }
619};
620
621#define FIXED_TYPE6_ME_LEN 0x0000025F
622
623#define FIXED_TYPE6_ME_EN_LEN 0x000000F0
624
625#define FIXED_TYPE6_ME_LENX 0x000002CB
626
627#define FIXED_TYPE6_ME_EN_LENX 0x0000015C
628
629static struct cca_public_sec static_cca_pub_sec = {
630 0x04,
631 0x00,
632 0x000f,
633 {0x00,0x00},
634 0x0003,
635 0x0000,
636 0x0000,
637 {0x01,0x00,0x01}
638};
639
640#define FIXED_TYPE6_CR_LEN 0x00000177
641
642#define FIXED_TYPE6_CR_LENX 0x000001E3
643
644#define MAX_RESPONSE_SIZE 0x00000710
645
646#define MAX_RESPONSEX_SIZE 0x0000077C
647
648#define RESPONSE_CPRB_SIZE 0x000006B8
649#define RESPONSE_CPRBX_SIZE 0x00000724
650
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]651struct error_hdr {
652 unsigned char reserved1;
653 unsigned char type;
654 unsigned char reserved2[2];
655 unsigned char reply_code;
656 unsigned char reserved3[3];
657};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]658
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]659#define TYPE82_RSP_CODE 0x82
660
661#define REP82_ERROR_MACHINE_FAILURE 0x10
662#define REP82_ERROR_PREEMPT_FAILURE 0x12
663#define REP82_ERROR_CHECKPT_FAILURE 0x14
664#define REP82_ERROR_MESSAGE_TYPE 0x20
665#define REP82_ERROR_INVALID_COMM_CD 0x21
666#define REP82_ERROR_INVALID_MSG_LEN 0x23
667#define REP82_ERROR_RESERVD_FIELD 0x24
668#define REP82_ERROR_FORMAT_FIELD 0x29
669#define REP82_ERROR_INVALID_COMMAND 0x30
670#define REP82_ERROR_MALFORMED_MSG 0x40
671#define REP82_ERROR_RESERVED_FIELDO 0x50
672#define REP82_ERROR_WORD_ALIGNMENT 0x60
673#define REP82_ERROR_MESSAGE_LENGTH 0x80
674#define REP82_ERROR_OPERAND_INVALID 0x82
675#define REP82_ERROR_OPERAND_SIZE 0x84
676#define REP82_ERROR_EVEN_MOD_IN_OPND 0x85
677#define REP82_ERROR_RESERVED_FIELD 0x88
678#define REP82_ERROR_TRANSPORT_FAIL 0x90
679#define REP82_ERROR_PACKET_TRUNCATED 0xA0
680#define REP82_ERROR_ZERO_BUFFER_LEN 0xB0
681
682#define CALLER_HEADER 12
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]683
684static inline int
685testq(int q_nr, int *q_depth, int *dev_type, struct ap_status_word *stat)
686{
687 int ccode;
688
689 asm volatile
690#ifdef __s390x__
691 (" llgfr 0,%4 \n"
692 " slgr 1,1 \n"
693 " lgr 2,1 \n"
694 "0: .long 0xb2af0000 \n"
695 "1: ipm %0 \n"
696 " srl %0,28 \n"
697 " iihh %0,0 \n"
698 " iihl %0,0 \n"
699 " lgr %1,1 \n"
700 " lgr %3,2 \n"
701 " srl %3,24 \n"
702 " sll 2,24 \n"
703 " srl 2,24 \n"
704 " lgr %2,2 \n"
705 "2: \n"
706 ".section .fixup,\"ax\" \n"
707 "3: \n"
708 " lhi %0,%h5 \n"
709 " jg 2b \n"
710 ".previous \n"
711 ".section __ex_table,\"a\" \n"
712 " .align 8 \n"
713 " .quad 0b,3b \n"
714 " .quad 1b,3b \n"
715 ".previous"
716 :"=d" (ccode),"=d" (*stat),"=d" (*q_depth), "=d" (*dev_type)
717 :"d" (q_nr), "K" (DEV_TSQ_EXCEPTION)
718 :"cc","0","1","2","memory");
719#else
720 (" lr 0,%4 \n"
721 " slr 1,1 \n"
722 " lr 2,1 \n"
723 "0: .long 0xb2af0000 \n"
724 "1: ipm %0 \n"
725 " srl %0,28 \n"
726 " lr %1,1 \n"
727 " lr %3,2 \n"
728 " srl %3,24 \n"
729 " sll 2,24 \n"
730 " srl 2,24 \n"
731 " lr %2,2 \n"
732 "2: \n"
733 ".section .fixup,\"ax\" \n"
734 "3: \n"
735 " lhi %0,%h5 \n"
736 " bras 1,4f \n"
737 " .long 2b \n"
738 "4: \n"
739 " l 1,0(1) \n"
740 " br 1 \n"
741 ".previous \n"
742 ".section __ex_table,\"a\" \n"
743 " .align 4 \n"
744 " .long 0b,3b \n"
745 " .long 1b,3b \n"
746 ".previous"
747 :"=d" (ccode),"=d" (*stat),"=d" (*q_depth), "=d" (*dev_type)
748 :"d" (q_nr), "K" (DEV_TSQ_EXCEPTION)
749 :"cc","0","1","2","memory");
750#endif
751 return ccode;
752}
753
754static inline int
755resetq(int q_nr, struct ap_status_word *stat_p)
756{
757 int ccode;
758
759 asm volatile
760#ifdef __s390x__
761 (" llgfr 0,%2 \n"
762 " lghi 1,1 \n"
763 " sll 1,24 \n"
764 " or 0,1 \n"
765 " slgr 1,1 \n"
766 " lgr 2,1 \n"
767 "0: .long 0xb2af0000 \n"
768 "1: ipm %0 \n"
769 " srl %0,28 \n"
770 " iihh %0,0 \n"
771 " iihl %0,0 \n"
772 " lgr %1,1 \n"
773 "2: \n"
774 ".section .fixup,\"ax\" \n"
775 "3: \n"
776 " lhi %0,%h3 \n"
777 " jg 2b \n"
778 ".previous \n"
779 ".section __ex_table,\"a\" \n"
780 " .align 8 \n"
781 " .quad 0b,3b \n"
782 " .quad 1b,3b \n"
783 ".previous"
784 :"=d" (ccode),"=d" (*stat_p)
785 :"d" (q_nr), "K" (DEV_RSQ_EXCEPTION)
786 :"cc","0","1","2","memory");
787#else
788 (" lr 0,%2 \n"
789 " lhi 1,1 \n"
790 " sll 1,24 \n"
791 " or 0,1 \n"
792 " slr 1,1 \n"
793 " lr 2,1 \n"
794 "0: .long 0xb2af0000 \n"
795 "1: ipm %0 \n"
796 " srl %0,28 \n"
797 " lr %1,1 \n"
798 "2: \n"
799 ".section .fixup,\"ax\" \n"
800 "3: \n"
801 " lhi %0,%h3 \n"
802 " bras 1,4f \n"
803 " .long 2b \n"
804 "4: \n"
805 " l 1,0(1) \n"
806 " br 1 \n"
807 ".previous \n"
808 ".section __ex_table,\"a\" \n"
809 " .align 4 \n"
810 " .long 0b,3b \n"
811 " .long 1b,3b \n"
812 ".previous"
813 :"=d" (ccode),"=d" (*stat_p)
814 :"d" (q_nr), "K" (DEV_RSQ_EXCEPTION)
815 :"cc","0","1","2","memory");
816#endif
817 return ccode;
818}
819
820static inline int
821sen(int msg_len, unsigned char *msg_ext, struct ap_status_word *stat)
822{
823 int ccode;
824
825 asm volatile
826#ifdef __s390x__
827 (" lgr 6,%3 \n"
828 " llgfr 7,%2 \n"
829 " llgt 0,0(6) \n"
830 " lghi 1,64 \n"
831 " sll 1,24 \n"
832 " or 0,1 \n"
833 " la 6,4(6) \n"
834 " llgt 2,0(6) \n"
835 " llgt 3,4(6) \n"
836 " la 6,8(6) \n"
837 " slr 1,1 \n"
838 "0: .long 0xb2ad0026 \n"
839 "1: brc 2,0b \n"
840 " ipm %0 \n"
841 " srl %0,28 \n"
842 " iihh %0,0 \n"
843 " iihl %0,0 \n"
844 " lgr %1,1 \n"
845 "2: \n"
846 ".section .fixup,\"ax\" \n"
847 "3: \n"
848 " lhi %0,%h4 \n"
849 " jg 2b \n"
850 ".previous \n"
851 ".section __ex_table,\"a\" \n"
852 " .align 8 \n"
853 " .quad 0b,3b \n"
854 " .quad 1b,3b \n"
855 ".previous"
856 :"=d" (ccode),"=d" (*stat)
857 :"d" (msg_len),"a" (msg_ext), "K" (DEV_SEN_EXCEPTION)
858 :"cc","0","1","2","3","6","7","memory");
859#else
860 (" lr 6,%3 \n"
861 " lr 7,%2 \n"
862 " l 0,0(6) \n"
863 " lhi 1,64 \n"
864 " sll 1,24 \n"
865 " or 0,1 \n"
866 " la 6,4(6) \n"
867 " l 2,0(6) \n"
868 " l 3,4(6) \n"
869 " la 6,8(6) \n"
870 " slr 1,1 \n"
871 "0: .long 0xb2ad0026 \n"
872 "1: brc 2,0b \n"
873 " ipm %0 \n"
874 " srl %0,28 \n"
875 " lr %1,1 \n"
876 "2: \n"
877 ".section .fixup,\"ax\" \n"
878 "3: \n"
879 " lhi %0,%h4 \n"
880 " bras 1,4f \n"
881 " .long 2b \n"
882 "4: \n"
883 " l 1,0(1) \n"
884 " br 1 \n"
885 ".previous \n"
886 ".section __ex_table,\"a\" \n"
887 " .align 4 \n"
888 " .long 0b,3b \n"
889 " .long 1b,3b \n"
890 ".previous"
891 :"=d" (ccode),"=d" (*stat)
892 :"d" (msg_len),"a" (msg_ext), "K" (DEV_SEN_EXCEPTION)
893 :"cc","0","1","2","3","6","7","memory");
894#endif
895 return ccode;
896}
897
898static inline int
899rec(int q_nr, int buff_l, unsigned char *rsp, unsigned char *id,
900 struct ap_status_word *st)
901{
902 int ccode;
903
904 asm volatile
905#ifdef __s390x__
906 (" llgfr 0,%2 \n"
907 " lgr 3,%4 \n"
908 " lgr 6,%3 \n"
909 " llgfr 7,%5 \n"
910 " lghi 1,128 \n"
911 " sll 1,24 \n"
912 " or 0,1 \n"
913 " slgr 1,1 \n"
914 " lgr 2,1 \n"
915 " lgr 4,1 \n"
916 " lgr 5,1 \n"
917 "0: .long 0xb2ae0046 \n"
918 "1: brc 2,0b \n"
919 " brc 4,0b \n"
920 " ipm %0 \n"
921 " srl %0,28 \n"
922 " iihh %0,0 \n"
923 " iihl %0,0 \n"
924 " lgr %1,1 \n"
925 " st 4,0(3) \n"
926 " st 5,4(3) \n"
927 "2: \n"
928 ".section .fixup,\"ax\" \n"
929 "3: \n"
930 " lhi %0,%h6 \n"
931 " jg 2b \n"
932 ".previous \n"
933 ".section __ex_table,\"a\" \n"
934 " .align 8 \n"
935 " .quad 0b,3b \n"
936 " .quad 1b,3b \n"
937 ".previous"
938 :"=d"(ccode),"=d"(*st)
939 :"d" (q_nr), "d" (rsp), "d" (id), "d" (buff_l), "K" (DEV_REC_EXCEPTION)
940 :"cc","0","1","2","3","4","5","6","7","memory");
941#else
942 (" lr 0,%2 \n"
943 " lr 3,%4 \n"
944 " lr 6,%3 \n"
945 " lr 7,%5 \n"
946 " lhi 1,128 \n"
947 " sll 1,24 \n"
948 " or 0,1 \n"
949 " slr 1,1 \n"
950 " lr 2,1 \n"
951 " lr 4,1 \n"
952 " lr 5,1 \n"
953 "0: .long 0xb2ae0046 \n"
954 "1: brc 2,0b \n"
955 " brc 4,0b \n"
956 " ipm %0 \n"
957 " srl %0,28 \n"
958 " lr %1,1 \n"
959 " st 4,0(3) \n"
960 " st 5,4(3) \n"
961 "2: \n"
962 ".section .fixup,\"ax\" \n"
963 "3: \n"
964 " lhi %0,%h6 \n"
965 " bras 1,4f \n"
966 " .long 2b \n"
967 "4: \n"
968 " l 1,0(1) \n"
969 " br 1 \n"
970 ".previous \n"
971 ".section __ex_table,\"a\" \n"
972 " .align 4 \n"
973 " .long 0b,3b \n"
974 " .long 1b,3b \n"
975 ".previous"
976 :"=d"(ccode),"=d"(*st)
977 :"d" (q_nr), "d" (rsp), "d" (id), "d" (buff_l), "K" (DEV_REC_EXCEPTION)
978 :"cc","0","1","2","3","4","5","6","7","memory");
979#endif
980 return ccode;
981}
982
983static inline void
984itoLe2(int *i_p, unsigned char *lechars)
985{
986 *lechars = *((unsigned char *) i_p + sizeof(int) - 1);
987 *(lechars + 1) = *((unsigned char *) i_p + sizeof(int) - 2);
988}
989
990static inline void
991le2toI(unsigned char *lechars, int *i_p)
992{
993 unsigned char *ic_p;
994 *i_p = 0;
995 ic_p = (unsigned char *) i_p;
996 *(ic_p + 2) = *(lechars + 1);
997 *(ic_p + 3) = *(lechars);
998}
999
1000static inline int
1001is_empty(unsigned char *ptr, int len)
1002{
1003 return !memcmp(ptr, (unsigned char *) &static_pvt_me_key+60, len);
1004}
1005
1006enum hdstat
1007query_online(int deviceNr, int cdx, int resetNr, int *q_depth, int *dev_type)
1008{
1009 int q_nr, i, t_depth, t_dev_type;
1010 enum devstat ccode;
1011 struct ap_status_word stat_word;
1012 enum hdstat stat;
1013 int break_out;
1014
1015 q_nr = (deviceNr << SKIP_BITL) + cdx;
1016 stat = HD_BUSY;
1017 ccode = testq(q_nr, &t_depth, &t_dev_type, &stat_word);
1018 PDEBUG("ccode %d response_code %02X\n", ccode, stat_word.response_code);
1019 break_out = 0;
1020 for (i = 0; i < resetNr; i++) {
1021 if (ccode > 3) {
1022 PRINTKC("Exception testing device %d\n", i);
1023 return HD_TSQ_EXCEPTION;
1024 }
1025 switch (ccode) {
1026 case 0:
1027 PDEBUG("t_dev_type %d\n", t_dev_type);
1028 break_out = 1;
1029 stat = HD_ONLINE;
1030 *q_depth = t_depth + 1;
1031 switch (t_dev_type) {
1032 case OTHER_HW:
1033 stat = HD_NOT_THERE;
1034 *dev_type = NILDEV;
1035 break;
1036 case PCICA_HW:
1037 *dev_type = PCICA;
1038 break;
1039 case PCICC_HW:
1040 *dev_type = PCICC;
1041 break;
1042 case PCIXCC_HW:
1043 *dev_type = PCIXCC_UNK;
1044 break;
1045 case CEX2C_HW:
1046 *dev_type = CEX2C;
1047 break;
1048 default:
1049 *dev_type = NILDEV;
1050 break;
1051 }
1052 PDEBUG("available device %d: Q depth = %d, dev "
1053 "type = %d, stat = %02X%02X%02X%02X\n",
1054 deviceNr, *q_depth, *dev_type,
1055 stat_word.q_stat_flags,
1056 stat_word.response_code,
1057 stat_word.reserved[0],
1058 stat_word.reserved[1]);
1059 break;
1060 case 3:
1061 switch (stat_word.response_code) {
1062 case AP_RESPONSE_NORMAL:
1063 stat = HD_ONLINE;
1064 break_out = 1;
1065 *q_depth = t_depth + 1;
1066 *dev_type = t_dev_type;
1067 PDEBUG("cc3, available device "
1068 "%d: Q depth = %d, dev "
1069 "type = %d, stat = "
1070 "%02X%02X%02X%02X\n",
1071 deviceNr, *q_depth,
1072 *dev_type,
1073 stat_word.q_stat_flags,
1074 stat_word.response_code,
1075 stat_word.reserved[0],
1076 stat_word.reserved[1]);
1077 break;
1078 case AP_RESPONSE_Q_NOT_AVAIL:
1079 stat = HD_NOT_THERE;
1080 break_out = 1;
1081 break;
1082 case AP_RESPONSE_RESET_IN_PROGRESS:
1083 PDEBUG("device %d in reset\n",
1084 deviceNr);
1085 break;
1086 case AP_RESPONSE_DECONFIGURED:
1087 stat = HD_DECONFIGURED;
1088 break_out = 1;
1089 break;
1090 case AP_RESPONSE_CHECKSTOPPED:
1091 stat = HD_CHECKSTOPPED;
1092 break_out = 1;
1093 break;
1094 case AP_RESPONSE_BUSY:
1095 PDEBUG("device %d busy\n",
1096 deviceNr);
1097 break;
1098 default:
1099 break;
1100 }
1101 break;
1102 default:
1103 stat = HD_NOT_THERE;
1104 break_out = 1;
1105 break;
1106 }
1107 if (break_out)
1108 break;
1109
1110 udelay(5);
1111
1112 ccode = testq(q_nr, &t_depth, &t_dev_type, &stat_word);
1113 }
1114 return stat;
1115}
1116
1117enum devstat
1118reset_device(int deviceNr, int cdx, int resetNr)
1119{
1120 int q_nr, ccode = 0, dummy_qdepth, dummy_devType, i;
1121 struct ap_status_word stat_word;
1122 enum devstat stat;
1123 int break_out;
1124
1125 q_nr = (deviceNr << SKIP_BITL) + cdx;
1126 stat = DEV_GONE;
1127 ccode = resetq(q_nr, &stat_word);
1128 if (ccode > 3)
1129 return DEV_RSQ_EXCEPTION;
1130
1131 break_out = 0;
1132 for (i = 0; i < resetNr; i++) {
1133 switch (ccode) {
1134 case 0:
1135 stat = DEV_ONLINE;
1136 if (stat_word.q_stat_flags & AP_Q_STATUS_EMPTY)
1137 break_out = 1;
1138 break;
1139 case 3:
1140 switch (stat_word.response_code) {
1141 case AP_RESPONSE_NORMAL:
1142 stat = DEV_ONLINE;
1143 if (stat_word.q_stat_flags & AP_Q_STATUS_EMPTY)
1144 break_out = 1;
1145 break;
1146 case AP_RESPONSE_Q_NOT_AVAIL:
1147 case AP_RESPONSE_DECONFIGURED:
1148 case AP_RESPONSE_CHECKSTOPPED:
1149 stat = DEV_GONE;
1150 break_out = 1;
1151 break;
1152 case AP_RESPONSE_RESET_IN_PROGRESS:
1153 case AP_RESPONSE_BUSY:
1154 default:
1155 break;
1156 }
1157 break;
1158 default:
1159 stat = DEV_GONE;
1160 break_out = 1;
1161 break;
1162 }
1163 if (break_out == 1)
1164 break;
1165 udelay(5);
1166
1167 ccode = testq(q_nr, &dummy_qdepth, &dummy_devType, &stat_word);
1168 if (ccode > 3) {
1169 stat = DEV_TSQ_EXCEPTION;
1170 break;
1171 }
1172 }
1173 PDEBUG("Number of testq's needed for reset: %d\n", i);
1174
1175 if (i >= resetNr) {
1176 stat = DEV_GONE;
1177 }
1178
1179 return stat;
1180}
1181
1182#ifdef DEBUG_HYDRA_MSGS
1183static inline void
1184print_buffer(unsigned char *buffer, int bufflen)
1185{
1186 int i;
1187 for (i = 0; i < bufflen; i += 16) {
1188 PRINTK("%04X: %02X%02X%02X%02X %02X%02X%02X%02X "
1189 "%02X%02X%02X%02X %02X%02X%02X%02X\n", i,
1190 buffer[i+0], buffer[i+1], buffer[i+2], buffer[i+3],
1191 buffer[i+4], buffer[i+5], buffer[i+6], buffer[i+7],
1192 buffer[i+8], buffer[i+9], buffer[i+10], buffer[i+11],
1193 buffer[i+12], buffer[i+13], buffer[i+14], buffer[i+15]);
1194 }
1195}
1196#endif
1197
1198enum devstat
1199send_to_AP(int dev_nr, int cdx, int msg_len, unsigned char *msg_ext)
1200{
1201 struct ap_status_word stat_word;
1202 enum devstat stat;
1203 int ccode;
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]1204 u32 *q_nr_p = (u32 *)msg_ext;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]1205
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]1206 *q_nr_p = (dev_nr << SKIP_BITL) + cdx;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]1207 PDEBUG("msg_len passed to sen: %d\n", msg_len);
1208 PDEBUG("q number passed to sen: %02x%02x%02x%02x\n",
1209 msg_ext[0], msg_ext[1], msg_ext[2], msg_ext[3]);
1210 stat = DEV_GONE;
1211
1212#ifdef DEBUG_HYDRA_MSGS
1213 PRINTK("Request header: %02X%02X%02X%02X %02X%02X%02X%02X "
1214 "%02X%02X%02X%02X\n",
1215 msg_ext[0], msg_ext[1], msg_ext[2], msg_ext[3],
1216 msg_ext[4], msg_ext[5], msg_ext[6], msg_ext[7],
1217 msg_ext[8], msg_ext[9], msg_ext[10], msg_ext[11]);
1218 print_buffer(msg_ext+CALLER_HEADER, msg_len);
1219#endif
1220
1221 ccode = sen(msg_len, msg_ext, &stat_word);
1222 if (ccode > 3)
1223 return DEV_SEN_EXCEPTION;
1224
1225 PDEBUG("nq cc: %u, st: %02x%02x%02x%02x\n",
1226 ccode, stat_word.q_stat_flags, stat_word.response_code,
1227 stat_word.reserved[0], stat_word.reserved[1]);
1228 switch (ccode) {
1229 case 0:
1230 stat = DEV_ONLINE;
1231 break;
1232 case 1:
1233 stat = DEV_GONE;
1234 break;
1235 case 3:
1236 switch (stat_word.response_code) {
1237 case AP_RESPONSE_NORMAL:
1238 stat = DEV_ONLINE;
1239 break;
1240 case AP_RESPONSE_Q_FULL:
1241 stat = DEV_QUEUE_FULL;
1242 break;
1243 default:
1244 stat = DEV_GONE;
1245 break;
1246 }
1247 break;
1248 default:
1249 stat = DEV_GONE;
1250 break;
1251 }
1252
1253 return stat;
1254}
1255
1256enum devstat
1257receive_from_AP(int dev_nr, int cdx, int resplen, unsigned char *resp,
1258 unsigned char *psmid)
1259{
1260 int ccode;
1261 struct ap_status_word stat_word;
1262 enum devstat stat;
1263
1264 memset(resp, 0x00, 8);
1265
1266 ccode = rec((dev_nr << SKIP_BITL) + cdx, resplen, resp, psmid,
1267 &stat_word);
1268 if (ccode > 3)
1269 return DEV_REC_EXCEPTION;
1270
1271 PDEBUG("dq cc: %u, st: %02x%02x%02x%02x\n",
1272 ccode, stat_word.q_stat_flags, stat_word.response_code,
1273 stat_word.reserved[0], stat_word.reserved[1]);
1274
1275 stat = DEV_GONE;
1276 switch (ccode) {
1277 case 0:
1278 stat = DEV_ONLINE;
1279#ifdef DEBUG_HYDRA_MSGS
1280 print_buffer(resp, resplen);
1281#endif
1282 break;
1283 case 3:
1284 switch (stat_word.response_code) {
1285 case AP_RESPONSE_NORMAL:
1286 stat = DEV_ONLINE;
1287 break;
1288 case AP_RESPONSE_NO_PENDING_REPLY:
1289 if (stat_word.q_stat_flags & AP_Q_STATUS_EMPTY)
1290 stat = DEV_EMPTY;
1291 else
1292 stat = DEV_NO_WORK;
1293 break;
1294 case AP_RESPONSE_INDEX_TOO_BIG:
1295 case AP_RESPONSE_NO_FIRST_PART:
1296 case AP_RESPONSE_MESSAGE_TOO_BIG:
1297 stat = DEV_BAD_MESSAGE;
1298 break;
1299 default:
1300 break;
1301 }
1302 break;
1303 default:
1304 break;
1305 }
1306
1307 return stat;
1308}
1309
1310static inline int
1311pad_msg(unsigned char *buffer, int totalLength, int msgLength)
1312{
1313 int pad_len;
1314
1315 for (pad_len = 0; pad_len < (totalLength - msgLength); pad_len++)
1316 if (buffer[pad_len] != 0x00)
1317 break;
1318 pad_len -= 3;
1319 if (pad_len < 8)
1320 return SEN_PAD_ERROR;
1321
1322 buffer[0] = 0x00;
1323 buffer[1] = 0x02;
1324
1325 memcpy(buffer+2, static_pad, pad_len);
1326
1327 buffer[pad_len + 2] = 0x00;
1328
1329 return 0;
1330}
1331
1332static inline int
1333is_common_public_key(unsigned char *key, int len)
1334{
1335 int i;
1336
1337 for (i = 0; i < len; i++)
1338 if (key[i])
1339 break;
1340 key += i;
1341 len -= i;
1342 if (((len == 1) && (key[0] == 3)) ||
1343 ((len == 3) && (key[0] == 1) && (key[1] == 0) && (key[2] == 1)))
1344 return 1;
1345
1346 return 0;
1347}
1348
1349static int
1350ICAMEX_msg_to_type4MEX_msg(struct ica_rsa_modexpo *icaMex_p, int *z90cMsg_l_p,
1351 union type4_msg *z90cMsg_p)
1352{
1353 int mod_len, msg_size, mod_tgt_len, exp_tgt_len, inp_tgt_len;
1354 unsigned char *mod_tgt, *exp_tgt, *inp_tgt;
1355 union type4_msg *tmp_type4_msg;
1356
1357 mod_len = icaMex_p->inputdatalength;
1358
1359 msg_size = ((mod_len <= 128) ? TYPE4_SME_LEN : TYPE4_LME_LEN) +
1360 CALLER_HEADER;
1361
1362 memset(z90cMsg_p, 0, msg_size);
1363
1364 tmp_type4_msg = (union type4_msg *)
1365 ((unsigned char *) z90cMsg_p + CALLER_HEADER);
1366
1367 tmp_type4_msg->sme.header.msg_type_code = TYPE4_TYPE_CODE;
1368 tmp_type4_msg->sme.header.request_code = TYPE4_REQU_CODE;
1369
1370 if (mod_len <= 128) {
1371 tmp_type4_msg->sme.header.msg_fmt = TYPE4_SME_FMT;
1372 tmp_type4_msg->sme.header.msg_len = TYPE4_SME_LEN;
1373 mod_tgt = tmp_type4_msg->sme.modulus;
1374 mod_tgt_len = sizeof(tmp_type4_msg->sme.modulus);
1375 exp_tgt = tmp_type4_msg->sme.exponent;
1376 exp_tgt_len = sizeof(tmp_type4_msg->sme.exponent);
1377 inp_tgt = tmp_type4_msg->sme.message;
1378 inp_tgt_len = sizeof(tmp_type4_msg->sme.message);
1379 } else {
1380 tmp_type4_msg->lme.header.msg_fmt = TYPE4_LME_FMT;
1381 tmp_type4_msg->lme.header.msg_len = TYPE4_LME_LEN;
1382 mod_tgt = tmp_type4_msg->lme.modulus;
1383 mod_tgt_len = sizeof(tmp_type4_msg->lme.modulus);
1384 exp_tgt = tmp_type4_msg->lme.exponent;
1385 exp_tgt_len = sizeof(tmp_type4_msg->lme.exponent);
1386 inp_tgt = tmp_type4_msg->lme.message;
1387 inp_tgt_len = sizeof(tmp_type4_msg->lme.message);
1388 }
1389
1390 mod_tgt += (mod_tgt_len - mod_len);
1391 if (copy_from_user(mod_tgt, icaMex_p->n_modulus, mod_len))
1392 return SEN_RELEASED;
1393 if (is_empty(mod_tgt, mod_len))
1394 return SEN_USER_ERROR;
1395 exp_tgt += (exp_tgt_len - mod_len);
1396 if (copy_from_user(exp_tgt, icaMex_p->b_key, mod_len))
1397 return SEN_RELEASED;
1398 if (is_empty(exp_tgt, mod_len))
1399 return SEN_USER_ERROR;
1400 inp_tgt += (inp_tgt_len - mod_len);
1401 if (copy_from_user(inp_tgt, icaMex_p->inputdata, mod_len))
1402 return SEN_RELEASED;
1403 if (is_empty(inp_tgt, mod_len))
1404 return SEN_USER_ERROR;
1405
1406 *z90cMsg_l_p = msg_size - CALLER_HEADER;
1407
1408 return 0;
1409}
1410
1411static int
1412ICACRT_msg_to_type4CRT_msg(struct ica_rsa_modexpo_crt *icaMsg_p,
1413 int *z90cMsg_l_p, union type4_msg *z90cMsg_p)
1414{
1415 int mod_len, short_len, long_len, tmp_size, p_tgt_len, q_tgt_len,
1416 dp_tgt_len, dq_tgt_len, u_tgt_len, inp_tgt_len;
1417 unsigned char *p_tgt, *q_tgt, *dp_tgt, *dq_tgt, *u_tgt, *inp_tgt;
1418 union type4_msg *tmp_type4_msg;
1419
1420 mod_len = icaMsg_p->inputdatalength;
1421 short_len = mod_len / 2;
1422 long_len = mod_len / 2 + 8;
1423
1424 tmp_size = ((mod_len <= 128) ? TYPE4_SCR_LEN : TYPE4_LCR_LEN) +
1425 CALLER_HEADER;
1426
1427 memset(z90cMsg_p, 0, tmp_size);
1428
1429 tmp_type4_msg = (union type4_msg *)
1430 ((unsigned char *) z90cMsg_p + CALLER_HEADER);
1431
1432 tmp_type4_msg->scr.header.msg_type_code = TYPE4_TYPE_CODE;
1433 tmp_type4_msg->scr.header.request_code = TYPE4_REQU_CODE;
1434 if (mod_len <= 128) {
1435 tmp_type4_msg->scr.header.msg_fmt = TYPE4_SCR_FMT;
1436 tmp_type4_msg->scr.header.msg_len = TYPE4_SCR_LEN;
1437 p_tgt = tmp_type4_msg->scr.p;
1438 p_tgt_len = sizeof(tmp_type4_msg->scr.p);
1439 q_tgt = tmp_type4_msg->scr.q;
1440 q_tgt_len = sizeof(tmp_type4_msg->scr.q);
1441 dp_tgt = tmp_type4_msg->scr.dp;
1442 dp_tgt_len = sizeof(tmp_type4_msg->scr.dp);
1443 dq_tgt = tmp_type4_msg->scr.dq;
1444 dq_tgt_len = sizeof(tmp_type4_msg->scr.dq);
1445 u_tgt = tmp_type4_msg->scr.u;
1446 u_tgt_len = sizeof(tmp_type4_msg->scr.u);
1447 inp_tgt = tmp_type4_msg->scr.message;
1448 inp_tgt_len = sizeof(tmp_type4_msg->scr.message);
1449 } else {
1450 tmp_type4_msg->lcr.header.msg_fmt = TYPE4_LCR_FMT;
1451 tmp_type4_msg->lcr.header.msg_len = TYPE4_LCR_LEN;
1452 p_tgt = tmp_type4_msg->lcr.p;
1453 p_tgt_len = sizeof(tmp_type4_msg->lcr.p);
1454 q_tgt = tmp_type4_msg->lcr.q;
1455 q_tgt_len = sizeof(tmp_type4_msg->lcr.q);
1456 dp_tgt = tmp_type4_msg->lcr.dp;
1457 dp_tgt_len = sizeof(tmp_type4_msg->lcr.dp);
1458 dq_tgt = tmp_type4_msg->lcr.dq;
1459 dq_tgt_len = sizeof(tmp_type4_msg->lcr.dq);
1460 u_tgt = tmp_type4_msg->lcr.u;
1461 u_tgt_len = sizeof(tmp_type4_msg->lcr.u);
1462 inp_tgt = tmp_type4_msg->lcr.message;
1463 inp_tgt_len = sizeof(tmp_type4_msg->lcr.message);
1464 }
1465
1466 p_tgt += (p_tgt_len - long_len);
1467 if (copy_from_user(p_tgt, icaMsg_p->np_prime, long_len))
1468 return SEN_RELEASED;
1469 if (is_empty(p_tgt, long_len))
1470 return SEN_USER_ERROR;
1471 q_tgt += (q_tgt_len - short_len);
1472 if (copy_from_user(q_tgt, icaMsg_p->nq_prime, short_len))
1473 return SEN_RELEASED;
1474 if (is_empty(q_tgt, short_len))
1475 return SEN_USER_ERROR;
1476 dp_tgt += (dp_tgt_len - long_len);
1477 if (copy_from_user(dp_tgt, icaMsg_p->bp_key, long_len))
1478 return SEN_RELEASED;
1479 if (is_empty(dp_tgt, long_len))
1480 return SEN_USER_ERROR;
1481 dq_tgt += (dq_tgt_len - short_len);
1482 if (copy_from_user(dq_tgt, icaMsg_p->bq_key, short_len))
1483 return SEN_RELEASED;
1484 if (is_empty(dq_tgt, short_len))
1485 return SEN_USER_ERROR;
1486 u_tgt += (u_tgt_len - long_len);
1487 if (copy_from_user(u_tgt, icaMsg_p->u_mult_inv, long_len))
1488 return SEN_RELEASED;
1489 if (is_empty(u_tgt, long_len))
1490 return SEN_USER_ERROR;
1491 inp_tgt += (inp_tgt_len - mod_len);
1492 if (copy_from_user(inp_tgt, icaMsg_p->inputdata, mod_len))
1493 return SEN_RELEASED;
1494 if (is_empty(inp_tgt, mod_len))
1495 return SEN_USER_ERROR;
1496
1497 *z90cMsg_l_p = tmp_size - CALLER_HEADER;
1498
1499 return 0;
1500}
1501
1502static int
1503ICAMEX_msg_to_type6MEX_de_msg(struct ica_rsa_modexpo *icaMsg_p, int cdx,
1504 int *z90cMsg_l_p, struct type6_msg *z90cMsg_p)
1505{
1506 int mod_len, vud_len, tmp_size, total_CPRB_len, parmBlock_l;
1507 unsigned char *temp;
1508 struct type6_hdr *tp6Hdr_p;
1509 struct CPRB *cprb_p;
1510 struct cca_private_ext_ME *key_p;
1511 static int deprecated_msg_count = 0;
1512
1513 mod_len = icaMsg_p->inputdatalength;
1514 tmp_size = FIXED_TYPE6_ME_LEN + mod_len;
1515 total_CPRB_len = tmp_size - sizeof(struct type6_hdr);
1516 parmBlock_l = total_CPRB_len - sizeof(struct CPRB);
1517 tmp_size = 4*((tmp_size + 3)/4) + CALLER_HEADER;
1518
1519 memset(z90cMsg_p, 0, tmp_size);
1520
1521 temp = (unsigned char *)z90cMsg_p + CALLER_HEADER;
1522 memcpy(temp, &static_type6_hdr, sizeof(struct type6_hdr));
1523 tp6Hdr_p = (struct type6_hdr *)temp;
1524 tp6Hdr_p->ToCardLen1 = 4*((total_CPRB_len+3)/4);
1525 tp6Hdr_p->FromCardLen1 = RESPONSE_CPRB_SIZE;
1526
1527 temp += sizeof(struct type6_hdr);
1528 memcpy(temp, &static_cprb, sizeof(struct CPRB));
1529 cprb_p = (struct CPRB *) temp;
1530 cprb_p->usage_domain[0]= (unsigned char)cdx;
1531 itoLe2(&parmBlock_l, cprb_p->req_parml);
1532 itoLe2((int *)&(tp6Hdr_p->FromCardLen1), cprb_p->rpl_parml);
1533
1534 temp += sizeof(struct CPRB);
1535 memcpy(temp, &static_pkd_function_and_rules,
1536 sizeof(struct function_and_rules_block));
1537
1538 temp += sizeof(struct function_and_rules_block);
1539 vud_len = 2 + icaMsg_p->inputdatalength;
1540 itoLe2(&vud_len, temp);
1541
1542 temp += 2;
1543 if (copy_from_user(temp, icaMsg_p->inputdata, mod_len))
1544 return SEN_RELEASED;
1545 if (is_empty(temp, mod_len))
1546 return SEN_USER_ERROR;
1547
1548 temp += mod_len;
1549 memcpy(temp, &static_T6_keyBlock_hdr, sizeof(struct T6_keyBlock_hdr));
1550
1551 temp += sizeof(struct T6_keyBlock_hdr);
1552 memcpy(temp, &static_pvt_me_key, sizeof(struct cca_private_ext_ME));
1553 key_p = (struct cca_private_ext_ME *)temp;
1554 temp = key_p->pvtMESec.exponent + sizeof(key_p->pvtMESec.exponent)
1555 - mod_len;
1556 if (copy_from_user(temp, icaMsg_p->b_key, mod_len))
1557 return SEN_RELEASED;
1558 if (is_empty(temp, mod_len))
1559 return SEN_USER_ERROR;
1560
1561 if (is_common_public_key(temp, mod_len)) {
1562 if (deprecated_msg_count < 20) {
1563 PRINTK("Common public key used for modex decrypt\n");
1564 deprecated_msg_count++;
1565 if (deprecated_msg_count == 20)
1566 PRINTK("No longer issuing messages about common"
1567 " public key for modex decrypt.\n");
1568 }
1569 return SEN_NOT_AVAIL;
1570 }
1571
1572 temp = key_p->pvtMESec.modulus + sizeof(key_p->pvtMESec.modulus)
1573 - mod_len;
1574 if (copy_from_user(temp, icaMsg_p->n_modulus, mod_len))
1575 return SEN_RELEASED;
1576 if (is_empty(temp, mod_len))
1577 return SEN_USER_ERROR;
1578
1579 key_p->pubMESec.modulus_bit_len = 8 * mod_len;
1580
1581 *z90cMsg_l_p = tmp_size - CALLER_HEADER;
1582
1583 return 0;
1584}
1585
1586static int
1587ICAMEX_msg_to_type6MEX_en_msg(struct ica_rsa_modexpo *icaMsg_p, int cdx,
1588 int *z90cMsg_l_p, struct type6_msg *z90cMsg_p)
1589{
1590 int mod_len, vud_len, exp_len, key_len;
1591 int pad_len, tmp_size, total_CPRB_len, parmBlock_l, i;
1592 unsigned char *temp_exp, *exp_p, *temp;
1593 struct type6_hdr *tp6Hdr_p;
1594 struct CPRB *cprb_p;
1595 struct cca_public_key *key_p;
1596 struct T6_keyBlock_hdr *keyb_p;
1597
1598 temp_exp = kmalloc(256, GFP_KERNEL);
1599 if (!temp_exp)
1600 return EGETBUFF;
1601 mod_len = icaMsg_p->inputdatalength;
1602 if (copy_from_user(temp_exp, icaMsg_p->b_key, mod_len)) {
1603 kfree(temp_exp);
1604 return SEN_RELEASED;
1605 }
1606 if (is_empty(temp_exp, mod_len)) {
1607 kfree(temp_exp);
1608 return SEN_USER_ERROR;
1609 }
1610
1611 exp_p = temp_exp;
1612 for (i = 0; i < mod_len; i++)
1613 if (exp_p[i])
1614 break;
1615 if (i >= mod_len) {
1616 kfree(temp_exp);
1617 return SEN_USER_ERROR;
1618 }
1619
1620 exp_len = mod_len - i;
1621 exp_p += i;
1622
1623 PDEBUG("exp_len after computation: %08x\n", exp_len);
1624 tmp_size = FIXED_TYPE6_ME_EN_LEN + 2 * mod_len + exp_len;
1625 total_CPRB_len = tmp_size - sizeof(struct type6_hdr);
1626 parmBlock_l = total_CPRB_len - sizeof(struct CPRB);
1627 tmp_size = 4*((tmp_size + 3)/4) + CALLER_HEADER;
1628
1629 vud_len = 2 + mod_len;
1630 memset(z90cMsg_p, 0, tmp_size);
1631
1632 temp = (unsigned char *)z90cMsg_p + CALLER_HEADER;
1633 memcpy(temp, &static_type6_hdr, sizeof(struct type6_hdr));
1634 tp6Hdr_p = (struct type6_hdr *)temp;
1635 tp6Hdr_p->ToCardLen1 = 4*((total_CPRB_len+3)/4);
1636 tp6Hdr_p->FromCardLen1 = RESPONSE_CPRB_SIZE;
1637 memcpy(tp6Hdr_p->function_code, static_PKE_function_code,
1638 sizeof(static_PKE_function_code));
1639 temp += sizeof(struct type6_hdr);
1640 memcpy(temp, &static_cprb, sizeof(struct CPRB));
1641 cprb_p = (struct CPRB *) temp;
1642 cprb_p->usage_domain[0]= (unsigned char)cdx;
1643 itoLe2((int *)&(tp6Hdr_p->FromCardLen1), cprb_p->rpl_parml);
1644 temp += sizeof(struct CPRB);
1645 memcpy(temp, &static_pke_function_and_rules,
1646 sizeof(struct function_and_rules_block));
1647 temp += sizeof(struct function_and_rules_block);
1648 temp += 2;
1649 if (copy_from_user(temp, icaMsg_p->inputdata, mod_len)) {
1650 kfree(temp_exp);
1651 return SEN_RELEASED;
1652 }
1653 if (is_empty(temp, mod_len)) {
1654 kfree(temp_exp);
1655 return SEN_USER_ERROR;
1656 }
1657 if ((temp[0] != 0x00) || (temp[1] != 0x02)) {
1658 kfree(temp_exp);
1659 return SEN_NOT_AVAIL;
1660 }
1661 for (i = 2; i < mod_len; i++)
1662 if (temp[i] == 0x00)
1663 break;
1664 if ((i < 9) || (i > (mod_len - 2))) {
1665 kfree(temp_exp);
1666 return SEN_NOT_AVAIL;
1667 }
1668 pad_len = i + 1;
1669 vud_len = mod_len - pad_len;
1670 memmove(temp, temp+pad_len, vud_len);
1671 temp -= 2;
1672 vud_len += 2;
1673 itoLe2(&vud_len, temp);
1674 temp += (vud_len);
1675 keyb_p = (struct T6_keyBlock_hdr *)temp;
1676 temp += sizeof(struct T6_keyBlock_hdr);
1677 memcpy(temp, &static_public_key, sizeof(static_public_key));
1678 key_p = (struct cca_public_key *)temp;
1679 temp = key_p->pubSec.exponent;
1680 memcpy(temp, exp_p, exp_len);
1681 kfree(temp_exp);
1682 temp += exp_len;
1683 if (copy_from_user(temp, icaMsg_p->n_modulus, mod_len))
1684 return SEN_RELEASED;
1685 if (is_empty(temp, mod_len))
1686 return SEN_USER_ERROR;
1687 key_p->pubSec.modulus_bit_len = 8 * mod_len;
1688 key_p->pubSec.modulus_byte_len = mod_len;
1689 key_p->pubSec.exponent_len = exp_len;
1690 key_p->pubSec.section_length = CALLER_HEADER + mod_len + exp_len;
1691 key_len = key_p->pubSec.section_length + sizeof(struct cca_token_hdr);
1692 key_p->pubHdr.token_length = key_len;
1693 key_len += 4;
1694 itoLe2(&key_len, keyb_p->ulen);
1695 key_len += 2;
1696 itoLe2(&key_len, keyb_p->blen);
1697 parmBlock_l -= pad_len;
1698 itoLe2(&parmBlock_l, cprb_p->req_parml);
1699 *z90cMsg_l_p = tmp_size - CALLER_HEADER;
1700
1701 return 0;
1702}
1703
1704static int
1705ICACRT_msg_to_type6CRT_msg(struct ica_rsa_modexpo_crt *icaMsg_p, int cdx,
1706 int *z90cMsg_l_p, struct type6_msg *z90cMsg_p)
1707{
1708 int mod_len, vud_len, tmp_size, total_CPRB_len, parmBlock_l, short_len;
1709 int long_len, pad_len, keyPartsLen, tmp_l;
1710 unsigned char *tgt_p, *temp;
1711 struct type6_hdr *tp6Hdr_p;
1712 struct CPRB *cprb_p;
1713 struct cca_token_hdr *keyHdr_p;
1714 struct cca_pvt_ext_CRT_sec *pvtSec_p;
1715 struct cca_public_sec *pubSec_p;
1716
1717 mod_len = icaMsg_p->inputdatalength;
1718 short_len = mod_len / 2;
1719 long_len = 8 + short_len;
1720 keyPartsLen = 3 * long_len + 2 * short_len;
1721 pad_len = (8 - (keyPartsLen % 8)) % 8;
1722 keyPartsLen += pad_len + mod_len;
1723 tmp_size = FIXED_TYPE6_CR_LEN + keyPartsLen + mod_len;
1724 total_CPRB_len = tmp_size - sizeof(struct type6_hdr);
1725 parmBlock_l = total_CPRB_len - sizeof(struct CPRB);
1726 vud_len = 2 + mod_len;
1727 tmp_size = 4*((tmp_size + 3)/4) + CALLER_HEADER;
1728
1729 memset(z90cMsg_p, 0, tmp_size);
1730 tgt_p = (unsigned char *)z90cMsg_p + CALLER_HEADER;
1731 memcpy(tgt_p, &static_type6_hdr, sizeof(struct type6_hdr));
1732 tp6Hdr_p = (struct type6_hdr *)tgt_p;
1733 tp6Hdr_p->ToCardLen1 = 4*((total_CPRB_len+3)/4);
1734 tp6Hdr_p->FromCardLen1 = RESPONSE_CPRB_SIZE;
1735 tgt_p += sizeof(struct type6_hdr);
1736 cprb_p = (struct CPRB *) tgt_p;
1737 memcpy(tgt_p, &static_cprb, sizeof(struct CPRB));
1738 cprb_p->usage_domain[0]= *((unsigned char *)(&(cdx))+3);
1739 itoLe2(&parmBlock_l, cprb_p->req_parml);
1740 memcpy(cprb_p->rpl_parml, cprb_p->req_parml,
1741 sizeof(cprb_p->req_parml));
1742 tgt_p += sizeof(struct CPRB);
1743 memcpy(tgt_p, &static_pkd_function_and_rules,
1744 sizeof(struct function_and_rules_block));
1745 tgt_p += sizeof(struct function_and_rules_block);
1746 itoLe2(&vud_len, tgt_p);
1747 tgt_p += 2;
1748 if (copy_from_user(tgt_p, icaMsg_p->inputdata, mod_len))
1749 return SEN_RELEASED;
1750 if (is_empty(tgt_p, mod_len))
1751 return SEN_USER_ERROR;
1752 tgt_p += mod_len;
1753 tmp_l = sizeof(struct T6_keyBlock_hdr) + sizeof(struct cca_token_hdr) +
1754 sizeof(struct cca_pvt_ext_CRT_sec) + 0x0F + keyPartsLen;
1755 itoLe2(&tmp_l, tgt_p);
1756 temp = tgt_p + 2;
1757 tmp_l -= 2;
1758 itoLe2(&tmp_l, temp);
1759 tgt_p += sizeof(struct T6_keyBlock_hdr);
1760 keyHdr_p = (struct cca_token_hdr *)tgt_p;
1761 keyHdr_p->token_identifier = CCA_TKN_HDR_ID_EXT;
1762 tmp_l -= 4;
1763 keyHdr_p->token_length = tmp_l;
1764 tgt_p += sizeof(struct cca_token_hdr);
1765 pvtSec_p = (struct cca_pvt_ext_CRT_sec *)tgt_p;
1766 pvtSec_p->section_identifier = CCA_PVT_EXT_CRT_SEC_ID_PVT;
1767 pvtSec_p->section_length =
1768 sizeof(struct cca_pvt_ext_CRT_sec) + keyPartsLen;
1769 pvtSec_p->key_format = CCA_PVT_EXT_CRT_SEC_FMT_CL;
1770 pvtSec_p->key_use_flags[0] = CCA_PVT_USAGE_ALL;
1771 pvtSec_p->p_len = long_len;
1772 pvtSec_p->q_len = short_len;
1773 pvtSec_p->dp_len = long_len;
1774 pvtSec_p->dq_len = short_len;
1775 pvtSec_p->u_len = long_len;
1776 pvtSec_p->mod_len = mod_len;
1777 pvtSec_p->pad_len = pad_len;
1778 tgt_p += sizeof(struct cca_pvt_ext_CRT_sec);
1779 if (copy_from_user(tgt_p, icaMsg_p->np_prime, long_len))
1780 return SEN_RELEASED;
1781 if (is_empty(tgt_p, long_len))
1782 return SEN_USER_ERROR;
1783 tgt_p += long_len;
1784 if (copy_from_user(tgt_p, icaMsg_p->nq_prime, short_len))
1785 return SEN_RELEASED;
1786 if (is_empty(tgt_p, short_len))
1787 return SEN_USER_ERROR;
1788 tgt_p += short_len;
1789 if (copy_from_user(tgt_p, icaMsg_p->bp_key, long_len))
1790 return SEN_RELEASED;
1791 if (is_empty(tgt_p, long_len))
1792 return SEN_USER_ERROR;
1793 tgt_p += long_len;
1794 if (copy_from_user(tgt_p, icaMsg_p->bq_key, short_len))
1795 return SEN_RELEASED;
1796 if (is_empty(tgt_p, short_len))
1797 return SEN_USER_ERROR;
1798 tgt_p += short_len;
1799 if (copy_from_user(tgt_p, icaMsg_p->u_mult_inv, long_len))
1800 return SEN_RELEASED;
1801 if (is_empty(tgt_p, long_len))
1802 return SEN_USER_ERROR;
1803 tgt_p += long_len;
1804 tgt_p += pad_len;
1805 memset(tgt_p, 0xFF, mod_len);
1806 tgt_p += mod_len;
1807 memcpy(tgt_p, &static_cca_pub_sec, sizeof(struct cca_public_sec));
1808 pubSec_p = (struct cca_public_sec *) tgt_p;
1809 pubSec_p->modulus_bit_len = 8 * mod_len;
1810 *z90cMsg_l_p = tmp_size - CALLER_HEADER;
1811
1812 return 0;
1813}
1814
1815static int
1816ICAMEX_msg_to_type6MEX_msgX(struct ica_rsa_modexpo *icaMsg_p, int cdx,
1817 int *z90cMsg_l_p, struct type6_msg *z90cMsg_p,
1818 int dev_type)
1819{
1820 int mod_len, exp_len, vud_len, tmp_size, total_CPRB_len, parmBlock_l;
1821 int key_len, i;
1822 unsigned char *temp_exp, *tgt_p, *temp, *exp_p;
1823 struct type6_hdr *tp6Hdr_p;
1824 struct CPRBX *cprbx_p;
1825 struct cca_public_key *key_p;
1826 struct T6_keyBlock_hdrX *keyb_p;
1827
1828 temp_exp = kmalloc(256, GFP_KERNEL);
1829 if (!temp_exp)
1830 return EGETBUFF;
1831 mod_len = icaMsg_p->inputdatalength;
1832 if (copy_from_user(temp_exp, icaMsg_p->b_key, mod_len)) {
1833 kfree(temp_exp);
1834 return SEN_RELEASED;
1835 }
1836 if (is_empty(temp_exp, mod_len)) {
1837 kfree(temp_exp);
1838 return SEN_USER_ERROR;
1839 }
1840 exp_p = temp_exp;
1841 for (i = 0; i < mod_len; i++)
1842 if (exp_p[i])
1843 break;
1844 if (i >= mod_len) {
1845 kfree(temp_exp);
1846 return SEN_USER_ERROR;
1847 }
1848 exp_len = mod_len - i;
1849 exp_p += i;
1850 PDEBUG("exp_len after computation: %08x\n", exp_len);
1851 tmp_size = FIXED_TYPE6_ME_EN_LENX + 2 * mod_len + exp_len;
1852 total_CPRB_len = tmp_size - sizeof(struct type6_hdr);
1853 parmBlock_l = total_CPRB_len - sizeof(struct CPRBX);
1854 tmp_size = tmp_size + CALLER_HEADER;
1855 vud_len = 2 + mod_len;
1856 memset(z90cMsg_p, 0, tmp_size);
1857 tgt_p = (unsigned char *)z90cMsg_p + CALLER_HEADER;
1858 memcpy(tgt_p, &static_type6_hdrX, sizeof(struct type6_hdr));
1859 tp6Hdr_p = (struct type6_hdr *)tgt_p;
1860 tp6Hdr_p->ToCardLen1 = total_CPRB_len;
1861 tp6Hdr_p->FromCardLen1 = RESPONSE_CPRBX_SIZE;
1862 memcpy(tp6Hdr_p->function_code, static_PKE_function_code,
1863 sizeof(static_PKE_function_code));
1864 tgt_p += sizeof(struct type6_hdr);
1865 memcpy(tgt_p, &static_cprbx, sizeof(struct CPRBX));
1866 cprbx_p = (struct CPRBX *) tgt_p;
1867 cprbx_p->domain = (unsigned short)cdx;
1868 cprbx_p->rpl_msgbl = RESPONSE_CPRBX_SIZE;
1869 tgt_p += sizeof(struct CPRBX);
1870 if (dev_type == PCIXCC_MCL2)
1871 memcpy(tgt_p, &static_pke_function_and_rulesX_MCL2,
1872 sizeof(struct function_and_rules_block));
1873 else
1874 memcpy(tgt_p, &static_pke_function_and_rulesX,
1875 sizeof(struct function_and_rules_block));
1876 tgt_p += sizeof(struct function_and_rules_block);
1877
1878 tgt_p += 2;
1879 if (copy_from_user(tgt_p, icaMsg_p->inputdata, mod_len)) {
1880 kfree(temp_exp);
1881 return SEN_RELEASED;
1882 }
1883 if (is_empty(tgt_p, mod_len)) {
1884 kfree(temp_exp);
1885 return SEN_USER_ERROR;
1886 }
1887 tgt_p -= 2;
1888 *((short *)tgt_p) = (short) vud_len;
1889 tgt_p += vud_len;
1890 keyb_p = (struct T6_keyBlock_hdrX *)tgt_p;
1891 tgt_p += sizeof(struct T6_keyBlock_hdrX);
1892 memcpy(tgt_p, &static_public_key, sizeof(static_public_key));
1893 key_p = (struct cca_public_key *)tgt_p;
1894 temp = key_p->pubSec.exponent;
1895 memcpy(temp, exp_p, exp_len);
1896 kfree(temp_exp);
1897 temp += exp_len;
1898 if (copy_from_user(temp, icaMsg_p->n_modulus, mod_len))
1899 return SEN_RELEASED;
1900 if (is_empty(temp, mod_len))
1901 return SEN_USER_ERROR;
1902 key_p->pubSec.modulus_bit_len = 8 * mod_len;
1903 key_p->pubSec.modulus_byte_len = mod_len;
1904 key_p->pubSec.exponent_len = exp_len;
1905 key_p->pubSec.section_length = CALLER_HEADER + mod_len + exp_len;
1906 key_len = key_p->pubSec.section_length + sizeof(struct cca_token_hdr);
1907 key_p->pubHdr.token_length = key_len;
1908 key_len += 4;
1909 keyb_p->ulen = (unsigned short)key_len;
1910 key_len += 2;
1911 keyb_p->blen = (unsigned short)key_len;
1912 cprbx_p->req_parml = parmBlock_l;
1913 *z90cMsg_l_p = tmp_size - CALLER_HEADER;
1914
1915 return 0;
1916}
1917
1918static int
1919ICACRT_msg_to_type6CRT_msgX(struct ica_rsa_modexpo_crt *icaMsg_p, int cdx,
1920 int *z90cMsg_l_p, struct type6_msg *z90cMsg_p,
1921 int dev_type)
1922{
1923 int mod_len, vud_len, tmp_size, total_CPRB_len, parmBlock_l, short_len;
1924 int long_len, pad_len, keyPartsLen, tmp_l;
1925 unsigned char *tgt_p, *temp;
1926 struct type6_hdr *tp6Hdr_p;
1927 struct CPRBX *cprbx_p;
1928 struct cca_token_hdr *keyHdr_p;
1929 struct cca_pvt_ext_CRT_sec *pvtSec_p;
1930 struct cca_public_sec *pubSec_p;
1931
1932 mod_len = icaMsg_p->inputdatalength;
1933 short_len = mod_len / 2;
1934 long_len = 8 + short_len;
1935 keyPartsLen = 3 * long_len + 2 * short_len;
1936 pad_len = (8 - (keyPartsLen % 8)) % 8;
1937 keyPartsLen += pad_len + mod_len;
1938 tmp_size = FIXED_TYPE6_CR_LENX + keyPartsLen + mod_len;
1939 total_CPRB_len = tmp_size - sizeof(struct type6_hdr);
1940 parmBlock_l = total_CPRB_len - sizeof(struct CPRBX);
1941 vud_len = 2 + mod_len;
1942 tmp_size = tmp_size + CALLER_HEADER;
1943 memset(z90cMsg_p, 0, tmp_size);
1944 tgt_p = (unsigned char *)z90cMsg_p + CALLER_HEADER;
1945 memcpy(tgt_p, &static_type6_hdrX, sizeof(struct type6_hdr));
1946 tp6Hdr_p = (struct type6_hdr *)tgt_p;
1947 tp6Hdr_p->ToCardLen1 = total_CPRB_len;
1948 tp6Hdr_p->FromCardLen1 = RESPONSE_CPRBX_SIZE;
1949 tgt_p += sizeof(struct type6_hdr);
1950 cprbx_p = (struct CPRBX *) tgt_p;
1951 memcpy(tgt_p, &static_cprbx, sizeof(struct CPRBX));
1952 cprbx_p->domain = (unsigned short)cdx;
1953 cprbx_p->req_parml = parmBlock_l;
1954 cprbx_p->rpl_msgbl = parmBlock_l;
1955 tgt_p += sizeof(struct CPRBX);
1956 if (dev_type == PCIXCC_MCL2)
1957 memcpy(tgt_p, &static_pkd_function_and_rulesX_MCL2,
1958 sizeof(struct function_and_rules_block));
1959 else
1960 memcpy(tgt_p, &static_pkd_function_and_rulesX,
1961 sizeof(struct function_and_rules_block));
1962 tgt_p += sizeof(struct function_and_rules_block);
1963 *((short *)tgt_p) = (short) vud_len;
1964 tgt_p += 2;
1965 if (copy_from_user(tgt_p, icaMsg_p->inputdata, mod_len))
1966 return SEN_RELEASED;
1967 if (is_empty(tgt_p, mod_len))
1968 return SEN_USER_ERROR;
1969 tgt_p += mod_len;
1970 tmp_l = sizeof(struct T6_keyBlock_hdr) + sizeof(struct cca_token_hdr) +
1971 sizeof(struct cca_pvt_ext_CRT_sec) + 0x0F + keyPartsLen;
1972 *((short *)tgt_p) = (short) tmp_l;
1973 temp = tgt_p + 2;
1974 tmp_l -= 2;
1975 *((short *)temp) = (short) tmp_l;
1976 tgt_p += sizeof(struct T6_keyBlock_hdr);
1977 keyHdr_p = (struct cca_token_hdr *)tgt_p;
1978 keyHdr_p->token_identifier = CCA_TKN_HDR_ID_EXT;
1979 tmp_l -= 4;
1980 keyHdr_p->token_length = tmp_l;
1981 tgt_p += sizeof(struct cca_token_hdr);
1982 pvtSec_p = (struct cca_pvt_ext_CRT_sec *)tgt_p;
1983 pvtSec_p->section_identifier = CCA_PVT_EXT_CRT_SEC_ID_PVT;
1984 pvtSec_p->section_length =
1985 sizeof(struct cca_pvt_ext_CRT_sec) + keyPartsLen;
1986 pvtSec_p->key_format = CCA_PVT_EXT_CRT_SEC_FMT_CL;
1987 pvtSec_p->key_use_flags[0] = CCA_PVT_USAGE_ALL;
1988 pvtSec_p->p_len = long_len;
1989 pvtSec_p->q_len = short_len;
1990 pvtSec_p->dp_len = long_len;
1991 pvtSec_p->dq_len = short_len;
1992 pvtSec_p->u_len = long_len;
1993 pvtSec_p->mod_len = mod_len;
1994 pvtSec_p->pad_len = pad_len;
1995 tgt_p += sizeof(struct cca_pvt_ext_CRT_sec);
1996 if (copy_from_user(tgt_p, icaMsg_p->np_prime, long_len))
1997 return SEN_RELEASED;
1998 if (is_empty(tgt_p, long_len))
1999 return SEN_USER_ERROR;
2000 tgt_p += long_len;
2001 if (copy_from_user(tgt_p, icaMsg_p->nq_prime, short_len))
2002 return SEN_RELEASED;
2003 if (is_empty(tgt_p, short_len))
2004 return SEN_USER_ERROR;
2005 tgt_p += short_len;
2006 if (copy_from_user(tgt_p, icaMsg_p->bp_key, long_len))
2007 return SEN_RELEASED;
2008 if (is_empty(tgt_p, long_len))
2009 return SEN_USER_ERROR;
2010 tgt_p += long_len;
2011 if (copy_from_user(tgt_p, icaMsg_p->bq_key, short_len))
2012 return SEN_RELEASED;
2013 if (is_empty(tgt_p, short_len))
2014 return SEN_USER_ERROR;
2015 tgt_p += short_len;
2016 if (copy_from_user(tgt_p, icaMsg_p->u_mult_inv, long_len))
2017 return SEN_RELEASED;
2018 if (is_empty(tgt_p, long_len))
2019 return SEN_USER_ERROR;
2020 tgt_p += long_len;
2021 tgt_p += pad_len;
2022 memset(tgt_p, 0xFF, mod_len);
2023 tgt_p += mod_len;
2024 memcpy(tgt_p, &static_cca_pub_sec, sizeof(struct cca_public_sec));
2025 pubSec_p = (struct cca_public_sec *) tgt_p;
2026 pubSec_p->modulus_bit_len = 8 * mod_len;
2027 *z90cMsg_l_p = tmp_size - CALLER_HEADER;
2028
2029 return 0;
2030}
2031
2032int
2033convert_request(unsigned char *buffer, int func, unsigned short function,
2034 int cdx, int dev_type, int *msg_l_p, unsigned char *msg_p)
2035{
2036 if (dev_type == PCICA) {
2037 if (func == ICARSACRT)
2038 return ICACRT_msg_to_type4CRT_msg(
2039 (struct ica_rsa_modexpo_crt *) buffer,
2040 msg_l_p, (union type4_msg *) msg_p);
2041 else
2042 return ICAMEX_msg_to_type4MEX_msg(
2043 (struct ica_rsa_modexpo *) buffer,
2044 msg_l_p, (union type4_msg *) msg_p);
2045 }
2046 if (dev_type == PCICC) {
2047 if (func == ICARSACRT)
2048 return ICACRT_msg_to_type6CRT_msg(
2049 (struct ica_rsa_modexpo_crt *) buffer,
2050 cdx, msg_l_p, (struct type6_msg *)msg_p);
2051 if (function == PCI_FUNC_KEY_ENCRYPT)
2052 return ICAMEX_msg_to_type6MEX_en_msg(
2053 (struct ica_rsa_modexpo *) buffer,
2054 cdx, msg_l_p, (struct type6_msg *) msg_p);
2055 else
2056 return ICAMEX_msg_to_type6MEX_de_msg(
2057 (struct ica_rsa_modexpo *) buffer,
2058 cdx, msg_l_p, (struct type6_msg *) msg_p);
2059 }
2060 if ((dev_type == PCIXCC_MCL2) ||
2061 (dev_type == PCIXCC_MCL3) ||
2062 (dev_type == CEX2C)) {
2063 if (func == ICARSACRT)
2064 return ICACRT_msg_to_type6CRT_msgX(
2065 (struct ica_rsa_modexpo_crt *) buffer,
2066 cdx, msg_l_p, (struct type6_msg *) msg_p,
2067 dev_type);
2068 else
2069 return ICAMEX_msg_to_type6MEX_msgX(
2070 (struct ica_rsa_modexpo *) buffer,
2071 cdx, msg_l_p, (struct type6_msg *) msg_p,
2072 dev_type);
2073 }
2074
2075 return 0;
2076}
2077
2078int ext_bitlens_msg_count = 0;
2079static inline void
2080unset_ext_bitlens(void)
2081{
2082 if (!ext_bitlens_msg_count) {
2083 PRINTK("Unable to use coprocessors for extended bitlengths. "
2084 "Using PCICAs (if present) for extended bitlengths. "
2085 "This is not an error.\n");
2086 ext_bitlens_msg_count++;
2087 }
2088 ext_bitlens = 0;
2089}
2090
2091int
2092convert_response(unsigned char *response, unsigned char *buffer,
2093 int *respbufflen_p, unsigned char *resp_buff)
2094{
2095 struct ica_rsa_modexpo *icaMsg_p = (struct ica_rsa_modexpo *) buffer;
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2096 struct error_hdr *errh_p = (struct error_hdr *) response;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2097 struct type84_hdr *t84h_p = (struct type84_hdr *) response;
2098 struct type86_fmt2_msg *t86m_p = (struct type86_fmt2_msg *) response;
2099 int reply_code, service_rc, service_rs, src_l;
2100 unsigned char *src_p, *tgt_p;
2101 struct CPRB *cprb_p;
2102 struct CPRBX *cprbx_p;
2103
2104 src_p = 0;
2105 reply_code = 0;
2106 service_rc = 0;
2107 service_rs = 0;
2108 src_l = 0;
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2109 switch (errh_p->type) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2110 case TYPE82_RSP_CODE:
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2111 reply_code = errh_p->reply_code;
2112 src_p = (unsigned char *)errh_p;
2113 PRINTK("Hardware error: Type %02X Message Header: "
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2114 "%02x%02x%02x%02x%02x%02x%02x%02x\n",
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2115 errh_p->type,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2116 src_p[0], src_p[1], src_p[2], src_p[3],
2117 src_p[4], src_p[5], src_p[6], src_p[7]);
2118 break;
2119 case TYPE84_RSP_CODE:
2120 src_l = icaMsg_p->outputdatalength;
2121 src_p = response + (int)t84h_p->len - src_l;
2122 break;
2123 case TYPE86_RSP_CODE:
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2124 reply_code = t86m_p->header.reply_code;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2125 if (reply_code != 0)
2126 break;
2127 cprb_p = (struct CPRB *)
2128 (response + sizeof(struct type86_fmt2_msg));
2129 cprbx_p = (struct CPRBX *) cprb_p;
2130 if (cprb_p->cprb_ver_id != 0x02) {
2131 le2toI(cprb_p->ccp_rtcode, &service_rc);
2132 if (service_rc != 0) {
2133 le2toI(cprb_p->ccp_rscode, &service_rs);
2134 if ((service_rc == 8) && (service_rs == 66))
2135 PDEBUG("Bad block format on PCICC\n");
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2136 else if ((service_rc == 8) && (service_rs == 65))
2137 PDEBUG("Probably an even modulus on "
2138 "PCICC\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2139 else if ((service_rc == 8) && (service_rs == 770)) {
2140 PDEBUG("Invalid key length on PCICC\n");
2141 unset_ext_bitlens();
2142 return REC_USE_PCICA;
2143 }
2144 else if ((service_rc == 8) && (service_rs == 783)) {
2145 PDEBUG("Extended bitlengths not enabled"
2146 "on PCICC\n");
2147 unset_ext_bitlens();
2148 return REC_USE_PCICA;
2149 }
2150 else
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2151 PRINTK("service rc/rs (PCICC): %d/%d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2152 service_rc, service_rs);
2153 return REC_OPERAND_INV;
2154 }
2155 src_p = (unsigned char *)cprb_p + sizeof(struct CPRB);
2156 src_p += 4;
2157 le2toI(src_p, &src_l);
2158 src_l -= 2;
2159 src_p += 2;
2160 } else {
2161 service_rc = (int)cprbx_p->ccp_rtcode;
2162 if (service_rc != 0) {
2163 service_rs = (int) cprbx_p->ccp_rscode;
2164 if ((service_rc == 8) && (service_rs == 66))
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2165 PDEBUG("Bad block format on PCIXCC\n");
2166 else if ((service_rc == 8) && (service_rs == 65))
2167 PDEBUG("Probably an even modulus on "
2168 "PCIXCC\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2169 else if ((service_rc == 8) && (service_rs == 770)) {
2170 PDEBUG("Invalid key length on PCIXCC\n");
2171 unset_ext_bitlens();
2172 return REC_USE_PCICA;
2173 }
2174 else if ((service_rc == 8) && (service_rs == 783)) {
2175 PDEBUG("Extended bitlengths not enabled"
2176 "on PCIXCC\n");
2177 unset_ext_bitlens();
2178 return REC_USE_PCICA;
2179 }
2180 else
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2181 PRINTK("service rc/rs (PCIXCC): %d/%d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2182 service_rc, service_rs);
2183 return REC_OPERAND_INV;
2184 }
2185 src_p = (unsigned char *)
2186 cprbx_p + sizeof(struct CPRBX);
2187 src_p += 4;
2188 src_l = (int)(*((short *) src_p));
2189 src_l -= 2;
2190 src_p += 2;
2191 }
2192 break;
2193 default:
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2194 src_p = (unsigned char *)errh_p;
2195 PRINTK("Unrecognized Message Header: "
2196 "%02x%02x%02x%02x%02x%02x%02x%02x\n",
2197 src_p[0], src_p[1], src_p[2], src_p[3],
2198 src_p[4], src_p[5], src_p[6], src_p[7]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2199 return REC_BAD_MESSAGE;
2200 }
2201
2202 if (reply_code)
2203 switch (reply_code) {
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2204 case REP82_ERROR_OPERAND_INVALID:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2205 return REC_OPERAND_INV;
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2206 case REP82_ERROR_OPERAND_SIZE:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2207 return REC_OPERAND_SIZE;
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2208 case REP82_ERROR_EVEN_MOD_IN_OPND:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2209 return REC_EVEN_MOD;
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2210 case REP82_ERROR_MESSAGE_TYPE:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2211 return WRONG_DEVICE_TYPE;
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2212 case REP82_ERROR_TRANSPORT_FAIL:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2213 PRINTKW("Transport failed (APFS = %02X%02X%02X%02X)\n",
2214 t86m_p->apfs[0], t86m_p->apfs[1],
2215 t86m_p->apfs[2], t86m_p->apfs[3]);
2216 return REC_HARDWAR_ERR;
2217 default:
2218 PRINTKW("reply code = %d\n", reply_code);
2219 return REC_HARDWAR_ERR;
2220 }
2221
2222 if (service_rc != 0)
2223 return REC_OPERAND_INV;
2224
2225 if ((src_l > icaMsg_p->outputdatalength) ||
2226 (src_l > RESPBUFFSIZE) ||
2227 (src_l <= 0))
2228 return REC_OPERAND_SIZE;
2229
2230 PDEBUG("Length returned = %d\n", src_l);
2231 tgt_p = resp_buff + icaMsg_p->outputdatalength - src_l;
2232 memcpy(tgt_p, src_p, src_l);
Eric Rossman2dee7022005-09-03 15:58:03 -0700[diff] [blame]2233 if ((errh_p->type == TYPE86_RSP_CODE) && (resp_buff < tgt_p)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700[diff] [blame]2234 memset(resp_buff, 0, icaMsg_p->outputdatalength - src_l);
2235 if (pad_msg(resp_buff, icaMsg_p->outputdatalength, src_l))
2236 return REC_INVALID_PAD;
2237 }
2238 *respbufflen_p = icaMsg_p->outputdatalength;
2239 if (*respbufflen_p == 0)
2240 PRINTK("Zero *respbufflen_p\n");
2241
2242 return 0;
2243}
2244