mirror of
https://github.com/Fishwaldo/Star64_linux.git
synced 2025-07-06 22:42:10 +00:00
linux-can-next-for-5.11-20201210
-----BEGIN PGP SIGNATURE----- iQFHBAABCgAxFiEEK3kIWJt9yTYMP3ehqclaivrt76kFAl/R7dETHG1rbEBwZW5n dXRyb25peC5kZQAKCRCpyVqK+u3vqVGdB/4kMAJaguAotadb18Zq6+5bQ3VYxKms a9ctqOnFHv/pTPijEtZoVOMTFItMhQZeBZqYqhe4P544z1oMBg+dtGcli++me2TR Lh8JSQIkql9EQN65XX4ZEdEE5u32fFzp2nr1WpKSa6INek5Pfv/QsiGOz2Ws0Oxy mZNj4lf30p1+tJunKKSWXghHkw12NPX77AeYLw5uYb1Jmq7o1LIdENpBJEULVwkI LVRcxiwcFmUkXMCXbdB8HuUiVCm5Ju3/BCaOWdQk23LYCBDGLi6jW3JAk3qtTqRA DQO6sMo/KXrzA49qma6o7AL/i3+fVYjsVPpRjiWNioKbHduvSXoyPyKb =u5Aa -----END PGP SIGNATURE----- Merge tag 'linux-can-next-for-5.11-20201210' of git://git.kernel.org/pub/scm/linux/kernel/git/mkl/linux-can-next Marc Kleine-Budde says: ==================== pull-request: can-next 2020-12-10 here's a pull request of 7 patches for net-next/master. The first patch is by Oliver Hartkopp for the CAN ISOTP, which adds support for functional addressing. A patch by Antonio Quartulli removes an unneeded unlikely() annotation from the rx-offload helper. The next three patches target the m_can driver. Sean Nyekjaers's patch removes a double clearing of clock stop request bit, Patrik Flykt's patch moves the runtime PM enable/disable to m_can_platform and Jarkko Nikula's patch adds a PCI glue code driver. Fabio Estevam's patch converts the flexcan driver to DT only. And Manivannan Sadhasivam's patchd for the mcp251xfd driver adds internal loopback mode support. ==================== Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
commit
c7dd222053
10 changed files with 242 additions and 48 deletions
|
@ -1940,15 +1940,8 @@ static const struct of_device_id flexcan_of_match[] = {
|
||||||
};
|
};
|
||||||
MODULE_DEVICE_TABLE(of, flexcan_of_match);
|
MODULE_DEVICE_TABLE(of, flexcan_of_match);
|
||||||
|
|
||||||
static const struct platform_device_id flexcan_id_table[] = {
|
|
||||||
{ .name = "flexcan", .driver_data = (kernel_ulong_t)&fsl_p1010_devtype_data, },
|
|
||||||
{ /* sentinel */ },
|
|
||||||
};
|
|
||||||
MODULE_DEVICE_TABLE(platform, flexcan_id_table);
|
|
||||||
|
|
||||||
static int flexcan_probe(struct platform_device *pdev)
|
static int flexcan_probe(struct platform_device *pdev)
|
||||||
{
|
{
|
||||||
const struct of_device_id *of_id;
|
|
||||||
const struct flexcan_devtype_data *devtype_data;
|
const struct flexcan_devtype_data *devtype_data;
|
||||||
struct net_device *dev;
|
struct net_device *dev;
|
||||||
struct flexcan_priv *priv;
|
struct flexcan_priv *priv;
|
||||||
|
@ -1997,15 +1990,7 @@ static int flexcan_probe(struct platform_device *pdev)
|
||||||
if (IS_ERR(regs))
|
if (IS_ERR(regs))
|
||||||
return PTR_ERR(regs);
|
return PTR_ERR(regs);
|
||||||
|
|
||||||
of_id = of_match_device(flexcan_of_match, &pdev->dev);
|
devtype_data = of_device_get_match_data(&pdev->dev);
|
||||||
if (of_id) {
|
|
||||||
devtype_data = of_id->data;
|
|
||||||
} else if (platform_get_device_id(pdev)->driver_data) {
|
|
||||||
devtype_data = (struct flexcan_devtype_data *)
|
|
||||||
platform_get_device_id(pdev)->driver_data;
|
|
||||||
} else {
|
|
||||||
return -ENODEV;
|
|
||||||
}
|
|
||||||
|
|
||||||
if ((devtype_data->quirks & FLEXCAN_QUIRK_SUPPORT_FD) &&
|
if ((devtype_data->quirks & FLEXCAN_QUIRK_SUPPORT_FD) &&
|
||||||
!(devtype_data->quirks & FLEXCAN_QUIRK_USE_OFF_TIMESTAMP)) {
|
!(devtype_data->quirks & FLEXCAN_QUIRK_USE_OFF_TIMESTAMP)) {
|
||||||
|
@ -2235,7 +2220,6 @@ static struct platform_driver flexcan_driver = {
|
||||||
},
|
},
|
||||||
.probe = flexcan_probe,
|
.probe = flexcan_probe,
|
||||||
.remove = flexcan_remove,
|
.remove = flexcan_remove,
|
||||||
.id_table = flexcan_id_table,
|
|
||||||
};
|
};
|
||||||
|
|
||||||
module_platform_driver(flexcan_driver);
|
module_platform_driver(flexcan_driver);
|
||||||
|
|
|
@ -7,6 +7,13 @@ menuconfig CAN_M_CAN
|
||||||
|
|
||||||
if CAN_M_CAN
|
if CAN_M_CAN
|
||||||
|
|
||||||
|
config CAN_M_CAN_PCI
|
||||||
|
tristate "Generic PCI Bus based M_CAN driver"
|
||||||
|
depends on PCI
|
||||||
|
help
|
||||||
|
Say Y here if you want to support Bosch M_CAN controller connected
|
||||||
|
to the pci bus.
|
||||||
|
|
||||||
config CAN_M_CAN_PLATFORM
|
config CAN_M_CAN_PLATFORM
|
||||||
tristate "Bosch M_CAN support for io-mapped devices"
|
tristate "Bosch M_CAN support for io-mapped devices"
|
||||||
depends on HAS_IOMEM
|
depends on HAS_IOMEM
|
||||||
|
|
|
@ -4,5 +4,6 @@
|
||||||
#
|
#
|
||||||
|
|
||||||
obj-$(CONFIG_CAN_M_CAN) += m_can.o
|
obj-$(CONFIG_CAN_M_CAN) += m_can.o
|
||||||
|
obj-$(CONFIG_CAN_M_CAN_PCI) += m_can_pci.o
|
||||||
obj-$(CONFIG_CAN_M_CAN_PLATFORM) += m_can_platform.o
|
obj-$(CONFIG_CAN_M_CAN_PLATFORM) += m_can_platform.o
|
||||||
obj-$(CONFIG_CAN_M_CAN_TCAN4X5X) += tcan4x5x.o
|
obj-$(CONFIG_CAN_M_CAN_TCAN4X5X) += tcan4x5x.o
|
||||||
|
|
|
@ -380,10 +380,6 @@ void m_can_config_endisable(struct m_can_classdev *cdev, bool enable)
|
||||||
cccr &= ~CCCR_CSR;
|
cccr &= ~CCCR_CSR;
|
||||||
|
|
||||||
if (enable) {
|
if (enable) {
|
||||||
/* Clear the Clock stop request if it was set */
|
|
||||||
if (cccr & CCCR_CSR)
|
|
||||||
cccr &= ~CCCR_CSR;
|
|
||||||
|
|
||||||
/* enable m_can configuration */
|
/* enable m_can configuration */
|
||||||
m_can_write(cdev, M_CAN_CCCR, cccr | CCCR_INIT);
|
m_can_write(cdev, M_CAN_CCCR, cccr | CCCR_INIT);
|
||||||
udelay(5);
|
udelay(5);
|
||||||
|
@ -1830,10 +1826,9 @@ int m_can_class_register(struct m_can_classdev *m_can_dev)
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
if (m_can_dev->pm_clock_support) {
|
if (m_can_dev->pm_clock_support) {
|
||||||
pm_runtime_enable(m_can_dev->dev);
|
|
||||||
ret = m_can_clk_start(m_can_dev);
|
ret = m_can_clk_start(m_can_dev);
|
||||||
if (ret)
|
if (ret)
|
||||||
goto pm_runtime_fail;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
ret = m_can_dev_setup(m_can_dev);
|
ret = m_can_dev_setup(m_can_dev);
|
||||||
|
@ -1859,11 +1854,6 @@ int m_can_class_register(struct m_can_classdev *m_can_dev)
|
||||||
*/
|
*/
|
||||||
clk_disable:
|
clk_disable:
|
||||||
m_can_clk_stop(m_can_dev);
|
m_can_clk_stop(m_can_dev);
|
||||||
pm_runtime_fail:
|
|
||||||
if (ret) {
|
|
||||||
if (m_can_dev->pm_clock_support)
|
|
||||||
pm_runtime_disable(m_can_dev->dev);
|
|
||||||
}
|
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
186
drivers/net/can/m_can/m_can_pci.c
Normal file
186
drivers/net/can/m_can/m_can_pci.c
Normal file
|
@ -0,0 +1,186 @@
|
||||||
|
// SPDX-License-Identifier: GPL-2.0
|
||||||
|
/*
|
||||||
|
* PCI Specific M_CAN Glue
|
||||||
|
*
|
||||||
|
* Copyright (C) 2018-2020 Intel Corporation
|
||||||
|
* Author: Felipe Balbi (Intel)
|
||||||
|
* Author: Jarkko Nikula <jarkko.nikula@linux.intel.com>
|
||||||
|
* Author: Raymond Tan <raymond.tan@intel.com>
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <linux/kernel.h>
|
||||||
|
#include <linux/module.h>
|
||||||
|
#include <linux/netdevice.h>
|
||||||
|
#include <linux/pci.h>
|
||||||
|
#include <linux/pm_runtime.h>
|
||||||
|
|
||||||
|
#include "m_can.h"
|
||||||
|
|
||||||
|
#define M_CAN_PCI_MMIO_BAR 0
|
||||||
|
|
||||||
|
#define M_CAN_CLOCK_FREQ_EHL 100000000
|
||||||
|
#define CTL_CSR_INT_CTL_OFFSET 0x508
|
||||||
|
|
||||||
|
struct m_can_pci_priv {
|
||||||
|
void __iomem *base;
|
||||||
|
};
|
||||||
|
|
||||||
|
static u32 iomap_read_reg(struct m_can_classdev *cdev, int reg)
|
||||||
|
{
|
||||||
|
struct m_can_pci_priv *priv = cdev->device_data;
|
||||||
|
|
||||||
|
return readl(priv->base + reg);
|
||||||
|
}
|
||||||
|
|
||||||
|
static u32 iomap_read_fifo(struct m_can_classdev *cdev, int offset)
|
||||||
|
{
|
||||||
|
struct m_can_pci_priv *priv = cdev->device_data;
|
||||||
|
|
||||||
|
return readl(priv->base + offset);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int iomap_write_reg(struct m_can_classdev *cdev, int reg, int val)
|
||||||
|
{
|
||||||
|
struct m_can_pci_priv *priv = cdev->device_data;
|
||||||
|
|
||||||
|
writel(val, priv->base + reg);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int iomap_write_fifo(struct m_can_classdev *cdev, int offset, int val)
|
||||||
|
{
|
||||||
|
struct m_can_pci_priv *priv = cdev->device_data;
|
||||||
|
|
||||||
|
writel(val, priv->base + offset);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct m_can_ops m_can_pci_ops = {
|
||||||
|
.read_reg = iomap_read_reg,
|
||||||
|
.write_reg = iomap_write_reg,
|
||||||
|
.write_fifo = iomap_write_fifo,
|
||||||
|
.read_fifo = iomap_read_fifo,
|
||||||
|
};
|
||||||
|
|
||||||
|
static int m_can_pci_probe(struct pci_dev *pci, const struct pci_device_id *id)
|
||||||
|
{
|
||||||
|
struct device *dev = &pci->dev;
|
||||||
|
struct m_can_classdev *mcan_class;
|
||||||
|
struct m_can_pci_priv *priv;
|
||||||
|
void __iomem *base;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
ret = pcim_enable_device(pci);
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
pci_set_master(pci);
|
||||||
|
|
||||||
|
ret = pcim_iomap_regions(pci, BIT(M_CAN_PCI_MMIO_BAR), pci_name(pci));
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
base = pcim_iomap_table(pci)[M_CAN_PCI_MMIO_BAR];
|
||||||
|
|
||||||
|
if (!base) {
|
||||||
|
dev_err(dev, "failed to map BARs\n");
|
||||||
|
return -ENOMEM;
|
||||||
|
}
|
||||||
|
|
||||||
|
priv = devm_kzalloc(&pci->dev, sizeof(*priv), GFP_KERNEL);
|
||||||
|
if (!priv)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
mcan_class = m_can_class_allocate_dev(&pci->dev);
|
||||||
|
if (!mcan_class)
|
||||||
|
return -ENOMEM;
|
||||||
|
|
||||||
|
priv->base = base;
|
||||||
|
|
||||||
|
ret = pci_alloc_irq_vectors(pci, 1, 1, PCI_IRQ_ALL_TYPES);
|
||||||
|
if (ret < 0)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
mcan_class->device_data = priv;
|
||||||
|
mcan_class->dev = &pci->dev;
|
||||||
|
mcan_class->net->irq = pci_irq_vector(pci, 0);
|
||||||
|
mcan_class->pm_clock_support = 1;
|
||||||
|
mcan_class->can.clock.freq = id->driver_data;
|
||||||
|
mcan_class->ops = &m_can_pci_ops;
|
||||||
|
|
||||||
|
pci_set_drvdata(pci, mcan_class->net);
|
||||||
|
|
||||||
|
ret = m_can_class_register(mcan_class);
|
||||||
|
if (ret)
|
||||||
|
goto err;
|
||||||
|
|
||||||
|
/* Enable interrupt control at CAN wrapper IP */
|
||||||
|
writel(0x1, base + CTL_CSR_INT_CTL_OFFSET);
|
||||||
|
|
||||||
|
pm_runtime_set_autosuspend_delay(dev, 1000);
|
||||||
|
pm_runtime_use_autosuspend(dev);
|
||||||
|
pm_runtime_put_noidle(dev);
|
||||||
|
pm_runtime_allow(dev);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
err:
|
||||||
|
pci_free_irq_vectors(pci);
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void m_can_pci_remove(struct pci_dev *pci)
|
||||||
|
{
|
||||||
|
struct net_device *dev = pci_get_drvdata(pci);
|
||||||
|
struct m_can_classdev *mcan_class = netdev_priv(dev);
|
||||||
|
struct m_can_pci_priv *priv = mcan_class->device_data;
|
||||||
|
|
||||||
|
pm_runtime_forbid(&pci->dev);
|
||||||
|
pm_runtime_get_noresume(&pci->dev);
|
||||||
|
|
||||||
|
/* Disable interrupt control at CAN wrapper IP */
|
||||||
|
writel(0x0, priv->base + CTL_CSR_INT_CTL_OFFSET);
|
||||||
|
|
||||||
|
m_can_class_unregister(mcan_class);
|
||||||
|
pci_free_irq_vectors(pci);
|
||||||
|
}
|
||||||
|
|
||||||
|
static __maybe_unused int m_can_pci_suspend(struct device *dev)
|
||||||
|
{
|
||||||
|
return m_can_class_suspend(dev);
|
||||||
|
}
|
||||||
|
|
||||||
|
static __maybe_unused int m_can_pci_resume(struct device *dev)
|
||||||
|
{
|
||||||
|
return m_can_class_resume(dev);
|
||||||
|
}
|
||||||
|
|
||||||
|
static SIMPLE_DEV_PM_OPS(m_can_pci_pm_ops,
|
||||||
|
m_can_pci_suspend, m_can_pci_resume);
|
||||||
|
|
||||||
|
static const struct pci_device_id m_can_pci_id_table[] = {
|
||||||
|
{ PCI_VDEVICE(INTEL, 0x4bc1), M_CAN_CLOCK_FREQ_EHL, },
|
||||||
|
{ PCI_VDEVICE(INTEL, 0x4bc2), M_CAN_CLOCK_FREQ_EHL, },
|
||||||
|
{ } /* Terminating Entry */
|
||||||
|
};
|
||||||
|
MODULE_DEVICE_TABLE(pci, m_can_pci_id_table);
|
||||||
|
|
||||||
|
static struct pci_driver m_can_pci_driver = {
|
||||||
|
.name = "m_can_pci",
|
||||||
|
.probe = m_can_pci_probe,
|
||||||
|
.remove = m_can_pci_remove,
|
||||||
|
.id_table = m_can_pci_id_table,
|
||||||
|
.driver = {
|
||||||
|
.pm = &m_can_pci_pm_ops,
|
||||||
|
},
|
||||||
|
};
|
||||||
|
|
||||||
|
module_pci_driver(m_can_pci_driver);
|
||||||
|
|
||||||
|
MODULE_AUTHOR("Felipe Balbi (Intel)");
|
||||||
|
MODULE_AUTHOR("Jarkko Nikula <jarkko.nikula@linux.intel.com>");
|
||||||
|
MODULE_AUTHOR("Raymond Tan <raymond.tan@intel.com>");
|
||||||
|
MODULE_LICENSE("GPL");
|
||||||
|
MODULE_DESCRIPTION("CAN bus driver for Bosch M_CAN controller on PCI bus");
|
|
@ -115,8 +115,15 @@ static int m_can_plat_probe(struct platform_device *pdev)
|
||||||
|
|
||||||
m_can_init_ram(mcan_class);
|
m_can_init_ram(mcan_class);
|
||||||
|
|
||||||
return m_can_class_register(mcan_class);
|
pm_runtime_enable(mcan_class->dev);
|
||||||
|
ret = m_can_class_register(mcan_class);
|
||||||
|
if (ret)
|
||||||
|
goto out_runtime_disable;
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
out_runtime_disable:
|
||||||
|
pm_runtime_disable(mcan_class->dev);
|
||||||
probe_fail:
|
probe_fail:
|
||||||
m_can_class_free_dev(mcan_class->net);
|
m_can_class_free_dev(mcan_class->net);
|
||||||
return ret;
|
return ret;
|
||||||
|
|
|
@ -157,7 +157,7 @@ can_rx_offload_offload_one(struct can_rx_offload *offload, unsigned int n)
|
||||||
/* There was a problem reading the mailbox, propagate
|
/* There was a problem reading the mailbox, propagate
|
||||||
* error value.
|
* error value.
|
||||||
*/
|
*/
|
||||||
if (unlikely(IS_ERR(skb))) {
|
if (IS_ERR(skb)) {
|
||||||
offload->dev->stats.rx_dropped++;
|
offload->dev->stats.rx_dropped++;
|
||||||
offload->dev->stats.rx_fifo_errors++;
|
offload->dev->stats.rx_fifo_errors++;
|
||||||
|
|
||||||
|
|
|
@ -965,7 +965,10 @@ static u8 mcp251xfd_get_normal_mode(const struct mcp251xfd_priv *priv)
|
||||||
{
|
{
|
||||||
u8 mode;
|
u8 mode;
|
||||||
|
|
||||||
if (priv->can.ctrlmode & CAN_CTRLMODE_LISTENONLY)
|
|
||||||
|
if (priv->can.ctrlmode & CAN_CTRLMODE_LOOPBACK)
|
||||||
|
mode = MCP251XFD_REG_CON_MODE_INT_LOOPBACK;
|
||||||
|
else if (priv->can.ctrlmode & CAN_CTRLMODE_LISTENONLY)
|
||||||
mode = MCP251XFD_REG_CON_MODE_LISTENONLY;
|
mode = MCP251XFD_REG_CON_MODE_LISTENONLY;
|
||||||
else if (priv->can.ctrlmode & CAN_CTRLMODE_FD)
|
else if (priv->can.ctrlmode & CAN_CTRLMODE_FD)
|
||||||
mode = MCP251XFD_REG_CON_MODE_MIXED;
|
mode = MCP251XFD_REG_CON_MODE_MIXED;
|
||||||
|
@ -2881,9 +2884,9 @@ static int mcp251xfd_probe(struct spi_device *spi)
|
||||||
priv->can.do_get_berr_counter = mcp251xfd_get_berr_counter;
|
priv->can.do_get_berr_counter = mcp251xfd_get_berr_counter;
|
||||||
priv->can.bittiming_const = &mcp251xfd_bittiming_const;
|
priv->can.bittiming_const = &mcp251xfd_bittiming_const;
|
||||||
priv->can.data_bittiming_const = &mcp251xfd_data_bittiming_const;
|
priv->can.data_bittiming_const = &mcp251xfd_data_bittiming_const;
|
||||||
priv->can.ctrlmode_supported = CAN_CTRLMODE_LISTENONLY |
|
priv->can.ctrlmode_supported = CAN_CTRLMODE_LOOPBACK |
|
||||||
CAN_CTRLMODE_BERR_REPORTING | CAN_CTRLMODE_FD |
|
CAN_CTRLMODE_LISTENONLY | CAN_CTRLMODE_BERR_REPORTING |
|
||||||
CAN_CTRLMODE_FD_NON_ISO;
|
CAN_CTRLMODE_FD | CAN_CTRLMODE_FD_NON_ISO;
|
||||||
priv->ndev = ndev;
|
priv->ndev = ndev;
|
||||||
priv->spi = spi;
|
priv->spi = spi;
|
||||||
priv->rx_int = rx_int;
|
priv->rx_int = rx_int;
|
||||||
|
|
|
@ -135,7 +135,7 @@ struct can_isotp_ll_options {
|
||||||
#define CAN_ISOTP_FORCE_RXSTMIN 0x100 /* ignore CFs depending on rx stmin */
|
#define CAN_ISOTP_FORCE_RXSTMIN 0x100 /* ignore CFs depending on rx stmin */
|
||||||
#define CAN_ISOTP_RX_EXT_ADDR 0x200 /* different rx extended addressing */
|
#define CAN_ISOTP_RX_EXT_ADDR 0x200 /* different rx extended addressing */
|
||||||
#define CAN_ISOTP_WAIT_TX_DONE 0x400 /* wait for tx completion */
|
#define CAN_ISOTP_WAIT_TX_DONE 0x400 /* wait for tx completion */
|
||||||
|
#define CAN_ISOTP_SF_BROADCAST 0x800 /* 1-to-N functional addressing */
|
||||||
|
|
||||||
/* default values */
|
/* default values */
|
||||||
|
|
||||||
|
|
|
@ -865,6 +865,14 @@ static int isotp_sendmsg(struct socket *sock, struct msghdr *msg, size_t size)
|
||||||
if (!size || size > MAX_MSG_LENGTH)
|
if (!size || size > MAX_MSG_LENGTH)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
|
/* take care of a potential SF_DL ESC offset for TX_DL > 8 */
|
||||||
|
off = (so->tx.ll_dl > CAN_MAX_DLEN) ? 1 : 0;
|
||||||
|
|
||||||
|
/* does the given data fit into a single frame for SF_BROADCAST? */
|
||||||
|
if ((so->opt.flags & CAN_ISOTP_SF_BROADCAST) &&
|
||||||
|
(size > so->tx.ll_dl - SF_PCI_SZ4 - ae - off))
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
err = memcpy_from_msg(so->tx.buf, msg, size);
|
err = memcpy_from_msg(so->tx.buf, msg, size);
|
||||||
if (err < 0)
|
if (err < 0)
|
||||||
return err;
|
return err;
|
||||||
|
@ -891,9 +899,6 @@ static int isotp_sendmsg(struct socket *sock, struct msghdr *msg, size_t size)
|
||||||
cf = (struct canfd_frame *)skb->data;
|
cf = (struct canfd_frame *)skb->data;
|
||||||
skb_put(skb, so->ll.mtu);
|
skb_put(skb, so->ll.mtu);
|
||||||
|
|
||||||
/* take care of a potential SF_DL ESC offset for TX_DL > 8 */
|
|
||||||
off = (so->tx.ll_dl > CAN_MAX_DLEN) ? 1 : 0;
|
|
||||||
|
|
||||||
/* check for single frame transmission depending on TX_DL */
|
/* check for single frame transmission depending on TX_DL */
|
||||||
if (size <= so->tx.ll_dl - SF_PCI_SZ4 - ae - off) {
|
if (size <= so->tx.ll_dl - SF_PCI_SZ4 - ae - off) {
|
||||||
/* The message size generally fits into a SingleFrame - good.
|
/* The message size generally fits into a SingleFrame - good.
|
||||||
|
@ -1016,7 +1021,7 @@ static int isotp_release(struct socket *sock)
|
||||||
hrtimer_cancel(&so->rxtimer);
|
hrtimer_cancel(&so->rxtimer);
|
||||||
|
|
||||||
/* remove current filters & unregister */
|
/* remove current filters & unregister */
|
||||||
if (so->bound) {
|
if (so->bound && (!(so->opt.flags & CAN_ISOTP_SF_BROADCAST))) {
|
||||||
if (so->ifindex) {
|
if (so->ifindex) {
|
||||||
struct net_device *dev;
|
struct net_device *dev;
|
||||||
|
|
||||||
|
@ -1052,15 +1057,25 @@ static int isotp_bind(struct socket *sock, struct sockaddr *uaddr, int len)
|
||||||
struct net_device *dev;
|
struct net_device *dev;
|
||||||
int err = 0;
|
int err = 0;
|
||||||
int notify_enetdown = 0;
|
int notify_enetdown = 0;
|
||||||
|
int do_rx_reg = 1;
|
||||||
|
|
||||||
if (len < CAN_REQUIRED_SIZE(struct sockaddr_can, can_addr.tp))
|
if (len < CAN_REQUIRED_SIZE(struct sockaddr_can, can_addr.tp))
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
if (addr->can_addr.tp.rx_id == addr->can_addr.tp.tx_id)
|
/* do not register frame reception for functional addressing */
|
||||||
return -EADDRNOTAVAIL;
|
if (so->opt.flags & CAN_ISOTP_SF_BROADCAST)
|
||||||
|
do_rx_reg = 0;
|
||||||
|
|
||||||
if ((addr->can_addr.tp.rx_id | addr->can_addr.tp.tx_id) &
|
/* do not validate rx address for functional addressing */
|
||||||
(CAN_ERR_FLAG | CAN_RTR_FLAG))
|
if (do_rx_reg) {
|
||||||
|
if (addr->can_addr.tp.rx_id == addr->can_addr.tp.tx_id)
|
||||||
|
return -EADDRNOTAVAIL;
|
||||||
|
|
||||||
|
if (addr->can_addr.tp.rx_id & (CAN_ERR_FLAG | CAN_RTR_FLAG))
|
||||||
|
return -EADDRNOTAVAIL;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (addr->can_addr.tp.tx_id & (CAN_ERR_FLAG | CAN_RTR_FLAG))
|
||||||
return -EADDRNOTAVAIL;
|
return -EADDRNOTAVAIL;
|
||||||
|
|
||||||
if (!addr->can_ifindex)
|
if (!addr->can_ifindex)
|
||||||
|
@ -1093,13 +1108,14 @@ static int isotp_bind(struct socket *sock, struct sockaddr *uaddr, int len)
|
||||||
|
|
||||||
ifindex = dev->ifindex;
|
ifindex = dev->ifindex;
|
||||||
|
|
||||||
can_rx_register(net, dev, addr->can_addr.tp.rx_id,
|
if (do_rx_reg)
|
||||||
SINGLE_MASK(addr->can_addr.tp.rx_id), isotp_rcv, sk,
|
can_rx_register(net, dev, addr->can_addr.tp.rx_id,
|
||||||
"isotp", sk);
|
SINGLE_MASK(addr->can_addr.tp.rx_id),
|
||||||
|
isotp_rcv, sk, "isotp", sk);
|
||||||
|
|
||||||
dev_put(dev);
|
dev_put(dev);
|
||||||
|
|
||||||
if (so->bound) {
|
if (so->bound && do_rx_reg) {
|
||||||
/* unregister old filter */
|
/* unregister old filter */
|
||||||
if (so->ifindex) {
|
if (so->ifindex) {
|
||||||
dev = dev_get_by_index(net, so->ifindex);
|
dev = dev_get_by_index(net, so->ifindex);
|
||||||
|
@ -1299,7 +1315,7 @@ static int isotp_notifier(struct notifier_block *nb, unsigned long msg,
|
||||||
case NETDEV_UNREGISTER:
|
case NETDEV_UNREGISTER:
|
||||||
lock_sock(sk);
|
lock_sock(sk);
|
||||||
/* remove current filters & unregister */
|
/* remove current filters & unregister */
|
||||||
if (so->bound)
|
if (so->bound && (!(so->opt.flags & CAN_ISOTP_SF_BROADCAST)))
|
||||||
can_rx_unregister(dev_net(dev), dev, so->rxid,
|
can_rx_unregister(dev_net(dev), dev, so->rxid,
|
||||||
SINGLE_MASK(so->rxid),
|
SINGLE_MASK(so->rxid),
|
||||||
isotp_rcv, sk);
|
isotp_rcv, sk);
|
||||||
|
|
Loading…
Add table
Add a link
Reference in a new issue