^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright (c) 2016, Linaro Ltd.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Copyright (c) 2015, Sony Mobile Communications Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) #include <linux/firmware.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/of_platform.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/rpmsg.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/soc/qcom/wcnss_ctrl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #define WCNSS_REQUEST_TIMEOUT (5 * HZ)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #define WCNSS_CBC_TIMEOUT (10 * HZ)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #define WCNSS_ACK_DONE_BOOTING 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #define WCNSS_ACK_COLD_BOOTING 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #define NV_FRAGMENT_SIZE 3072
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #define NVBIN_FILE "wlan/prima/WCNSS_qcom_wlan_nv.bin"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) * struct wcnss_ctrl - driver context
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) * @dev: device handle
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) * @channel: SMD channel handle
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) * @ack: completion for outstanding requests
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) * @cbc: completion for cbc complete indication
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) * @ack_status: status of the outstanding request
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) * @probe_work: worker for uploading nv binary
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) struct wcnss_ctrl {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) struct device *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) struct rpmsg_endpoint *channel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) struct completion ack;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) struct completion cbc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) int ack_status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) struct work_struct probe_work;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) /* message types */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) enum {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) WCNSS_VERSION_REQ = 0x01000000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) WCNSS_VERSION_RESP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) WCNSS_DOWNLOAD_NV_REQ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) WCNSS_DOWNLOAD_NV_RESP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) WCNSS_UPLOAD_CAL_REQ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) WCNSS_UPLOAD_CAL_RESP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) WCNSS_DOWNLOAD_CAL_REQ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) WCNSS_DOWNLOAD_CAL_RESP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) WCNSS_VBAT_LEVEL_IND,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) WCNSS_BUILD_VERSION_REQ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) WCNSS_BUILD_VERSION_RESP,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) WCNSS_PM_CONFIG_REQ,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) WCNSS_CBC_COMPLETE_IND,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) * struct wcnss_msg_hdr - common packet header for requests and responses
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) * @type: packet message type
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) * @len: total length of the packet, including this header
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) struct wcnss_msg_hdr {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) u32 type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) u32 len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) * struct wcnss_version_resp - version request response
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) * @hdr: common packet wcnss_msg_hdr header
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) struct wcnss_version_resp {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) struct wcnss_msg_hdr hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) u8 major;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) u8 minor;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) u8 version;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) u8 revision;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) * struct wcnss_download_nv_req - firmware fragment request
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) * @hdr: common packet wcnss_msg_hdr header
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) * @seq: sequence number of this fragment
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) * @last: boolean indicator of this being the last fragment of the binary
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) * @frag_size: length of this fragment
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) * @fragment: fragment data
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) struct wcnss_download_nv_req {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) struct wcnss_msg_hdr hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) u16 seq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) u16 last;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) u32 frag_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) u8 fragment[];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) * struct wcnss_download_nv_resp - firmware download response
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) * @hdr: common packet wcnss_msg_hdr header
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) * @status: boolean to indicate success of the download
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) struct wcnss_download_nv_resp {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) struct wcnss_msg_hdr hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) u8 status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) * wcnss_ctrl_smd_callback() - handler from SMD responses
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) * @channel: smd channel handle
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) * @data: pointer to the incoming data packet
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) * @count: size of the incoming data packet
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) * Handles any incoming packets from the remote WCNSS_CTRL service.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) static int wcnss_ctrl_smd_callback(struct rpmsg_device *rpdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) void *data,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) int count,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) void *priv,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) u32 addr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) struct wcnss_ctrl *wcnss = dev_get_drvdata(&rpdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) const struct wcnss_download_nv_resp *nvresp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) const struct wcnss_version_resp *version;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) const struct wcnss_msg_hdr *hdr = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) switch (hdr->type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) case WCNSS_VERSION_RESP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) if (count != sizeof(*version)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) dev_err(wcnss->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) "invalid size of version response\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) version = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) dev_info(wcnss->dev, "WCNSS Version %d.%d %d.%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) version->major, version->minor,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) version->version, version->revision);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) complete(&wcnss->ack);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) case WCNSS_DOWNLOAD_NV_RESP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) if (count != sizeof(*nvresp)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) dev_err(wcnss->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) "invalid size of download response\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) nvresp = data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) wcnss->ack_status = nvresp->status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) complete(&wcnss->ack);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) case WCNSS_CBC_COMPLETE_IND:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) dev_dbg(wcnss->dev, "cold boot complete\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) complete(&wcnss->cbc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) dev_info(wcnss->dev, "unknown message type %d\n", hdr->type);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) * wcnss_request_version() - send a version request to WCNSS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) * @wcnss: wcnss ctrl driver context
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) static int wcnss_request_version(struct wcnss_ctrl *wcnss)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) struct wcnss_msg_hdr msg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) msg.type = WCNSS_VERSION_REQ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) msg.len = sizeof(msg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) ret = rpmsg_send(wcnss->channel, &msg, sizeof(msg));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) ret = wait_for_completion_timeout(&wcnss->ack, WCNSS_CBC_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) if (!ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) dev_err(wcnss->dev, "timeout waiting for version response\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) return -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) * wcnss_download_nv() - send nv binary to WCNSS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) * @wcnss: wcnss_ctrl state handle
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) * @expect_cbc: indicator to caller that an cbc event is expected
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) * Returns 0 on success. Negative errno on failure.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) static int wcnss_download_nv(struct wcnss_ctrl *wcnss, bool *expect_cbc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) struct wcnss_download_nv_req *req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) const struct firmware *fw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) const void *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) ssize_t left;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) req = kzalloc(sizeof(*req) + NV_FRAGMENT_SIZE, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) if (!req)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) ret = request_firmware(&fw, NVBIN_FILE, wcnss->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) dev_err(wcnss->dev, "Failed to load nv file %s: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) NVBIN_FILE, ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) goto free_req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) data = fw->data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) left = fw->size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) req->hdr.type = WCNSS_DOWNLOAD_NV_REQ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) req->hdr.len = sizeof(*req) + NV_FRAGMENT_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) req->last = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) req->frag_size = NV_FRAGMENT_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) req->seq = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) if (left <= NV_FRAGMENT_SIZE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) req->last = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) req->frag_size = left;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) req->hdr.len = sizeof(*req) + left;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) memcpy(req->fragment, data, req->frag_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) ret = rpmsg_send(wcnss->channel, req, req->hdr.len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) dev_err(wcnss->dev, "failed to send smd packet\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) goto release_fw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) /* Increment for next fragment */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) req->seq++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) data += NV_FRAGMENT_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) left -= NV_FRAGMENT_SIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) } while (left > 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) ret = wait_for_completion_timeout(&wcnss->ack, WCNSS_REQUEST_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) if (!ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) dev_err(wcnss->dev, "timeout waiting for nv upload ack\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) ret = -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) *expect_cbc = wcnss->ack_status == WCNSS_ACK_COLD_BOOTING;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) release_fw:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) release_firmware(fw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) free_req:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) kfree(req);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) /**
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) * qcom_wcnss_open_channel() - open additional SMD channel to WCNSS
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) * @wcnss: wcnss handle, retrieved from drvdata
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) * @name: SMD channel name
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) * @cb: callback to handle incoming data on the channel
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) struct rpmsg_endpoint *qcom_wcnss_open_channel(void *wcnss, const char *name, rpmsg_rx_cb_t cb, void *priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) struct rpmsg_channel_info chinfo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) struct wcnss_ctrl *_wcnss = wcnss;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) strscpy(chinfo.name, name, sizeof(chinfo.name));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) chinfo.src = RPMSG_ADDR_ANY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) chinfo.dst = RPMSG_ADDR_ANY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) return rpmsg_create_ept(_wcnss->channel->rpdev, cb, priv, chinfo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) EXPORT_SYMBOL(qcom_wcnss_open_channel);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) static void wcnss_async_probe(struct work_struct *work)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) struct wcnss_ctrl *wcnss = container_of(work, struct wcnss_ctrl, probe_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) bool expect_cbc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) ret = wcnss_request_version(wcnss);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) ret = wcnss_download_nv(wcnss, &expect_cbc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) /* Wait for pending cold boot completion if indicated by the nv downloader */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) if (expect_cbc) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) ret = wait_for_completion_timeout(&wcnss->cbc, WCNSS_REQUEST_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) if (!ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) dev_err(wcnss->dev, "expected cold boot completion\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) of_platform_populate(wcnss->dev->of_node, NULL, NULL, wcnss->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) static int wcnss_ctrl_probe(struct rpmsg_device *rpdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) struct wcnss_ctrl *wcnss;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) wcnss = devm_kzalloc(&rpdev->dev, sizeof(*wcnss), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) if (!wcnss)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) wcnss->dev = &rpdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) wcnss->channel = rpdev->ept;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) init_completion(&wcnss->ack);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) init_completion(&wcnss->cbc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) INIT_WORK(&wcnss->probe_work, wcnss_async_probe);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) dev_set_drvdata(&rpdev->dev, wcnss);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) schedule_work(&wcnss->probe_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) static void wcnss_ctrl_remove(struct rpmsg_device *rpdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) struct wcnss_ctrl *wcnss = dev_get_drvdata(&rpdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) cancel_work_sync(&wcnss->probe_work);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) of_platform_depopulate(&rpdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) static const struct of_device_id wcnss_ctrl_of_match[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) { .compatible = "qcom,wcnss", },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) {}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) MODULE_DEVICE_TABLE(of, wcnss_ctrl_of_match);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) static struct rpmsg_driver wcnss_ctrl_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) .probe = wcnss_ctrl_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) .remove = wcnss_ctrl_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) .callback = wcnss_ctrl_smd_callback,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) .drv = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) .name = "qcom_wcnss_ctrl",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) .of_match_table = wcnss_ctrl_of_match,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) module_rpmsg_driver(wcnss_ctrl_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) MODULE_DESCRIPTION("Qualcomm WCNSS control driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) MODULE_LICENSE("GPL v2");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags
| Donate