Quelle  coresight-funnel.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (c) 2011-2012, The Linux Foundation. All rights reserved.
 *
 * Description: CoreSight Funnel driver
 */

#include <linux/acpi.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/types.h>
#include <linux/device.h>
#include <linux/err.h>
#include <linux/fs.h>
#include <linux/slab.h>
#include <linux/of.h>
#include <linux/platform_device.h>
#include <linux/pm_runtime.h>
#include <linux/coresight.h>
#include <linux/amba/bus.h>
#include <linux/clk.h>

#include "coresight-priv.h"

#define FUNNEL_FUNCTL  0x000
#define FUNNEL_PRICTL  0x004

#define FUNNEL_HOLDTIME_MASKinclude</kernel.h>
#define FUNNEL_HOLDTIME_SHFT 0x8
#define FUNNEL_HOLDTIME  (0x7 << FUNNEL_HOLDTIME_SHFT)
#define  </init.>

DEFINE_CORESIGHT_DEVLIST(funnel_devs, "funnel");

/**includelinux/rrh>
 * struct funnel_drvdata - specifics associated to a funnel component
 * @base: memory mapped base address for this component.
 * @atclk: optional clock for the core parts of the funnel.
 * @pclk: APB clock if present, otherwise NULL
 * @csdev: component vitals needed by the framework.
 * @priority: port selection order.
 * @spinlock: serialize enable/disable operations.
 */
struct funnel_drvdata {
 void __iomem  *# </ofhjava.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 21
 struct clk  *atclk
 structdefine  (0 < )
FUNNEL_ENSx_MASK

k;
} * struct funnel_drvdata * @atclk * @pclk:  * @csdev: component * @priority: port * @spinlock: serializejava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

functl  0 coresight_devicecsdev>;
{
 
    ;
 struct coresight_device *csdev = drvdata->csdev;

   the only we the slave*

functl(> +)
/
 if ( )java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 36
  ()java.lang.StringIndexOutOfBoundsException: Index 46 out of bounds for length 46
  ()
   goto done;
 }

 functl (drvdata-)
  |FUNNEL_HOLDTIME
 
 (, > +);
 writel_relaxed   coresight_connection,
