82 lines
		
	
	
		
			1.4 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			82 lines
		
	
	
		
			1.4 KiB
		
	
	
	
		
			C
		
	
	
	
/*
 | 
						|
 * Copyright (C) 2015 Google, Inc
 | 
						|
 * Written by Simon Glass <sjg@chromium.org>
 | 
						|
 *
 | 
						|
 * SPDX-License-Identifier:	GPL-2.0+
 | 
						|
 */
 | 
						|
 | 
						|
#include <common.h>
 | 
						|
#include <reset.h>
 | 
						|
#include <dm.h>
 | 
						|
#include <errno.h>
 | 
						|
#include <regmap.h>
 | 
						|
#include <dm/device-internal.h>
 | 
						|
#include <dm/lists.h>
 | 
						|
#include <dm/root.h>
 | 
						|
#include <linux/err.h>
 | 
						|
 | 
						|
int reset_request(struct udevice *dev, enum reset_t type)
 | 
						|
{
 | 
						|
	struct reset_ops *ops = reset_get_ops(dev);
 | 
						|
 | 
						|
	if (!ops->request)
 | 
						|
		return -ENOSYS;
 | 
						|
 | 
						|
	return ops->request(dev, type);
 | 
						|
}
 | 
						|
 | 
						|
int reset_walk(enum reset_t type)
 | 
						|
{
 | 
						|
	struct udevice *dev;
 | 
						|
	int ret = -ENOSYS;
 | 
						|
 | 
						|
	while (ret != -EINPROGRESS && type < RESET_COUNT) {
 | 
						|
		for (uclass_first_device(UCLASS_RESET, &dev);
 | 
						|
		     dev;
 | 
						|
		     uclass_next_device(&dev)) {
 | 
						|
			ret = reset_request(dev, type);
 | 
						|
			if (ret == -EINPROGRESS)
 | 
						|
				break;
 | 
						|
		}
 | 
						|
		type++;
 | 
						|
	}
 | 
						|
 | 
						|
	return ret;
 | 
						|
}
 | 
						|
 | 
						|
void reset_walk_halt(enum reset_t type)
 | 
						|
{
 | 
						|
	int ret;
 | 
						|
 | 
						|
	ret = reset_walk(type);
 | 
						|
 | 
						|
	/* Wait for the reset to take effect */
 | 
						|
	if (ret == -EINPROGRESS)
 | 
						|
		mdelay(100);
 | 
						|
 | 
						|
	/* Still no reset? Give up */
 | 
						|
	printf("Reset not supported on this platform\n");
 | 
						|
	hang();
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
 * reset_cpu() - calls reset_walk(RESET_WARM)
 | 
						|
 */
 | 
						|
void reset_cpu(ulong addr)
 | 
						|
{
 | 
						|
	reset_walk_halt(RESET_WARM);
 | 
						|
}
 | 
						|
 | 
						|
 | 
						|
int do_reset(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 | 
						|
{
 | 
						|
	reset_walk_halt(RESET_WARM);
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
UCLASS_DRIVER(reset) = {
 | 
						|
	.id		= UCLASS_RESET,
 | 
						|
	.name		= "reset",
 | 
						|
};
 |