1 | /* $NetBSD: ld_icp.c,v 1.29 2016/09/27 03:33:32 pgoyette Exp $ */ |
2 | |
3 | /*- |
4 | * Copyright (c) 2002 The NetBSD Foundation, Inc. |
5 | * All rights reserved. |
6 | * |
7 | * This code is derived from software contributed to The NetBSD Foundation |
8 | * by Andrew Doran. |
9 | * |
10 | * Redistribution and use in source and binary forms, with or without |
11 | * modification, are permitted provided that the following conditions |
12 | * are met: |
13 | * 1. Redistributions of source code must retain the above copyright |
14 | * notice, this list of conditions and the following disclaimer. |
15 | * 2. Redistributions in binary form must reproduce the above copyright |
16 | * notice, this list of conditions and the following disclaimer in the |
17 | * documentation and/or other materials provided with the distribution. |
18 | * |
19 | * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS |
20 | * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED |
21 | * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR |
22 | * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS |
23 | * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
24 | * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
25 | * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
26 | * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
27 | * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
28 | * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
29 | * POSSIBILITY OF SUCH DAMAGE. |
30 | */ |
31 | |
32 | /* |
33 | * ICP-Vortex "GDT" front-end for ld(4) driver. |
34 | */ |
35 | |
36 | #include <sys/cdefs.h> |
37 | __KERNEL_RCSID(0, "$NetBSD: ld_icp.c,v 1.29 2016/09/27 03:33:32 pgoyette Exp $" ); |
38 | |
39 | #include <sys/param.h> |
40 | #include <sys/systm.h> |
41 | #include <sys/kernel.h> |
42 | #include <sys/device.h> |
43 | #include <sys/buf.h> |
44 | #include <sys/bufq.h> |
45 | #include <sys/endian.h> |
46 | #include <sys/dkio.h> |
47 | #include <sys/disk.h> |
48 | #include <sys/module.h> |
49 | #include <sys/bus.h> |
50 | |
51 | #include <dev/ldvar.h> |
52 | |
53 | #include <dev/ic/icpreg.h> |
54 | #include <dev/ic/icpvar.h> |
55 | |
56 | #include "ioconf.h" |
57 | |
58 | struct ld_icp_softc { |
59 | struct ld_softc sc_ld; |
60 | int sc_hwunit; |
61 | }; |
62 | |
63 | void ld_icp_attach(device_t, device_t, void *); |
64 | int ld_icp_detach(device_t, int); |
65 | int ld_icp_dobio(struct ld_icp_softc *, void *, int, int, int, |
66 | struct buf *); |
67 | int ld_icp_dump(struct ld_softc *, void *, int, int); |
68 | int ld_icp_flush(struct ld_softc *, int); |
69 | void ld_icp_intr(struct icp_ccb *); |
70 | int ld_icp_match(device_t, cfdata_t, void *); |
71 | int ld_icp_start(struct ld_softc *, struct buf *); |
72 | |
73 | void ld_icp_adjqparam(device_t, int); |
74 | |
75 | CFATTACH_DECL_NEW(ld_icp, sizeof(struct ld_icp_softc), |
76 | ld_icp_match, ld_icp_attach, ld_icp_detach, NULL); |
77 | |
78 | static const struct icp_servicecb ld_icp_servicecb = { |
79 | ld_icp_adjqparam, |
80 | }; |
81 | |
82 | int |
83 | ld_icp_match(device_t parent, cfdata_t match, void *aux) |
84 | { |
85 | struct icp_attach_args *icpa; |
86 | |
87 | icpa = aux; |
88 | |
89 | return (icpa->icpa_unit < ICPA_UNIT_SCSI); |
90 | } |
91 | |
92 | void |
93 | ld_icp_attach(device_t parent, device_t self, void *aux) |
94 | { |
95 | struct icp_attach_args *icpa = aux; |
96 | struct ld_icp_softc *sc = device_private(self); |
97 | struct ld_softc *ld = &sc->sc_ld; |
98 | struct icp_softc *icp = device_private(parent); |
99 | struct icp_cachedrv *cd = &icp->icp_cdr[icpa->icpa_unit]; |
100 | struct icp_cdevinfo *cdi; |
101 | const char *str; |
102 | int t; |
103 | |
104 | ld->sc_dv = self; |
105 | |
106 | icp_register_servicecb(icp, icpa->icpa_unit, &ld_icp_servicecb); |
107 | |
108 | sc->sc_hwunit = icpa->icpa_unit; |
109 | ld->sc_maxxfer = ICP_MAX_XFER; |
110 | ld->sc_secsize = ICP_SECTOR_SIZE; |
111 | ld->sc_start = ld_icp_start; |
112 | ld->sc_dump = ld_icp_dump; |
113 | ld->sc_flush = ld_icp_flush; |
114 | ld->sc_secperunit = cd->cd_size; |
115 | ld->sc_flags = LDF_ENABLED; |
116 | ld->sc_maxqueuecnt = icp->icp_openings; |
117 | |
118 | if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_IOCTL, ICP_CACHE_DRV_INFO, |
119 | sc->sc_hwunit, sizeof(struct icp_cdevinfo))) { |
120 | aprint_error(": unable to retrieve device info\n" ); |
121 | ld->sc_flags = LDF_ENABLED; |
122 | goto out; |
123 | } |
124 | cdi = (struct icp_cdevinfo *)icp->icp_scr; |
125 | |
126 | aprint_normal(": <%.8s>, " , cdi->ld_name); |
127 | t = le32toh(cdi->ld_dtype) >> 16; |
128 | |
129 | /* |
130 | * Print device type. |
131 | */ |
132 | if (le32toh(cdi->ld_dcnt) > 1 || le32toh(cdi->ld_slave) != -1) |
133 | str = "RAID-1" ; |
134 | else if (t == 0) |
135 | str = "JBOD" ; |
136 | else if (t == 1) |
137 | str = "RAID-0" ; |
138 | else if (t == 2) |
139 | str = "Chain" ; |
140 | else |
141 | str = "unknown type" ; |
142 | |
143 | aprint_normal("type: %s, " , str); |
144 | |
145 | /* |
146 | * Print device status. |
147 | */ |
148 | if (t > 2) |
149 | str = "missing" ; |
150 | else if ((cdi->ld_error & 1) != 0) { |
151 | str = "fault" ; |
152 | ld->sc_flags = LDF_ENABLED; |
153 | } else if ((cdi->ld_error & 2) != 0) |
154 | str = "invalid" ; |
155 | else { |
156 | str = "optimal" ; |
157 | ld->sc_flags = LDF_ENABLED; |
158 | } |
159 | |
160 | aprint_normal("status: %s\n" , str); |
161 | |
162 | out: |
163 | ldattach(ld, BUFQ_DISK_DEFAULT_STRAT); |
164 | } |
165 | |
166 | int |
167 | ld_icp_detach(device_t dv, int flags) |
168 | { |
169 | int rv; |
170 | |
171 | if ((rv = ldbegindetach((struct ld_softc *)dv, flags)) != 0) |
172 | return (rv); |
173 | ldenddetach((struct ld_softc *) dv); |
174 | |
175 | return (0); |
176 | } |
177 | |
178 | int |
179 | ld_icp_dobio(struct ld_icp_softc *sc, void *data, int datasize, int blkno, |
180 | int dowrite, struct buf *bp) |
181 | { |
182 | struct icp_cachecmd *cc; |
183 | struct icp_ccb *ic; |
184 | struct icp_softc *icp; |
185 | int s, rv; |
186 | |
187 | icp = device_private(device_parent(sc->sc_ld.sc_dv)); |
188 | |
189 | /* |
190 | * Allocate a command control block. |
191 | */ |
192 | if (__predict_false((ic = icp_ccb_alloc(icp)) == NULL)) |
193 | return (EAGAIN); |
194 | |
195 | /* |
196 | * Map the data transfer. |
197 | */ |
198 | cc = &ic->ic_cmd.cmd_packet.cc; |
199 | ic->ic_sg = cc->cc_sg; |
200 | ic->ic_service = ICP_CACHESERVICE; |
201 | |
202 | rv = icp_ccb_map(icp, ic, data, datasize, |
203 | dowrite ? IC_XFER_OUT : IC_XFER_IN); |
204 | if (rv != 0) { |
205 | icp_ccb_free(icp, ic); |
206 | return (rv); |
207 | } |
208 | |
209 | /* |
210 | * Build the command. |
211 | */ |
212 | ic->ic_cmd.cmd_opcode = htole16((dowrite ? ICP_WRITE : ICP_READ)); |
213 | cc->cc_deviceno = htole16(sc->sc_hwunit); |
214 | cc->cc_blockno = htole32(blkno); |
215 | cc->cc_blockcnt = htole32(datasize / ICP_SECTOR_SIZE); |
216 | cc->cc_addr = ~0; /* scatter gather */ |
217 | cc->cc_nsgent = htole32(ic->ic_nsgent); |
218 | |
219 | ic->ic_cmdlen = (u_long)ic->ic_sg - (u_long)&ic->ic_cmd + |
220 | ic->ic_nsgent * sizeof(*ic->ic_sg); |
221 | |
222 | /* |
223 | * Fire it off to the controller. |
224 | */ |
225 | if (bp == NULL) { |
226 | s = splbio(); |
227 | rv = icp_ccb_poll(icp, ic, 10000); |
228 | icp_ccb_unmap(icp, ic); |
229 | icp_ccb_free(icp, ic); |
230 | splx(s); |
231 | } else { |
232 | ic->ic_intr = ld_icp_intr; |
233 | ic->ic_context = bp; |
234 | ic->ic_dv = sc->sc_ld.sc_dv; |
235 | icp_ccb_enqueue(icp, ic); |
236 | } |
237 | |
238 | return (rv); |
239 | } |
240 | |
241 | int |
242 | ld_icp_start(struct ld_softc *ld, struct buf *bp) |
243 | { |
244 | |
245 | return (ld_icp_dobio((struct ld_icp_softc *)ld, bp->b_data, |
246 | bp->b_bcount, bp->b_rawblkno, (bp->b_flags & B_READ) == 0, bp)); |
247 | } |
248 | |
249 | int |
250 | ld_icp_dump(struct ld_softc *ld, void *data, int blkno, int blkcnt) |
251 | { |
252 | |
253 | return (ld_icp_dobio((struct ld_icp_softc *)ld, data, |
254 | blkcnt * ld->sc_secsize, blkno, 1, NULL)); |
255 | } |
256 | |
257 | int |
258 | ld_icp_flush(struct ld_softc *ld, int flags) |
259 | { |
260 | struct ld_icp_softc *sc; |
261 | struct icp_softc *icp; |
262 | struct icp_cachecmd *cc; |
263 | struct icp_ccb *ic; |
264 | int rv; |
265 | |
266 | sc = (struct ld_icp_softc *)ld; |
267 | icp = device_private(device_parent(ld->sc_dv)); |
268 | |
269 | ic = icp_ccb_alloc_wait(icp); |
270 | ic->ic_cmd.cmd_opcode = htole16(ICP_FLUSH); |
271 | |
272 | cc = &ic->ic_cmd.cmd_packet.cc; |
273 | cc->cc_deviceno = htole16(sc->sc_hwunit); |
274 | cc->cc_blockno = htole32(1); |
275 | cc->cc_blockcnt = 0; |
276 | cc->cc_addr = 0; |
277 | cc->cc_nsgent = 0; |
278 | |
279 | ic->ic_cmdlen = (u_long)&cc->cc_sg - (u_long)&ic->ic_cmd; |
280 | ic->ic_service = ICP_CACHESERVICE; |
281 | |
282 | rv = icp_ccb_wait(icp, ic, 30000); |
283 | icp_ccb_free(icp, ic); |
284 | |
285 | return (rv); |
286 | } |
287 | |
288 | void |
289 | ld_icp_intr(struct icp_ccb *ic) |
290 | { |
291 | struct buf *bp; |
292 | struct ld_icp_softc *sc; |
293 | struct icp_softc *icp; |
294 | |
295 | bp = ic->ic_context; |
296 | sc = device_private(ic->ic_dv); |
297 | icp = device_private(device_parent(sc->sc_ld.sc_dv)); |
298 | |
299 | if (ic->ic_status != ICP_S_OK) { |
300 | aprint_error_dev(ic->ic_dv, "request failed; status=0x%04x\n" , |
301 | ic->ic_status); |
302 | bp->b_error = EIO; |
303 | bp->b_resid = bp->b_bcount; |
304 | |
305 | icp->icp_evt.size = sizeof(icp->icp_evt.eu.sync); |
306 | icp->icp_evt.eu.sync.ionode = device_unit(icp->icp_dv); |
307 | icp->icp_evt.eu.sync.service = icp->icp_service; |
308 | icp->icp_evt.eu.sync.status = icp->icp_status; |
309 | icp->icp_evt.eu.sync.info = icp->icp_info; |
310 | icp->icp_evt.eu.sync.hostdrive = sc->sc_hwunit; |
311 | if (icp->icp_status >= 0x8000) |
312 | icp_store_event(icp, GDT_ES_SYNC, 0, &icp->icp_evt); |
313 | else |
314 | icp_store_event(icp, GDT_ES_SYNC, icp->icp_service, |
315 | &icp->icp_evt); |
316 | } else |
317 | bp->b_resid = 0; |
318 | |
319 | icp_ccb_unmap(icp, ic); |
320 | icp_ccb_free(icp, ic); |
321 | lddone(&sc->sc_ld, bp); |
322 | } |
323 | |
324 | void |
325 | ld_icp_adjqparam(device_t dv, int openings) |
326 | { |
327 | |
328 | ldadjqparam((struct ld_softc *) dv, openings); |
329 | } |
330 | |
331 | MODULE(MODULE_CLASS_DRIVER, ld_icp, "ld" ); /* no icp module yet */ |
332 | |
333 | #ifdef _MODULE |
334 | /* |
335 | * XXX Don't allow ioconf.c to redefine the "struct cfdriver ld_cd" |
336 | * XXX it will be defined in the common-code module |
337 | */ |
338 | #undef CFDRIVER_DECL |
339 | #define CFDRIVER_DECL(name, class, attr) |
340 | #include "ioconf.c" |
341 | #endif |
342 | |
343 | static int |
344 | ld_icp_modcmd(modcmd_t cmd, void *opaque) |
345 | { |
346 | #ifdef _MODULE |
347 | /* |
348 | * We ignore the cfdriver_vec[] that ioconf provides, since |
349 | * the cfdrivers are attached already. |
350 | */ |
351 | static struct cfdriver * const no_cfdriver_vec[] = { NULL }; |
352 | #endif |
353 | int error = 0; |
354 | |
355 | #ifdef _MODULE |
356 | switch (cmd) { |
357 | case MODULE_CMD_INIT: |
358 | error = config_init_component(no_cfdriver_vec, |
359 | cfattach_ioconf_ld_icp, cfdata_ioconf_ld_icp); |
360 | break; |
361 | case MODULE_CMD_FINI: |
362 | error = config_fini_component(no_cfdriver_vec, |
363 | cfattach_ioconf_ld_icp, cfdata_ioconf_ld_icp); |
364 | break; |
365 | default: |
366 | error = ENOTTY; |
367 | break; |
368 | } |
369 | #endif |
370 | |
371 | return error; |
372 | } |
373 | |