2019-05-23 17:15:00 +08:00
|
|
|
// SPDX-License-Identifier: GPL-2.0-or-later
|
2015-08-20 23:26:02 +08:00
|
|
|
/*
|
|
|
|
* I2C Link Layer for Samsung S3FWRN5 NCI based Driver
|
|
|
|
*
|
|
|
|
* Copyright (C) 2015 Samsung Electrnoics
|
|
|
|
* Robert Baldyga <r.baldyga@samsung.com>
|
|
|
|
*/
|
|
|
|
|
2021-05-19 17:16:13 +08:00
|
|
|
#include <linux/clk.h>
|
2015-08-20 23:26:02 +08:00
|
|
|
#include <linux/i2c.h>
|
|
|
|
#include <linux/gpio.h>
|
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/of_gpio.h>
|
|
|
|
#include <linux/of_irq.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
|
|
|
|
#include <net/nfc/nfc.h>
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
#include "phy_common.h"
|
2015-08-20 23:26:02 +08:00
|
|
|
|
|
|
|
#define S3FWRN5_I2C_DRIVER_NAME "s3fwrn5_i2c"
|
|
|
|
|
|
|
|
struct s3fwrn5_i2c_phy {
|
2020-12-02 19:47:40 +08:00
|
|
|
struct phy_common common;
|
2015-08-20 23:26:02 +08:00
|
|
|
struct i2c_client *i2c_dev;
|
2021-05-19 17:16:13 +08:00
|
|
|
struct clk *clk;
|
2015-08-20 23:26:02 +08:00
|
|
|
|
|
|
|
unsigned int irq_skip:1;
|
|
|
|
};
|
|
|
|
|
|
|
|
static void s3fwrn5_i2c_set_mode(void *phy_id, enum s3fwrn5_mode mode)
|
|
|
|
{
|
|
|
|
struct s3fwrn5_i2c_phy *phy = phy_id;
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
mutex_lock(&phy->common.mutex);
|
2015-08-20 23:26:02 +08:00
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
if (s3fwrn5_phy_power_ctrl(&phy->common, mode) == false)
|
2015-08-20 23:26:02 +08:00
|
|
|
goto out;
|
|
|
|
|
|
|
|
phy->irq_skip = true;
|
|
|
|
|
|
|
|
out:
|
2020-12-02 19:47:40 +08:00
|
|
|
mutex_unlock(&phy->common.mutex);
|
2015-08-20 23:26:02 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static int s3fwrn5_i2c_write(void *phy_id, struct sk_buff *skb)
|
|
|
|
{
|
|
|
|
struct s3fwrn5_i2c_phy *phy = phy_id;
|
|
|
|
int ret;
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
mutex_lock(&phy->common.mutex);
|
2015-08-20 23:26:02 +08:00
|
|
|
|
|
|
|
phy->irq_skip = false;
|
|
|
|
|
|
|
|
ret = i2c_master_send(phy->i2c_dev, skb->data, skb->len);
|
|
|
|
if (ret == -EREMOTEIO) {
|
|
|
|
/* Retry, chip was in standby */
|
|
|
|
usleep_range(110000, 120000);
|
|
|
|
ret = i2c_master_send(phy->i2c_dev, skb->data, skb->len);
|
|
|
|
}
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
mutex_unlock(&phy->common.mutex);
|
2015-08-20 23:26:02 +08:00
|
|
|
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
if (ret != skb->len)
|
|
|
|
return -EREMOTEIO;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-11-13 20:04:41 +08:00
|
|
|
static const struct s3fwrn5_phy_ops i2c_phy_ops = {
|
2020-12-02 19:47:40 +08:00
|
|
|
.set_wake = s3fwrn5_phy_set_wake,
|
2015-08-20 23:26:02 +08:00
|
|
|
.set_mode = s3fwrn5_i2c_set_mode,
|
2020-12-02 19:47:40 +08:00
|
|
|
.get_mode = s3fwrn5_phy_get_mode,
|
2015-08-20 23:26:02 +08:00
|
|
|
.write = s3fwrn5_i2c_write,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int s3fwrn5_i2c_read(struct s3fwrn5_i2c_phy *phy)
|
|
|
|
{
|
|
|
|
struct sk_buff *skb;
|
|
|
|
size_t hdr_size;
|
|
|
|
size_t data_len;
|
|
|
|
char hdr[4];
|
|
|
|
int ret;
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
hdr_size = (phy->common.mode == S3FWRN5_MODE_NCI) ?
|
2015-08-20 23:26:02 +08:00
|
|
|
NCI_CTRL_HDR_SIZE : S3FWRN5_FW_HDR_SIZE;
|
|
|
|
ret = i2c_master_recv(phy->i2c_dev, hdr, hdr_size);
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
if (ret < hdr_size)
|
|
|
|
return -EBADMSG;
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
data_len = (phy->common.mode == S3FWRN5_MODE_NCI) ?
|
2015-08-20 23:26:02 +08:00
|
|
|
((struct nci_ctrl_hdr *)hdr)->plen :
|
|
|
|
((struct s3fwrn5_fw_header *)hdr)->len;
|
|
|
|
|
|
|
|
skb = alloc_skb(hdr_size + data_len, GFP_KERNEL);
|
|
|
|
if (!skb)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
networking: introduce and use skb_put_data()
A common pattern with skb_put() is to just want to memcpy()
some data into the new space, introduce skb_put_data() for
this.
An spatch similar to the one for skb_put_zero() converts many
of the places using it:
@@
identifier p, p2;
expression len, skb, data;
type t, t2;
@@
(
-p = skb_put(skb, len);
+p = skb_put_data(skb, data, len);
|
-p = (t)skb_put(skb, len);
+p = skb_put_data(skb, data, len);
)
(
p2 = (t2)p;
-memcpy(p2, data, len);
|
-memcpy(p, data, len);
)
@@
type t, t2;
identifier p, p2;
expression skb, data;
@@
t *p;
...
(
-p = skb_put(skb, sizeof(t));
+p = skb_put_data(skb, data, sizeof(t));
|
-p = (t *)skb_put(skb, sizeof(t));
+p = skb_put_data(skb, data, sizeof(t));
)
(
p2 = (t2)p;
-memcpy(p2, data, sizeof(*p));
|
-memcpy(p, data, sizeof(*p));
)
@@
expression skb, len, data;
@@
-memcpy(skb_put(skb, len), data, len);
+skb_put_data(skb, data, len);
(again, manually post-processed to retain some comments)
Reviewed-by: Stephen Hemminger <stephen@networkplumber.org>
Signed-off-by: Johannes Berg <johannes.berg@intel.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-06-16 20:29:20 +08:00
|
|
|
skb_put_data(skb, hdr, hdr_size);
|
2015-08-20 23:26:02 +08:00
|
|
|
|
|
|
|
if (data_len == 0)
|
|
|
|
goto out;
|
|
|
|
|
|
|
|
ret = i2c_master_recv(phy->i2c_dev, skb_put(skb, data_len), data_len);
|
|
|
|
if (ret != data_len) {
|
|
|
|
kfree_skb(skb);
|
|
|
|
return -EBADMSG;
|
|
|
|
}
|
|
|
|
|
|
|
|
out:
|
2020-12-02 19:47:40 +08:00
|
|
|
return s3fwrn5_recv_frame(phy->common.ndev, skb, phy->common.mode);
|
2015-08-20 23:26:02 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static irqreturn_t s3fwrn5_i2c_irq_thread_fn(int irq, void *phy_id)
|
|
|
|
{
|
|
|
|
struct s3fwrn5_i2c_phy *phy = phy_id;
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
if (!phy || !phy->common.ndev) {
|
2015-08-20 23:26:02 +08:00
|
|
|
WARN_ON_ONCE(1);
|
|
|
|
return IRQ_NONE;
|
|
|
|
}
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
mutex_lock(&phy->common.mutex);
|
2015-08-20 23:26:02 +08:00
|
|
|
|
|
|
|
if (phy->irq_skip)
|
|
|
|
goto out;
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
switch (phy->common.mode) {
|
2015-08-20 23:26:02 +08:00
|
|
|
case S3FWRN5_MODE_NCI:
|
|
|
|
case S3FWRN5_MODE_FW:
|
2020-09-11 00:12:15 +08:00
|
|
|
s3fwrn5_i2c_read(phy);
|
2015-08-20 23:26:02 +08:00
|
|
|
break;
|
|
|
|
case S3FWRN5_MODE_COLD:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
out:
|
2020-12-02 19:47:40 +08:00
|
|
|
mutex_unlock(&phy->common.mutex);
|
2015-08-20 23:26:02 +08:00
|
|
|
|
|
|
|
return IRQ_HANDLED;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int s3fwrn5_i2c_parse_dt(struct i2c_client *client)
|
|
|
|
{
|
|
|
|
struct s3fwrn5_i2c_phy *phy = i2c_get_clientdata(client);
|
|
|
|
struct device_node *np = client->dev.of_node;
|
|
|
|
|
|
|
|
if (!np)
|
|
|
|
return -ENODEV;
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
phy->common.gpio_en = of_get_named_gpio(np, "en-gpios", 0);
|
|
|
|
if (!gpio_is_valid(phy->common.gpio_en)) {
|
2020-09-11 00:12:14 +08:00
|
|
|
/* Support also deprecated property */
|
2020-12-02 19:47:40 +08:00
|
|
|
phy->common.gpio_en = of_get_named_gpio(np,
|
|
|
|
"s3fwrn5,en-gpios",
|
|
|
|
0);
|
|
|
|
if (!gpio_is_valid(phy->common.gpio_en))
|
2020-09-11 00:12:14 +08:00
|
|
|
return -ENODEV;
|
|
|
|
}
|
2015-08-20 23:26:02 +08:00
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
phy->common.gpio_fw_wake = of_get_named_gpio(np, "wake-gpios", 0);
|
|
|
|
if (!gpio_is_valid(phy->common.gpio_fw_wake)) {
|
2020-09-11 00:12:14 +08:00
|
|
|
/* Support also deprecated property */
|
2020-12-02 19:47:40 +08:00
|
|
|
phy->common.gpio_fw_wake = of_get_named_gpio(np,
|
|
|
|
"s3fwrn5,fw-gpios",
|
|
|
|
0);
|
|
|
|
if (!gpio_is_valid(phy->common.gpio_fw_wake))
|
2020-09-11 00:12:14 +08:00
|
|
|
return -ENODEV;
|
|
|
|
}
|
2015-08-20 23:26:02 +08:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2022-11-23 12:55:05 +08:00
|
|
|
static int s3fwrn5_i2c_probe(struct i2c_client *client)
|
2015-08-20 23:26:02 +08:00
|
|
|
{
|
|
|
|
struct s3fwrn5_i2c_phy *phy;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
phy = devm_kzalloc(&client->dev, sizeof(*phy), GFP_KERNEL);
|
|
|
|
if (!phy)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
mutex_init(&phy->common.mutex);
|
|
|
|
phy->common.mode = S3FWRN5_MODE_COLD;
|
2015-08-20 23:26:02 +08:00
|
|
|
phy->irq_skip = true;
|
|
|
|
|
|
|
|
phy->i2c_dev = client;
|
|
|
|
i2c_set_clientdata(client, phy);
|
|
|
|
|
|
|
|
ret = s3fwrn5_i2c_parse_dt(client);
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
ret = devm_gpio_request_one(&phy->i2c_dev->dev, phy->common.gpio_en,
|
|
|
|
GPIOF_OUT_INIT_HIGH, "s3fwrn5_en");
|
2015-08-20 23:26:02 +08:00
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
ret = devm_gpio_request_one(&phy->i2c_dev->dev,
|
|
|
|
phy->common.gpio_fw_wake,
|
|
|
|
GPIOF_OUT_INIT_LOW, "s3fwrn5_fw_wake");
|
2015-08-20 23:26:02 +08:00
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
2021-05-19 17:16:13 +08:00
|
|
|
/*
|
|
|
|
* S3FWRN5 depends on a clock input ("XI" pin) to function properly.
|
|
|
|
* Depending on the hardware configuration this could be an always-on
|
|
|
|
* oscillator or some external clock that must be explicitly enabled.
|
|
|
|
* Make sure the clock is running before starting S3FWRN5.
|
|
|
|
*/
|
2022-10-27 15:34:02 +08:00
|
|
|
phy->clk = devm_clk_get_optional_enabled(&client->dev, NULL);
|
|
|
|
if (IS_ERR(phy->clk))
|
|
|
|
return dev_err_probe(&client->dev, PTR_ERR(phy->clk),
|
|
|
|
"failed to get clock\n");
|
2021-05-19 17:16:13 +08:00
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
ret = s3fwrn5_probe(&phy->common.ndev, phy, &phy->i2c_dev->dev,
|
|
|
|
&i2c_phy_ops);
|
2015-08-20 23:26:02 +08:00
|
|
|
if (ret < 0)
|
2022-10-27 15:34:02 +08:00
|
|
|
return ret;
|
2015-08-20 23:26:02 +08:00
|
|
|
|
2015-09-22 17:49:26 +08:00
|
|
|
ret = devm_request_threaded_irq(&client->dev, phy->i2c_dev->irq, NULL,
|
2020-12-11 05:18:24 +08:00
|
|
|
s3fwrn5_i2c_irq_thread_fn, IRQF_ONESHOT,
|
2015-08-20 23:26:02 +08:00
|
|
|
S3FWRN5_I2C_DRIVER_NAME, phy);
|
|
|
|
if (ret)
|
2021-05-19 17:16:13 +08:00
|
|
|
goto s3fwrn5_remove;
|
2015-08-20 23:26:02 +08:00
|
|
|
|
2021-05-19 17:16:13 +08:00
|
|
|
return 0;
|
|
|
|
|
|
|
|
s3fwrn5_remove:
|
|
|
|
s3fwrn5_remove(phy->common.ndev);
|
2015-08-20 23:26:02 +08:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2022-08-15 16:02:30 +08:00
|
|
|
static void s3fwrn5_i2c_remove(struct i2c_client *client)
|
2015-08-20 23:26:02 +08:00
|
|
|
{
|
|
|
|
struct s3fwrn5_i2c_phy *phy = i2c_get_clientdata(client);
|
|
|
|
|
2020-12-02 19:47:40 +08:00
|
|
|
s3fwrn5_remove(phy->common.ndev);
|
2015-08-20 23:26:02 +08:00
|
|
|
}
|
|
|
|
|
2017-08-22 01:03:58 +08:00
|
|
|
static const struct i2c_device_id s3fwrn5_i2c_id_table[] = {
|
2015-08-20 23:26:02 +08:00
|
|
|
{S3FWRN5_I2C_DRIVER_NAME, 0},
|
|
|
|
{}
|
|
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(i2c, s3fwrn5_i2c_id_table);
|
|
|
|
|
2021-05-28 20:41:56 +08:00
|
|
|
static const struct of_device_id of_s3fwrn5_i2c_match[] __maybe_unused = {
|
2015-08-20 23:26:02 +08:00
|
|
|
{ .compatible = "samsung,s3fwrn5-i2c", },
|
|
|
|
{}
|
|
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE(of, of_s3fwrn5_i2c_match);
|
|
|
|
|
|
|
|
static struct i2c_driver s3fwrn5_i2c_driver = {
|
|
|
|
.driver = {
|
|
|
|
.name = S3FWRN5_I2C_DRIVER_NAME,
|
|
|
|
.of_match_table = of_match_ptr(of_s3fwrn5_i2c_match),
|
|
|
|
},
|
2022-11-23 12:55:05 +08:00
|
|
|
.probe_new = s3fwrn5_i2c_probe,
|
2015-08-20 23:26:02 +08:00
|
|
|
.remove = s3fwrn5_i2c_remove,
|
|
|
|
.id_table = s3fwrn5_i2c_id_table,
|
|
|
|
};
|
|
|
|
|
|
|
|
module_i2c_driver(s3fwrn5_i2c_driver);
|
|
|
|
|
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
MODULE_DESCRIPTION("I2C driver for Samsung S3FWRN5");
|
|
|
|
MODULE_AUTHOR("Robert Baldyga <r.baldyga@samsung.com>");
|