Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit cef4bafc authored by Justin Chen's avatar Justin Chen Committed by Florian Fainelli
Browse files

soc: brcmstb: add SoC driver to brcmstb 



Value of soc_dev_attributes:
* family = chip family id
* soc_id = product id
* revision = product revision

Signed-off-by: default avatarJustin Chen <justin.chen@broadcom.com>
Signed-off-by: default avatarFlorian Fainelli <f.fainelli@gmail.com>
parent f55532a0

arch/arm/mach-bcm/Kconfig

+1 −0
Original line number Diff line number Diff line
@@ -179,6 +179,7 @@ config ARCH_BRCMSTB 
	select ARCH_DMA_ADDR_T_64BIT if ARM_LPAE

	select ARCH_WANT_OPTIONAL_GPIOLIB

	select SOC_BRCMSTB

	select SOC_BUS

	help

	  Say Y if you intend to run the kernel on a Broadcom ARM-based STB

	  chipset.

drivers/soc/brcmstb/common.c

+58 −0
Original line number Diff line number Diff line
@@ -12,10 +12,18 @@ 
 * GNU General Public License for more details.

 */



#include <linux/io.h>

#include <linux/of.h>

#include <linux/of_address.h>

#include <linux/slab.h>

#include <linux/soc/brcmstb/brcmstb.h>

#include <linux/sys_soc.h>



#include <soc/brcmstb/common.h>



static u32 family_id;

static u32 product_id;



static const struct of_device_id brcmstb_machine_match[] = {

	{ .compatible = "brcm,brcmstb", },

	{ }
@@ -31,3 +39,53 @@ bool soc_is_brcmstb(void) 


	return of_match_node(brcmstb_machine_match, root) != NULL;

}



static const struct of_device_id sun_top_ctrl_match[] = {

	{ .compatible = "brcm,brcmstb-sun-top-ctrl", },

	{ }

};



static int __init brcmstb_soc_device_init(void)

{

	struct soc_device_attribute *soc_dev_attr;

	struct soc_device *soc_dev;

	struct device_node *sun_top_ctrl;

	void __iomem *sun_top_ctrl_base;



	sun_top_ctrl = of_find_matching_node(NULL, sun_top_ctrl_match);

	if (!sun_top_ctrl)

		return -ENODEV;



	sun_top_ctrl_base = of_iomap(sun_top_ctrl, 0);

	if (!sun_top_ctrl_base)

		return -ENODEV;



	family_id = readl(sun_top_ctrl_base);

	product_id = readl(sun_top_ctrl_base + 0x4);



	soc_dev_attr = kzalloc(sizeof(*soc_dev_attr), GFP_KERNEL);

	if (!soc_dev_attr)

		return -ENOMEM;



	soc_dev_attr->family = kasprintf(GFP_KERNEL, "%x",

					 family_id >> 28 ?

					 family_id >> 16 : family_id >> 8);

	soc_dev_attr->soc_id = kasprintf(GFP_KERNEL, "%x",

					 product_id >> 28 ?

					 product_id >> 16 : product_id >> 8);

	soc_dev_attr->revision = kasprintf(GFP_KERNEL, "%c%d",

					 ((product_id & 0xf0) >> 4) + 'A',

					   product_id & 0xf);



	soc_dev = soc_device_register(soc_dev_attr);

	if (IS_ERR(soc_dev)) {

		kfree(soc_dev_attr->family);

		kfree(soc_dev_attr->soc_id);

		kfree(soc_dev_attr->revision);

		kfree(soc_dev_attr);

		return -ENODEV;

	}



	return 0;

}

arch_initcall(brcmstb_soc_device_init);