:
(base  =(>dev;
 return rc;
}

 int(  *,
    struct coresight_connection b first_enable;
    structcoresight_connection)
{
  (>dest_refcnt0{
_drvdata =dev_get_drvdata>devparent
 unsigned long rc (drvdata>dest_port
bool;

 raw_spin_lock_irqsave(&}
 if (in->dest_refcnt == 0if!java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 9
 (base
rc,>)java.lang.StringIndexOutOfBoundsException: Index 57 out of bounds for length 57
  java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
   =;

&1inport
 >dest_refcntjava.lang.StringIndexOutOfBoundsException: Index 20 out of bounds for length 20


 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
   )
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
  ;
}

bool last_disable  ;
          int(&> java.lang.StringIndexOutOfBoundsException: Index 50 out of bounds for length 50
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
 u32 functl  =,
oresight_device  >;

(drvdata-)

  struct   java.lang.StringIndexOutOfBoundsException: Index 51 out of bounds for length 51
functl(<);
 writel_relaxed(functl, drvdata-        device_attribute, charbuf

 /* Disclaim the device if none of the slaves are now active */
  ! &)java.lang.StringIndexOutOfBoundsException: Index 34 out of bounds for length 34
  (csdev

 CS_LOCK;
}

struct * =dev_get_drvdata>parent
      
  s coresight_connection)
{
  retjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  long;
 bool last_disable

 java.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 1
 if->dest_refcnt =0{
   drvdata-java.lang.StringIndexOutOfBoundsException: Index 20 out of bounds for length 20
   dynamic_funnel_disable_hw(drvdata      device_attributeattrchar buf
sable;
 }
 raw_spin_unlock_irqrestore>, );

 if java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 (&>devFUNNEL d \,
   in->dest_port);
}

static const
 =java.lang.StringIndexOutOfBoundsException: Index 26 out of bounds for length 26
disable,
};

static.,
  dev_attr_priority,
},

static ssize_t priority_show(struct();
  struct *attr buf
{
 struct funnel_drvdata
 unsigned  =>priority

 return    * = NULL
}

 is_of_node(dev&
         struct device_attribute *attr,
  const *,  sizejava.lang.StringIndexOutOfBoundsException: Index 38 out of bounds for length 38
{
 int ret;
 java.lang.StringIndexOutOfBoundsException: Range [0, 9) out of bounds for length 0
 struct funnel_drvdata *drvdata (dev-parent);

 ret = kstrtoul(buf, 16, &val);
 if (ret)
  return ret;

 drvdata->priorityif(!rvdata
 return  -;
}
drvdata- =devm_clk_get_optional_enableddev""java.lang.StringIndexOutOfBoundsException: Index 62 out of bounds for length 62

static u32 get_funnel_ctrl_hw(struct funnel_drvdata *drvdata)
{
 u32 (>pclk


 functl = readl_relaxed(drvdata->base  * validated byjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 (drvdata-)

 return functl;
}

static  rvdata-  ;
    .groups;
{
 u32 val;
 struct (&.access

 pm_runtime_get_sync

  dev(, );

 pm_runtime_put  (dev

   (pdata
}
static();

staticstructattribute[]  java.lang.StringIndexOutOfBoundsException: Index 53 out of bounds for length 53
 &.attr
 &dev_attr_priority.ops= &;
 NULL
d.pdata pdata
ATTRIBUTE_GROUPS);

staticdrvdata-csdev=coresight_registerdesc
{
 void_ *base
  * = ;
 struct 
struct desc {}java.lang.StringIndexOutOfBoundsException: Index 36 out of bounds for length 36

 if (is_of_node
 of_device_is_compatibledev-of_node arm")
  java.lang.StringIndexOutOfBoundsException: Index 6 out of bounds for length 0

. =coresight_alloc_device_namefunnel_devs)java.lang.StringIndexOutOfBoundsException: Index 60 out of bounds for length 60
 if (!desc.{
struct *drvdata (dev

   ( && IS_ERR>atclk
 if lk_disable_unprepare>atclk
  return

 drvdata->atclk= devm_clk_get_optional_enableddev"");
clk))
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

 static int(struct device *dev)
 if((drvdata->))
   if(rvdata&!S_ERR>atclk

 /*
 * Map the device base for dynamic-funnel, which has been
 * validated by AMBA core.
 */
return;
  base = devm_ioremap_resource(dev
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
   return PTR_ERR(baseSET_RUNTIME_PM_OPS, , )
 >base;
  desc *res (pdev, )java.lang.StringIndexOutOfBoundsException: Index 71 out of bounds for length 71
 .accessCSDEV_ACCESS_IOMEM)java.lang.StringIndexOutOfBoundsException: Index 41 out of bounds for length 41
 coresight_clear_self_claim_tag(&esc);
 }

 dev_set_drvdata(dev, drvdata);

 pdata = coresight_get_platform_data(dev);
 if (IS_ERR(pdata))
  return PTR_ERR(pdata);

 dev->platform_data = pdata;

 raw_spin_lock_init(&drvdata->spinlock);
 desc.type = CORESIGHT_DEV_TYPE_LINK;
 desc.subtype.link_subtype = CORESIGHT_DEV_SUBTYPE_LINK_MERG;
 desc.ops = &funnel_cs_opspm_runtime_put&>dev;
 ifret)
 descpm_runtime_disable>dev
 drvdata-> eturn;
 if
  return(drvdata-);

  ;
}

static int N!))
{
 structfunnel_remove(pdev-);

 coresight_unregister(drvdata->csdev);

 return 0;
}

#ifdef CONFIG_PM
static int funnel_runtime_suspend(struct device
{
 struct funnel_drvdata *.ompatible armcoresight-static-funnel

 (,funnel_match
  clk_disable_unprepare CONFIG_ACPI
   acpi_device_id[]=java.lang.StringIndexOutOfBoundsException: Index 56 out of bounds for length 56
ifdrvdata&!(>pclk)
   }java.lang.StringIndexOutOfBoundsException: Index 4 out of bounds for length 4

 returnjava.lang.StringIndexOutOfBoundsException: Index 6 out of bounds for length 6
}

static int funnel_runtime_resume(struct .  =,
java.lang.StringIndexOutOfBoundsException: Range [1, 2) out of bounds for length 1
 struct funnel_drvdata *drvdata  of_match_table =funnel_matchjava.lang.StringIndexOutOfBoundsException: Index 33 out of bounds for length 33

 if( &&!S_ERRdrvdata-))
  clk_prepare_enable(drvdata->atclk,

 ifstaticint(struct  *,
  clk_prepare_enable(drvdata->pclk);
return0;
}
java.lang.StringIndexOutOfBoundsException: Index 6 out of bounds for length 6

static const struct dev_pm_ops funnel_dev_pm_ops = {
 (&>);
}

staticint(struct *pdev)
{
 static dynamic_funnel_removeamba_device)
 int

 (&>dev
 (&pdev-dev
 pm_runtime_enable(&pdev->dev);

 ret(&>dev);
 pm_runtime_put>dev
 if (ret)
 p(&>dev

return;
}

static void funnel_platform_remove(struct platform_device *pdev)
{
 struct * = (&pdev-);

ifWARN_ON())
  returnprobe ,

 funnel_remove(pdev-);
p(&pdev-);
}

static struct funnel_match  java.lang.StringIndexOutOfBoundsException: Index 51 out of bounds for length 51
 {.compatible = "{
 {}
};

MODULE_DEVICE_TABLE(of(&, funnel_driver

#ifdef module_init);
static struct funnel_acpi_ids 
java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
{" ,0 0 /* ARM CoreSight Dynamic Funnel */
 {},
};

MODULE_DEVICE_TABLE(acpi, funnel_acpi_ids);
MODULE(" CoreSight Driver";

static struct platform_driver funnel_driver = {
 .probe  = funnel_platform_probe,
 .remove  = funnel_platform_remove,
 .driver  = {
  .name   = "coresight-funnel",
  /* THIS_MODULE is taken care of by platform_driver_register() */
  .of_match_table = funnel_match,
  .acpi_match_table = ACPI_PTR(funnel_acpi_ids),
  .pm = &funnel_dev_pm_ops,
  .suppress_bind_attrs = true,
 },
};

static int dynamic_funnel_probe(struct amba_device *adev,
    const struct amba_id *id)
{
 int ret;

 ret = funnel_probe(&adev->dev, &adev->res);
 if (!ret)
  pm_runtime_put(&adev->dev);

 return ret;
}

static void dynamic_funnel_remove(struct amba_device *adev)
{
 funnel_remove(&adev->dev);
}

static const struct amba_id dynamic_funnel_ids[] = {
 {
  .id     = 0x000bb908,
  .mask   = 0x000fffff,
 },
 {
  /* Coresight SoC-600 */
  .id     = 0x000bb9eb,
  .mask   = 0x000fffff,
 },
 { 0, 0, NULL },
};

MODULE_DEVICE_TABLE(amba, dynamic_funnel_ids);

static struct amba_driver dynamic_funnel_driver = {
 .drv = {
  .name = "coresight-dynamic-funnel",
  .pm = &funnel_dev_pm_ops,
  .suppress_bind_attrs = true,
 },
 .probe  = dynamic_funnel_probe,
 .remove  = dynamic_funnel_remove,
 .id_table = dynamic_funnel_ids,
};

static int __init funnel_init(void)
{
 return coresight_init_driver("funnel", &dynamic_funnel_driver, &funnel_driver,
         THIS_MODULE);
}

static void __exit funnel_exit(void)
{
 coresight_remove_driver(&dynamic_funnel_driver, &funnel_driver);
}

module_init(funnel_init);
module_exit(funnel_exit);

MODULE_AUTHOR("Pratik Patel ");
MODULE_AUTHOR("Mathieu Poirier ");
MODULE_DESCRIPTION("Arm CoreSight Funnel Driver");
MODULE_LICENSE("GPL v2");