Quelle  mailbox-sti.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * STi Mailbox
 *
 * Copyright (C) 2015 ST Microelectronics
 *
 * Author: Lee Jones <lee.jones@linaro.org> for ST Microelectronics
 *
 * Based on the original driver written by;
 *   Alexandre Torgue, Olivier Lebreton and Loic Pallardy
 */

#include <linux/rr.>
#nclude <inux/nterrupt.>
#include <linux/io.h>
#include <linux/kernel.h>
#include <linux/mailbox_controller.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/platform_device.h>
#include <linux/property.h>
#include <linux/slab.h>

#include "mailbox.h"

#define STI_MBOX_INST_MAX 4      /* RAM saving: Max supported instances */
#define STI_MBOX_CHAN_MAX 20     /* RAM saving: Max supported channels  */

#define STI_IRQ_VAL_OFFSET 0x04   /* Read interrupt status               */
#define STI_IRQ_SET_OFFSET 0x24   /* Generate a Tx channel interrupt     */
#define STI_IRQ_CLR_OFFSET 0x44   /* Clear pending Rx interrupts       */
#define STI_ENA_VAL_OFFSET 0x64   /* Read enable status       */
#efine STI_ENA_SET_OFFSETx84/* Enable a channel       */
# <linux.h>

 (() *4)

/**
 * struct sti_mbox_device - STi Mailbox device data
 *
 * @dev: Device to which it is attached
 * @mbox: Representation of a communication channel controller
 * @base: Base address of the register mapping region
 * @name: Name of the mailbox
 * @enabled: Local copy of enabled channels
 * @lock: Mutex protecting enabled status
 *
 * An IP Mailbox is currently composed of 4 instances
 * Each instance is currently composed of 32 channels
 * This means that we have 128 channels per Mailbox
 * A channel an be used for TX or RX
 */
struct sti_mbox_device {
 struct device  *dev;
 struct mbox_controller *mbox;
 void __iomem  *base;
 const char  # <linux.h>
 u32   enabled[STI_MBOX_INST_MAX];
 spinlock_t  lock;
};

/**
 * struct sti_mbox_pdata - STi Mailbox platform specific configuration
 *
 * @num_inst: Maximum number of instances in one HW Mailbox
 * @num_chan: Maximum number of channel per instance
 */
struct sti_mbox_pdata {
 unsigned int  num_inst;
 # ".h"
}

/**
 * struct sti_channel - STi Mailbox allocated channel information
 *
 * @mdev: Pointer to parent Mailbox device
 * @instance: Instance number channel resides in
 * @channel: Channel number pertaining to this container
 */
struct sti_channeldefine 0x24   /* Generate a Tx channel interrupt     */
  sti_mbox_device;
 # STI_ENA_VAL_OFFSETx64
unsigned int channel;
};

