78 lines
		
	
	
		
			1.4 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			78 lines
		
	
	
		
			1.4 KiB
		
	
	
	
		
			C
		
	
	
	
| /*
 | |
|  * Copyright (c) 2016 Google, Inc
 | |
|  *
 | |
|  * From coreboot broadwell support
 | |
|  *
 | |
|  * SPDX-License-Identifier:	GPL-2.0
 | |
|  */
 | |
| 
 | |
| #include <common.h>
 | |
| #include <dm.h>
 | |
| #include <pch.h>
 | |
| #include <asm/intel_regs.h>
 | |
| #include <asm/io.h>
 | |
| #include <asm/lpc_common.h>
 | |
| #include <asm/arch/pch.h>
 | |
| #include <asm/arch/spi.h>
 | |
| 
 | |
| static void set_spi_speed(void)
 | |
| {
 | |
| 	u32 fdod;
 | |
| 	u8 ssfc;
 | |
| 
 | |
| 	/* Observe SPI Descriptor Component Section 0 */
 | |
| 	writel(0x1000, SPI_REG(SPIBAR_FDOC));
 | |
| 
 | |
| 	/* Extract the Write/Erase SPI Frequency from descriptor */
 | |
| 	fdod = readl(SPI_REG(SPIBAR_FDOD));
 | |
| 	fdod >>= 24;
 | |
| 	fdod &= 7;
 | |
| 
 | |
| 	/* Set Software Sequence frequency to match */
 | |
| 	ssfc = readb(SPI_REG(SPIBAR_SSFC + 2));
 | |
| 	ssfc &= ~7;
 | |
| 	ssfc |= fdod;
 | |
| 	writeb(ssfc, SPI_REG(SPIBAR_SSFC + 2));
 | |
| }
 | |
| 
 | |
| static int broadwell_lpc_early_init(struct udevice *dev)
 | |
| {
 | |
| 	set_spi_speed();
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int lpc_init_extra(struct udevice *dev)
 | |
| {
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int broadwell_lpc_probe(struct udevice *dev)
 | |
| {
 | |
| 	int ret;
 | |
| 
 | |
| 	if (!(gd->flags & GD_FLG_RELOC)) {
 | |
| 		ret = lpc_common_early_init(dev);
 | |
| 		if (ret) {
 | |
| 			debug("%s: lpc_early_init() failed\n", __func__);
 | |
| 			return ret;
 | |
| 		}
 | |
| 
 | |
| 		return broadwell_lpc_early_init(dev);
 | |
| 	}
 | |
| 
 | |
| 	return lpc_init_extra(dev);
 | |
| }
 | |
| 
 | |
| static const struct udevice_id broadwell_lpc_ids[] = {
 | |
| 	{ .compatible = "intel,broadwell-lpc" },
 | |
| 	{ }
 | |
| };
 | |
| 
 | |
| U_BOOT_DRIVER(broadwell_lpc_drv) = {
 | |
| 	.name		= "lpc",
 | |
| 	.id		= UCLASS_LPC,
 | |
| 	.of_match	= broadwell_lpc_ids,
 | |
| 	.probe		= broadwell_lpc_probe,
 | |
| };
 |