2a1b9716b1
Re-arrange ipa registration sequence to handle cases where rmnet_ctl is being initialized before ipa is ready. Change-Id: Ic8416ad8f96f818e32f1320e997287ebfe755d03 Acked-by: Weiyi Chen <weiyic@qti.qualcomm.com> Signed-off-by: Subash Abhinov Kasiviswanathan <subashab@codeaurora.org>
114 行
2.2 KiB
C
114 行
2.2 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/* Copyright (c) 2020, The Linux Foundation. All rights reserved.
|
|
*
|
|
* RMNET_CTL mhi handler
|
|
*
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/skbuff.h>
|
|
#include <linux/ipa.h>
|
|
#include "rmnet_ctl.h"
|
|
#include "rmnet_ctl_client.h"
|
|
|
|
struct rmnet_ctl_ipa_dev {
|
|
struct rmnet_ctl_dev dev;
|
|
spinlock_t rx_lock; /* rx lock */
|
|
spinlock_t tx_lock; /* tx lock */
|
|
};
|
|
|
|
static struct rmnet_ctl_ipa_dev ctl_ipa_dev;
|
|
static bool rmnet_ctl_ipa_registered;
|
|
|
|
static int rmnet_ctl_send_ipa(struct rmnet_ctl_dev *dev, struct sk_buff *skb)
|
|
{
|
|
struct rmnet_ctl_ipa_dev *ctl_dev = container_of(
|
|
dev, struct rmnet_ctl_ipa_dev, dev);
|
|
int rc;
|
|
|
|
spin_lock_bh(&ctl_dev->tx_lock);
|
|
|
|
rc = ipa_rmnet_ctl_xmit(skb);
|
|
if (rc)
|
|
dev->stats.tx_err++;
|
|
else
|
|
dev->stats.tx_pkts++;
|
|
|
|
spin_unlock_bh(&ctl_dev->tx_lock);
|
|
|
|
return rc;
|
|
}
|
|
|
|
static void rmnet_ctl_dl_callback(void *user_data, void *rx_data)
|
|
{
|
|
struct rmnet_ctl_ipa_dev *ctl_dev = user_data;
|
|
|
|
ctl_dev->dev.stats.rx_pkts++;
|
|
rmnet_ctl_endpoint_post(rx_data, 0xFFFFFFFF);
|
|
}
|
|
|
|
static void rmnet_ctl_probe(void *user_data)
|
|
{
|
|
memset(&ctl_ipa_dev, 0, sizeof(ctl_ipa_dev));
|
|
|
|
spin_lock_init(&ctl_ipa_dev.rx_lock);
|
|
spin_lock_init(&ctl_ipa_dev.tx_lock);
|
|
|
|
ctl_ipa_dev.dev.xmit = rmnet_ctl_send_ipa;
|
|
rmnet_ctl_endpoint_setdev(&ctl_ipa_dev.dev);
|
|
|
|
pr_info("rmnet_ctl driver probed\n");
|
|
}
|
|
|
|
static void rmnet_ctl_remove(void *user_data)
|
|
{
|
|
rmnet_ctl_endpoint_setdev(NULL);
|
|
|
|
pr_info("rmnet_ctl driver removed\n");
|
|
}
|
|
|
|
static void rmnet_ctl_ipa_ready(void *user_data)
|
|
{
|
|
int rc;
|
|
|
|
rc = ipa_register_rmnet_ctl_cb(
|
|
rmnet_ctl_probe,
|
|
&ctl_ipa_dev,
|
|
rmnet_ctl_remove,
|
|
&ctl_ipa_dev,
|
|
rmnet_ctl_dl_callback,
|
|
&ctl_ipa_dev);
|
|
|
|
if (rc)
|
|
pr_err("%s: %d\n", __func__, rc);
|
|
else
|
|
rmnet_ctl_ipa_registered = true;
|
|
}
|
|
|
|
static int __init rmnet_ctl_init(void)
|
|
{
|
|
int rc;
|
|
|
|
rc = ipa_register_ipa_ready_cb(rmnet_ctl_ipa_ready, NULL);
|
|
if (rc == -EEXIST)
|
|
rmnet_ctl_ipa_ready(NULL);
|
|
else if (rc)
|
|
pr_err("%s: %d\n", __func__, rc);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void __exit rmnet_ctl_exit(void)
|
|
{
|
|
if (rmnet_ctl_ipa_registered) {
|
|
ipa_unregister_rmnet_ctl_cb();
|
|
rmnet_ctl_ipa_registered = false;
|
|
}
|
|
}
|
|
|
|
module_init(rmnet_ctl_init)
|
|
module_exit(rmnet_ctl_exit)
|
|
|
|
MODULE_DESCRIPTION("RmNet control IPA Driver");
|
|
MODULE_LICENSE("GPL v2");
|