ata_all.c revision 220616
1290650Shselasky/*-
2290650Shselasky * Copyright (c) 2009 Alexander Motin <mav@FreeBSD.org>
3290650Shselasky * All rights reserved.
4290650Shselasky *
5290650Shselasky * Redistribution and use in source and binary forms, with or without
6290650Shselasky * modification, are permitted provided that the following conditions
7290650Shselasky * are met:
8290650Shselasky * 1. Redistributions of source code must retain the above copyright
9290650Shselasky *    notice, this list of conditions and the following disclaimer,
10290650Shselasky *    without modification, immediately at the beginning of the file.
11290650Shselasky * 2. Redistributions in binary form must reproduce the above copyright
12290650Shselasky *    notice, this list of conditions and the following disclaimer in the
13290650Shselasky *    documentation and/or other materials provided with the distribution.
14290650Shselasky *
15290650Shselasky * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16290650Shselasky * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17290650Shselasky * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18290650Shselasky * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19290650Shselasky * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20290650Shselasky * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21290650Shselasky * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22290650Shselasky * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23290650Shselasky * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24290650Shselasky * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25290650Shselasky */
26290650Shselasky
27290650Shselasky#include <sys/cdefs.h>
28290650Shselasky__FBSDID("$FreeBSD: head/sys/cam/ata/ata_all.c 220616 2011-04-14 08:17:45Z mav $");
29290650Shselasky
30290650Shselasky#include <sys/param.h>
31290650Shselasky
32290650Shselasky#ifdef _KERNEL
33290650Shselasky#include <opt_scsi.h>
34290650Shselasky
35290650Shselasky#include <sys/systm.h>
36290650Shselasky#include <sys/libkern.h>
37290650Shselasky#include <sys/kernel.h>
38290650Shselasky#include <sys/sysctl.h>
39290650Shselasky#else
40290650Shselasky#include <errno.h>
41290650Shselasky#include <stdio.h>
42290650Shselasky#include <stdlib.h>
43290650Shselasky#include <string.h>
44290650Shselasky#ifndef min
45290650Shselasky#define min(a,b) (((a)<(b))?(a):(b))
46290650Shselasky#endif
47290650Shselasky#endif
48290650Shselasky
49290650Shselasky#include <cam/cam.h>
50290650Shselasky#include <cam/cam_ccb.h>
51290650Shselasky#include <cam/cam_queue.h>
52290650Shselasky#include <cam/cam_xpt.h>
53291938Shselasky#include <sys/ata.h>
54291938Shselasky#include <cam/ata/ata_all.h>
55291938Shselasky#include <sys/sbuf.h>
56291938Shselasky#include <sys/endian.h>
57291938Shselasky
58291938Shselaskyint
59291938Shselaskyata_version(int ver)
60290650Shselasky{
61290650Shselasky	int bit;
62290650Shselasky
63290650Shselasky	if (ver == 0xffff)
64290650Shselasky		return 0;
65290650Shselasky	for (bit = 15; bit >= 0; bit--)
66290650Shselasky		if (ver & (1<<bit))
67290650Shselasky			return bit;
68290650Shselasky	return 0;
69290650Shselasky}
70290650Shselasky
71290650Shselaskychar *
72290650Shselaskyata_op_string(struct ata_cmd *cmd)
73290650Shselasky{
74290650Shselasky
75290650Shselasky	if (cmd->control & 0x04)
76290650Shselasky		return ("SOFT_RESET");
77290650Shselasky	switch (cmd->command) {
78290650Shselasky	case 0x00: return ("NOP");
79290650Shselasky	case 0x03: return ("CFA_REQUEST_EXTENDED_ERROR");
80290650Shselasky	case 0x06:
81290650Shselasky		switch (cmd->features) {
82290650Shselasky	        case 0x01: return ("DSM TRIM");
83290650Shselasky	        }
84291070Shselasky	        return "DSM";
85290650Shselasky	case 0x08: return ("DEVICE_RESET");
86291070Shselasky	case 0x20: return ("READ");
87290650Shselasky	case 0x24: return ("READ48");
88290650Shselasky	case 0x25: return ("READ_DMA48");
89290650Shselasky	case 0x26: return ("READ_DMA_QUEUED48");
90290650Shselasky	case 0x27: return ("READ_NATIVE_MAX_ADDRESS48");
91290650Shselasky	case 0x29: return ("READ_MUL48");
92290650Shselasky	case 0x2a: return ("READ_STREAM_DMA48");
93290650Shselasky	case 0x2b: return ("READ_STREAM48");
94290650Shselasky	case 0x2f: return ("READ_LOG_EXT");
95290650Shselasky	case 0x30: return ("WRITE");
96290650Shselasky	case 0x34: return ("WRITE48");
97290650Shselasky	case 0x35: return ("WRITE_DMA48");
98290650Shselasky	case 0x36: return ("WRITE_DMA_QUEUED48");
99291070Shselasky	case 0x37: return ("SET_MAX_ADDRESS48");
100291070Shselasky	case 0x39: return ("WRITE_MUL48");
101291070Shselasky	case 0x3a: return ("WRITE_STREAM_DMA48");
102290650Shselasky	case 0x3b: return ("WRITE_STREAM48");
103290650Shselasky	case 0x3d: return ("WRITE_DMA_FUA48");
104290650Shselasky	case 0x3e: return ("WRITE_DMA_QUEUED_FUA48");
105290650Shselasky	case 0x3f: return ("WRITE_LOG_EXT");
106291070Shselasky	case 0x40: return ("READ_VERIFY");
107290650Shselasky	case 0x42: return ("READ_VERIFY48");
108290650Shselasky	case 0x51: return ("CONFIGURE_STREAM");
109290650Shselasky	case 0x60: return ("READ_FPDMA_QUEUED");
110290650Shselasky	case 0x61: return ("WRITE_FPDMA_QUEUED");
111290650Shselasky	case 0x70: return ("SEEK");
112290650Shselasky	case 0x87: return ("CFA_TRANSLATE_SECTOR");
113290650Shselasky	case 0x90: return ("EXECUTE_DEVICE_DIAGNOSTIC");
114290650Shselasky	case 0x92: return ("DOWNLOAD_MICROCODE");
115290650Shselasky	case 0xa0: return ("PACKET");
116290650Shselasky	case 0xa1: return ("ATAPI_IDENTIFY");
117290650Shselasky	case 0xa2: return ("SERVICE");
118290650Shselasky	case 0xb0: return ("SMART");
119290650Shselasky	case 0xb1: return ("DEVICE CONFIGURATION");
120290650Shselasky	case 0xc0: return ("CFA_ERASE");
121290650Shselasky	case 0xc4: return ("READ_MUL");
122290650Shselasky	case 0xc5: return ("WRITE_MUL");
123290650Shselasky	case 0xc6: return ("SET_MULTI");
124290650Shselasky	case 0xc7: return ("READ_DMA_QUEUED");
125290650Shselasky	case 0xc8: return ("READ_DMA");
126290650Shselasky	case 0xca: return ("WRITE_DMA");
127290650Shselasky	case 0xcc: return ("WRITE_DMA_QUEUED");
128290650Shselasky	case 0xcd: return ("CFA_WRITE_MULTIPLE_WITHOUT_ERASE");
129290650Shselasky	case 0xce: return ("WRITE_MUL_FUA48");
130290650Shselasky	case 0xd1: return ("CHECK_MEDIA_CARD_TYPE");
131290650Shselasky	case 0xda: return ("GET_MEDIA_STATUS");
132290650Shselasky	case 0xde: return ("MEDIA_LOCK");
133290650Shselasky	case 0xdf: return ("MEDIA_UNLOCK");
134290650Shselasky	case 0xe0: return ("STANDBY_IMMEDIATE");
135290650Shselasky	case 0xe1: return ("IDLE_IMMEDIATE");
136290650Shselasky	case 0xe2: return ("STANDBY");
137290650Shselasky	case 0xe3: return ("IDLE");
138290650Shselasky	case 0xe4: return ("READ_BUFFER/PM");
139290650Shselasky	case 0xe5: return ("CHECK_POWER_MODE");
140290650Shselasky	case 0xe6: return ("SLEEP");
141290650Shselasky	case 0xe7: return ("FLUSHCACHE");
142290650Shselasky	case 0xe8: return ("WRITE_PM");
143290650Shselasky	case 0xea: return ("FLUSHCACHE48");
144290650Shselasky	case 0xec: return ("ATA_IDENTIFY");
145290650Shselasky	case 0xed: return ("MEDIA_EJECT");
146290650Shselasky	case 0xef:
147290650Shselasky		switch (cmd->features) {
148290650Shselasky	        case 0x03: return ("SETFEATURES SET TRANSFER MODE");
149290650Shselasky	        case 0x02: return ("SETFEATURES ENABLE WCACHE");
150290650Shselasky	        case 0x82: return ("SETFEATURES DISABLE WCACHE");
151290650Shselasky	        case 0x06: return ("SETFEATURES ENABLE PUIS");
152291069Shselasky	        case 0x86: return ("SETFEATURES DISABLE PUIS");
153290650Shselasky	        case 0x07: return ("SETFEATURES SPIN-UP");
154290650Shselasky	        case 0x10: return ("SETFEATURES ENABLE SATA FEATURE");
155290650Shselasky	        case 0x90: return ("SETFEATURES DISABLE SATA FEATURE");
156290650Shselasky	        case 0xaa: return ("SETFEATURES ENABLE RCACHE");
157290650Shselasky	        case 0x55: return ("SETFEATURES DISABLE RCACHE");
158290650Shselasky	        }
159290650Shselasky	        return "SETFEATURES";
160290650Shselasky	case 0xf1: return ("SECURITY_SET_PASSWORD");
161290650Shselasky	case 0xf2: return ("SECURITY_UNLOCK");
162290650Shselasky	case 0xf3: return ("SECURITY_ERASE_PREPARE");
163290650Shselasky	case 0xf4: return ("SECURITY_ERASE_UNIT");
164290650Shselasky	case 0xf5: return ("SECURITY_FREE_LOCK");
165290650Shselasky	case 0xf6: return ("SECURITY DISABLE PASSWORD");
166290650Shselasky	case 0xf8: return ("READ_NATIVE_MAX_ADDRESS");
167290650Shselasky	case 0xf9: return ("SET_MAX_ADDRESS");
168290650Shselasky	}
169290650Shselasky	return "UNKNOWN";
170291070Shselasky}
171290650Shselasky
172290650Shselaskychar *
173291069Shselaskyata_cmd_string(struct ata_cmd *cmd, char *cmd_string, size_t len)
174290650Shselasky{
175290650Shselasky
176290650Shselasky	snprintf(cmd_string, len, "%02x %02x %02x %02x "
177290650Shselasky	    "%02x %02x %02x %02x %02x %02x %02x %02x",
178290650Shselasky	    cmd->command, cmd->features,
179290650Shselasky	    cmd->lba_low, cmd->lba_mid, cmd->lba_high, cmd->device,
180290650Shselasky	    cmd->lba_low_exp, cmd->lba_mid_exp, cmd->lba_high_exp,
181290650Shselasky	    cmd->features_exp, cmd->sector_count, cmd->sector_count_exp);
182290650Shselasky
183290650Shselasky	return(cmd_string);
184290650Shselasky}
185290650Shselasky
186290650Shselaskychar *
187290650Shselaskyata_res_string(struct ata_res *res, char *res_string, size_t len)
188290650Shselasky{
189290650Shselasky
190290650Shselasky	snprintf(res_string, len, "%02x %02x %02x %02x "
191290650Shselasky	    "%02x %02x %02x %02x %02x %02x %02x",
192290650Shselasky	    res->status, res->error,
193290650Shselasky	    res->lba_low, res->lba_mid, res->lba_high, res->device,
194290650Shselasky	    res->lba_low_exp, res->lba_mid_exp, res->lba_high_exp,
195290650Shselasky	    res->sector_count, res->sector_count_exp);
196290650Shselasky
197290650Shselasky	return(res_string);
198290650Shselasky}
199290650Shselasky
200290650Shselasky/*
201290650Shselasky * ata_command_sbuf() returns 0 for success and -1 for failure.
202290650Shselasky */
203290650Shselaskyint
204290650Shselaskyata_command_sbuf(struct ccb_ataio *ataio, struct sbuf *sb)
205290650Shselasky{
206290650Shselasky	char cmd_str[(12 * 3) + 1];
207290650Shselasky
208290650Shselasky	sbuf_printf(sb, "%s. ACB: %s",
209290650Shselasky	    ata_op_string(&ataio->cmd),
210290650Shselasky	    ata_cmd_string(&ataio->cmd, cmd_str, sizeof(cmd_str)));
211290650Shselasky
212290650Shselasky	return(0);
213290650Shselasky}
214290650Shselasky
215290650Shselasky/*
216290650Shselasky * ata_status_abuf() returns 0 for success and -1 for failure.
217290650Shselasky */
218290650Shselaskyint
219290650Shselaskyata_status_sbuf(struct ccb_ataio *ataio, struct sbuf *sb)
220290650Shselasky{
221290650Shselasky
222290650Shselasky	sbuf_printf(sb, "ATA status: %02x (%s%s%s%s%s%s%s%s)",
223290650Shselasky	    ataio->res.status,
224290650Shselasky	    (ataio->res.status & 0x80) ? "BSY " : "",
225290650Shselasky	    (ataio->res.status & 0x40) ? "DRDY " : "",
226290650Shselasky	    (ataio->res.status & 0x20) ? "DF " : "",
227290650Shselasky	    (ataio->res.status & 0x10) ? "SERV " : "",
228290650Shselasky	    (ataio->res.status & 0x08) ? "DRQ " : "",
229290650Shselasky	    (ataio->res.status & 0x04) ? "CORR " : "",
230290650Shselasky	    (ataio->res.status & 0x02) ? "IDX " : "",
231290650Shselasky	    (ataio->res.status & 0x01) ? "ERR" : "");
232290650Shselasky	if (ataio->res.status & 1) {
233290650Shselasky	    sbuf_printf(sb, ", error: %02x (%s%s%s%s%s%s%s%s)",
234290650Shselasky		ataio->res.error,
235290650Shselasky		(ataio->res.error & 0x80) ? "ICRC " : "",
236290650Shselasky		(ataio->res.error & 0x40) ? "UNC " : "",
237291070Shselasky		(ataio->res.error & 0x20) ? "MC " : "",
238290650Shselasky		(ataio->res.error & 0x10) ? "IDNF " : "",
239290650Shselasky		(ataio->res.error & 0x08) ? "MCR " : "",
240290650Shselasky		(ataio->res.error & 0x04) ? "ABRT " : "",
241290650Shselasky		(ataio->res.error & 0x02) ? "NM " : "",
242290650Shselasky		(ataio->res.error & 0x01) ? "ILI" : "");
243290650Shselasky	}
244290650Shselasky
245290650Shselasky	return(0);
246290650Shselasky}
247290650Shselasky
248290650Shselasky/*
249290650Shselasky * ata_res_sbuf() returns 0 for success and -1 for failure.
250290650Shselasky */
251290650Shselaskyint
252290650Shselaskyata_res_sbuf(struct ccb_ataio *ataio, struct sbuf *sb)
253290650Shselasky{
254290650Shselasky	char res_str[(11 * 3) + 1];
255290650Shselasky
256290650Shselasky	sbuf_printf(sb, "RES: %s",
257290650Shselasky	    ata_res_string(&ataio->res, res_str, sizeof(res_str)));
258290650Shselasky
259290650Shselasky	return(0);
260290650Shselasky}
261290650Shselasky
262290650Shselaskyvoid
263290650Shselaskyata_print_ident(struct ata_params *ident_data)
264290650Shselasky{
265290650Shselasky	char product[48], revision[16];
266290650Shselasky
267290650Shselasky	cam_strvis(product, ident_data->model, sizeof(ident_data->model),
268290650Shselasky		   sizeof(product));
269290650Shselasky	cam_strvis(revision, ident_data->revision, sizeof(ident_data->revision),
270290650Shselasky		   sizeof(revision));
271290650Shselasky	printf("<%s %s> %s-%d",
272290650Shselasky	    product, revision,
273290650Shselasky	    (ident_data->config & ATA_PROTO_ATAPI) ? "ATAPI" : "ATA",
274290650Shselasky	    ata_version(ident_data->version_major));
275290650Shselasky	if (ident_data->satacapabilities && ident_data->satacapabilities != 0xffff) {
276290650Shselasky		if (ident_data->satacapabilities & ATA_SATA_GEN3)
277290650Shselasky			printf(" SATA 3.x");
278290650Shselasky		else if (ident_data->satacapabilities & ATA_SATA_GEN2)
279290650Shselasky			printf(" SATA 2.x");
280290650Shselasky		else if (ident_data->satacapabilities & ATA_SATA_GEN1)
281290650Shselasky			printf(" SATA 1.x");
282290650Shselasky		else
283290650Shselasky			printf(" SATA");
284291069Shselasky	}
285290650Shselasky	printf(" device\n");
286290650Shselasky}
287290650Shselasky
288290650Shselaskyuint32_t
289290650Shselaskyata_logical_sector_size(struct ata_params *ident_data)
290290650Shselasky{
291290650Shselasky	if ((ident_data->pss & 0xc000) == 0x4000 &&
292290650Shselasky	    (ident_data->pss & ATA_PSS_LSSABOVE512)) {
293290650Shselasky		return ((u_int32_t)ident_data->lss_1 |
294290650Shselasky		    ((u_int32_t)ident_data->lss_2 << 16));
295290650Shselasky	}
296290650Shselasky	return (512);
297290650Shselasky}
298290650Shselasky
299290650Shselaskyuint64_t
300290650Shselaskyata_physical_sector_size(struct ata_params *ident_data)
301290650Shselasky{
302291070Shselasky	if ((ident_data->pss & 0xc000) == 0x4000 &&
303290650Shselasky	    (ident_data->pss & ATA_PSS_MULTLS)) {
304290650Shselasky		return ((uint64_t)ata_logical_sector_size(ident_data) *
305290650Shselasky		    (1 << (ident_data->pss & ATA_PSS_LSPPS)));
306290650Shselasky	}
307290650Shselasky	return (512);
308291070Shselasky}
309290650Shselasky
310290650Shselaskyuint64_t
311290650Shselaskyata_logical_sector_offset(struct ata_params *ident_data)
312290650Shselasky{
313290650Shselasky	if ((ident_data->lsalign & 0xc000) == 0x4000) {
314291070Shselasky		return ((uint64_t)ata_logical_sector_size(ident_data) *
315290650Shselasky		    (ident_data->lsalign & 0x3fff));
316290650Shselasky	}
317290650Shselasky	return (0);
318290650Shselasky}
319290650Shselasky
320290650Shselaskyvoid
321290650Shselaskyata_28bit_cmd(struct ccb_ataio *ataio, uint8_t cmd, uint8_t features,
322290650Shselasky    uint32_t lba, uint8_t sector_count)
323290650Shselasky{
324290650Shselasky	bzero(&ataio->cmd, sizeof(ataio->cmd));
325290650Shselasky	ataio->cmd.flags = 0;
326290650Shselasky	if (cmd == ATA_READ_DMA ||
327290650Shselasky	    cmd == ATA_READ_DMA_QUEUED ||
328290650Shselasky	    cmd == ATA_WRITE_DMA ||
329290650Shselasky	    cmd == ATA_WRITE_DMA_QUEUED)
330290650Shselasky		ataio->cmd.flags |= CAM_ATAIO_DMA;
331291070Shselasky	ataio->cmd.command = cmd;
332290650Shselasky	ataio->cmd.features = features;
333290650Shselasky	ataio->cmd.lba_low = lba;
334290650Shselasky	ataio->cmd.lba_mid = lba >> 8;
335290650Shselasky	ataio->cmd.lba_high = lba >> 16;
336290650Shselasky	ataio->cmd.device = 0x40 | ((lba >> 24) & 0x0f);
337290650Shselasky	ataio->cmd.sector_count = sector_count;
338290650Shselasky}
339290650Shselasky
340290650Shselaskyvoid
341290650Shselaskyata_48bit_cmd(struct ccb_ataio *ataio, uint8_t cmd, uint16_t features,
342290650Shselasky    uint64_t lba, uint16_t sector_count)
343290650Shselasky{
344290650Shselasky	bzero(&ataio->cmd, sizeof(ataio->cmd));
345290650Shselasky	ataio->cmd.flags = CAM_ATAIO_48BIT;
346290650Shselasky	if (cmd == ATA_READ_DMA48 ||
347290650Shselasky	    cmd == ATA_READ_DMA_QUEUED48 ||
348291070Shselasky	    cmd == ATA_READ_STREAM_DMA48 ||
349290650Shselasky	    cmd == ATA_WRITE_DMA48 ||
350290650Shselasky	    cmd == ATA_WRITE_DMA_FUA48 ||
351290650Shselasky	    cmd == ATA_WRITE_DMA_QUEUED48 ||
352290650Shselasky	    cmd == ATA_WRITE_DMA_QUEUED_FUA48 ||
353290650Shselasky	    cmd == ATA_WRITE_STREAM_DMA48 ||
354290650Shselasky	    cmd == ATA_DATA_SET_MANAGEMENT)
355290650Shselasky		ataio->cmd.flags |= CAM_ATAIO_DMA;
356290650Shselasky	ataio->cmd.command = cmd;
357290650Shselasky	ataio->cmd.features = features;
358290650Shselasky	ataio->cmd.lba_low = lba;
359290650Shselasky	ataio->cmd.lba_mid = lba >> 8;
360290650Shselasky	ataio->cmd.lba_high = lba >> 16;
361290650Shselasky	ataio->cmd.device = 0x40;
362290650Shselasky	ataio->cmd.lba_low_exp = lba >> 24;
363290650Shselasky	ataio->cmd.lba_mid_exp = lba >> 32;
364290650Shselasky	ataio->cmd.lba_high_exp = lba >> 40;
365290650Shselasky	ataio->cmd.features_exp = features >> 8;
366291932Shselasky	ataio->cmd.sector_count = sector_count;
367290650Shselasky	ataio->cmd.sector_count_exp = sector_count >> 8;
368290650Shselasky}
369290650Shselasky
370290650Shselaskyvoid
371290650Shselaskyata_ncq_cmd(struct ccb_ataio *ataio, uint8_t cmd,
372291070Shselasky    uint64_t lba, uint16_t sector_count)
373292838Shselasky{
374291070Shselasky	bzero(&ataio->cmd, sizeof(ataio->cmd));
375290650Shselasky	ataio->cmd.flags = CAM_ATAIO_48BIT | CAM_ATAIO_FPDMA;
376294314Shselasky	ataio->cmd.command = cmd;
377294314Shselasky	ataio->cmd.features = sector_count;
378290650Shselasky	ataio->cmd.lba_low = lba;
379290650Shselasky	ataio->cmd.lba_mid = lba >> 8;
380290650Shselasky	ataio->cmd.lba_high = lba >> 16;
381290650Shselasky	ataio->cmd.device = 0x40;
382290650Shselasky	ataio->cmd.lba_low_exp = lba >> 24;
383290650Shselasky	ataio->cmd.lba_mid_exp = lba >> 32;
384290650Shselasky	ataio->cmd.lba_high_exp = lba >> 40;
385290650Shselasky	ataio->cmd.features_exp = sector_count >> 8;
386290650Shselasky}
387290650Shselasky
388290650Shselaskyvoid
389290650Shselaskyata_reset_cmd(struct ccb_ataio *ataio)
390290650Shselasky{
391290650Shselasky	bzero(&ataio->cmd, sizeof(ataio->cmd));
392290650Shselasky	ataio->cmd.flags = CAM_ATAIO_CONTROL | CAM_ATAIO_NEEDRESULT;
393291932Shselasky	ataio->cmd.control = 0x04;
394300277Shselasky}
395300277Shselasky
396292838Shselaskyvoid
397292838Shselaskyata_pm_read_cmd(struct ccb_ataio *ataio, int reg, int port)
398290650Shselasky{
399290650Shselasky	bzero(&ataio->cmd, sizeof(ataio->cmd));
400290650Shselasky	ataio->cmd.flags = CAM_ATAIO_NEEDRESULT;
401290650Shselasky	ataio->cmd.command = ATA_READ_PM;
402290650Shselasky	ataio->cmd.features = reg;
403290650Shselasky	ataio->cmd.device = port & 0x0f;
404290650Shselasky}
405290650Shselasky
406290650Shselaskyvoid
407290650Shselaskyata_pm_write_cmd(struct ccb_ataio *ataio, int reg, int port, uint32_t val)
408291070Shselasky{
409291070Shselasky	bzero(&ataio->cmd, sizeof(ataio->cmd));
410290650Shselasky	ataio->cmd.flags = 0;
411290650Shselasky	ataio->cmd.command = ATA_WRITE_PM;
412290650Shselasky	ataio->cmd.features = reg;
413291070Shselasky	ataio->cmd.sector_count = val;
414291070Shselasky	ataio->cmd.lba_low = val >> 8;
415290650Shselasky	ataio->cmd.lba_mid = val >> 16;
416290650Shselasky	ataio->cmd.lba_high = val >> 24;
417290650Shselasky	ataio->cmd.device = port & 0x0f;
418291070Shselasky}
419291070Shselasky
420290650Shselaskyvoid
421290650Shselaskyata_bswap(int8_t *buf, int len)
422290650Shselasky{
423291070Shselasky	u_int16_t *ptr = (u_int16_t*)(buf + len);
424291070Shselasky
425290650Shselasky	while (--ptr >= (u_int16_t*)buf)
426291070Shselasky		*ptr = be16toh(*ptr);
427291070Shselasky}
428290650Shselasky
429291070Shselaskyvoid
430291070Shselaskyata_btrim(int8_t *buf, int len)
431290650Shselasky{
432291070Shselasky	int8_t *ptr;
433290650Shselasky
434290650Shselasky	for (ptr = buf; ptr < buf+len; ++ptr)
435290650Shselasky		if (!*ptr || *ptr == '_')
436290650Shselasky			*ptr = ' ';
437290650Shselasky	for (ptr = buf + len - 1; ptr >= buf && *ptr == ' '; --ptr)
438290650Shselasky		*ptr = 0;
439290650Shselasky}
440290650Shselasky
441290650Shselaskyvoid
442290650Shselaskyata_bpack(int8_t *src, int8_t *dst, int len)
443290650Shselasky{
444290650Shselasky	int i, j, blank;
445290650Shselasky
446290650Shselasky	for (i = j = blank = 0 ; i < len; i++) {
447291070Shselasky		if (blank && src[i] == ' ') continue;
448291070Shselasky		if (blank && src[i] != ' ') {
449291070Shselasky			dst[j++] = src[i];
450290650Shselasky			blank = 0;
451290650Shselasky			continue;
452290650Shselasky		}
453290650Shselasky		if (src[i] == ' ') {
454290650Shselasky			blank = 1;
455290650Shselasky			if (i == 0)
456290650Shselasky			continue;
457290650Shselasky		}
458290650Shselasky		dst[j++] = src[i];
459290650Shselasky	}
460290650Shselasky	while (j < len)
461290650Shselasky		dst[j++] = 0x00;
462290650Shselasky}
463290650Shselasky
464290650Shselaskyint
465290650Shselaskyata_max_pmode(struct ata_params *ap)
466290650Shselasky{
467290650Shselasky    if (ap->atavalid & ATA_FLAG_64_70) {
468290650Shselasky	if (ap->apiomodes & 0x02)
469290650Shselasky	    return ATA_PIO4;
470290650Shselasky	if (ap->apiomodes & 0x01)
471290650Shselasky	    return ATA_PIO3;
472290650Shselasky    }
473290650Shselasky    if (ap->mwdmamodes & 0x04)
474290650Shselasky	return ATA_PIO4;
475290650Shselasky    if (ap->mwdmamodes & 0x02)
476290650Shselasky	return ATA_PIO3;
477290650Shselasky    if (ap->mwdmamodes & 0x01)
478290650Shselasky	return ATA_PIO2;
479290650Shselasky    if ((ap->retired_piomode & ATA_RETIRED_PIO_MASK) == 0x200)
480290650Shselasky	return ATA_PIO2;
481290650Shselasky    if ((ap->retired_piomode & ATA_RETIRED_PIO_MASK) == 0x100)
482290650Shselasky	return ATA_PIO1;
483290650Shselasky    if ((ap->retired_piomode & ATA_RETIRED_PIO_MASK) == 0x000)
484290650Shselasky	return ATA_PIO0;
485290650Shselasky    return ATA_PIO0;
486290650Shselasky}
487290650Shselasky
488290650Shselaskyint
489290650Shselaskyata_max_wmode(struct ata_params *ap)
490290650Shselasky{
491291070Shselasky    if (ap->mwdmamodes & 0x04)
492290650Shselasky	return ATA_WDMA2;
493291070Shselasky    if (ap->mwdmamodes & 0x02)
494290650Shselasky	return ATA_WDMA1;
495290650Shselasky    if (ap->mwdmamodes & 0x01)
496290650Shselasky	return ATA_WDMA0;
497290650Shselasky    return -1;
498290650Shselasky}
499290650Shselasky
500290650Shselaskyint
501300277Shselaskyata_max_umode(struct ata_params *ap)
502300277Shselasky{
503300277Shselasky    if (ap->atavalid & ATA_FLAG_88) {
504300277Shselasky	if (ap->udmamodes & 0x40)
505300277Shselasky	    return ATA_UDMA6;
506300277Shselasky	if (ap->udmamodes & 0x20)
507300277Shselasky	    return ATA_UDMA5;
508300280Shselasky	if (ap->udmamodes & 0x10)
509300280Shselasky	    return ATA_UDMA4;
510300280Shselasky	if (ap->udmamodes & 0x08)
511300280Shselasky	    return ATA_UDMA3;
512291070Shselasky	if (ap->udmamodes & 0x04)
513290650Shselasky	    return ATA_UDMA2;
514291070Shselasky	if (ap->udmamodes & 0x02)
515291070Shselasky	    return ATA_UDMA1;
516291070Shselasky	if (ap->udmamodes & 0x01)
517290650Shselasky	    return ATA_UDMA0;
518290650Shselasky    }
519291070Shselasky    return -1;
520291070Shselasky}
521290650Shselasky
522290650Shselaskyint
523291070Shselaskyata_max_mode(struct ata_params *ap, int maxmode)
524291070Shselasky{
525291070Shselasky
526290650Shselasky	if (maxmode == 0)
527290650Shselasky		maxmode = ATA_DMA_MAX;
528291070Shselasky	if (maxmode >= ATA_UDMA0 && ata_max_umode(ap) > 0)
529290650Shselasky		return (min(maxmode, ata_max_umode(ap)));
530290650Shselasky	if (maxmode >= ATA_WDMA0 && ata_max_wmode(ap) > 0)
531290650Shselasky		return (min(maxmode, ata_max_wmode(ap)));
532291070Shselasky	return (min(maxmode, ata_max_pmode(ap)));
533291070Shselasky}
534291070Shselasky
535290650Shselaskychar *
536291070Shselaskyata_mode2string(int mode)
537290650Shselasky{
538290650Shselasky    switch (mode) {
539290650Shselasky    case -1: return "UNSUPPORTED";
540290650Shselasky    case 0: return "NONE";
541290650Shselasky    case ATA_PIO0: return "PIO0";
542290650Shselasky    case ATA_PIO1: return "PIO1";
543290650Shselasky    case ATA_PIO2: return "PIO2";
544290650Shselasky    case ATA_PIO3: return "PIO3";
545290650Shselasky    case ATA_PIO4: return "PIO4";
546290650Shselasky    case ATA_WDMA0: return "WDMA0";
547290650Shselasky    case ATA_WDMA1: return "WDMA1";
548290650Shselasky    case ATA_WDMA2: return "WDMA2";
549290650Shselasky    case ATA_UDMA0: return "UDMA0";
550290650Shselasky    case ATA_UDMA1: return "UDMA1";
551290650Shselasky    case ATA_UDMA2: return "UDMA2";
552290650Shselasky    case ATA_UDMA3: return "UDMA3";
553290650Shselasky    case ATA_UDMA4: return "UDMA4";
554290650Shselasky    case ATA_UDMA5: return "UDMA5";
555290650Shselasky    case ATA_UDMA6: return "UDMA6";
556290650Shselasky    default:
557290650Shselasky	if (mode & ATA_DMA_MASK)
558290650Shselasky	    return "BIOSDMA";
559290650Shselasky	else
560290650Shselasky	    return "BIOSPIO";
561290650Shselasky    }
562290650Shselasky}
563290650Shselasky
564290650Shselaskyint
565290650Shselaskyata_string2mode(char *str)
566290650Shselasky{
567290650Shselasky	if (!strcasecmp(str, "PIO0")) return (ATA_PIO0);
568290650Shselasky	if (!strcasecmp(str, "PIO1")) return (ATA_PIO1);
569290650Shselasky	if (!strcasecmp(str, "PIO2")) return (ATA_PIO2);
570290650Shselasky	if (!strcasecmp(str, "PIO3")) return (ATA_PIO3);
571290650Shselasky	if (!strcasecmp(str, "PIO4")) return (ATA_PIO4);
572290650Shselasky	if (!strcasecmp(str, "WDMA0")) return (ATA_WDMA0);
573290650Shselasky	if (!strcasecmp(str, "WDMA1")) return (ATA_WDMA1);
574290650Shselasky	if (!strcasecmp(str, "WDMA2")) return (ATA_WDMA2);
575290650Shselasky	if (!strcasecmp(str, "UDMA0")) return (ATA_UDMA0);
576290650Shselasky	if (!strcasecmp(str, "UDMA16")) return (ATA_UDMA0);
577290650Shselasky	if (!strcasecmp(str, "UDMA1")) return (ATA_UDMA1);
578290650Shselasky	if (!strcasecmp(str, "UDMA25")) return (ATA_UDMA1);
579290650Shselasky	if (!strcasecmp(str, "UDMA2")) return (ATA_UDMA2);
580290650Shselasky	if (!strcasecmp(str, "UDMA33")) return (ATA_UDMA2);
581290650Shselasky	if (!strcasecmp(str, "UDMA3")) return (ATA_UDMA3);
582290650Shselasky	if (!strcasecmp(str, "UDMA44")) return (ATA_UDMA3);
583290650Shselasky	if (!strcasecmp(str, "UDMA4")) return (ATA_UDMA4);
584290650Shselasky	if (!strcasecmp(str, "UDMA66")) return (ATA_UDMA4);
585290650Shselasky	if (!strcasecmp(str, "UDMA5")) return (ATA_UDMA5);
586290650Shselasky	if (!strcasecmp(str, "UDMA100")) return (ATA_UDMA5);
587290650Shselasky	if (!strcasecmp(str, "UDMA6")) return (ATA_UDMA6);
588290650Shselasky	if (!strcasecmp(str, "UDMA133")) return (ATA_UDMA6);
589290650Shselasky	return (-1);
590290650Shselasky}
591290650Shselasky
592290650Shselasky
593290650Shselaskyu_int
594290650Shselaskyata_mode2speed(int mode)
595290650Shselasky{
596290650Shselasky	switch (mode) {
597290650Shselasky	case ATA_PIO0:
598290650Shselasky	default:
599290650Shselasky		return (3300);
600290650Shselasky	case ATA_PIO1:
601290650Shselasky		return (5200);
602290650Shselasky	case ATA_PIO2:
603290650Shselasky		return (8300);
604290650Shselasky	case ATA_PIO3:
605290650Shselasky		return (11100);
606290650Shselasky	case ATA_PIO4:
607290650Shselasky		return (16700);
608290650Shselasky	case ATA_WDMA0:
609290650Shselasky		return (4200);
610290650Shselasky	case ATA_WDMA1:
611290650Shselasky		return (13300);
612290650Shselasky	case ATA_WDMA2:
613290650Shselasky		return (16700);
614290650Shselasky	case ATA_UDMA0:
615290650Shselasky		return (16700);
616290650Shselasky	case ATA_UDMA1:
617290650Shselasky		return (25000);
618290650Shselasky	case ATA_UDMA2:
619290650Shselasky		return (33300);
620290650Shselasky	case ATA_UDMA3:
621290650Shselasky		return (44400);
622290650Shselasky	case ATA_UDMA4:
623290650Shselasky		return (66700);
624290650Shselasky	case ATA_UDMA5:
625290650Shselasky		return (100000);
626290650Shselasky	case ATA_UDMA6:
627290650Shselasky		return (133000);
628290650Shselasky	}
629290650Shselasky}
630290650Shselasky
631290650Shselaskyu_int
632290650Shselaskyata_revision2speed(int revision)
633290650Shselasky{
634290650Shselasky	switch (revision) {
635290650Shselasky	case 1:
636290650Shselasky	default:
637290650Shselasky		return (150000);
638290650Shselasky	case 2:
639290650Shselasky		return (300000);
640290650Shselasky	case 3:
641290650Shselasky		return (600000);
642290650Shselasky	}
643290650Shselasky}
644291070Shselasky
645290650Shselaskyint
646290650Shselaskyata_speed2revision(u_int speed)
647290650Shselasky{
648290650Shselasky	switch (speed) {
649290650Shselasky	case 0:
650290650Shselasky		return (0);
651290650Shselasky	case 150000:
652290650Shselasky		return (1);
653290650Shselasky	case 300000:
654290650Shselasky		return (2);
655290650Shselasky	case 600000:
656290650Shselasky		return (3);
657290650Shselasky	default:
658290650Shselasky		return (-1);
659290650Shselasky	}
660290650Shselasky}
661290650Shselasky
662290650Shselaskyint
663290650Shselaskyata_identify_match(caddr_t identbuffer, caddr_t table_entry)
664290650Shselasky{
665290650Shselasky	struct scsi_inquiry_pattern *entry;
666290650Shselasky	struct ata_params *ident;
667290650Shselasky
668290650Shselasky	entry = (struct scsi_inquiry_pattern *)table_entry;
669290650Shselasky	ident = (struct ata_params *)identbuffer;
670290650Shselasky
671290650Shselasky	if ((cam_strmatch(ident->model, entry->product,
672290650Shselasky			  sizeof(ident->model)) == 0)
673290650Shselasky	 && (cam_strmatch(ident->revision, entry->revision,
674290650Shselasky			  sizeof(ident->revision)) == 0)) {
675290650Shselasky		return (0);
676290650Shselasky	}
677290650Shselasky        return (-1);
678290650Shselasky}
679290650Shselasky
680290650Shselaskyint
681290650Shselaskyata_static_identify_match(caddr_t identbuffer, caddr_t table_entry)
682290650Shselasky{
683290650Shselasky	struct scsi_static_inquiry_pattern *entry;
684290650Shselasky	struct ata_params *ident;
685290650Shselasky
686290650Shselasky	entry = (struct scsi_static_inquiry_pattern *)table_entry;
687290650Shselasky	ident = (struct ata_params *)identbuffer;
688290650Shselasky
689290650Shselasky	if ((cam_strmatch(ident->model, entry->product,
690290650Shselasky			  sizeof(ident->model)) == 0)
691291070Shselasky	 && (cam_strmatch(ident->revision, entry->revision,
692291070Shselasky			  sizeof(ident->revision)) == 0)) {
693291070Shselasky		return (0);
694291070Shselasky	}
695291070Shselasky        return (-1);
696291070Shselasky}
697291070Shselasky