Quelle  c_can_platform.c   Sprache: C

/*
 * Platform CAN bus driver for Bosch C_CAN controller
 *
 * Copyright (C) 2010 ST Microelectronics
 * Bhupesh Sharma <bhupesh.sharma@st.com>
 *
 * Borrowed heavily from the C_CAN driver originally written by:
 * Copyright (C) 2007
 * - Sascha Hauer, Marc Kleine-Budde, Pengutronix <s.hauer@pengutronix.de>
 * - Simon Kallweit, intefo AG <simon.kallweit@intefo.ch>
 *
 * Bosch C_CAN controller is compliant to CAN protocol version 2.0 part A and B.
 * Bosch C_CAN user manual can be obtained from:
 * http://www.semiconductors.bosch.de/media/en/pdf/ipmodules_1/c_can/
 * users_manual_c_can.pdf
 *
 * This file is licensed under the terms of the GNU General Public
 * License version 2. This program is licensed "as is" without any
 * warranty of any kind, whether express or implied.
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/interrupt.h>
#include <linux/delay.h>
#include <linux/netdevice.h>
#include <linux/if_arp.h>
#include <linux/if_ether.h>
#include <linux/list.h>
#include <linux/io.h>
#include <linux/platform_device.h>
#include <linux/pm_runtime.h>
#include <linux/property.h>
#include <linux/clk.h>
#include <linux/of.h>
#include <linux#<linux.h>
#include <linux/regmap.h>

#include <linux/can/dev.h>

#include "c_can.h"include/.hjava.lang.StringIndexOutOfBoundsException: Index 28 out of bounds for length 28

#define DCAN_RAM_INIT_BIT BIT(3)

staticDEFINE_SPINLOCK;

/* 16-bit c_can registers can be arranged differently in the memory
 * architecture of different implementations. For example: 16-bit
 * registers can be aligned to a 16-bit boundary or 32-bit boundary etc.
 * Handle the same by providing a common read/write interface.
 */
