[J-u-boot.git] / cmd / sata.c

/*
 * Copyright (C) 2000-2005, DENX Software Engineering
 *		Wolfgang Denk <[email protected]>
 * Copyright (C) Procsys. All rights reserved.
 *		Mushtaq Khan <[email protected]>
 *			<[email protected]>
 * Copyright (C) 2008 Freescale Semiconductor, Inc.
 *		Dave Liu <[email protected]>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <common.h>
#include <ahci.h>
#include <dm.h>
#include <command.h>
#include <part.h>
#include <sata.h>
#include <dm/device-internal.h>
#include <dm/uclass-internal.h>

static int sata_curr_device = -1;

int sata_remove(int devnum)
{
#ifdef CONFIG_AHCI
	struct udevice *dev;
	int rc;

	rc = uclass_find_device(UCLASS_AHCI, devnum, &dev);
	if (!rc && !dev)
		rc = uclass_find_first_device(UCLASS_AHCI, &dev);
	if (rc || !dev) {
		printf("Cannot find SATA device %d (err=%d)\n", devnum, rc);
		return CMD_RET_FAILURE;
	}

	rc = device_remove(dev, DM_REMOVE_NORMAL);
	if (rc) {
		printf("Cannot remove SATA device '%s' (err=%d)\n", dev->name,
		       rc);
		return CMD_RET_FAILURE;
	}

	return 0;
#else
	return sata_stop();
#endif
}

int sata_probe(int devnum)
{
#ifdef CONFIG_AHCI
	struct udevice *dev;
	struct udevice *blk;
	int rc;

	rc = uclass_get_device(UCLASS_AHCI, devnum, &dev);
	if (rc)
		rc = uclass_find_first_device(UCLASS_AHCI, &dev);
	if (rc) {
		printf("Cannot probe SATA device %d (err=%d)\n", devnum, rc);
		return CMD_RET_FAILURE;
	}
	rc = sata_scan(dev);
	if (rc) {
		printf("Cannot scan SATA device %d (err=%d)\n", devnum, rc);
		return CMD_RET_FAILURE;
	}

	rc = blk_get_from_parent(dev, &blk);
	if (!rc) {
		struct blk_desc *desc = dev_get_uclass_platdata(blk);

		if (desc->lba > 0 && desc->blksz > 0)
			part_init(desc);
	}

	return 0;
#else
	return sata_initialize() < 0 ? CMD_RET_FAILURE : CMD_RET_SUCCESS;
#endif
}

static int do_sata(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
{
	int rc = 0;

	if (argc >= 2) {
		int devnum = 0;

		if (argc == 3)
			devnum = (int)simple_strtoul(argv[2], NULL, 10);
		if (!strcmp(argv[1], "stop"))
			return sata_remove(devnum);

		if (!strcmp(argv[1], "init")) {
			if (sata_curr_device != -1) {
				rc = sata_remove(devnum);
				if (rc)
					return rc;
			}

			return sata_probe(devnum);
		}
	}

	/* If the user has not yet run `sata init`, do it now */
	if (sata_curr_device == -1) {
		rc = sata_probe(0);
		if (rc < 0)
			return CMD_RET_FAILURE;
		sata_curr_device = 0;
	}

	return blk_common_cmd(argc, argv, IF_TYPE_SATA, &sata_curr_device);
}

U_BOOT_CMD(
	sata, 5, 1, do_sata,
	"SATA sub system",
	"init - init SATA sub system\n"
	"sata stop [dev] - disable SATA sub system or device\n"
	"sata info - show available SATA devices\n"
	"sata device [dev] - show or set current device\n"
	"sata part [dev] - print partition table\n"
	"sata read addr blk# cnt\n"
	"sata write addr blk# cnt"
);
Commit	Line	Data
c7057b52 DL	1	/*
	2	* Copyright (C) 2000-2005, DENX Software Engineering
	3	* Wolfgang Denk <[email protected]>
	4	* Copyright (C) Procsys. All rights reserved.
	5	* Mushtaq Khan <[email protected]>
	6	* <[email protected]>
	7	* Copyright (C) 2008 Freescale Semiconductor, Inc.
	8	* Dave Liu <[email protected]>
	9	*
1a459660	10	* SPDX-License-Identifier: GPL-2.0+
c7057b52 DL	11	*/
	12
	13	#include <common.h>
f19f1ecb SG	14	#include <ahci.h>
f19f1ecb SG	15	#include <dm.h>
c7057b52 DL	16	#include <command.h>
	17	#include <part.h>
	18	#include <sata.h>
