Loading Documentation/devicetree/bindings/arm/msm/msm_ipc_router_mhi_dev_xprt.txt 0 → 100644 +21 −0 Original line number Diff line number Diff line Qualcomm Technologies, Inc. IPC Router MHI_DEV Transport Required properties: -compatible: should be "qcom,ipc-router-mhi-dev-xprt". -qcom,out-chan-id: MHI Channel ID for the transmit path. -qcom,in-chan-id: MHI Channel ID for the receive path. -qcom,xprt-remote: string that defines the edge of the transport. -qcom,xprt-linkid: unique integer to identify the tier to which the link belongs to in the network and is used to avoid the routing loops while forwarding the broadcast messages. -qcom,xprt-version: unique version ID used by MHI transport header. Example: qcom,ipc_router_external_ap_xprt { compatible = "qcom,ipc-router-mhi-dev-xprt"; qcom,out-chan-id = <34>; qcom,in-chan-id = <35>; qcom,xprt-remote = "external-ap"; qcom,xprt-linkid = <2>; qcom,xprt-version = <1>; }; drivers/soc/qcom/Kconfig +10 −0 Original line number Diff line number Diff line Loading @@ -660,6 +660,16 @@ config MSM_IPC_ROUTER_MHI_XPRT registers the transport with IPC Router and enable message exchange. config MSM_IPC_ROUTER_MHI_DEV_XPRT depends on MSM_MHI_DEV depends on IPC_ROUTER bool "MSM MHI_DEV XPRT Layer" help MHI_DEV Transport Layer that enables off-chip communication of IPC Router. When the MHI endpoint becomes available, this layer registers the transport with IPC Router and enables message exchange. config MSM_SYSTEM_HEALTH_MONITOR bool "System Health Monitor" depends on MSM_QMI_INTERFACE && MSM_SUBSYSTEM_RESTART Loading drivers/soc/qcom/Makefile +1 −0 Original line number Diff line number Diff line Loading @@ -54,6 +54,7 @@ obj-$(CONFIG_MSM_QMI_INTERFACE) += qmi_interface.o obj-$(CONFIG_MSM_IPC_ROUTER_SMD_XPRT) += ipc_router_smd_xprt.o obj-$(CONFIG_MSM_IPC_ROUTER_HSIC_XPRT) += ipc_router_hsic_xprt.o obj-$(CONFIG_MSM_IPC_ROUTER_MHI_XPRT) += ipc_router_mhi_xprt.o obj-$(CONFIG_MSM_IPC_ROUTER_MHI_DEV_XPRT) += ipc_router_mhi_dev_xprt.o obj-$(CONFIG_MSM_IPC_ROUTER_GLINK_XPRT) += ipc_router_glink_xprt.o obj-$(CONFIG_MSM_SYSMON_GLINK_COMM) += sysmon-glink.o sysmon-qmi.o obj-$(CONFIG_MSM_SHARED_HEAP_ACCESS) += shared_memory.o Loading drivers/soc/qcom/ipc_router_mhi_dev_xprt.c 0 → 100644 +638 −0 Original line number Diff line number Diff line /* Copyright (c) 2013-2018, The Linux Foundation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include <linux/ipc_router_xprt.h> #include <linux/module.h> #include <linux/msm_mhi_dev.h> #include <linux/of.h> #include <linux/platform_device.h> #include <linux/skbuff.h> #include <linux/types.h> static int ipc_router_mhi_dev_xprt_debug_mask; module_param_named(debug_mask, ipc_router_mhi_dev_xprt_debug_mask, int, S_IRUGO | S_IWUSR | S_IWGRP); #define D(x...) do { \ if (ipc_router_mhi_dev_xprt_debug_mask) \ pr_info(x); \ } while (0) #define MODULE_NAME "ipc_router_mhi_dev_xprt" #define XPRT_NAME_LEN 32 #define IPC_ROUTER_MHI_XPRT_MAX_PKT_SIZE 0x1000 /** * ipc_router_mhi_dev_channel - MHI Channel related information * @out_chan_id: Out channel ID for use by IPC ROUTER enumerated in MHI driver. * @out_handle: MHI Output channel handle. * @in_chan_id: In channel ID for use by IPC ROUTER enumerated in MHI driver. * @in_handle: MHI Input channel handle. * @state_lock: Lock to protect access to the state information. * @out_chan_enabled: State of the outgoing channel. * @in_chan_enabled: State of the incoming channel. * @bytes_to_rx: Remaining bytes to be received in a packet. * @in_skbq: Queue containing the input buffers. * @max_packet_size: Possible maximum packet size. * @mhi_xprtp: Pointer to IPC Router MHI XPRT. */ struct ipc_router_mhi_dev_channel { enum mhi_client_channel out_chan_id; struct mhi_dev_client *out_handle; enum mhi_client_channel in_chan_id; struct mhi_dev_client *in_handle; struct mutex state_lock; bool out_chan_enabled; bool in_chan_enabled; int bytes_to_rx; struct sk_buff_head in_skbq; size_t max_packet_size; void *mhi_xprtp; }; /** * ipc_router_mhi_dev_xprt - IPC Router's MHI XPRT structure * @list: IPC router's MHI XPRTs list. * @ch_hndl: Data Structure to hold MHI Channel information. * @xprt_name: Name of the XPRT to be registered with IPC Router. * @xprt: IPC Router XPRT structure to contain MHI XPRT specific info. * @wq: Workqueue to queue read & other XPRT related works. * @read_work: Read Work to perform read operation from MHI Driver. * @in_pkt: Pointer to any partially read packet. * @write_wait_q: Wait Queue to handle the write events. * @xprt_version: IPC Router header version supported by this XPRT. * @xprt_option: XPRT specific options to be handled by IPC Router. */ struct ipc_router_mhi_dev_xprt { struct list_head list; struct ipc_router_mhi_dev_channel ch_hndl; char xprt_name[XPRT_NAME_LEN]; struct msm_ipc_router_xprt xprt; struct workqueue_struct *wq; struct work_struct read_work; struct rr_packet *in_pkt; size_t bytes_to_rx; wait_queue_head_t write_wait_q; unsigned xprt_version; unsigned xprt_option; }; /** * ipc_router_mhi_dev_xprt_config - Config. Info. of each MHI XPRT * @out_chan_id: Out channel ID for use by IPC ROUTER enumerated in MHI driver. * @in_chan_id: In channel ID for use by IPC ROUTER enumerated in MHI driver. * @xprt_name: Name of the XPRT to be registered with IPC Router. * @link_id: Network Cluster ID to which this XPRT belongs to. * @xprt_version: IPC Router header version supported by this XPRT. */ struct ipc_router_mhi_dev_xprt_config { enum mhi_client_channel out_chan_id; enum mhi_client_channel in_chan_id; char xprt_name[XPRT_NAME_LEN]; uint32_t link_id; uint32_t xprt_version; uint32_t xprt_option; }; static struct ipc_router_mhi_dev_xprt *mhi_xprtp; /* * ipc_router_mhi_dev_release_pkt() - Release a cloned IPC Router packet * @ref: Reference to the kref object in the IPC Router packet. */ static void ipc_router_mhi_dev_release_pkt(struct kref *ref) { struct rr_packet *pkt = container_of(ref, struct rr_packet, ref); release_pkt(pkt); } /** * ipc_router_mhi_dev_set_xprt_version() - Set the IPC Router version in transport * @xprt: Reference to the transport structure. * @version: The version to be set in transport. */ static void ipc_router_mhi_dev_set_xprt_version( struct msm_ipc_router_xprt *xprt, unsigned version) { struct ipc_router_mhi_dev_xprt *mhi_xprtp; if (!xprt) return; mhi_xprtp = container_of(xprt, struct ipc_router_mhi_dev_xprt, xprt); mhi_xprtp->xprt_version = version; } /** * ipc_router_mhi_dev_get_xprt_version() - Get IPC Router header version * supported by the XPRT * @xprt: XPRT for which the version information is required. * * @return: IPC Router header version supported by the XPRT. */ static int ipc_router_mhi_dev_get_xprt_version(struct msm_ipc_router_xprt *xprt) { struct ipc_router_mhi_dev_xprt *mhi_xprtp; if (!xprt) return -EINVAL; mhi_xprtp = container_of(xprt, struct ipc_router_mhi_dev_xprt, xprt); return (int)mhi_xprtp->xprt_version; } /** * ipc_router_mhi_dev_get_xprt_option() - Get XPRT options * @xprt: XPRT for which the option information is required. * * @return: Options supported by the XPRT. */ static int ipc_router_mhi_dev_get_xprt_option(struct msm_ipc_router_xprt *xprt) { struct ipc_router_mhi_dev_xprt *mhi_xprtp; if (!xprt) return -EINVAL; mhi_xprtp = container_of(xprt, struct ipc_router_mhi_dev_xprt, xprt); return (int)mhi_xprtp->xprt_option; } static void mhi_xprt_event_notifier(struct mhi_dev_client_cb_reason *reason) { if (reason->reason == MHI_DEV_TRE_AVAILABLE) { if (reason->ch_id == mhi_xprtp->ch_hndl.in_chan_id) wake_up(&mhi_xprtp->write_wait_q); else if (reason->ch_id == mhi_xprtp->ch_hndl.out_chan_id) queue_work(mhi_xprtp->wq, &mhi_xprtp->read_work); } } /* * mhi_xprt_read_data() - Read data from the XPRT */ static void mhi_xprt_read_data(struct work_struct *work) { struct sk_buff *skb; uint32_t buf_size = mhi_xprtp->ch_hndl.max_packet_size; struct mhi_req mreq = {0}; size_t data_sz; struct ipc_router_mhi_dev_xprt *mhi_xprtp = container_of(work, struct ipc_router_mhi_dev_xprt, read_work); while (1) { /* Create a new rr_packet, if first fragment */ if (!mhi_xprtp->bytes_to_rx) { mhi_xprtp->in_pkt = create_pkt(NULL); if (!mhi_xprtp->in_pkt) { IPC_RTR_ERR("%s: Couldn't alloc rr_packet\n", __func__); return; } D("%s: Allocated rr_packet\n", __func__); } skb = alloc_skb(buf_size, GFP_KERNEL); if (!skb) { IPC_RTR_ERR("%s: Could not allocate SKB\n", __func__); return; } mreq.client = mhi_xprtp->ch_hndl.out_handle; mreq.buf = skb->data; mreq.len = buf_size; mreq.chan = mhi_xprtp->ch_hndl.out_chan_id; mreq.mode = IPA_DMA_SYNC; data_sz = mhi_dev_read_channel(&mreq); if (data_sz < 0) { IPC_RTR_ERR("%s: Failed to queue TRB into MHI\n", __func__); kfree_skb(skb); release_pkt(mhi_xprtp->in_pkt); return; } else if (!data_sz) { kfree_skb(skb); break; } if (!mhi_xprtp->bytes_to_rx) { mhi_xprtp->bytes_to_rx = ipc_router_peek_pkt_size(skb->data) - data_sz; } else { mhi_xprtp->bytes_to_rx -= data_sz; } skb_put(skb, data_sz); mhi_xprtp->in_pkt->length += data_sz; skb_queue_tail(mhi_xprtp->in_pkt->pkt_fragment_q, skb); if (!mhi_xprtp->bytes_to_rx) { D("%s: Packet size read %d\n", __func__, mhi_xprtp->in_pkt->length); msm_ipc_router_xprt_notify(&mhi_xprtp->xprt, IPC_ROUTER_XPRT_EVENT_DATA, (void *)mhi_xprtp->in_pkt); release_pkt(mhi_xprtp->in_pkt); mhi_xprtp->in_pkt = NULL; } } } /** * ipc_router_mhi_dev_write_skb() - Write a single SKB onto the XPRT * @mhi_xprtp: XPRT in which the SKB has to be written. * @skb: SKB to be written. * * @return: return number of bytes written on success, * standard Linux error codes on failure. */ static int ipc_router_mhi_dev_write_skb( struct ipc_router_mhi_dev_xprt *mhi_xprtp, struct sk_buff *skb, struct rr_packet *pkt) { size_t sz_to_write = 0; size_t offset = 0; int rc; struct mhi_req wreq = {0}; while (offset < skb->len) { wait_event(mhi_xprtp->write_wait_q, !mhi_dev_channel_isempty( mhi_xprtp->ch_hndl.in_handle) || !mhi_xprtp->ch_hndl.in_chan_enabled); mutex_lock(&mhi_xprtp->ch_hndl.state_lock); if (!mhi_xprtp->ch_hndl.in_chan_enabled) { mutex_unlock(&mhi_xprtp->ch_hndl.state_lock); IPC_RTR_ERR("%s: %s chnl reset\n", __func__, mhi_xprtp->xprt_name); return -ENETRESET; } sz_to_write = min((size_t)(skb->len - offset), (size_t)IPC_ROUTER_MHI_XPRT_MAX_PKT_SIZE); wreq.client = mhi_xprtp->ch_hndl.in_handle; wreq.buf = skb->data + offset; wreq.len = sz_to_write; wreq.chan = mhi_xprtp->ch_hndl.in_chan_id; wreq.mode = IPA_DMA_SYNC; rc = mhi_dev_write_channel(&wreq); if (rc <= 0) { mutex_unlock(&mhi_xprtp->ch_hndl.state_lock); IPC_RTR_ERR("%s: Error queueing mhi_xfer 0x%zx\n", __func__, sz_to_write); return -EFAULT; } offset += sz_to_write; mutex_unlock(&mhi_xprtp->ch_hndl.state_lock); } return skb->len; } /** * ipc_router_mhi_dev_write() - Write to XPRT * @data: Data to be written to the XPRT. * @len: Length of the data to be written. * @xprt: XPRT to which the data has to be written. * * @return: Data Length on success, standard Linux error codes on failure. */ static int ipc_router_mhi_dev_write(void *data, uint32_t len, struct msm_ipc_router_xprt *xprt) { struct rr_packet *pkt = (struct rr_packet *)data; struct sk_buff *ipc_rtr_pkt; struct rr_packet *cloned_pkt; int rc = 0; struct ipc_router_mhi_dev_xprt *mhi_xprtp = container_of(xprt, struct ipc_router_mhi_dev_xprt, xprt); if (!pkt) return -EINVAL; if (!len || pkt->length != len) return -EINVAL; cloned_pkt = clone_pkt(pkt); if (!cloned_pkt) { pr_err("%s: Error in cloning packet while tx\n", __func__); return -ENOMEM; } D("%s: Ready to write %d bytes\n", __func__, len); skb_queue_walk(cloned_pkt->pkt_fragment_q, ipc_rtr_pkt) { rc = ipc_router_mhi_dev_write_skb(mhi_xprtp, ipc_rtr_pkt, cloned_pkt); if (rc < 0) { IPC_RTR_ERR("%s: Error writing SKB %d\n", __func__, rc); break; } } kref_put(&cloned_pkt->ref, ipc_router_mhi_dev_release_pkt); if (rc < 0) return rc; else return len; } /** * ipc_router_mhi_dev_close() - Close the XPRT * @xprt: XPRT which needs to be closed. * * @return: 0 on success, standard Linux error codes on failure. */ static int ipc_router_mhi_dev_close(struct msm_ipc_router_xprt *xprt) { struct ipc_router_mhi_dev_xprt *mhi_xprtp; if (!xprt) return -EINVAL; mhi_xprtp = container_of(xprt, struct ipc_router_mhi_dev_xprt, xprt); mutex_lock(&mhi_xprtp->ch_hndl.state_lock); mhi_xprtp->ch_hndl.out_chan_enabled = false; mhi_xprtp->ch_hndl.in_chan_enabled = false; mutex_unlock(&mhi_xprtp->ch_hndl.state_lock); flush_workqueue(mhi_xprtp->wq); return 0; } /** * ipc_router_mhi_dev_driver_register() - register for MHI channels * * @mhi_xprtp: pointer to IPC router mhi xprt structure. * * @return: 0 on success, standard Linux error codes on error. * * This function is called when a new XPRT is added and the MHI * channel is ready. */ static int ipc_router_mhi_dev_driver_register( struct ipc_router_mhi_dev_xprt *mhi_xprtp) { int rc; rc = mhi_dev_open_channel(mhi_xprtp->ch_hndl.out_chan_id, &mhi_xprtp->ch_hndl.out_handle, mhi_xprt_event_notifier); if (rc) { IPC_RTR_ERR("%s Failed to open chan 0x%x, rc %d\n", __func__, mhi_xprtp->ch_hndl.out_chan_id, rc); goto exit; } mutex_lock(&mhi_xprtp->ch_hndl.state_lock); mhi_xprtp->ch_hndl.out_chan_enabled = true; mutex_unlock(&mhi_xprtp->ch_hndl.state_lock); rc = mhi_dev_open_channel(mhi_xprtp->ch_hndl.in_chan_id, &mhi_xprtp->ch_hndl.in_handle, mhi_xprt_event_notifier); if (rc) { IPC_RTR_ERR("%s Failed to open chan 0x%x, rc %d\n", __func__, mhi_xprtp->ch_hndl.in_chan_id, rc); goto exit; } mutex_lock(&mhi_xprtp->ch_hndl.state_lock); mhi_xprtp->ch_hndl.in_chan_enabled = true; mutex_unlock(&mhi_xprtp->ch_hndl.state_lock); /* Register the XPRT before receiving any data */ msm_ipc_router_xprt_notify(&mhi_xprtp->xprt, IPC_ROUTER_XPRT_EVENT_OPEN, NULL); D("%s: Notified IPC Router of %s OPEN\n", __func__, mhi_xprtp->xprt.name); exit: return rc; } /** * mhi_xprt_enable_cb() - Enable the MHI link for communication */ static void mhi_dev_xprt_state_cb(struct mhi_dev_client_cb_data *cb_data) { int rc; struct ipc_router_mhi_dev_xprt *mhi_xprtp = (struct ipc_router_mhi_dev_xprt *)cb_data->user_data; /* Channel already enabled */ if (mhi_xprtp->ch_hndl.in_chan_enabled) return; rc = ipc_router_mhi_dev_driver_register(mhi_xprtp); if (rc) IPC_RTR_ERR("%s: Failed to regiter for MHI channels\n", __func__); } /** * ipc_router_mhi_dev_config_init() - init MHI xprt configs * * @mhi_xprt_config: pointer to MHI xprt configurations. * * @return: 0 on success, standard Linux error codes on error. * * This function is called to initialize the MHI XPRT pointer with * the MHI XPRT configurations from device tree. */ static int ipc_router_mhi_dev_config_init( struct ipc_router_mhi_dev_xprt_config *mhi_xprt_config, struct device *dev) { char wq_name[XPRT_NAME_LEN]; int rc = 0; mhi_xprtp = devm_kzalloc(dev, sizeof(struct ipc_router_mhi_dev_xprt), GFP_KERNEL); if (IS_ERR_OR_NULL(mhi_xprtp)) { IPC_RTR_ERR("%s: devm_kzalloc() failed for mhi_xprtp:%s\n", __func__, mhi_xprt_config->xprt_name); return -ENOMEM; } scnprintf(wq_name, XPRT_NAME_LEN, "MHI_DEV_XPRT%x:%x", mhi_xprt_config->out_chan_id, mhi_xprt_config->in_chan_id); mhi_xprtp->wq = create_singlethread_workqueue(wq_name); if (!mhi_xprtp->wq) { IPC_RTR_ERR("%s: %s create WQ failed\n", __func__, mhi_xprt_config->xprt_name); kfree(mhi_xprtp); return -EFAULT; } INIT_WORK(&mhi_xprtp->read_work, mhi_xprt_read_data); init_waitqueue_head(&mhi_xprtp->write_wait_q); mhi_xprtp->xprt_version = mhi_xprt_config->xprt_version; mhi_xprtp->xprt_option = mhi_xprt_config->xprt_option; strlcpy(mhi_xprtp->xprt_name, mhi_xprt_config->xprt_name, XPRT_NAME_LEN); /* Initialize XPRT operations and parameters registered with IPC RTR */ mhi_xprtp->xprt.link_id = mhi_xprt_config->link_id; mhi_xprtp->xprt.name = mhi_xprtp->xprt_name; mhi_xprtp->xprt.get_version = ipc_router_mhi_dev_get_xprt_version; mhi_xprtp->xprt.set_version = ipc_router_mhi_dev_set_xprt_version; mhi_xprtp->xprt.get_option = ipc_router_mhi_dev_get_xprt_option; mhi_xprtp->xprt.read_avail = NULL; mhi_xprtp->xprt.read = NULL; mhi_xprtp->xprt.write_avail = NULL; mhi_xprtp->xprt.write = ipc_router_mhi_dev_write; mhi_xprtp->xprt.close = ipc_router_mhi_dev_close; mhi_xprtp->xprt.sft_close_done = NULL; mhi_xprtp->xprt.priv = NULL; /* Initialize channel handle parameters */ mhi_xprtp->ch_hndl.out_chan_id = mhi_xprt_config->out_chan_id; mhi_xprtp->ch_hndl.in_chan_id = mhi_xprt_config->in_chan_id; mutex_init(&mhi_xprtp->ch_hndl.state_lock); skb_queue_head_init(&mhi_xprtp->ch_hndl.in_skbq); mhi_xprtp->ch_hndl.max_packet_size = IPC_ROUTER_MHI_XPRT_MAX_PKT_SIZE; mhi_xprtp->ch_hndl.mhi_xprtp = mhi_xprtp; /* Register callback to mhi_dev */ rc = mhi_register_state_cb(mhi_dev_xprt_state_cb, mhi_xprtp, mhi_xprtp->ch_hndl.in_chan_id); if (rc == -EEXIST) { rc = ipc_router_mhi_dev_driver_register(mhi_xprtp); if (rc) IPC_RTR_ERR("%s: Failed to regiter for MHI channels\n", __func__); } return rc; } /** * parse_devicetree() - parse device tree binding * * @node: pointer to device tree node * @mhi_xprt_config: pointer to MHI XPRT configurations * * @return: 0 on success, -ENODEV on failure. */ static int parse_devicetree(struct device_node *node, struct ipc_router_mhi_dev_xprt_config *mhi_xprt_config) { int rc; uint32_t out_chan_id; uint32_t in_chan_id; const char *remote_ss; uint32_t link_id; uint32_t version; char *key; key = "qcom,out-chan-id"; rc = of_property_read_u32(node, key, &out_chan_id); if (rc) goto error; mhi_xprt_config->out_chan_id = out_chan_id; key = "qcom,in-chan-id"; rc = of_property_read_u32(node, key, &in_chan_id); if (rc) goto error; mhi_xprt_config->in_chan_id = in_chan_id; key = "qcom,xprt-remote"; remote_ss = of_get_property(node, key, NULL); if (!remote_ss) goto error; key = "qcom,xprt-linkid"; rc = of_property_read_u32(node, key, &link_id); if (rc) goto error; mhi_xprt_config->link_id = link_id; key = "qcom,xprt-version"; rc = of_property_read_u32(node, key, &version); if (rc) goto error; mhi_xprt_config->xprt_version = version; mhi_xprt_config->xprt_option = 0; scnprintf(mhi_xprt_config->xprt_name, XPRT_NAME_LEN, "%s_IPCRTR", remote_ss); return 0; error: IPC_RTR_ERR("%s: missing key: %s\n", __func__, key); return -ENODEV; } /** * ipc_router_mhi_dev_xprt_probe() - Probe an MHI xprt * @pdev: Platform device corresponding to MHI xprt. * * @return: 0 on success, standard Linux error codes on error. * * This function is called when the underlying device tree driver registers * a platform device, mapped to an MHI transport. */ static int ipc_router_mhi_dev_xprt_probe(struct platform_device *pdev) { int rc = 0; struct ipc_router_mhi_dev_xprt_config mhi_xprt_config; if (pdev && pdev->dev.of_node) { rc = parse_devicetree(pdev->dev.of_node, &mhi_xprt_config); if (rc) { IPC_RTR_ERR("%s: failed to parse device tree\n", __func__); return rc; } rc = ipc_router_mhi_dev_config_init(&mhi_xprt_config, &pdev->dev); if (rc) { if (rc == -ENXIO) return -EPROBE_DEFER; IPC_RTR_ERR("%s: init failed\n", __func__); return rc; } } return rc; } static struct of_device_id ipc_router_mhi_dev_xprt_match_table[] = { { .compatible = "qcom,ipc-router-mhi-dev-xprt" }, {}, }; static struct platform_driver ipc_router_mhi_dev_xprt_driver = { .probe = ipc_router_mhi_dev_xprt_probe, .driver = { .name = MODULE_NAME, .owner = THIS_MODULE, .of_match_table = ipc_router_mhi_dev_xprt_match_table, }, }; static int __init ipc_router_mhi_dev_xprt_init(void) { int rc; rc = platform_driver_register(&ipc_router_mhi_dev_xprt_driver); if (rc) { IPC_RTR_ERR( "%s: ipc_router_mhi_dev_xprt_driver reg. failed %d\n", __func__, rc); return rc; } return 0; } module_init(ipc_router_mhi_dev_xprt_init); MODULE_DESCRIPTION("IPC Router MHI_DEV XPRT"); MODULE_LICENSE("GPL v2"); Loading
Documentation/devicetree/bindings/arm/msm/msm_ipc_router_mhi_dev_xprt.txt 0 → 100644 +21 −0 Original line number Diff line number Diff line Qualcomm Technologies, Inc. IPC Router MHI_DEV Transport Required properties: -compatible: should be "qcom,ipc-router-mhi-dev-xprt". -qcom,out-chan-id: MHI Channel ID for the transmit path. -qcom,in-chan-id: MHI Channel ID for the receive path. -qcom,xprt-remote: string that defines the edge of the transport. -qcom,xprt-linkid: unique integer to identify the tier to which the link belongs to in the network and is used to avoid the routing loops while forwarding the broadcast messages. -qcom,xprt-version: unique version ID used by MHI transport header. Example: qcom,ipc_router_external_ap_xprt { compatible = "qcom,ipc-router-mhi-dev-xprt"; qcom,out-chan-id = <34>; qcom,in-chan-id = <35>; qcom,xprt-remote = "external-ap"; qcom,xprt-linkid = <2>; qcom,xprt-version = <1>; };
drivers/soc/qcom/Kconfig +10 −0 Original line number Diff line number Diff line Loading @@ -660,6 +660,16 @@ config MSM_IPC_ROUTER_MHI_XPRT registers the transport with IPC Router and enable message exchange. config MSM_IPC_ROUTER_MHI_DEV_XPRT depends on MSM_MHI_DEV depends on IPC_ROUTER bool "MSM MHI_DEV XPRT Layer" help MHI_DEV Transport Layer that enables off-chip communication of IPC Router. When the MHI endpoint becomes available, this layer registers the transport with IPC Router and enables message exchange. config MSM_SYSTEM_HEALTH_MONITOR bool "System Health Monitor" depends on MSM_QMI_INTERFACE && MSM_SUBSYSTEM_RESTART Loading
drivers/soc/qcom/Makefile +1 −0 Original line number Diff line number Diff line Loading @@ -54,6 +54,7 @@ obj-$(CONFIG_MSM_QMI_INTERFACE) += qmi_interface.o obj-$(CONFIG_MSM_IPC_ROUTER_SMD_XPRT) += ipc_router_smd_xprt.o obj-$(CONFIG_MSM_IPC_ROUTER_HSIC_XPRT) += ipc_router_hsic_xprt.o obj-$(CONFIG_MSM_IPC_ROUTER_MHI_XPRT) += ipc_router_mhi_xprt.o obj-$(CONFIG_MSM_IPC_ROUTER_MHI_DEV_XPRT) += ipc_router_mhi_dev_xprt.o obj-$(CONFIG_MSM_IPC_ROUTER_GLINK_XPRT) += ipc_router_glink_xprt.o obj-$(CONFIG_MSM_SYSMON_GLINK_COMM) += sysmon-glink.o sysmon-qmi.o obj-$(CONFIG_MSM_SHARED_HEAP_ACCESS) += shared_memory.o Loading
drivers/soc/qcom/ipc_router_mhi_dev_xprt.c 0 → 100644 +638 −0 Original line number Diff line number Diff line /* Copyright (c) 2013-2018, The Linux Foundation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include <linux/ipc_router_xprt.h> #include <linux/module.h> #include <linux/msm_mhi_dev.h> #include <linux/of.h> #include <linux/platform_device.h> #include <linux/skbuff.h> #include <linux/types.h> static int ipc_router_mhi_dev_xprt_debug_mask; module_param_named(debug_mask, ipc_router_mhi_dev_xprt_debug_mask, int, S_IRUGO | S_IWUSR | S_IWGRP); #define D(x...) do { \ if (ipc_router_mhi_dev_xprt_debug_mask) \ pr_info(x); \ } while (0) #define MODULE_NAME "ipc_router_mhi_dev_xprt" #define XPRT_NAME_LEN 32 #define IPC_ROUTER_MHI_XPRT_MAX_PKT_SIZE 0x1000 /** * ipc_router_mhi_dev_channel - MHI Channel related information * @out_chan_id: Out channel ID for use by IPC ROUTER enumerated in MHI driver. * @out_handle: MHI Output channel handle. * @in_chan_id: In channel ID for use by IPC ROUTER enumerated in MHI driver. * @in_handle: MHI Input channel handle. * @state_lock: Lock to protect access to the state information. * @out_chan_enabled: State of the outgoing channel. * @in_chan_enabled: State of the incoming channel. * @bytes_to_rx: Remaining bytes to be received in a packet. * @in_skbq: Queue containing the input buffers. * @max_packet_size: Possible maximum packet size. * @mhi_xprtp: Pointer to IPC Router MHI XPRT. */ struct ipc_router_mhi_dev_channel { enum mhi_client_channel out_chan_id; struct mhi_dev_client *out_handle; enum mhi_client_channel in_chan_id; struct mhi_dev_client *in_handle; struct mutex state_lock; bool out_chan_enabled; bool in_chan_enabled; int bytes_to_rx; struct sk_buff_head in_skbq; size_t max_packet_size; void *mhi_xprtp; }; /** * ipc_router_mhi_dev_xprt - IPC Router's MHI XPRT structure * @list: IPC router's MHI XPRTs list. * @ch_hndl: Data Structure to hold MHI Channel information. * @xprt_name: Name of the XPRT to be registered with IPC Router. * @xprt: IPC Router XPRT structure to contain MHI XPRT specific info. * @wq: Workqueue to queue read & other XPRT related works. * @read_work: Read Work to perform read operation from MHI Driver. * @in_pkt: Pointer to any partially read packet. * @write_wait_q: Wait Queue to handle the write events. * @xprt_version: IPC Router header version supported by this XPRT. * @xprt_option: XPRT specific options to be handled by IPC Router. */ struct ipc_router_mhi_dev_xprt { struct list_head list; struct ipc_router_mhi_dev_channel ch_hndl; char xprt_name[XPRT_NAME_LEN]; struct msm_ipc_router_xprt xprt; struct workqueue_struct *wq; struct work_struct read_work; struct rr_packet *in_pkt; size_t bytes_to_rx; wait_queue_head_t write_wait_q; unsigned xprt_version; unsigned xprt_option; }; /** * ipc_router_mhi_dev_xprt_config - Config. Info. of each MHI XPRT * @out_chan_id: Out channel ID for use by IPC ROUTER enumerated in MHI driver. * @in_chan_id: In channel ID for use by IPC ROUTER enumerated in MHI driver. * @xprt_name: Name of the XPRT to be registered with IPC Router. * @link_id: Network Cluster ID to which this XPRT belongs to. * @xprt_version: IPC Router header version supported by this XPRT. */ struct ipc_router_mhi_dev_xprt_config { enum mhi_client_channel out_chan_id; enum mhi_client_channel in_chan_id; char xprt_name[XPRT_NAME_LEN]; uint32_t link_id; uint32_t xprt_version; uint32_t xprt_option; }; static struct ipc_router_mhi_dev_xprt *mhi_xprtp; /* * ipc_router_mhi_dev_release_pkt() - Release a cloned IPC Router packet * @ref: Reference to the kref object in the IPC Router packet. */ static void ipc_router_mhi_dev_release_pkt(struct kref *ref) { struct rr_packet *pkt = container_of(ref, struct rr_packet, ref); release_pkt(pkt); } /** * ipc_router_mhi_dev_set_xprt_version() - Set the IPC Router version in transport * @xprt: Reference to the transport structure. * @version: The version to be set in transport. */ static void ipc_router_mhi_dev_set_xprt_version( struct msm_ipc_router_xprt *xprt, unsigned version) { struct ipc_router_mhi_dev_xprt *mhi_xprtp; if (!xprt) return; mhi_xprtp = container_of(xprt, struct ipc_router_mhi_dev_xprt, xprt); mhi_xprtp->xprt_version = version; } /** * ipc_router_mhi_dev_get_xprt_version() - Get IPC Router header version * supported by the XPRT * @xprt: XPRT for which the version information is required. * * @return: IPC Router header version supported by the XPRT. */ static int ipc_router_mhi_dev_get_xprt_version(struct msm_ipc_router_xprt *xprt) { struct ipc_router_mhi_dev_xprt *mhi_xprtp; if (!xprt) return -EINVAL; mhi_xprtp = container_of(xprt, struct ipc_router_mhi_dev_xprt, xprt); return (int)mhi_xprtp->xprt_version; } /** * ipc_router_mhi_dev_get_xprt_option() - Get XPRT options * @xprt: XPRT for which the option information is required. * * @return: Options supported by the XPRT. */ static int ipc_router_mhi_dev_get_xprt_option(struct msm_ipc_router_xprt *xprt) { struct ipc_router_mhi_dev_xprt *mhi_xprtp; if (!xprt) return -EINVAL; mhi_xprtp = container_of(xprt, struct ipc_router_mhi_dev_xprt, xprt); return (int)mhi_xprtp->xprt_option; } static void mhi_xprt_event_notifier(struct mhi_dev_client_cb_reason *reason) { if (reason->reason == MHI_DEV_TRE_AVAILABLE) { if (reason->ch_id == mhi_xprtp->ch_hndl.in_chan_id) wake_up(&mhi_xprtp->write_wait_q); else if (reason->ch_id == mhi_xprtp->ch_hndl.out_chan_id) queue_work(mhi_xprtp->wq, &mhi_xprtp->read_work); } } /* * mhi_xprt_read_data() - Read data from the XPRT */ static void mhi_xprt_read_data(struct work_struct *work) { struct sk_buff *skb; uint32_t buf_size = mhi_xprtp->ch_hndl.max_packet_size; struct mhi_req mreq = {0}; size_t data_sz; struct ipc_router_mhi_dev_xprt *mhi_xprtp = container_of(work, struct ipc_router_mhi_dev_xprt, read_work); while (1) { /* Create a new rr_packet, if first fragment */ if (!mhi_xprtp->bytes_to_rx) { mhi_xprtp->in_pkt = create_pkt(NULL); if (!mhi_xprtp->in_pkt) { IPC_RTR_ERR("%s: Couldn't alloc rr_packet\n", __func__); return; } D("%s: Allocated rr_packet\n", __func__); } skb = alloc_skb(buf_size, GFP_KERNEL); if (!skb) { IPC_RTR_ERR("%s: Could not allocate SKB\n", __func__); return; } mreq.client = mhi_xprtp->ch_hndl.out_handle; mreq.buf = skb->data; mreq.len = buf_size; mreq.chan = mhi_xprtp->ch_hndl.out_chan_id; mreq.mode = IPA_DMA_SYNC; data_sz = mhi_dev_read_channel(&mreq); if (data_sz < 0) { IPC_RTR_ERR("%s: Failed to queue TRB into MHI\n", __func__); kfree_skb(skb); release_pkt(mhi_xprtp->in_pkt); return; } else if (!data_sz) { kfree_skb(skb); break; } if (!mhi_xprtp->bytes_to_rx) { mhi_xprtp->bytes_to_rx = ipc_router_peek_pkt_size(skb->data) - data_sz; } else { mhi_xprtp->bytes_to_rx -= data_sz; } skb_put(skb, data_sz); mhi_xprtp->in_pkt->length += data_sz; skb_queue_tail(mhi_xprtp->in_pkt->pkt_fragment_q, skb); if (!mhi_xprtp->bytes_to_rx) { D("%s: Packet size read %d\n", __func__, mhi_xprtp->in_pkt->length); msm_ipc_router_xprt_notify(&mhi_xprtp->xprt, IPC_ROUTER_XPRT_EVENT_DATA, (void *)mhi_xprtp->in_pkt); release_pkt(mhi_xprtp->in_pkt); mhi_xprtp->in_pkt = NULL; } } } /** * ipc_router_mhi_dev_write_skb() - Write a single SKB onto the XPRT * @mhi_xprtp: XPRT in which the SKB has to be written. * @skb: SKB to be written. * * @return: return number of bytes written on success, * standard Linux error codes on failure. */ static int ipc_router_mhi_dev_write_skb( struct ipc_router_mhi_dev_xprt *mhi_xprtp, struct sk_buff *skb, struct rr_packet *pkt) { size_t sz_to_write = 0; size_t offset = 0; int rc; struct mhi_req wreq = {0}; while (offset < skb->len) { wait_event(mhi_xprtp->write_wait_q, !mhi_dev_channel_isempty( mhi_xprtp->ch_hndl.in_handle) || !mhi_xprtp->ch_hndl.in_chan_enabled); mutex_lock(&mhi_xprtp->ch_hndl.state_lock); if (!mhi_xprtp->ch_hndl.in_chan_enabled) { mutex_unlock(&mhi_xprtp->ch_hndl.state_lock); IPC_RTR_ERR("%s: %s chnl reset\n", __func__, mhi_xprtp->xprt_name); return -ENETRESET; } sz_to_write = min((size_t)(skb->len - offset), (size_t)IPC_ROUTER_MHI_XPRT_MAX_PKT_SIZE); wreq.client = mhi_xprtp->ch_hndl.in_handle; wreq.buf = skb->data + offset; wreq.len = sz_to_write; wreq.chan = mhi_xprtp->ch_hndl.in_chan_id; wreq.mode = IPA_DMA_SYNC; rc = mhi_dev_write_channel(&wreq); if (rc <= 0) { mutex_unlock(&mhi_xprtp->ch_hndl.state_lock); IPC_RTR_ERR("%s: Error queueing mhi_xfer 0x%zx\n", __func__, sz_to_write); return -EFAULT; } offset += sz_to_write; mutex_unlock(&mhi_xprtp->ch_hndl.state_lock); } return skb->len; } /** * ipc_router_mhi_dev_write() - Write to XPRT * @data: Data to be written to the XPRT. * @len: Length of the data to be written. * @xprt: XPRT to which the data has to be written. * * @return: Data Length on success, standard Linux error codes on failure. */ static int ipc_router_mhi_dev_write(void *data, uint32_t len, struct msm_ipc_router_xprt *xprt) { struct rr_packet *pkt = (struct rr_packet *)data; struct sk_buff *ipc_rtr_pkt; struct rr_packet *cloned_pkt; int rc = 0; struct ipc_router_mhi_dev_xprt *mhi_xprtp = container_of(xprt, struct ipc_router_mhi_dev_xprt, xprt); if (!pkt) return -EINVAL; if (!len || pkt->length != len) return -EINVAL; cloned_pkt = clone_pkt(pkt); if (!cloned_pkt) { pr_err("%s: Error in cloning packet while tx\n", __func__); return -ENOMEM; } D("%s: Ready to write %d bytes\n", __func__, len); skb_queue_walk(cloned_pkt->pkt_fragment_q, ipc_rtr_pkt) { rc = ipc_router_mhi_dev_write_skb(mhi_xprtp, ipc_rtr_pkt, cloned_pkt); if (rc < 0) { IPC_RTR_ERR("%s: Error writing SKB %d\n", __func__, rc); break; } } kref_put(&cloned_pkt->ref, ipc_router_mhi_dev_release_pkt); if (rc < 0) return rc; else return len; } /** * ipc_router_mhi_dev_close() - Close the XPRT * @xprt: XPRT which needs to be closed. * * @return: 0 on success, standard Linux error codes on failure. */ static int ipc_router_mhi_dev_close(struct msm_ipc_router_xprt *xprt) { struct ipc_router_mhi_dev_xprt *mhi_xprtp; if (!xprt) return -EINVAL; mhi_xprtp = container_of(xprt, struct ipc_router_mhi_dev_xprt, xprt); mutex_lock(&mhi_xprtp->ch_hndl.state_lock); mhi_xprtp->ch_hndl.out_chan_enabled = false; mhi_xprtp->ch_hndl.in_chan_enabled = false; mutex_unlock(&mhi_xprtp->ch_hndl.state_lock); flush_workqueue(mhi_xprtp->wq); return 0; } /** * ipc_router_mhi_dev_driver_register() - register for MHI channels * * @mhi_xprtp: pointer to IPC router mhi xprt structure. * * @return: 0 on success, standard Linux error codes on error. * * This function is called when a new XPRT is added and the MHI * channel is ready. */ static int ipc_router_mhi_dev_driver_register( struct ipc_router_mhi_dev_xprt *mhi_xprtp) { int rc; rc = mhi_dev_open_channel(mhi_xprtp->ch_hndl.out_chan_id, &mhi_xprtp->ch_hndl.out_handle, mhi_xprt_event_notifier); if (rc) { IPC_RTR_ERR("%s Failed to open chan 0x%x, rc %d\n", __func__, mhi_xprtp->ch_hndl.out_chan_id, rc); goto exit; } mutex_lock(&mhi_xprtp->ch_hndl.state_lock); mhi_xprtp->ch_hndl.out_chan_enabled = true; mutex_unlock(&mhi_xprtp->ch_hndl.state_lock); rc = mhi_dev_open_channel(mhi_xprtp->ch_hndl.in_chan_id, &mhi_xprtp->ch_hndl.in_handle, mhi_xprt_event_notifier); if (rc) { IPC_RTR_ERR("%s Failed to open chan 0x%x, rc %d\n", __func__, mhi_xprtp->ch_hndl.in_chan_id, rc); goto exit; } mutex_lock(&mhi_xprtp->ch_hndl.state_lock); mhi_xprtp->ch_hndl.in_chan_enabled = true; mutex_unlock(&mhi_xprtp->ch_hndl.state_lock); /* Register the XPRT before receiving any data */ msm_ipc_router_xprt_notify(&mhi_xprtp->xprt, IPC_ROUTER_XPRT_EVENT_OPEN, NULL); D("%s: Notified IPC Router of %s OPEN\n", __func__, mhi_xprtp->xprt.name); exit: return rc; } /** * mhi_xprt_enable_cb() - Enable the MHI link for communication */ static void mhi_dev_xprt_state_cb(struct mhi_dev_client_cb_data *cb_data) { int rc; struct ipc_router_mhi_dev_xprt *mhi_xprtp = (struct ipc_router_mhi_dev_xprt *)cb_data->user_data; /* Channel already enabled */ if (mhi_xprtp->ch_hndl.in_chan_enabled) return; rc = ipc_router_mhi_dev_driver_register(mhi_xprtp); if (rc) IPC_RTR_ERR("%s: Failed to regiter for MHI channels\n", __func__); } /** * ipc_router_mhi_dev_config_init() - init MHI xprt configs * * @mhi_xprt_config: pointer to MHI xprt configurations. * * @return: 0 on success, standard Linux error codes on error. * * This function is called to initialize the MHI XPRT pointer with * the MHI XPRT configurations from device tree. */ static int ipc_router_mhi_dev_config_init( struct ipc_router_mhi_dev_xprt_config *mhi_xprt_config, struct device *dev) { char wq_name[XPRT_NAME_LEN]; int rc = 0; mhi_xprtp = devm_kzalloc(dev, sizeof(struct ipc_router_mhi_dev_xprt), GFP_KERNEL); if (IS_ERR_OR_NULL(mhi_xprtp)) { IPC_RTR_ERR("%s: devm_kzalloc() failed for mhi_xprtp:%s\n", __func__, mhi_xprt_config->xprt_name); return -ENOMEM; } scnprintf(wq_name, XPRT_NAME_LEN, "MHI_DEV_XPRT%x:%x", mhi_xprt_config->out_chan_id, mhi_xprt_config->in_chan_id); mhi_xprtp->wq = create_singlethread_workqueue(wq_name); if (!mhi_xprtp->wq) { IPC_RTR_ERR("%s: %s create WQ failed\n", __func__, mhi_xprt_config->xprt_name); kfree(mhi_xprtp); return -EFAULT; } INIT_WORK(&mhi_xprtp->read_work, mhi_xprt_read_data); init_waitqueue_head(&mhi_xprtp->write_wait_q); mhi_xprtp->xprt_version = mhi_xprt_config->xprt_version; mhi_xprtp->xprt_option = mhi_xprt_config->xprt_option; strlcpy(mhi_xprtp->xprt_name, mhi_xprt_config->xprt_name, XPRT_NAME_LEN); /* Initialize XPRT operations and parameters registered with IPC RTR */ mhi_xprtp->xprt.link_id = mhi_xprt_config->link_id; mhi_xprtp->xprt.name = mhi_xprtp->xprt_name; mhi_xprtp->xprt.get_version = ipc_router_mhi_dev_get_xprt_version; mhi_xprtp->xprt.set_version = ipc_router_mhi_dev_set_xprt_version; mhi_xprtp->xprt.get_option = ipc_router_mhi_dev_get_xprt_option; mhi_xprtp->xprt.read_avail = NULL; mhi_xprtp->xprt.read = NULL; mhi_xprtp->xprt.write_avail = NULL; mhi_xprtp->xprt.write = ipc_router_mhi_dev_write; mhi_xprtp->xprt.close = ipc_router_mhi_dev_close; mhi_xprtp->xprt.sft_close_done = NULL; mhi_xprtp->xprt.priv = NULL; /* Initialize channel handle parameters */ mhi_xprtp->ch_hndl.out_chan_id = mhi_xprt_config->out_chan_id; mhi_xprtp->ch_hndl.in_chan_id = mhi_xprt_config->in_chan_id; mutex_init(&mhi_xprtp->ch_hndl.state_lock); skb_queue_head_init(&mhi_xprtp->ch_hndl.in_skbq); mhi_xprtp->ch_hndl.max_packet_size = IPC_ROUTER_MHI_XPRT_MAX_PKT_SIZE; mhi_xprtp->ch_hndl.mhi_xprtp = mhi_xprtp; /* Register callback to mhi_dev */ rc = mhi_register_state_cb(mhi_dev_xprt_state_cb, mhi_xprtp, mhi_xprtp->ch_hndl.in_chan_id); if (rc == -EEXIST) { rc = ipc_router_mhi_dev_driver_register(mhi_xprtp); if (rc) IPC_RTR_ERR("%s: Failed to regiter for MHI channels\n", __func__); } return rc; } /** * parse_devicetree() - parse device tree binding * * @node: pointer to device tree node * @mhi_xprt_config: pointer to MHI XPRT configurations * * @return: 0 on success, -ENODEV on failure. */ static int parse_devicetree(struct device_node *node, struct ipc_router_mhi_dev_xprt_config *mhi_xprt_config) { int rc; uint32_t out_chan_id; uint32_t in_chan_id; const char *remote_ss; uint32_t link_id; uint32_t version; char *key; key = "qcom,out-chan-id"; rc = of_property_read_u32(node, key, &out_chan_id); if (rc) goto error; mhi_xprt_config->out_chan_id = out_chan_id; key = "qcom,in-chan-id"; rc = of_property_read_u32(node, key, &in_chan_id); if (rc) goto error; mhi_xprt_config->in_chan_id = in_chan_id; key = "qcom,xprt-remote"; remote_ss = of_get_property(node, key, NULL); if (!remote_ss) goto error; key = "qcom,xprt-linkid"; rc = of_property_read_u32(node, key, &link_id); if (rc) goto error; mhi_xprt_config->link_id = link_id; key = "qcom,xprt-version"; rc = of_property_read_u32(node, key, &version); if (rc) goto error; mhi_xprt_config->xprt_version = version; mhi_xprt_config->xprt_option = 0; scnprintf(mhi_xprt_config->xprt_name, XPRT_NAME_LEN, "%s_IPCRTR", remote_ss); return 0; error: IPC_RTR_ERR("%s: missing key: %s\n", __func__, key); return -ENODEV; } /** * ipc_router_mhi_dev_xprt_probe() - Probe an MHI xprt * @pdev: Platform device corresponding to MHI xprt. * * @return: 0 on success, standard Linux error codes on error. * * This function is called when the underlying device tree driver registers * a platform device, mapped to an MHI transport. */ static int ipc_router_mhi_dev_xprt_probe(struct platform_device *pdev) { int rc = 0; struct ipc_router_mhi_dev_xprt_config mhi_xprt_config; if (pdev && pdev->dev.of_node) { rc = parse_devicetree(pdev->dev.of_node, &mhi_xprt_config); if (rc) { IPC_RTR_ERR("%s: failed to parse device tree\n", __func__); return rc; } rc = ipc_router_mhi_dev_config_init(&mhi_xprt_config, &pdev->dev); if (rc) { if (rc == -ENXIO) return -EPROBE_DEFER; IPC_RTR_ERR("%s: init failed\n", __func__); return rc; } } return rc; } static struct of_device_id ipc_router_mhi_dev_xprt_match_table[] = { { .compatible = "qcom,ipc-router-mhi-dev-xprt" }, {}, }; static struct platform_driver ipc_router_mhi_dev_xprt_driver = { .probe = ipc_router_mhi_dev_xprt_probe, .driver = { .name = MODULE_NAME, .owner = THIS_MODULE, .of_match_table = ipc_router_mhi_dev_xprt_match_table, }, }; static int __init ipc_router_mhi_dev_xprt_init(void) { int rc; rc = platform_driver_register(&ipc_router_mhi_dev_xprt_driver); if (rc) { IPC_RTR_ERR( "%s: ipc_router_mhi_dev_xprt_driver reg. failed %d\n", __func__, rc); return rc; } return 0; } module_init(ipc_router_mhi_dev_xprt_init); MODULE_DESCRIPTION("IPC Router MHI_DEV XPRT"); MODULE_LICENSE("GPL v2");