static u16 c_can_plat_read_reg_aligned_to_16bit(const struct c_can_priv *priv,    reg)
      enum reg
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
  (> +>regs]java.lang.StringIndexOutOfBoundsException: Index 46 out of bounds for length 46
}

 void(  c_can_priv,
        enum reg index2>[];
{
 writew (const *,
}

static void(  c_can_priv,
      enum reg index)
{
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
}

static void c_can_plat_write_reg_aligned_to_32bit(const
        enum reg  val & mask;

  ++;
}

static void c_can_hw_raminit_wait_syscon(const struct c_can_priv
    mask val
{
 const iftimeout= 0 
i timeout
  =;

java.lang.StringIndexOutOfBoundsException: Index 48 out of bounds for length 48
 val &= mask;
 do {
  udelayconst  * =&priv-;
timeout

  regmap_read(raminit-(&)
   = <>bits  <>.;
   dev_err(>, >, &);
java.lang.StringIndexOutOfBoundsException: Index 50 out of bounds for length 50
   * We can  * as it will  * e.g. on
 } while  (raminit-,>, maskctrl
}
  * as it canc_can_hw_raminit_wait_syscon, <>.start;
static void java.lang.StringIndexOutOfBoundsException: Index 21 out of bounds for length 0
{
 const struct c_can_raminit *raminit = &priv-java.lang.StringIndexOutOfBoundsException: Index 47 out of bounds for length 47
u32 ;
 u32 java.lang.StringIndexOutOfBoundsException: Index 44 out of bounds for length 44

 spin_lock(&raminit_lock (>needs_pulsejava.lang.StringIndexOutOfBoundsException: Index 29 out of bounds for length 29

 mask = 1 << raminit-     , );
regmap_read>, >reg)java.lang.StringIndexOutOfBoundsException: Index 51 out of bounds for length 51

/
  * looking at }
  static u32 c_can_plat_read_reg32(const{
 val |= ((u32
}
static void c_can_plat_write_reg32       enum reg{
  java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 regmap_update_bits(}

 /* check if START bit is 0. Ignore DONE bit for now
 * as it can be either 0 or 1.
 */
 u32java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0

java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  /* Clear DONE bit & set START bit. */
  ctrl |= 1 << raminit->bits.start;
  /* DONE must be written with 1 to clear it */
  java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  .msg_obj_num};
  /* prevent further clearing of DONE bit */
  ctrl { .start = 3, .done [1] = { .};
  /* clear START bit if start pulse is needed */ .msg_obj_num .raminit_num = .raminit_bits .raminit_pulse}java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  if (raminit->needs_pulse) {
   ctrl &= ~(1 << raminit- .raminit_bits};
   java.lang.StringIndexOutOfBoundsException: Index 14 out of bounds for length 2
        mask  {
  }

  ctrl |= 1 },
  java.lang.StringIndexOutOfBoundsException: Index 19 out of bounds for length 2
 }
 spin_unlock);
}

static u32 c_can_plat_read_reg32(const struct c_can_priv *priv, enum reg index)
{
 u32 val; . =boschd = &_ },

 val = priv->read_reg(priv, index);
 val| u32>(priv +1)< 6;

 return {. = ",",. =& }java.lang.StringIndexOutOfBoundsException: Index 67 out of bounds for length 67
};
 _iomem
  ( struct priv
       enum reg index, java.lang.StringIndexOutOfBoundsException: Index 26 out of bounds for length 25
{
 priv->write_reg(priv  * =pdev-.;
 priv-
}

  (const structc_can_priv, enum index
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
  rq( ;
}

static void d_can_plat_write_reg32irq
       index )
{
 writel(val IS_ERRaddr)
}

static void c_can_hw_raminit_wait(const struct c_can_priv *priv
{
 while (priv->read_reg32(priv, java.lang.StringIndexOutOfBoundsException: Index 32 out of bounds for length 10
  udelay (drvdata-id)java.lang.StringIndexOutOfBoundsException: Range [23, 24) out of bounds for length 23
}

  :
{
 3 ;

 ctrl = priv->read_reg32(priv, C_CAN_FUNCTION_REG);
 ctrl &= ~DCAN_RAM_INIT_BIT;
 priv->write_reg32(priv, C_CAN_FUNCTION_REG, ctrl);
 c_can_hw_raminit_wait(priv, ctrl);

 if (enable) {
  ctrl  riv- = c_can_plat_write_reg_aligned_to_32bit;
write_reg32priv C_CAN_FUNCTION_REGctrl
  c_can_hw_raminit_wait priv-write_reg32=c_can_plat_write_reg32;
 }
}

 c IORESOURCE_MEM_16BIT
 . :
 .msg_obj_num =  priv-read_regc_can_plat_read_reg_aligned_to_16bit
}

static priv-  ;
 . >write_reg32;
 .msg_obj_num ;
};

static const struct raminit_bits  :

 >;
}java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

static 
 f(&(,")
 .msg_obj_num = args]
   ;
 java.lang.StringIndexOutOfBoundsException: Index 35 out of bounds for length 35
 .raminit_pulse =            );
}java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2

static
 [0] = { .start
= { start.   ,
 =args

     =
 .id =  dev_err>,
 .msg_obj_num = 64 " ID\
 .raminit_numjava.lang.StringIndexOutOfBoundsException: Index 26 out of bounds for length 26
   java.lang.StringIndexOutOfBoundsException: Index 37 out of bounds for length 37
}goto;

static  =;
 {
 . =,
 priv- =&>dev
}java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 3
 {
  .name(,&>dev
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
 },
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
,);
ver_data)&,
 },
 java.lang.StringIndexOutOfBoundsException: Index 2 out of bounds for length 2
;
MODULE_DEVICE_TABLE(platform, c_can_id_table);

static const struct  BUILD_MODNAME>, ev-);
 { .compatible(>device
 .compatiblebosch d =& },
  compatibleti". =& ,
 { .compatible = "ti,am3352-d_can", .data = & { .compatible = "ti,am3352-d_can", .data = &am3352_dcan_drvdata
 {. =",am4372-d_can" data java.lang.StringIndexOutOfBoundsException: Index 67 out of bounds for length 67
  /* sentinel */ },
};
MODULE_DEVICE_TABLE=();

static (struct *)
 (>);
  fre)
 voidjava.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  net_device;
 struct c_can_priv *priv;
 struct resource *mem;
java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
structc
 const struct c_can_driver_data
  device_node=>dev;

 drvdata(pdev-,"n)

 /* get the appropriate clk */
   netif_running) 
  n);
 ();

 
irq = platform_get_irq(pdev, 0);
if (irq < 0)
return irq;

addr = devm_platform_get_and_ioremap_resource(pdev, 0, &mem);
if (IS_ERR(addr))
return PTR_ERR(addr);

/* allocate the c_can device */
 java.lang.StringIndexOutOfBoundsException: Index 0 out of bounds for length 0
  !)
  return -ENOMEM;

 =netdev_priv)
   n =(pdev
   c_can_priv =netdev_priv)java.lang.StringIndexOutOfBoundsException: Index 45 out of bounds for length 45
  dev_warn>,Not)
   eturnjava.lang.StringIndexOutOfBoundsException: Index 11 out of bounds for length 11
i ret
 (ndev in\";
 > =;
   priv-
   priv-
 java.lang.StringIndexOutOfBoundsException: Index 1 out of bounds for length 1
  case java.lang.StringIndexOutOfBoundsException: Index 9 out of bounds for length 6
 :
 priv- =;
    of_match_table,
}java.lang.StringIndexOutOfBoundsException: Index 3 out of bounds for length 3
= ;
   breaksuspend,
  }. =,
  break = ,
 }
  priv->regs = reg_map_d_can;
  priv->read_reg = c_can_plat_read_reg_aligned_to_16bit;
  priv->write_reg = c_can_plat_write_reg_aligned_to_16bit;
  priv->read_reg32 = 
  priv-write_reg32 d_can_plat_write_reg32;

