[J-u-boot.git] / drivers / block / libata.c

/*
 * Copyright (C) 2008 Freescale Semiconductor, Inc.
 *		Dave Liu <[email protected]>
 *		port from the libata of linux kernel
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <libata.h>

u64 ata_id_n_sectors(u16 *id)
{
	if (ata_id_has_lba(id)) {
		if (ata_id_has_lba48(id))
			return ata_id_u64(id, ATA_ID_LBA48_SECTORS);
		else
			return ata_id_u32(id, ATA_ID_LBA_SECTORS);
	} else {
		return 0;
	}
}

u32 ata_dev_classify(u32 sig)
{
	u8 lbam, lbah;

	lbam = (sig >> 16) & 0xff;
	lbah = (sig >> 24) & 0xff;

	if (((lbam == 0) && (lbah == 0)) ||
		((lbam == 0x3c) && (lbah == 0xc3)))
		return ATA_DEV_ATA;

	if ((lbam == 0x14) && (lbah == 0xeb))
		return ATA_DEV_ATAPI;

	if ((lbam == 0x69) && (lbah == 0x96))
		return ATA_DEV_PMP;

	return ATA_DEV_UNKNOWN;
}

static void ata_id_string(const u16 *id, unsigned char *s,
			 unsigned int ofs, unsigned int len)
{
	unsigned int c;

	while (len > 0) {
		c = id[ofs] >> 8;
		*s = c;
		s++;

		c = id[ofs] & 0xff;
		*s = c;
		s++;

		ofs++;
		len -= 2;
	}
}

void ata_id_c_string(const u16 *id, unsigned char *s,
			 unsigned int ofs, unsigned int len)
{
	unsigned char *p;

	ata_id_string(id, s, ofs, len - 1);

	p = s + strnlen((char *)s, len - 1);
	while (p > s && p[-1] == ' ')
		p--;
	*p = '\0';
}

void ata_dump_id(u16 *id)
{
	unsigned char serial[ATA_ID_SERNO_LEN + 1];
	unsigned char firmware[ATA_ID_FW_REV_LEN + 1];
	unsigned char product[ATA_ID_PROD_LEN + 1];
	u64 n_sectors;

	/* Serial number */
	ata_id_c_string(id, serial, ATA_ID_SERNO, sizeof(serial));
	printf("S/N: %s\n\r", serial);

	/* Firmware version */
	ata_id_c_string(id, firmware, ATA_ID_FW_REV, sizeof(firmware));
	printf("Firmware version: %s\n\r", firmware);

	/* Product model */
	ata_id_c_string(id, product, ATA_ID_PROD, sizeof(product));
	printf("Product model number: %s\n\r", product);

	/* Total sectors of device  */
	n_sectors = ata_id_n_sectors(id);
	printf("Capablity: %lld sectors\n\r", n_sectors);

	printf ("id[49]: capabilities = 0x%04x\n"
		"id[53]: field valid = 0x%04x\n"
		"id[63]: mwdma = 0x%04x\n"
		"id[64]: pio = 0x%04x\n"
		"id[75]: queue depth = 0x%04x\n",
		id[49],
		id[53],
		id[63],
		id[64],
		id[75]);

	printf ("id[76]: sata capablity = 0x%04x\n"
		"id[78]: sata features supported = 0x%04x\n"
		"id[79]: sata features enable = 0x%04x\n",
		id[76],
		id[78],
		id[79]);

	printf ("id[80]: major version = 0x%04x\n"
		"id[81]: minor version = 0x%04x\n"
		"id[82]: command set supported 1 = 0x%04x\n"
		"id[83]: command set supported 2 = 0x%04x\n"
		"id[84]: command set extension = 0x%04x\n",
		id[80],
		id[81],
		id[82],
		id[83],
		id[84]);
	printf ("id[85]: command set enable 1 = 0x%04x\n"
		"id[86]: command set enable 2 = 0x%04x\n"
		"id[87]: command set default = 0x%04x\n"
		"id[88]: udma = 0x%04x\n"
		"id[93]: hardware reset result = 0x%04x\n",
		id[85],
		id[86],
		id[87],
		id[88],
		id[93]);
}

