1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /* -*- linux-c -*- ------------------------------------------------------- *
3 *
4 * Copyright 2002 H. Peter Anvin - All Rights Reserved
5 *
6 * ----------------------------------------------------------------------- */
7
8 /*
9 * raid6/recov.c
10 *
11 * RAID-6 data recovery in dual failure mode. In single failure mode,
12 * use the RAID-5 algorithm (or, in the case of Q failure, just reconstruct
13 * the syndrome.)
14 */
15
16 #include <linux/raid/pq.h>
17
18 /* Recover two failed data blocks. */
raid6_2data_recov_intx1(int disks,size_t bytes,int faila,int failb,void ** ptrs)19 static void raid6_2data_recov_intx1(int disks, size_t bytes, int faila,
20 int failb, void **ptrs)
21 {
22 u8 *p, *q, *dp, *dq;
23 u8 px, qx, db;
24 const u8 *pbmul; /* P multiplier table for B data */
25 const u8 *qmul; /* Q multiplier table (for both) */
26
27 p = (u8 *)ptrs[disks-2];
28 q = (u8 *)ptrs[disks-1];
29
30 /* Compute syndrome with zero for the missing data pages
31 Use the dead data pages as temporary storage for
32 delta p and delta q */
33 dp = (u8 *)ptrs[faila];
34 ptrs[faila] = (void *)raid6_empty_zero_page;
35 ptrs[disks-2] = dp;
36 dq = (u8 *)ptrs[failb];
37 ptrs[failb] = (void *)raid6_empty_zero_page;
38 ptrs[disks-1] = dq;
39
40 raid6_call.gen_syndrome(disks, bytes, ptrs);
41
42 /* Restore pointer table */
43 ptrs[faila] = dp;
44 ptrs[failb] = dq;
45 ptrs[disks-2] = p;
46 ptrs[disks-1] = q;
47
48 /* Now, pick the proper data tables */
49 pbmul = raid6_gfmul[raid6_gfexi[failb-faila]];
50 qmul = raid6_gfmul[raid6_gfinv[raid6_gfexp[faila]^raid6_gfexp[failb]]];
51
52 /* Now do it... */
53 while ( bytes-- ) {
54 px = *p ^ *dp;
55 qx = qmul[*q ^ *dq];
56 *dq++ = db = pbmul[px] ^ qx; /* Reconstructed B */
57 *dp++ = db ^ px; /* Reconstructed A */
58 p++; q++;
59 }
60 }
61
62 /* Recover failure of one data block plus the P block */
raid6_datap_recov_intx1(int disks,size_t bytes,int faila,void ** ptrs)63 static void raid6_datap_recov_intx1(int disks, size_t bytes, int faila,
64 void **ptrs)
65 {
66 u8 *p, *q, *dq;
67 const u8 *qmul; /* Q multiplier table */
68
69 p = (u8 *)ptrs[disks-2];
70 q = (u8 *)ptrs[disks-1];
71
72 /* Compute syndrome with zero for the missing data page
73 Use the dead data page as temporary storage for delta q */
74 dq = (u8 *)ptrs[faila];
75 ptrs[faila] = (void *)raid6_empty_zero_page;
76 ptrs[disks-1] = dq;
77
78 raid6_call.gen_syndrome(disks, bytes, ptrs);
79
80 /* Restore pointer table */
81 ptrs[faila] = dq;
82 ptrs[disks-1] = q;
83
84 /* Now, pick the proper data tables */
85 qmul = raid6_gfmul[raid6_gfinv[raid6_gfexp[faila]]];
86
87 /* Now do it... */
88 while ( bytes-- ) {
89 *p++ ^= *dq = qmul[*q ^ *dq];
90 q++; dq++;
91 }
92 }
93
94
95 const struct raid6_recov_calls raid6_recov_intx1 = {
96 .data2 = raid6_2data_recov_intx1,
97 .datap = raid6_datap_recov_intx1,
98 .valid = NULL,
99 .name = "intx1",
100 .priority = 0,
101 };
102
103 #ifndef __KERNEL__
104 /* Testing only */
105
106 /* Recover two failed blocks. */
raid6_dual_recov(int disks,size_t bytes,int faila,int failb,void ** ptrs)107 void raid6_dual_recov(int disks, size_t bytes, int faila, int failb, void **ptrs)
108 {
109 if ( faila > failb ) {
110 int tmp = faila;
111 faila = failb;
112 failb = tmp;
113 }
114
115 if ( failb == disks-1 ) {
116 if ( faila == disks-2 ) {
117 /* P+Q failure. Just rebuild the syndrome. */
118 raid6_call.gen_syndrome(disks, bytes, ptrs);
119 } else {
120 /* data+Q failure. Reconstruct data from P,
121 then rebuild syndrome. */
122 /* NOT IMPLEMENTED - equivalent to RAID-5 */
123 }
124 } else {
125 if ( failb == disks-2 ) {
126 /* data+P failure. */
127 raid6_datap_recov(disks, bytes, faila, ptrs);
128 } else {
129 /* data+data failure. */
130 raid6_2data_recov(disks, bytes, faila, failb, ptrs);
131 }
132 }
133 }
134
135 #endif
136