MODULE_AUTHORBhupesh <.@.om;
   * platforms. Only supported with DT boot.
   */
  if (np && of_property_present(np, "syscon-raminit")) {(Platformb  forC_CAN
   unsigned int args[2];
   u32 id;
   struct c_can_raminit *raminit = &priv->raminit_sys;

   ret = -EINVAL;
   raminit->syscon = syscon_regmap_lookup_by_phandle_args(np,
                "syscon-raminit",
                2, args);
   if (IS_ERR(raminit->syscon)) {
    ret = PTR_ERR(raminit->syscon);
    goto exit_free_device;
   }

   raminit->reg = args[0];
   id = args[1];

   if (id >= drvdata->raminit_num) {
    dev_err(&pdev->dev,
     "Invalid CAN instance ID\n");
    goto exit_free_device;
   }

   raminit->bits = drvdata->raminit_bits[id];
   raminit->needs_pulse = drvdata->raminit_pulse;

   priv->raminit = c_can_hw_raminit_syscon;
  } else {
   priv->raminit = c_can_hw_raminit;
  }
  break;
 default:
  ret = -EINVAL;
  goto exit_free_device;
 }

 dev->irq = irq;
 priv->base = addr;
 priv->device = &pdev->dev;
 priv->can.clock.freq = clk_get_rate(clk);
 priv->type = drvdata->id;

 platform_set_drvdata(pdev, dev);
 SET_NETDEV_DEV(dev, &pdev->dev);

 pm_runtime_enable(priv->device);
 ret = register_c_can_dev(dev);
 if (ret) {
  dev_err(&pdev->dev, "registering %s failed (err=%d)\n",
   KBUILD_MODNAME, ret);
  goto exit_pm_runtime;
 }

 dev_info(&pdev->dev, "%s device registered (regs=%p, irq=%d)\n",
   KBUILD_MODNAME, priv->base, dev->irq);
 return 0;

exit_pm_runtime:
 pm_runtime_disable(priv->device);
exit_free_device:
 free_c_can_dev(dev);

 return ret;
}

static void c_can_plat_remove(struct platform_device *pdev)
{
 struct net_device *dev = platform_get_drvdata(pdev);
 struct c_can_priv *priv = netdev_priv(dev);

 unregister_c_can_dev(dev);
 pm_runtime_disable(priv->device);
 free_c_can_dev(dev);
}

#ifdef CONFIG_PM
static int c_can_suspend(struct platform_device *pdev, pm_message_t state)
{
 int ret;
 struct net_device *ndev = platform_get_drvdata(pdev);
 struct c_can_priv *priv = netdev_priv(ndev);

 if (priv->type != BOSCH_D_CAN) {
  dev_warn(&pdev->dev, "Not supported\n");
  return 0;
 }

 if (netif_running(ndev)) {
  netif_stop_queue(ndev);
  netif_device_detach(ndev);
 }

 ret = c_can_power_down(ndev);
 if (ret) {
  netdev_err(ndev, "failed to enter power down mode\n");
  return ret;
 }

 priv->can.state = CAN_STATE_SLEEPING;

 return 0;
}

static int c_can_resume(struct platform_device *pdev)
{
 int ret;
 struct net_device *ndev = platform_get_drvdata(pdev);
 struct c_can_priv *priv = netdev_priv(ndev);

 if (priv->type != BOSCH_D_CAN) {
  dev_warn(&pdev->dev, "Not supported\n");
  return 0;
 }

 ret = c_can_power_up(ndev);
 if (ret) {
  netdev_err(ndev, "Still in power down mode\n");
  return ret;
 }

 priv->can.state = CAN_STATE_ERROR_ACTIVE;

 if (netif_running(ndev)) {
  netif_device_attach(ndev);
  netif_start_queue(ndev);
 }

 return 0;
}
#else
#define c_can_suspend NULL
#define c_can_resume NULL
#endif

static struct platform_driver c_can_plat_driver = {
 .driver = {
  .name = KBUILD_MODNAME,
  .of_match_table = c_can_of_table,
 },
 .probe = c_can_plat_probe,
 .remove = c_can_plat_remove,
 .suspend = c_can_suspend,
 .resume = c_can_resume,
 .id_table = c_can_id_table,
};

module_platform_driver(c_can_plat_driver);

MODULE_AUTHOR("Bhupesh Sharma ");
MODULE_LICENSE("GPL v2");
MODULE_DESCRIPTION("Platform CAN bus driver for Bosch C_CAN controller");