1
2
3
4
5
6
7
8
9#define KMSG_COMPONENT "hmcdrv"
10#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
11
12#include <linux/kernel.h>
13#include <linux/mm.h>
14#include <linux/irq.h>
15#include <linux/wait.h>
16#include <linux/string.h>
17#include <asm/ctl_reg.h>
18#include <asm/diag.h>
19
20#include "hmcdrv_ftp.h"
21#include "diag_ftp.h"
22
23
24#define DIAG_FTP_RET_OK 0
25#define DIAG_FTP_RET_EBUSY 4
26#define DIAG_FTP_RET_EIO 8
27
28#define DIAG_FTP_RET_EPERM 2
29
30
31#define DIAG_FTP_STAT_OK 0U
32#define DIAG_FTP_STAT_PGCC 4U
33#define DIAG_FTP_STAT_PGIOE 8U
34#define DIAG_FTP_STAT_TIMEOUT 12U
35#define DIAG_FTP_STAT_EBASE 16U
36#define DIAG_FTP_STAT_LDFAIL (DIAG_FTP_STAT_EBASE + 1U)
37#define DIAG_FTP_STAT_LDNPERM (DIAG_FTP_STAT_EBASE + 2U)
38#define DIAG_FTP_STAT_LDRUNS (DIAG_FTP_STAT_EBASE + 3U)
39#define DIAG_FTP_STAT_LDNRUNS (DIAG_FTP_STAT_EBASE + 4U)
40
41
42
43
44
45
46
47
48
49
50
51
52
53struct diag_ftp_ldfpl {
54 u64 bufaddr;
55 u64 buflen;
56 u64 offset;
57 u64 intparm;
58 u64 transferred;
59 u64 fsize;
60 u64 failaddr;
61 u64 spare;
62 u8 fident[HMCDRV_FTP_FIDENT_MAX];
63} __packed;
64
65static DECLARE_COMPLETION(diag_ftp_rx_complete);
66static int diag_ftp_subcode;
67
68
69
70
71
72
73
74static void diag_ftp_handler(struct ext_code extirq,
75 unsigned int param32,
76 unsigned long param64)
77{
78 if ((extirq.subcode >> 8) != 8)
79 return;
80
81 inc_irq_stat(IRQEXT_FTP);
82 diag_ftp_subcode = extirq.subcode & 0xffU;
83 complete(&diag_ftp_rx_complete);
84}
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101static int diag_ftp_2c4(struct diag_ftp_ldfpl *fpl,
102 enum hmcdrv_ftp_cmdid cmd)
103{
104 int rc;
105
106 diag_stat_inc(DIAG_STAT_X2C4);
107 asm volatile(
108 " diag %[addr],%[cmd],0x2c4\n"
109 "0: j 2f\n"
110 "1: la %[rc],%[err]\n"
111 "2:\n"
112 EX_TABLE(0b, 1b)
113 : [rc] "=d" (rc), "+m" (*fpl)
114 : [cmd] "0" (cmd), [addr] "d" (virt_to_phys(fpl)),
115 [err] "i" (DIAG_FTP_RET_EPERM)
116 : "cc");
117
118 switch (rc) {
119 case DIAG_FTP_RET_OK:
120 return 0;
121 case DIAG_FTP_RET_EBUSY:
122 return -EBUSY;
123 case DIAG_FTP_RET_EPERM:
124 return -EPERM;
125 case DIAG_FTP_RET_EIO:
126 default:
127 return -EIO;
128 }
129}
130
131
132
133
134
135
136
137
138
139
140
141ssize_t diag_ftp_cmd(const struct hmcdrv_ftp_cmdspec *ftp, size_t *fsize)
142{
143 struct diag_ftp_ldfpl *ldfpl;
144 ssize_t len;
145#ifdef DEBUG
146 unsigned long start_jiffies;
147
148 pr_debug("starting DIAG X'2C4' on '%s', requesting %zd bytes\n",
149 ftp->fname, ftp->len);
150 start_jiffies = jiffies;
151#endif
152 init_completion(&diag_ftp_rx_complete);
153
154 ldfpl = (void *) get_zeroed_page(GFP_KERNEL | GFP_DMA);
155 if (!ldfpl) {
156 len = -ENOMEM;
157 goto out;
158 }
159
160 len = strlcpy(ldfpl->fident, ftp->fname, sizeof(ldfpl->fident));
161 if (len >= HMCDRV_FTP_FIDENT_MAX) {
162 len = -EINVAL;
163 goto out_free;
164 }
165
166 ldfpl->transferred = 0;
167 ldfpl->fsize = 0;
168 ldfpl->offset = ftp->ofs;
169 ldfpl->buflen = ftp->len;
170 ldfpl->bufaddr = virt_to_phys(ftp->buf);
171
172 len = diag_ftp_2c4(ldfpl, ftp->id);
173 if (len)
174 goto out_free;
175
176
177
178
179
180 wait_for_completion(&diag_ftp_rx_complete);
181
182#ifdef DEBUG
183 pr_debug("completed DIAG X'2C4' after %lu ms\n",
184 (jiffies - start_jiffies) * 1000 / HZ);
185 pr_debug("status of DIAG X'2C4' is %u, with %lld/%lld bytes\n",
186 diag_ftp_subcode, ldfpl->transferred, ldfpl->fsize);
187#endif
188
189 switch (diag_ftp_subcode) {
190 case DIAG_FTP_STAT_OK:
191 len = ldfpl->transferred;
192 if (fsize)
193 *fsize = ldfpl->fsize;
194 break;
195 case DIAG_FTP_STAT_LDNPERM:
196 len = -EPERM;
197 break;
198 case DIAG_FTP_STAT_LDRUNS:
199 len = -EBUSY;
200 break;
201 case DIAG_FTP_STAT_LDFAIL:
202 len = -ENOENT;
203 break;
204 default:
205 len = -EIO;
206 break;
207 }
208
209out_free:
210 free_page((unsigned long) ldfpl);
211out:
212 return len;
213}
214
215
216
217
218
219
220int diag_ftp_startup(void)
221{
222 int rc;
223
224 rc = register_external_irq(EXT_IRQ_CP_SERVICE, diag_ftp_handler);
225 if (rc)
226 return rc;
227
228 irq_subclass_register(IRQ_SUBCLASS_SERVICE_SIGNAL);
229 return 0;
230}
231
232
233
234
235void diag_ftp_shutdown(void)
236{
237 irq_subclass_unregister(IRQ_SUBCLASS_SERVICE_SIGNAL);
238 unregister_external_irq(EXT_IRQ_CP_SERVICE, diag_ftp_handler);
239}
240