drivers/misc/fsl_devdis.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright 2015 Freescale Semiconductor, Inc.
   4  * Author: Zhuoyu Zhang <Zhuoyu.Zhang@freescale.com>
   5  */
   6 #include <common.h>
   7 #include <asm/io.h>
   8 #include <asm/arch-ls102xa/immap_ls102xa.h>
   9 #include <asm/arch-ls102xa/config.h>
  10 #include <linux/compiler.h>
  11 #include <hwconfig.h>
  12 #include <fsl_devdis.h>
  13
  14 void device_disable(const struct devdis_table *tbl, uint32_t num)
  15 {
  16         int i;
  17         struct ccsr_gur __iomem *gur = (void *)CONFIG_SYS_FSL_GUTS_ADDR;
  18
  19         /*
  20          * Extract hwconfig from environment and disable unused device.
  21          */
  22         for (i = 0; i < num; i++) {
  23                 if (hwconfig_sub("devdis", tbl[i].name))
  24                         setbits_be32(&gur->devdisr + tbl[i].offset,
  25                                 tbl[i].mask);
  26         }
  27 }
  28