1 | /* $NetBSD: satafis_subr.c,v 1.7 2012/07/22 17:57:57 jakllsch Exp $ */ |
2 | |
3 | /*- |
4 | * Copyright (c) 2009 Jonathan A. Kollasch. |
5 | * All rights reserved. |
6 | * |
7 | * Redistribution and use in source and binary forms, with or without |
8 | * modification, are permitted provided that the following conditions |
9 | * are met: |
10 | * 1. Redistributions of source code must retain the above copyright |
11 | * notice, this list of conditions and the following disclaimer. |
12 | * 2. Redistributions in binary form must reproduce the above copyright |
13 | * notice, this list of conditions and the following disclaimer in the |
14 | * documentation and/or other materials provided with the distribution. |
15 | * |
16 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
17 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
18 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
19 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
20 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
21 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
22 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
23 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
24 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
25 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
26 | */ |
27 | |
28 | /* |
29 | * Copyright (c) 2006 Manuel Bouyer. |
30 | * |
31 | * Redistribution and use in source and binary forms, with or without |
32 | * modification, are permitted provided that the following conditions |
33 | * are met: |
34 | * 1. Redistributions of source code must retain the above copyright |
35 | * notice, this list of conditions and the following disclaimer. |
36 | * 2. Redistributions in binary form must reproduce the above copyright |
37 | * notice, this list of conditions and the following disclaimer in the |
38 | * documentation and/or other materials provided with the distribution. |
39 | * |
40 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
41 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
42 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
43 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
44 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
45 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
46 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
47 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
48 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
49 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
50 | * |
51 | */ |
52 | |
53 | #include <sys/cdefs.h> |
54 | __KERNEL_RCSID(0, "$NetBSD: satafis_subr.c,v 1.7 2012/07/22 17:57:57 jakllsch Exp $" ); |
55 | |
56 | #include <sys/param.h> |
57 | #include <sys/systm.h> |
58 | |
59 | #include <sys/disklabel.h> |
60 | |
61 | #include <dev/ata/atareg.h> |
62 | #include <dev/ata/atavar.h> |
63 | |
64 | #include <dev/ata/satafisreg.h> |
65 | #include <dev/ata/satafisvar.h> |
66 | |
67 | #include "atapibus.h" |
68 | |
69 | void |
70 | satafis_rhd_construct_cmd(struct ata_command *ata_c, uint8_t *fis) |
71 | { |
72 | |
73 | memset(fis, 0, RHD_FISLEN); |
74 | |
75 | fis[fis_type] = RHD_FISTYPE; |
76 | fis[rhd_c] = RHD_C; |
77 | fis[rhd_command] = ata_c->r_command; |
78 | fis[rhd_features0] = (ata_c->r_features >> 0) & 0xff; |
79 | |
80 | fis[rhd_lba0] = (ata_c->r_lba >> 0) & 0xff; |
81 | fis[rhd_lba1] = (ata_c->r_lba >> 8) & 0xff; |
82 | fis[rhd_lba2] = (ata_c->r_lba >> 16) & 0xff; |
83 | if ((ata_c->flags & AT_LBA48) != 0) { |
84 | fis[rhd_dh] = ata_c->r_device; |
85 | fis[rhd_lba3] = (ata_c->r_lba >> 24) & 0xff; |
86 | fis[rhd_lba4] = (ata_c->r_lba >> 32) & 0xff; |
87 | fis[rhd_lba5] = (ata_c->r_lba >> 40) & 0xff; |
88 | fis[rhd_features1] = (ata_c->r_features >> 8) & 0xff; |
89 | } else { |
90 | fis[rhd_dh] = (ata_c->r_device & 0xf0) | |
91 | ((ata_c->r_lba >> 24) & 0x0f); |
92 | } |
93 | |
94 | fis[rhd_count0] = (ata_c->r_count >> 0) & 0xff; |
95 | if ((ata_c->flags & AT_LBA48) != 0) { |
96 | fis[rhd_count1] = (ata_c->r_count >> 8) & 0xff; |
97 | } |
98 | } |
99 | |
100 | void |
101 | satafis_rhd_construct_bio(struct ata_xfer *xfer, uint8_t *fis) |
102 | { |
103 | struct ata_bio *ata_bio = xfer->c_cmd; |
104 | int nblks; |
105 | |
106 | nblks = xfer->c_bcount / ata_bio->lp->d_secsize; |
107 | |
108 | memset(fis, 0, RHD_FISLEN); |
109 | |
110 | fis[fis_type] = RHD_FISTYPE; |
111 | fis[rhd_c] = RHD_C; |
112 | if (ata_bio->flags & ATA_LBA48) { |
113 | fis[rhd_command] = (ata_bio->flags & ATA_READ) ? |
114 | WDCC_READDMA_EXT : WDCC_WRITEDMA_EXT; |
115 | } else { |
116 | fis[rhd_command] = |
117 | (ata_bio->flags & ATA_READ) ? WDCC_READDMA : WDCC_WRITEDMA; |
118 | } |
119 | |
120 | fis[rhd_lba0] = (ata_bio->blkno >> 0) & 0xff; |
121 | fis[rhd_lba1] = (ata_bio->blkno >> 8) & 0xff; |
122 | fis[rhd_lba2] = (ata_bio->blkno >> 16) & 0xff; |
123 | if ((ata_bio->flags & ATA_LBA48) != 0) { |
124 | fis[rhd_dh] = WDSD_LBA; |
125 | fis[rhd_lba3] = (ata_bio->blkno >> 24) & 0xff; |
126 | fis[rhd_lba4] = (ata_bio->blkno >> 32) & 0xff; |
127 | fis[rhd_lba5] = (ata_bio->blkno >> 40) & 0xff; |
128 | } else { |
129 | fis[rhd_dh] = ((ata_bio->blkno >> 24) & 0x0f) | |
130 | (((ata_bio->flags & ATA_LBA) != 0) ? WDSD_LBA : 0); |
131 | } |
132 | |
133 | fis[rhd_count0] = nblks & 0xff; |
134 | if ((ata_bio->flags & ATA_LBA48) != 0) { |
135 | fis[rhd_count1] = (nblks >> 8) & 0xff; |
136 | } |
137 | } |
138 | |
139 | #if NATAPIBUS > 0 |
140 | void |
141 | satafis_rhd_construct_atapi(struct ata_xfer *xfer, uint8_t *fis) |
142 | { |
143 | |
144 | memset(fis, 0, RHD_FISLEN); |
145 | |
146 | fis[fis_type] = RHD_FISTYPE; |
147 | fis[rhd_c] = RHD_C; |
148 | fis[rhd_command] = ATAPI_PKT_CMD; |
149 | fis[rhd_features0] = (xfer->c_flags & C_DMA) ? |
150 | ATAPI_PKT_CMD_FTRE_DMA : 0; |
151 | } |
152 | #endif /* NATAPIBUS */ |
153 | |
154 | void |
155 | satafis_rdh_parse(struct ata_channel *chp, const uint8_t *fis) |
156 | { |
157 | |
158 | chp->ch_status = fis[rdh_status]; |
159 | chp->ch_error = fis[rdh_error]; |
160 | } |
161 | |
162 | void |
163 | satafis_rdh_cmd_readreg(struct ata_command *ata_c, const uint8_t *fis) |
164 | { |
165 | |
166 | ata_c->r_lba = (uint64_t)fis[rdh_lba0] << 0; |
167 | ata_c->r_lba |= (uint64_t)fis[rdh_lba1] << 8; |
168 | ata_c->r_lba |= (uint64_t)fis[rdh_lba2] << 16; |
169 | if ((ata_c->flags & AT_LBA48) != 0) { |
170 | ata_c->r_lba |= (uint64_t)fis[rdh_lba3] << 24; |
171 | ata_c->r_lba |= (uint64_t)fis[rdh_lba4] << 32; |
172 | ata_c->r_lba |= (uint64_t)fis[rdh_lba5] << 40; |
173 | ata_c->r_device = fis[rdh_dh]; |
174 | } else { |
175 | ata_c->r_lba |= (uint64_t)(fis[rdh_dh] & 0x0f) << 24; |
176 | ata_c->r_device = fis[rdh_dh] & 0xf0; |
177 | } |
178 | |
179 | ata_c->r_count = fis[rdh_count0] << 0; |
180 | if ((ata_c->flags & AT_LBA48) != 0) { |
181 | ata_c->r_count |= fis[rdh_count1] << 8; |
182 | } |
183 | |
184 | ata_c->r_error = fis[rdh_error]; |
185 | ata_c->r_status = fis[rdh_status]; |
186 | } |
187 | |