void ata_swap_buf_le16(u16 *buf, unsigned int buf_words)
{
	unsigned int i;

	for (i = 0; i < buf_words; i++)
		buf[i] = le16_to_cpu(buf[i]);
}
Commit	Line	Data
ffc664e8 DL	1	/*
	2	* Copyright (C) 2008 Freescale Semiconductor, Inc.
	3	* Dave Liu <[email protected]>
	4	* port from the libata of linux kernel
	5	*
1a459660	6	* SPDX-License-Identifier: GPL-2.0+
ffc664e8 DL	7	*/
	8
	9	#include <libata.h>
	10
	11	u64 ata_id_n_sectors(u16 *id)
	12	{
	13	if (ata_id_has_lba(id)) {
	14	if (ata_id_has_lba48(id))
	15	return ata_id_u64(id, ATA_ID_LBA48_SECTORS);
	16	else
	17	return ata_id_u32(id, ATA_ID_LBA_SECTORS);
	18	} else {
	19	return 0;
	20	}
	21	}
	22
	23	u32 ata_dev_classify(u32 sig)
	24	{
	25	u8 lbam, lbah;
	26
	27	lbam = (sig >> 16) & 0xff;
	28	lbah = (sig >> 24) & 0xff;
	29
	30	if (((lbam == 0) && (lbah == 0)) \|\|
	31	((lbam == 0x3c) && (lbah == 0xc3)))
	32	return ATA_DEV_ATA;
	33
	34	if ((lbam == 0x14) && (lbah == 0xeb))
	35	return ATA_DEV_ATAPI;
	36
	37	if ((lbam == 0x69) && (lbah == 0x96))
	38	return ATA_DEV_PMP;
	39
	40	return ATA_DEV_UNKNOWN;
	41	}
	42
	43	static void ata_id_string(const u16 id, unsigned char s,
	44	unsigned int ofs, unsigned int len)
	45	{
	46	unsigned int c;
	47
	48	while (len > 0) {
	49	c = id[ofs] >> 8;
	50	*s = c;
	51	s++;
	52
	53	c = id[ofs] & 0xff;
	54	*s = c;
	55	s++;
	56
	57	ofs++;
	58	len -= 2;
	59	}
	60	}
	61
	62	void ata_id_c_string(const u16 id, unsigned char s,
	63	unsigned int ofs, unsigned int len)
	64	{
	65	unsigned char *p;
	66
	67	ata_id_string(id, s, ofs, len - 1);
	68
	69	p = s + strnlen((char *)s, len - 1);
	70	while (p > s && p[-1] == ' ')
71	p--;
72	*p = '\0';
73	}
74
75	void ata_dump_id(u16 *id)
76	{
77	unsigned char serial[ATA_ID_SERNO_LEN + 1];
78	unsigned char firmware[ATA_ID_FW_REV_LEN + 1];
79	unsigned char product[ATA_ID_PROD_LEN + 1];
80	u64 n_sectors;
81
82	/* Serial number */
83	ata_id_c_string(id, serial, ATA_ID_SERNO, sizeof(serial));
84	printf("S/N: %s\n\r", serial);
85
86	/* Firmware version */
87	ata_id_c_string(id, firmware, ATA_ID_FW_REV, sizeof(firmware));
88	printf("Firmware version: %s\n\r", firmware);
89
90	/* Product model */
91	ata_id_c_string(id, product, ATA_ID_PROD, sizeof(product));
92	printf("Product model number: %s\n\r", product);
93
94	/* Total sectors of device */
95	n_sectors = ata_id_n_sectors(id);
4109df6f	96	printf("Capablity: %lld sectors\n\r", n_sectors);
ffc664e8	97
f297b7a1 DL	98	printf ("id[49]: capabilities = 0x%04x\n"
	99	"id[53]: field valid = 0x%04x\n"
	100	"id[63]: mwdma = 0x%04x\n"
	101	"id[64]: pio = 0x%04x\n"
	102	"id[75]: queue depth = 0x%04x\n",
ffc664e8 DL	103	id[49],
	104	id[53],
	105	id[63],
	106	id[64],
	107	id[75]);
	108
f297b7a1 DL	109	printf ("id[76]: sata capablity = 0x%04x\n"
	110	"id[78]: sata features supported = 0x%04x\n"
	111	"id[79]: sata features enable = 0x%04x\n",
ffc664e8 DL	112	id[76],
	113	id[78],
	114	id[79]);
	115
f297b7a1 DL	116	printf ("id[80]: major version = 0x%04x\n"
	117	"id[81]: minor version = 0x%04x\n"
	118	"id[82]: command set supported 1 = 0x%04x\n"
	119	"id[83]: command set supported 2 = 0x%04x\n"
	120	"id[84]: command set extension = 0x%04x\n",
ffc664e8 DL	121	id[80],
	122	id[81],
	123	id[82],
	124	id[83],
	125	id[84]);
f297b7a1 DL	126	printf ("id[85]: command set enable 1 = 0x%04x\n"
	127	"id[86]: command set enable 2 = 0x%04x\n"
	128	"id[87]: command set default = 0x%04x\n"
	129	"id[88]: udma = 0x%04x\n"
	130	"id[93]: hardware reset result = 0x%04x\n",
ffc664e8 DL	131	id[85],
	132	id[86],
	133	id[87],
	134	id[88],
	135	id[93]);
	136	}
	137
	138	void ata_swap_buf_le16(u16 *buf, unsigned int buf_words)
	139	{
	140	unsigned int i;
	141
	142	for (i = 0; i < buf_words; i++)
	143	buf[i] = le16_to_cpu(buf[i]);
	144	}