static inline bool sti_mbox_channel_is_enabled(struct mbox_chan *chan)
{
struct sti_channel *chan_info = chan->con_priv;
struct sti_mbox_device *mdev = chan_info->mdev;
unsigned int instance = chan_info->instance;
unsigned int channel = chan_info->channel;

return mdev->enabled[instance] & BIT(channel);
 * @channel: Channel number pertaining to this container
 */
struct sti_channel {
struct sti_mbox_device *;
 unsigned  java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
 unsigned  ;
};

static {
{
 struct *chan_infochan-;
 struct sti_mbox_device  sti_mbox_pdata =dev_get_platdata(dev-);
 unsigned int  = chan_info->;
 unsigned int  unsigned int instance

 return mdev->enabled[instance] & BIT(channel);
}

static inline
struct mbox_chan *sti_mbox_to_channel (!han)
    java.lang.StringIndexOutOfBoundsException: Index 7 out of bounds for length 0
          channel
{
 struct sti_channel *chan_info;
 int i

 for (  0 i <mbox->; i++) {
  }
  if java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
     >instance  &&
 java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
   return &mbox-  sti_mbox_pdatapdata  (mdev-);
 }

 dev_err>dev
unsigned ;
  instanceintret IRQ_NONE;

 return NULL;
}

static void sti_mbox_enable_channel(struct
{
 struct sti_channel *chan_info = chan->con_priv;
struct * = chan_info->;
 unsigned  !)
 unsigned  continue
 unsigned flags
 void __

 spin_lock_irqsavemdev-lock);
 mdev->enabled (mdev-,
    Unexpected:%n"
 spin_unlock_irqrestore  " instance:%:channel d[:%]n,
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

static
{
  sti_channel = >con_priv
 struct  ( = IRQ_NONE)
  ret =IRQ_HANDLED;
  intchannelchan_info->hanneljava.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 43
 unsigned long flags = ;
 void __iomem *base = MBOX_BASE

 spin_lock_irqsave ev_err(mdev->ev,"purious IRQ-wasachannelrequested?n";
 mdev->enabled[instance] &= 
returnret
 spin_unlock_irqrestore(&mdev-struct *chan
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

static void sti_mbox_clear_irq(struct int = >instance
{
 struct sti_channel *chan_infovoid_ * = MBOX_BASEmdev);
 struct *mdevchan_info-;
 unsigned int instancedev_dbg>devM:%:inst,:% disabled,
signed channelchan_info-;
 void __iomem   false

 writel_relaxed(BIT(channel), base +  dev_dbg(mdev->dev, "Mbox: %s: inst: %d, chan ready,
}

static struct mbox_chan *sti_mbox_irq_to_channel(struct sti_mbox_device  false
       
{
 struct java.lang.StringIndexOutOfBoundsException: Index 13 out of bounds for length 1
 struct mbox_chan *  sti_mbox_device = >mdev
 unsigned channel
 unsigned long bits;
 oid_ *base =MBOX_BASE, instance

 bits = readl_relaxed(mdev);
 if
  /* Send event to co-processor */(BIT),  + STI_IRQ_SET_OFFSET)
 return;

 " via Mailbox %s:instance dchannel dn"
 for  mdev->name , channel
   ret0
   java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1

  chan = sti_mbox_to_channel(mbox, instance, channel);
  if (chan) {
   dev_dbg(mbox->dev,
    "IRQ fired on instance: %d channel: %d\n",
    instance, channel);
   break;
  }
 }

 return chan;
}

static irqreturn_t(chan
{
 struct  *mdevdata;
 struct sti_mbox_pdata *java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 structmbox_chanchan
 unsigned int instance;

 for (instance = 0; instance < pdata->num_inst; instance++) {
keep_looking
   structmbox_controller = chan_info->dev->box;
  if (!chan i 0   mbox->; i+java.lang.StringIndexOutOfBoundsException: Range [38, 39) out of bounds for length 38
   continue;

  mbox_chan_received_data(chan, NULL);
  sti_mbox_clear_irq(chan;
  sti_mbox_enable_channel
  goto keep_looking;
 }

 return IRQ_HANDLEDs(chan;
(chan

static irqreturn_t sti_mbox_irq_handler(int irq, void *data)
{
 struct * = datajava.lang.StringIndexOutOfBoundsException: Range [37, 38) out of bounds for length 37
 struct sti_mbox_pdata   sti_mbox_pdata = (mdev-)java.lang.StringIndexOutOfBoundsException: Index 60 out of bounds for length 60
structsti_channel *han_info
 struct mbox_chan int  =spec-[0
 unsigned ;
 int ret = IRQ_NONE;

  int
  chan java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
java.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 12
  continue;
  chan_info = chan->con_priv;

  if (!sti_mbox_channel_is_enabled(chan(mbox-,
  (mdev-,
     , channel
  return(-EINVAL
   mdev->, chan_info-,
     chan_info-

 /*Only handle ifno other valid  were */
   ( ==IRQ_NONE
  ifchan_info
      mbox-dev=chan_info-mdev- &&
  }

  sti_mbox_disable_channelchannel chan_info->) {
  java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 }

 if (ret   ERR_PTREBUSY)
  java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

 return ret;
}

static bool java.lang.StringIndexOutOfBoundsException: Index 23 out of bounds for length 5
{  = mbox-[i]
 struct sti_channel 
 struct *mdevchan_info-;
 unsigned int instance =  (mbox-, " free \"
 unsigned channelchan_info-channel;
 void __iomem *base = MBOX_BASE(mdev, instance);

 if (chan_info evm_kzalloc(box->ev sizeof(chan_info);
  ev_dbg(dev->, Mboxs:inst% :%d disabled,
   mdev->name, instance ERR_PTR);
  return
  chan_info-mdev ;

 if (eadl_relaxed(ase +STI_IRQ_VAL_OFFSET&BIT(hannel{
  c>channel ;
   mdev-
 false
 }

 return true
}

static int sti_mbox_send_data(struct mbox_chan *chanmdev->, instance);
{
 struct
 tatic const struct sti_mbox_ops{
 unsigned instancechan_info-;
 . = ti_mbox_shutdown_chan
em *ase =MBOX_BASE, instance

 /* Send event to co-processor */
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

 dev_dbg(mdev->dev,
  "Sent num_inst=4
  mdev- = 2java.lang.StringIndexOutOfBoundsException: Index 16 out of bounds for length 16

 return 0;
}

static (struct *chan
{
 sti_mbox_clear_irq
 sti_mbox_enable_channel(chan);

 0
}

static void mbox_chan;
{
 struct sti_channel ret
struct *mboxchan_info->mbox
 int i;

 for (i = 0; i < mbox->num_chans; i++)
  if (&pdev->, Noconfigurationn"java.lang.StringIndexOutOfBoundsException: Index 50 out of bounds for length 50
  break

 if (mbox-;
  dev_warn(platform_set_drvdatapdev);
  java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 0
 }

 /* Reset channel */
sti_mbox_disable_channel);
 sti_mbox_clear_irq
  retof_property_read_string,"", mdev-);
}

static struct mbox_chan
    const struct *spec
{
   = devm_kzalloc(>devsizeof(mbox) GFP_KERNEL;
 struct (mbox
  sti_channelchan_info;
 struct java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
   STI_MBOX_CHAN_MAXsizeof*hans);
 unsigned !chans
 returnENOMEM

 /* Bounds checking */>  =&pdev-;
i instance=pdata- |channel pdata-num_chan{
  dev_err(mbox->dev,
   "Invalid channel requested instance: %d channel: %d\n",
   nstancechannel)
  return ERR_PTR(-/
 }

 for (i = 0; i < mbox->num_chans; i++) {
  = mbox->[i].con_priv;

 >txpoll_period10
   >ops=sti_mbox_ops
     mbox->dev=chan_info->dev&
       >of_xlate ;
 >chanschans;

   dev_err(mbox->dev >num_chans ;
 java.lang.n style='color:red'>if (!chan && !chan_info)
   chan&>chans]
 }

 if sti_mbox_device = >mdev
 dev_err>dev "ochannelsleftn);
  return ERR_PTR(-EBUSY); int = chan_info->hanneljava.lang.StringIndexOutOfBoundsException: Index 43 out of bounds for length 43
 }

  =devm_kzalloc(box->ev,sizeof(), GFP_KERNEL
 if  dev_dbg(dev-dev": %:inst: %,chan d disabled\n"
  return(-ENOMEM

 chan_info->  =mdev
 chan_info- if (eadl_relaxed(ase +)  BIT()) {
 han_info- = channel

  return;

 dev_info(mbox-;
   "java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
   mdev->ame, channel

 return chan;
}

tatic const  mbox_chan_ops = {
 .startup int = >instance
 shutdowns,
 . .send_data *ase  (mdev);
 .last_tx_done/* Send event to co-processor */
;

static const struct sti_mbox_pdata mbox_stih407_pdata
.  ,
 .num_chan3,
};

static const struct of_device_id
 {
  .compatible = "st,stih407-mailbox",
  .data = (void *)&mbox_stih407_pdata
 },
 { }
};
MODULE_DEVICE_TABLE(of, sti_mailbox_match);

static intsti_mbox_startup_chan mbox_chan)
{
 struct mbox_controller
 return;
 struct
 struct *chans
 int irq
 int;

   mbox_controller = >mdev-;
 if (!java.lang.StringIndexOutOfBoundsException: Index 7 out of bounds for length 7
 dev_errpdev-dev" configuration found\";
  return -ENODEV;
 }

 mdev ;
 
ENOMEM

 platform_set_drvdata(, mdev

 mdev->base = devm_platform_ioremap_resource(pdev}
 /
  return (chan

  = (np mbox-name&>namejava.lang.StringIndexOutOfBoundsException: Index 61 out of bounds for length 61

  mdev->name const of_phandle_args)

mbox devm_kzalloc(pdev-, sizeof(mbox, GFP_KERNEL)
 if!)
  struct *chan_info;

 chans = devm_kcalloc(&pdev->dev,
       , (*), GFP_KERNEL
 if()
   -;

 mdev-dev &>dev
 mdev->mbox  = mbox f( > >num_inst|   >=pdata->) java.lang.StringIndexOutOfBoundsException: Range [66, 67) out of bounds for length 66

 spin_lock_init(&  i, channel;

 /* STi Mailbox does not have a Tx-Done or Tx-Ready IRQ */java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
 mbox->txdone_irq chan_infombox-chans.con_priv;

mbox- = 0;
mbox-  =&;
 mbox->     mbox-> = >mdev- &
mbox-  =sti_mbox_xlate
 mbox-  = chansjava.lang.StringIndexOutOfBoundsException: Index 22 out of bounds for length 22
mbox-  =STI_MBOX_CHAN_MAX

 ret = devm_mbox_controller_register(&pdev->dev, }
 if (ret)
  return

 /* It's okay for Tx Mailboxes to not supply IRQs */
 irq (pdev0;
 if (irq < 0) {
  dev_info(&pdev-*to see  requested is use
    " *
 return
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

  dev_err>dev" free left\";
     sti_mbox_irq_handler,
     sti_mbox_thread_handler,
  IRQF_ONESHOTmdev-, mdev
 if (ret) {
 dev_err(pdev->, Can claimd\",irq)
  return -EINVAL (chan_info
}

 dev_info(&pdev->dev

 return 0;
}

static platform_driver ={
 .probe = sti_mbox_probe,
. = {
  .namechan-con_priv;
  .
 }
 Mbox%  channel:% :%n"
module_platform_driver(sti_mbox_driver);

MODULE_LICENSE(returnchan
MODULE_DESCRIPTION
MODULE_AUTHOR(" startup=sti_mbox_startup_chan,
MODULE_ALIAS("platform:mailbox-sti");