f19f1ecb SG	19	#include <dm/device-internal.h>
f19f1ecb SG	20	#include <dm/uclass-internal.h>
c7057b52	21
088f1b19	22	static int sata_curr_device = -1;
c7057b52	23
f19f1ecb SG	24	int sata_remove(int devnum)
	25	{
	26	#ifdef CONFIG_AHCI
	27	struct udevice *dev;
	28	int rc;
	29
	30	rc = uclass_find_device(UCLASS_AHCI, devnum, &dev);
	31	if (!rc && !dev)
	32	rc = uclass_find_first_device(UCLASS_AHCI, &dev);
	33	if (rc \|\| !dev) {
	34	printf("Cannot find SATA device %d (err=%d)\n", devnum, rc);
	35	return CMD_RET_FAILURE;
	36	}
	37
	38	rc = device_remove(dev, DM_REMOVE_NORMAL);
	39	if (rc) {
	40	printf("Cannot remove SATA device '%s' (err=%d)\n", dev->name,
	41	rc);
	42	return CMD_RET_FAILURE;
	43	}
	44
	45	return 0;
	46	#else
	47	return sata_stop();
	48	#endif
	49	}
	50
	51	int sata_probe(int devnum)
	52	{
	53	#ifdef CONFIG_AHCI
	54	struct udevice *dev;
	55	struct udevice *blk;
	56	int rc;
	57
	58	rc = uclass_get_device(UCLASS_AHCI, devnum, &dev);
	59	if (rc)
	60	rc = uclass_find_first_device(UCLASS_AHCI, &dev);
	61	if (rc) {
	62	printf("Cannot probe SATA device %d (err=%d)\n", devnum, rc);
	63	return CMD_RET_FAILURE;
	64	}
	65	rc = sata_scan(dev);
	66	if (rc) {
	67	printf("Cannot scan SATA device %d (err=%d)\n", devnum, rc);
	68	return CMD_RET_FAILURE;
	69	}
	70
	71	rc = blk_get_from_parent(dev, &blk);
	72	if (!rc) {
	73	struct blk_desc *desc = dev_get_uclass_platdata(blk);
	74
	75	if (desc->lba > 0 && desc->blksz > 0)
	76	part_init(desc);
	77	}
	78
	79	return 0;
	80	#else
	81	return sata_initialize() < 0 ? CMD_RET_FAILURE : CMD_RET_SUCCESS;
	82	#endif
	83	}
	84
088f1b19	85	static int do_sata(cmd_tbl_t cmdtp, int flag, int argc, char const argv[])
c7057b52 DL	86	{
	87	int rc = 0;
	88
f19f1ecb SG	89	if (argc >= 2) {
	90	int devnum = 0;
	91
	92	if (argc == 3)
	93	devnum = (int)simple_strtoul(argv[2], NULL, 10);
	94	if (!strcmp(argv[1], "stop"))
	95	return sata_remove(devnum);
d957c28a	96
f19f1ecb SG	97	if (!strcmp(argv[1], "init")) {
	98	if (sata_curr_device != -1) {
	99	rc = sata_remove(devnum);
	100	if (rc)
	101	return rc;
	102	}
d957c28a	103
f19f1ecb SG	104	return sata_probe(devnum);
f19f1ecb SG	105	}
d957c28a	106	}
cf7e399f MF	107
cf7e399f MF	108	/* If the user has not yet run `sata init`, do it now */
aa6ab905	109	if (sata_curr_device == -1) {
f19f1ecb SG	110	rc = sata_probe(0);
f19f1ecb SG	111	if (rc < 0)
8547f45b	112	return CMD_RET_FAILURE;
f19f1ecb	113	sata_curr_device = 0;
aa6ab905	114	}
cf7e399f	115
e29e71e9	116	return blk_common_cmd(argc, argv, IF_TYPE_SATA, &sata_curr_device);
c7057b52 DL	117	}
	118
	119	U_BOOT_CMD(
	120	sata, 5, 1, do_sata,
2fb2604d	121	"SATA sub system",
85dafbb8	122	"init - init SATA sub system\n"
f19f1ecb	123	"sata stop [dev] - disable SATA sub system or device\n"
c7057b52 DL	124	"sata info - show available SATA devices\n"
	125	"sata device [dev] - show or set current device\n"
	126	"sata part [dev] - print partition table\n"
	127	"sata read addr blk# cnt\n"
a89c33db WD	128	"sata write addr blk# cnt"
a89c33db WD	129	);