Loading Documentation/devicetree/bindings/thermal/qti-rpmh-reg-cdev.txt 0 → 100644 +44 −0 Original line number Diff line number Diff line RPMh regulator cooling device. The RPMh regulator cooling device, will be used to place a voltage floor restriction on a rail. This cooling device will use a QMP AOP mail box to send the message to apply and clear voltage floor restriction. The cooling device node should be a child of the regulator devicetree node, which it is trying to place the floor restriction. Properties: - compatible: Usage: required Value type: <string> Definition: shall be "qcom,rpmh-reg-cdev" - qcom,reg-resource-name: Usage: required Value type: <string> Definition: The regulator resource name to be used for communicating with RPMh. This value should be any of the below resource name, cx -> For CX rail, mx -> For MX rail, ebi -> For EBI rail. - mboxes: Usage: required Value type: <phandle> Definition: A phandle to the QMP AOP mail box, that needs to be used for sending the floor restriction message. - #cooling-cells: Must be 2. Please refer to <devicetree/bindings/thermal/thermal.txt> for more details. Example: vdd_cx: rpmh-cx-regulator-cdev { compatible = "qcom,rpmh-reg-cdev"; mboxes = <&qmp_aop 0>; qcom,reg-resource-name = "cx"; #cooling-cells = <2>; }; Documentation/devicetree/bindings/thermal/regulator-cdev.txt 0 → 100644 +38 −0 Original line number Diff line number Diff line Regulator cooling device. The regulator cooling device, will be used to place a voltage floor restriction on a rail. Properties: - compatible: Usage: required Value type: <string> Definition: shall be "qcom,regulator-cooling-device" - cdev-supply: Usage: required Value type: <phandle> Definition: phandle to the regulator to which the cooling device will place a floor mitigation. - regulator-levels: Usage: required Value type: <U32 array> Definition: Array of regulator voltages the cooling device should use to place a floor restriction. The voltages should be specified in descending order. - #cooling-cells: Must be 2. Please refer to <devicetree/bindings/thermal/thermal.txt> for more details. Example: mv_cdev: mx-cdev-lvl { compatible = "qcom,regulator-cooling-device"; cdev-supply = <®ulator-cdev-supply>; regulator-levels = <RPMH_REGULATOR_LEVEL_NOM RPMH_REGULATOR_LEVEL_OFF>; #cooling-cells = <2>; }; drivers/thermal/qcom/Kconfig +21 −0 Original line number Diff line number Diff line Loading @@ -50,3 +50,24 @@ config QTI_BCL_SOC_DRIVER If you want this support, you should say Y here. config QTI_QMI_COOLING_DEVICE bool "QTI QMI cooling devices" depends on QCOM_QMI_HELPERS && THERMAL_OF help This enables the QTI remote subsystem cooling devices. These cooling devices will be used by QTI chipset to place various remote subsystem mitigations like remote processor passive mitigation, remote subsystem voltage restriction at low temperatures etc. The QMI cooling device will interface with remote subsystem using QTI QMI interface. config REGULATOR_COOLING_DEVICE bool "Regulator voltage floor cooling device" depends on REGULATOR && THERMAL_OF help This implements a mitigation device to place a minimum voltage floor on a particular regulator. This mitigation device will be used by low temperature reliability rules to mitigate a regulator at nominal voltage. If you want this support, you should say Y here. drivers/thermal/qcom/Makefile +2 −0 Original line number Diff line number Diff line Loading @@ -4,3 +4,5 @@ obj-$(CONFIG_QTI_VIRTUAL_SENSOR) += qti_virtual_sensor.o obj-$(CONFIG_QTI_QMI_SENSOR) += thermal_sensor_service_v01.o qmi_sensors.o obj-$(CONFIG_QTI_BCL_PMIC5) += bcl_pmic5.o obj-$(CONFIG_QTI_BCL_SOC_DRIVER) += bcl_soc.o obj-$(CONFIG_QTI_QMI_COOLING_DEVICE) += thermal_mitigation_device_service_v01.o qmi_cooling.o obj-$(CONFIG_REGULATOR_COOLING_DEVICE) += regulator_cdev.o drivers/thermal/qcom/qmi_cooling.c 0 → 100644 +614 −0 Original line number Diff line number Diff line // SPDX-License-Identifier: GPL-2.0-only /* * Copyright (c) 2017-2018, The Linux Foundation. All rights reserved. */ #define pr_fmt(fmt) "%s:%s " fmt, KBUILD_MODNAME, __func__ #include <linux/module.h> #include <linux/platform_device.h> #include <linux/thermal.h> #include <linux/err.h> #include <linux/slab.h> #include <linux/of.h> #include <linux/soc/qcom/qmi.h> #include <linux/net.h> #include "thermal_mitigation_device_service_v01.h" #define QMI_CDEV_DRIVER "qmi-cooling-device" #define QMI_TMD_RESP_TOUT msecs_to_jiffies(100) #define QMI_CLIENT_NAME_LENGTH 40 enum qmi_device_type { QMI_CDEV_MAX_LIMIT_TYPE, QMI_CDEV_MIN_LIMIT_TYPE, QMI_CDEV_TYPE_NR, }; struct qmi_cooling_device { struct device_node *np; char cdev_name[THERMAL_NAME_LENGTH]; char qmi_name[QMI_CLIENT_NAME_LENGTH]; bool connection_active; enum qmi_device_type type; struct list_head qmi_node; struct thermal_cooling_device *cdev; unsigned int mtgn_state; unsigned int max_level; struct qmi_tmd_instance *tmd; }; struct qmi_tmd_instance { struct device *dev; struct qmi_handle handle; struct mutex mutex; uint32_t inst_id; struct list_head tmd_cdev_list; struct work_struct svc_arrive_work; }; struct qmi_dev_info { char *dev_name; enum qmi_device_type type; }; static struct qmi_tmd_instance *tmd_instances; static int tmd_inst_cnt; static struct qmi_dev_info device_clients[] = { { .dev_name = "pa", .type = QMI_CDEV_MAX_LIMIT_TYPE, }, { .dev_name = "cx_vdd_limit", .type = QMI_CDEV_MAX_LIMIT_TYPE, }, { .dev_name = "modem", .type = QMI_CDEV_MAX_LIMIT_TYPE, }, { .dev_name = "modem_current", .type = QMI_CDEV_MAX_LIMIT_TYPE, }, { .dev_name = "modem_skin", .type = QMI_CDEV_MAX_LIMIT_TYPE, }, { .dev_name = "modem_bw", .type = QMI_CDEV_MAX_LIMIT_TYPE, }, { .dev_name = "cpuv_restriction_cold", .type = QMI_CDEV_MIN_LIMIT_TYPE, }, { .dev_name = "cpr_cold", .type = QMI_CDEV_MIN_LIMIT_TYPE, } }; static int qmi_get_max_state(struct thermal_cooling_device *cdev, unsigned long *state) { struct qmi_cooling_device *qmi_cdev = cdev->devdata; if (!qmi_cdev) return -EINVAL; *state = qmi_cdev->max_level; return 0; } static int qmi_get_cur_state(struct thermal_cooling_device *cdev, unsigned long *state) { struct qmi_cooling_device *qmi_cdev = cdev->devdata; if (!qmi_cdev) return -EINVAL; if (qmi_cdev->type == QMI_CDEV_MIN_LIMIT_TYPE) { *state = 0; return 0; } *state = qmi_cdev->mtgn_state; return 0; } static int qmi_tmd_send_state_request(struct qmi_cooling_device *qmi_cdev, uint8_t state) { int ret = 0; struct tmd_set_mitigation_level_req_msg_v01 req; struct tmd_set_mitigation_level_resp_msg_v01 tmd_resp; struct qmi_tmd_instance *tmd = qmi_cdev->tmd; struct qmi_txn txn; memset(&req, 0, sizeof(req)); memset(&tmd_resp, 0, sizeof(tmd_resp)); strlcpy(req.mitigation_dev_id.mitigation_dev_id, qmi_cdev->qmi_name, QMI_TMD_MITIGATION_DEV_ID_LENGTH_MAX_V01); req.mitigation_level = state; mutex_lock(&tmd->mutex); ret = qmi_txn_init(&tmd->handle, &txn, tmd_set_mitigation_level_resp_msg_v01_ei, &tmd_resp); if (ret < 0) { pr_err("qmi set state:%d txn init failed for %s ret:%d\n", state, qmi_cdev->cdev_name, ret); goto qmi_send_exit; } ret = qmi_send_request(&tmd->handle, NULL, &txn, QMI_TMD_SET_MITIGATION_LEVEL_REQ_V01, TMD_SET_MITIGATION_LEVEL_REQ_MSG_V01_MAX_MSG_LEN, tmd_set_mitigation_level_req_msg_v01_ei, &req); if (ret < 0) { pr_err("qmi set state:%d txn send failed for %s ret:%d\n", state, qmi_cdev->cdev_name, ret); qmi_txn_cancel(&txn); goto qmi_send_exit; } ret = qmi_txn_wait(&txn, QMI_TMD_RESP_TOUT); if (ret < 0) { pr_err("qmi set state:%d txn wait failed for %s ret:%d\n", state, qmi_cdev->cdev_name, ret); goto qmi_send_exit; } if (tmd_resp.resp.result != QMI_RESULT_SUCCESS_V01) { ret = tmd_resp.resp.result; pr_err("qmi set state:%d NOT success for %s ret:%d\n", state, qmi_cdev->cdev_name, ret); goto qmi_send_exit; } pr_debug("Requested qmi state:%d for %s\n", state, qmi_cdev->cdev_name); qmi_send_exit: mutex_unlock(&tmd->mutex); return ret; } static int qmi_set_cur_or_min_state(struct qmi_cooling_device *qmi_cdev, unsigned long state) { int ret = 0; struct qmi_tmd_instance *tmd = qmi_cdev->tmd; if (!tmd) return -EINVAL; if (qmi_cdev->mtgn_state == state) return ret; /* save it and return if server exit */ if (!qmi_cdev->connection_active) { qmi_cdev->mtgn_state = state; pr_debug("Pending request:%ld for %s\n", state, qmi_cdev->cdev_name); return ret; } /* It is best effort to save state even if QMI fail */ ret = qmi_tmd_send_state_request(qmi_cdev, (uint8_t)state); qmi_cdev->mtgn_state = state; return ret; } static int qmi_set_cur_state(struct thermal_cooling_device *cdev, unsigned long state) { struct qmi_cooling_device *qmi_cdev = cdev->devdata; if (!qmi_cdev) return -EINVAL; if (qmi_cdev->type == QMI_CDEV_MIN_LIMIT_TYPE) return 0; if (state > qmi_cdev->max_level) state = qmi_cdev->max_level; return qmi_set_cur_or_min_state(qmi_cdev, state); } static int qmi_set_min_state(struct thermal_cooling_device *cdev, unsigned long state) { struct qmi_cooling_device *qmi_cdev = cdev->devdata; if (!qmi_cdev) return -EINVAL; if (qmi_cdev->type == QMI_CDEV_MAX_LIMIT_TYPE) return 0; if (state > qmi_cdev->max_level) state = qmi_cdev->max_level; /* Convert state into QMI client expects for min state */ state = qmi_cdev->max_level - state; return qmi_set_cur_or_min_state(qmi_cdev, state); } static int qmi_get_min_state(struct thermal_cooling_device *cdev, unsigned long *state) { struct qmi_cooling_device *qmi_cdev = cdev->devdata; if (!qmi_cdev) return -EINVAL; if (qmi_cdev->type == QMI_CDEV_MAX_LIMIT_TYPE) { *state = 0; return 0; } *state = qmi_cdev->max_level - qmi_cdev->mtgn_state; return 0; } static struct thermal_cooling_device_ops qmi_device_ops = { .get_max_state = qmi_get_max_state, .get_cur_state = qmi_get_cur_state, .set_cur_state = qmi_set_cur_state, .set_min_state = qmi_set_min_state, .get_min_state = qmi_get_min_state, }; static int qmi_register_cooling_device(struct qmi_cooling_device *qmi_cdev) { qmi_cdev->cdev = thermal_of_cooling_device_register( qmi_cdev->np, qmi_cdev->cdev_name, qmi_cdev, &qmi_device_ops); if (IS_ERR(qmi_cdev->cdev)) { pr_err("Cooling register failed for %s, ret:%ld\n", qmi_cdev->cdev_name, PTR_ERR(qmi_cdev->cdev)); return PTR_ERR(qmi_cdev->cdev); } pr_debug("Cooling register success for %s\n", qmi_cdev->cdev_name); return 0; } static int verify_devices_and_register(struct qmi_tmd_instance *tmd) { struct tmd_get_mitigation_device_list_req_msg_v01 req; struct tmd_get_mitigation_device_list_resp_msg_v01 *tmd_resp; int ret = 0, i; struct qmi_txn txn; memset(&req, 0, sizeof(req)); /* size of tmd_resp is very high, use heap memory rather than stack */ tmd_resp = kzalloc(sizeof(*tmd_resp), GFP_KERNEL); if (!tmd_resp) return -ENOMEM; mutex_lock(&tmd->mutex); ret = qmi_txn_init(&tmd->handle, &txn, tmd_get_mitigation_device_list_resp_msg_v01_ei, tmd_resp); if (ret < 0) { pr_err("Transaction Init error for inst_id:0x%x ret:%d\n", tmd->inst_id, ret); goto reg_exit; } ret = qmi_send_request(&tmd->handle, NULL, &txn, QMI_TMD_GET_MITIGATION_DEVICE_LIST_REQ_V01, TMD_GET_MITIGATION_DEVICE_LIST_REQ_MSG_V01_MAX_MSG_LEN, tmd_get_mitigation_device_list_req_msg_v01_ei, &req); if (ret < 0) { qmi_txn_cancel(&txn); goto reg_exit; } ret = qmi_txn_wait(&txn, QMI_TMD_RESP_TOUT); if (ret < 0) { pr_err("Transaction wait error for inst_id:0x%x ret:%d\n", tmd->inst_id, ret); goto reg_exit; } if (tmd_resp->resp.result != QMI_RESULT_SUCCESS_V01) { ret = tmd_resp->resp.result; pr_err("Get device list NOT success for inst_id:0x%x ret:%d\n", tmd->inst_id, ret); goto reg_exit; } mutex_unlock(&tmd->mutex); for (i = 0; i < tmd_resp->mitigation_device_list_len; i++) { struct qmi_cooling_device *qmi_cdev = NULL; list_for_each_entry(qmi_cdev, &tmd->tmd_cdev_list, qmi_node) { struct tmd_mitigation_dev_list_type_v01 *device = &tmd_resp->mitigation_device_list[i]; if ((strncasecmp(qmi_cdev->qmi_name, device->mitigation_dev_id.mitigation_dev_id, QMI_TMD_MITIGATION_DEV_ID_LENGTH_MAX_V01))) continue; qmi_cdev->connection_active = true; qmi_cdev->max_level = device->max_mitigation_level; /* * It is better to set current state * initially or during restart */ qmi_tmd_send_state_request(qmi_cdev, qmi_cdev->mtgn_state); if (!qmi_cdev->cdev) ret = qmi_register_cooling_device(qmi_cdev); break; } } kfree(tmd_resp); return ret; reg_exit: mutex_unlock(&tmd->mutex); kfree(tmd_resp); return ret; } static void qmi_tmd_svc_arrive(struct work_struct *work) { struct qmi_tmd_instance *tmd = container_of(work, struct qmi_tmd_instance, svc_arrive_work); verify_devices_and_register(tmd); } static void thermal_qmi_net_reset(struct qmi_handle *qmi) { struct qmi_tmd_instance *tmd = container_of(qmi, struct qmi_tmd_instance, handle); struct qmi_cooling_device *qmi_cdev = NULL; list_for_each_entry(qmi_cdev, &tmd->tmd_cdev_list, qmi_node) { if (qmi_cdev->connection_active) qmi_tmd_send_state_request(qmi_cdev, qmi_cdev->mtgn_state); } } static void thermal_qmi_del_server(struct qmi_handle *qmi, struct qmi_service *service) { struct qmi_tmd_instance *tmd = container_of(qmi, struct qmi_tmd_instance, handle); struct qmi_cooling_device *qmi_cdev = NULL; list_for_each_entry(qmi_cdev, &tmd->tmd_cdev_list, qmi_node) qmi_cdev->connection_active = false; } static int thermal_qmi_new_server(struct qmi_handle *qmi, struct qmi_service *service) { struct qmi_tmd_instance *tmd = container_of(qmi, struct qmi_tmd_instance, handle); struct sockaddr_qrtr sq = {AF_QIPCRTR, service->node, service->port}; mutex_lock(&tmd->mutex); kernel_connect(qmi->sock, (struct sockaddr *)&sq, sizeof(sq), 0); mutex_unlock(&tmd->mutex); queue_work(system_highpri_wq, &tmd->svc_arrive_work); return 0; } static struct qmi_ops thermal_qmi_event_ops = { .new_server = thermal_qmi_new_server, .del_server = thermal_qmi_del_server, .net_reset = thermal_qmi_net_reset, }; static void qmi_tmd_cleanup(void) { int idx = 0; struct qmi_tmd_instance *tmd = tmd_instances; struct qmi_cooling_device *qmi_cdev, *c_next; for (; idx < tmd_inst_cnt; idx++) { mutex_lock(&tmd[idx].mutex); list_for_each_entry_safe(qmi_cdev, c_next, &tmd[idx].tmd_cdev_list, qmi_node) { qmi_cdev->connection_active = false; if (qmi_cdev->cdev) thermal_cooling_device_unregister( qmi_cdev->cdev); list_del(&qmi_cdev->qmi_node); } qmi_handle_release(&tmd[idx].handle); mutex_unlock(&tmd[idx].mutex); } } static int of_get_qmi_tmd_platform_data(struct device *dev) { int ret = 0, idx = 0, i = 0, subsys_cnt = 0; struct device_node *np = dev->of_node; struct device_node *subsys_np, *cdev_np; struct qmi_tmd_instance *tmd; struct qmi_cooling_device *qmi_cdev; subsys_cnt = of_get_available_child_count(np); if (!subsys_cnt) { dev_err(dev, "No child node to process\n"); return -EFAULT; } tmd = devm_kcalloc(dev, subsys_cnt, sizeof(*tmd), GFP_KERNEL); if (!tmd) return -ENOMEM; for_each_available_child_of_node(np, subsys_np) { if (idx >= subsys_cnt) break; ret = of_property_read_u32(subsys_np, "qcom,instance-id", &tmd[idx].inst_id); if (ret) { dev_err(dev, "error reading qcom,insance-id. ret:%d\n", ret); return ret; } tmd[idx].dev = dev; mutex_init(&tmd[idx].mutex); INIT_LIST_HEAD(&tmd[idx].tmd_cdev_list); INIT_WORK(&tmd[idx].svc_arrive_work, qmi_tmd_svc_arrive); for_each_available_child_of_node(subsys_np, cdev_np) { const char *qmi_name; qmi_cdev = devm_kzalloc(dev, sizeof(*qmi_cdev), GFP_KERNEL); if (!qmi_cdev) { ret = -ENOMEM; return ret; } strlcpy(qmi_cdev->cdev_name, cdev_np->name, THERMAL_NAME_LENGTH); if (!of_property_read_string(cdev_np, "qcom,qmi-dev-name", &qmi_name)) { strlcpy(qmi_cdev->qmi_name, qmi_name, QMI_CLIENT_NAME_LENGTH); } else { dev_err(dev, "Fail to parse dev name for %s\n", cdev_np->name); break; } /* Check for supported qmi dev*/ for (i = 0; i < ARRAY_SIZE(device_clients); i++) { if (strcmp(device_clients[i].dev_name, qmi_cdev->qmi_name) == 0) break; } if (i >= ARRAY_SIZE(device_clients)) { dev_err(dev, "Not supported dev name for %s\n", cdev_np->name); break; } qmi_cdev->type = device_clients[i].type; qmi_cdev->tmd = &tmd[idx]; qmi_cdev->np = cdev_np; qmi_cdev->mtgn_state = 0; list_add(&qmi_cdev->qmi_node, &tmd[idx].tmd_cdev_list); } idx++; } tmd_instances = tmd; tmd_inst_cnt = subsys_cnt; return 0; } static int qmi_device_probe(struct platform_device *pdev) { struct device *dev = &pdev->dev; int ret = 0, idx = 0; ret = of_get_qmi_tmd_platform_data(dev); if (ret) goto probe_err; if (!tmd_instances || !tmd_inst_cnt) { dev_err(dev, "Empty tmd instances\n"); return -EINVAL; } for (; idx < tmd_inst_cnt; idx++) { struct qmi_tmd_instance *tmd = &tmd_instances[idx]; if (list_empty(&tmd->tmd_cdev_list)) continue; ret = qmi_handle_init(&tmd->handle, TMD_GET_MITIGATION_DEVICE_LIST_RESP_MSG_V01_MAX_MSG_LEN, &thermal_qmi_event_ops, NULL); if (ret < 0) { dev_err(dev, "QMI[0x%x] handle init failed. err:%d\n", tmd->inst_id, ret); goto probe_err; } ret = qmi_add_lookup(&tmd->handle, TMD_SERVICE_ID_V01, TMD_SERVICE_VERS_V01, tmd->inst_id); if (ret < 0) { dev_err(dev, "QMI register failed for 0x%x, ret:%d\n", tmd->inst_id, ret); goto probe_err; } } return 0; probe_err: qmi_tmd_cleanup(); return ret; } static int qmi_device_remove(struct platform_device *pdev) { qmi_tmd_cleanup(); return 0; } static const struct of_device_id qmi_device_match[] = { {.compatible = "qcom,qmi-cooling-devices"}, {} }; static struct platform_driver qmi_device_driver = { .probe = qmi_device_probe, .remove = qmi_device_remove, .driver = { .name = QMI_CDEV_DRIVER, .of_match_table = qmi_device_match, }, }; static int __init qmi_device_init(void) { return platform_driver_register(&qmi_device_driver); } module_init(qmi_device_init); static void __exit qmi_device_exit(void) { platform_driver_unregister(&qmi_device_driver); } module_exit(qmi_device_exit); MODULE_LICENSE("GPL v2"); MODULE_DESCRIPTION("QTI QMI cooling device driver"); Loading
Documentation/devicetree/bindings/thermal/qti-rpmh-reg-cdev.txt 0 → 100644 +44 −0 Original line number Diff line number Diff line RPMh regulator cooling device. The RPMh regulator cooling device, will be used to place a voltage floor restriction on a rail. This cooling device will use a QMP AOP mail box to send the message to apply and clear voltage floor restriction. The cooling device node should be a child of the regulator devicetree node, which it is trying to place the floor restriction. Properties: - compatible: Usage: required Value type: <string> Definition: shall be "qcom,rpmh-reg-cdev" - qcom,reg-resource-name: Usage: required Value type: <string> Definition: The regulator resource name to be used for communicating with RPMh. This value should be any of the below resource name, cx -> For CX rail, mx -> For MX rail, ebi -> For EBI rail. - mboxes: Usage: required Value type: <phandle> Definition: A phandle to the QMP AOP mail box, that needs to be used for sending the floor restriction message. - #cooling-cells: Must be 2. Please refer to <devicetree/bindings/thermal/thermal.txt> for more details. Example: vdd_cx: rpmh-cx-regulator-cdev { compatible = "qcom,rpmh-reg-cdev"; mboxes = <&qmp_aop 0>; qcom,reg-resource-name = "cx"; #cooling-cells = <2>; };
Documentation/devicetree/bindings/thermal/regulator-cdev.txt 0 → 100644 +38 −0 Original line number Diff line number Diff line Regulator cooling device. The regulator cooling device, will be used to place a voltage floor restriction on a rail. Properties: - compatible: Usage: required Value type: <string> Definition: shall be "qcom,regulator-cooling-device" - cdev-supply: Usage: required Value type: <phandle> Definition: phandle to the regulator to which the cooling device will place a floor mitigation. - regulator-levels: Usage: required Value type: <U32 array> Definition: Array of regulator voltages the cooling device should use to place a floor restriction. The voltages should be specified in descending order. - #cooling-cells: Must be 2. Please refer to <devicetree/bindings/thermal/thermal.txt> for more details. Example: mv_cdev: mx-cdev-lvl { compatible = "qcom,regulator-cooling-device"; cdev-supply = <®ulator-cdev-supply>; regulator-levels = <RPMH_REGULATOR_LEVEL_NOM RPMH_REGULATOR_LEVEL_OFF>; #cooling-cells = <2>; };
drivers/thermal/qcom/Kconfig +21 −0 Original line number Diff line number Diff line Loading @@ -50,3 +50,24 @@ config QTI_BCL_SOC_DRIVER If you want this support, you should say Y here. config QTI_QMI_COOLING_DEVICE bool "QTI QMI cooling devices" depends on QCOM_QMI_HELPERS && THERMAL_OF help This enables the QTI remote subsystem cooling devices. These cooling devices will be used by QTI chipset to place various remote subsystem mitigations like remote processor passive mitigation, remote subsystem voltage restriction at low temperatures etc. The QMI cooling device will interface with remote subsystem using QTI QMI interface. config REGULATOR_COOLING_DEVICE bool "Regulator voltage floor cooling device" depends on REGULATOR && THERMAL_OF help This implements a mitigation device to place a minimum voltage floor on a particular regulator. This mitigation device will be used by low temperature reliability rules to mitigate a regulator at nominal voltage. If you want this support, you should say Y here.
drivers/thermal/qcom/Makefile +2 −0 Original line number Diff line number Diff line Loading @@ -4,3 +4,5 @@ obj-$(CONFIG_QTI_VIRTUAL_SENSOR) += qti_virtual_sensor.o obj-$(CONFIG_QTI_QMI_SENSOR) += thermal_sensor_service_v01.o qmi_sensors.o obj-$(CONFIG_QTI_BCL_PMIC5) += bcl_pmic5.o obj-$(CONFIG_QTI_BCL_SOC_DRIVER) += bcl_soc.o obj-$(CONFIG_QTI_QMI_COOLING_DEVICE) += thermal_mitigation_device_service_v01.o qmi_cooling.o obj-$(CONFIG_REGULATOR_COOLING_DEVICE) += regulator_cdev.o
drivers/thermal/qcom/qmi_cooling.c 0 → 100644 +614 −0 Original line number Diff line number Diff line // SPDX-License-Identifier: GPL-2.0-only /* * Copyright (c) 2017-2018, The Linux Foundation. All rights reserved. */ #define pr_fmt(fmt) "%s:%s " fmt, KBUILD_MODNAME, __func__ #include <linux/module.h> #include <linux/platform_device.h> #include <linux/thermal.h> #include <linux/err.h> #include <linux/slab.h> #include <linux/of.h> #include <linux/soc/qcom/qmi.h> #include <linux/net.h> #include "thermal_mitigation_device_service_v01.h" #define QMI_CDEV_DRIVER "qmi-cooling-device" #define QMI_TMD_RESP_TOUT msecs_to_jiffies(100) #define QMI_CLIENT_NAME_LENGTH 40 enum qmi_device_type { QMI_CDEV_MAX_LIMIT_TYPE, QMI_CDEV_MIN_LIMIT_TYPE, QMI_CDEV_TYPE_NR, }; struct qmi_cooling_device { struct device_node *np; char cdev_name[THERMAL_NAME_LENGTH]; char qmi_name[QMI_CLIENT_NAME_LENGTH]; bool connection_active; enum qmi_device_type type; struct list_head qmi_node; struct thermal_cooling_device *cdev; unsigned int mtgn_state; unsigned int max_level; struct qmi_tmd_instance *tmd; }; struct qmi_tmd_instance { struct device *dev; struct qmi_handle handle; struct mutex mutex; uint32_t inst_id; struct list_head tmd_cdev_list; struct work_struct svc_arrive_work; }; struct qmi_dev_info { char *dev_name; enum qmi_device_type type; }; static struct qmi_tmd_instance *tmd_instances; static int tmd_inst_cnt; static struct qmi_dev_info device_clients[] = { { .dev_name = "pa", .type = QMI_CDEV_MAX_LIMIT_TYPE, }, { .dev_name = "cx_vdd_limit", .type = QMI_CDEV_MAX_LIMIT_TYPE, }, { .dev_name = "modem", .type = QMI_CDEV_MAX_LIMIT_TYPE, }, { .dev_name = "modem_current", .type = QMI_CDEV_MAX_LIMIT_TYPE, }, { .dev_name = "modem_skin", .type = QMI_CDEV_MAX_LIMIT_TYPE, }, { .dev_name = "modem_bw", .type = QMI_CDEV_MAX_LIMIT_TYPE, }, { .dev_name = "cpuv_restriction_cold", .type = QMI_CDEV_MIN_LIMIT_TYPE, }, { .dev_name = "cpr_cold", .type = QMI_CDEV_MIN_LIMIT_TYPE, } }; static int qmi_get_max_state(struct thermal_cooling_device *cdev, unsigned long *state) { struct qmi_cooling_device *qmi_cdev = cdev->devdata; if (!qmi_cdev) return -EINVAL; *state = qmi_cdev->max_level; return 0; } static int qmi_get_cur_state(struct thermal_cooling_device *cdev, unsigned long *state) { struct qmi_cooling_device *qmi_cdev = cdev->devdata; if (!qmi_cdev) return -EINVAL; if (qmi_cdev->type == QMI_CDEV_MIN_LIMIT_TYPE) { *state = 0; return 0; } *state = qmi_cdev->mtgn_state; return 0; } static int qmi_tmd_send_state_request(struct qmi_cooling_device *qmi_cdev, uint8_t state) { int ret = 0; struct tmd_set_mitigation_level_req_msg_v01 req; struct tmd_set_mitigation_level_resp_msg_v01 tmd_resp; struct qmi_tmd_instance *tmd = qmi_cdev->tmd; struct qmi_txn txn; memset(&req, 0, sizeof(req)); memset(&tmd_resp, 0, sizeof(tmd_resp)); strlcpy(req.mitigation_dev_id.mitigation_dev_id, qmi_cdev->qmi_name, QMI_TMD_MITIGATION_DEV_ID_LENGTH_MAX_V01); req.mitigation_level = state; mutex_lock(&tmd->mutex); ret = qmi_txn_init(&tmd->handle, &txn, tmd_set_mitigation_level_resp_msg_v01_ei, &tmd_resp); if (ret < 0) { pr_err("qmi set state:%d txn init failed for %s ret:%d\n", state, qmi_cdev->cdev_name, ret); goto qmi_send_exit; } ret = qmi_send_request(&tmd->handle, NULL, &txn, QMI_TMD_SET_MITIGATION_LEVEL_REQ_V01, TMD_SET_MITIGATION_LEVEL_REQ_MSG_V01_MAX_MSG_LEN, tmd_set_mitigation_level_req_msg_v01_ei, &req); if (ret < 0) { pr_err("qmi set state:%d txn send failed for %s ret:%d\n", state, qmi_cdev->cdev_name, ret); qmi_txn_cancel(&txn); goto qmi_send_exit; } ret = qmi_txn_wait(&txn, QMI_TMD_RESP_TOUT); if (ret < 0) { pr_err("qmi set state:%d txn wait failed for %s ret:%d\n", state, qmi_cdev->cdev_name, ret); goto qmi_send_exit; } if (tmd_resp.resp.result != QMI_RESULT_SUCCESS_V01) { ret = tmd_resp.resp.result; pr_err("qmi set state:%d NOT success for %s ret:%d\n", state, qmi_cdev->cdev_name, ret); goto qmi_send_exit; } pr_debug("Requested qmi state:%d for %s\n", state, qmi_cdev->cdev_name); qmi_send_exit: mutex_unlock(&tmd->mutex); return ret; } static int qmi_set_cur_or_min_state(struct qmi_cooling_device *qmi_cdev, unsigned long state) { int ret = 0; struct qmi_tmd_instance *tmd = qmi_cdev->tmd; if (!tmd) return -EINVAL; if (qmi_cdev->mtgn_state == state) return ret; /* save it and return if server exit */ if (!qmi_cdev->connection_active) { qmi_cdev->mtgn_state = state; pr_debug("Pending request:%ld for %s\n", state, qmi_cdev->cdev_name); return ret; } /* It is best effort to save state even if QMI fail */ ret = qmi_tmd_send_state_request(qmi_cdev, (uint8_t)state); qmi_cdev->mtgn_state = state; return ret; } static int qmi_set_cur_state(struct thermal_cooling_device *cdev, unsigned long state) { struct qmi_cooling_device *qmi_cdev = cdev->devdata; if (!qmi_cdev) return -EINVAL; if (qmi_cdev->type == QMI_CDEV_MIN_LIMIT_TYPE) return 0; if (state > qmi_cdev->max_level) state = qmi_cdev->max_level; return qmi_set_cur_or_min_state(qmi_cdev, state); } static int qmi_set_min_state(struct thermal_cooling_device *cdev, unsigned long state) { struct qmi_cooling_device *qmi_cdev = cdev->devdata; if (!qmi_cdev) return -EINVAL; if (qmi_cdev->type == QMI_CDEV_MAX_LIMIT_TYPE) return 0; if (state > qmi_cdev->max_level) state = qmi_cdev->max_level; /* Convert state into QMI client expects for min state */ state = qmi_cdev->max_level - state; return qmi_set_cur_or_min_state(qmi_cdev, state); } static int qmi_get_min_state(struct thermal_cooling_device *cdev, unsigned long *state) { struct qmi_cooling_device *qmi_cdev = cdev->devdata; if (!qmi_cdev) return -EINVAL; if (qmi_cdev->type == QMI_CDEV_MAX_LIMIT_TYPE) { *state = 0; return 0; } *state = qmi_cdev->max_level - qmi_cdev->mtgn_state; return 0; } static struct thermal_cooling_device_ops qmi_device_ops = { .get_max_state = qmi_get_max_state, .get_cur_state = qmi_get_cur_state, .set_cur_state = qmi_set_cur_state, .set_min_state = qmi_set_min_state, .get_min_state = qmi_get_min_state, }; static int qmi_register_cooling_device(struct qmi_cooling_device *qmi_cdev) { qmi_cdev->cdev = thermal_of_cooling_device_register( qmi_cdev->np, qmi_cdev->cdev_name, qmi_cdev, &qmi_device_ops); if (IS_ERR(qmi_cdev->cdev)) { pr_err("Cooling register failed for %s, ret:%ld\n", qmi_cdev->cdev_name, PTR_ERR(qmi_cdev->cdev)); return PTR_ERR(qmi_cdev->cdev); } pr_debug("Cooling register success for %s\n", qmi_cdev->cdev_name); return 0; } static int verify_devices_and_register(struct qmi_tmd_instance *tmd) { struct tmd_get_mitigation_device_list_req_msg_v01 req; struct tmd_get_mitigation_device_list_resp_msg_v01 *tmd_resp; int ret = 0, i; struct qmi_txn txn; memset(&req, 0, sizeof(req)); /* size of tmd_resp is very high, use heap memory rather than stack */ tmd_resp = kzalloc(sizeof(*tmd_resp), GFP_KERNEL); if (!tmd_resp) return -ENOMEM; mutex_lock(&tmd->mutex); ret = qmi_txn_init(&tmd->handle, &txn, tmd_get_mitigation_device_list_resp_msg_v01_ei, tmd_resp); if (ret < 0) { pr_err("Transaction Init error for inst_id:0x%x ret:%d\n", tmd->inst_id, ret); goto reg_exit; } ret = qmi_send_request(&tmd->handle, NULL, &txn, QMI_TMD_GET_MITIGATION_DEVICE_LIST_REQ_V01, TMD_GET_MITIGATION_DEVICE_LIST_REQ_MSG_V01_MAX_MSG_LEN, tmd_get_mitigation_device_list_req_msg_v01_ei, &req); if (ret < 0) { qmi_txn_cancel(&txn); goto reg_exit; } ret = qmi_txn_wait(&txn, QMI_TMD_RESP_TOUT); if (ret < 0) { pr_err("Transaction wait error for inst_id:0x%x ret:%d\n", tmd->inst_id, ret); goto reg_exit; } if (tmd_resp->resp.result != QMI_RESULT_SUCCESS_V01) { ret = tmd_resp->resp.result; pr_err("Get device list NOT success for inst_id:0x%x ret:%d\n", tmd->inst_id, ret); goto reg_exit; } mutex_unlock(&tmd->mutex); for (i = 0; i < tmd_resp->mitigation_device_list_len; i++) { struct qmi_cooling_device *qmi_cdev = NULL; list_for_each_entry(qmi_cdev, &tmd->tmd_cdev_list, qmi_node) { struct tmd_mitigation_dev_list_type_v01 *device = &tmd_resp->mitigation_device_list[i]; if ((strncasecmp(qmi_cdev->qmi_name, device->mitigation_dev_id.mitigation_dev_id, QMI_TMD_MITIGATION_DEV_ID_LENGTH_MAX_V01))) continue; qmi_cdev->connection_active = true; qmi_cdev->max_level = device->max_mitigation_level; /* * It is better to set current state * initially or during restart */ qmi_tmd_send_state_request(qmi_cdev, qmi_cdev->mtgn_state); if (!qmi_cdev->cdev) ret = qmi_register_cooling_device(qmi_cdev); break; } } kfree(tmd_resp); return ret; reg_exit: mutex_unlock(&tmd->mutex); kfree(tmd_resp); return ret; } static void qmi_tmd_svc_arrive(struct work_struct *work) { struct qmi_tmd_instance *tmd = container_of(work, struct qmi_tmd_instance, svc_arrive_work); verify_devices_and_register(tmd); } static void thermal_qmi_net_reset(struct qmi_handle *qmi) { struct qmi_tmd_instance *tmd = container_of(qmi, struct qmi_tmd_instance, handle); struct qmi_cooling_device *qmi_cdev = NULL; list_for_each_entry(qmi_cdev, &tmd->tmd_cdev_list, qmi_node) { if (qmi_cdev->connection_active) qmi_tmd_send_state_request(qmi_cdev, qmi_cdev->mtgn_state); } } static void thermal_qmi_del_server(struct qmi_handle *qmi, struct qmi_service *service) { struct qmi_tmd_instance *tmd = container_of(qmi, struct qmi_tmd_instance, handle); struct qmi_cooling_device *qmi_cdev = NULL; list_for_each_entry(qmi_cdev, &tmd->tmd_cdev_list, qmi_node) qmi_cdev->connection_active = false; } static int thermal_qmi_new_server(struct qmi_handle *qmi, struct qmi_service *service) { struct qmi_tmd_instance *tmd = container_of(qmi, struct qmi_tmd_instance, handle); struct sockaddr_qrtr sq = {AF_QIPCRTR, service->node, service->port}; mutex_lock(&tmd->mutex); kernel_connect(qmi->sock, (struct sockaddr *)&sq, sizeof(sq), 0); mutex_unlock(&tmd->mutex); queue_work(system_highpri_wq, &tmd->svc_arrive_work); return 0; } static struct qmi_ops thermal_qmi_event_ops = { .new_server = thermal_qmi_new_server, .del_server = thermal_qmi_del_server, .net_reset = thermal_qmi_net_reset, }; static void qmi_tmd_cleanup(void) { int idx = 0; struct qmi_tmd_instance *tmd = tmd_instances; struct qmi_cooling_device *qmi_cdev, *c_next; for (; idx < tmd_inst_cnt; idx++) { mutex_lock(&tmd[idx].mutex); list_for_each_entry_safe(qmi_cdev, c_next, &tmd[idx].tmd_cdev_list, qmi_node) { qmi_cdev->connection_active = false; if (qmi_cdev->cdev) thermal_cooling_device_unregister( qmi_cdev->cdev); list_del(&qmi_cdev->qmi_node); } qmi_handle_release(&tmd[idx].handle); mutex_unlock(&tmd[idx].mutex); } } static int of_get_qmi_tmd_platform_data(struct device *dev) { int ret = 0, idx = 0, i = 0, subsys_cnt = 0; struct device_node *np = dev->of_node; struct device_node *subsys_np, *cdev_np; struct qmi_tmd_instance *tmd; struct qmi_cooling_device *qmi_cdev; subsys_cnt = of_get_available_child_count(np); if (!subsys_cnt) { dev_err(dev, "No child node to process\n"); return -EFAULT; } tmd = devm_kcalloc(dev, subsys_cnt, sizeof(*tmd), GFP_KERNEL); if (!tmd) return -ENOMEM; for_each_available_child_of_node(np, subsys_np) { if (idx >= subsys_cnt) break; ret = of_property_read_u32(subsys_np, "qcom,instance-id", &tmd[idx].inst_id); if (ret) { dev_err(dev, "error reading qcom,insance-id. ret:%d\n", ret); return ret; } tmd[idx].dev = dev; mutex_init(&tmd[idx].mutex); INIT_LIST_HEAD(&tmd[idx].tmd_cdev_list); INIT_WORK(&tmd[idx].svc_arrive_work, qmi_tmd_svc_arrive); for_each_available_child_of_node(subsys_np, cdev_np) { const char *qmi_name; qmi_cdev = devm_kzalloc(dev, sizeof(*qmi_cdev), GFP_KERNEL); if (!qmi_cdev) { ret = -ENOMEM; return ret; } strlcpy(qmi_cdev->cdev_name, cdev_np->name, THERMAL_NAME_LENGTH); if (!of_property_read_string(cdev_np, "qcom,qmi-dev-name", &qmi_name)) { strlcpy(qmi_cdev->qmi_name, qmi_name, QMI_CLIENT_NAME_LENGTH); } else { dev_err(dev, "Fail to parse dev name for %s\n", cdev_np->name); break; } /* Check for supported qmi dev*/ for (i = 0; i < ARRAY_SIZE(device_clients); i++) { if (strcmp(device_clients[i].dev_name, qmi_cdev->qmi_name) == 0) break; } if (i >= ARRAY_SIZE(device_clients)) { dev_err(dev, "Not supported dev name for %s\n", cdev_np->name); break; } qmi_cdev->type = device_clients[i].type; qmi_cdev->tmd = &tmd[idx]; qmi_cdev->np = cdev_np; qmi_cdev->mtgn_state = 0; list_add(&qmi_cdev->qmi_node, &tmd[idx].tmd_cdev_list); } idx++; } tmd_instances = tmd; tmd_inst_cnt = subsys_cnt; return 0; } static int qmi_device_probe(struct platform_device *pdev) { struct device *dev = &pdev->dev; int ret = 0, idx = 0; ret = of_get_qmi_tmd_platform_data(dev); if (ret) goto probe_err; if (!tmd_instances || !tmd_inst_cnt) { dev_err(dev, "Empty tmd instances\n"); return -EINVAL; } for (; idx < tmd_inst_cnt; idx++) { struct qmi_tmd_instance *tmd = &tmd_instances[idx]; if (list_empty(&tmd->tmd_cdev_list)) continue; ret = qmi_handle_init(&tmd->handle, TMD_GET_MITIGATION_DEVICE_LIST_RESP_MSG_V01_MAX_MSG_LEN, &thermal_qmi_event_ops, NULL); if (ret < 0) { dev_err(dev, "QMI[0x%x] handle init failed. err:%d\n", tmd->inst_id, ret); goto probe_err; } ret = qmi_add_lookup(&tmd->handle, TMD_SERVICE_ID_V01, TMD_SERVICE_VERS_V01, tmd->inst_id); if (ret < 0) { dev_err(dev, "QMI register failed for 0x%x, ret:%d\n", tmd->inst_id, ret); goto probe_err; } } return 0; probe_err: qmi_tmd_cleanup(); return ret; } static int qmi_device_remove(struct platform_device *pdev) { qmi_tmd_cleanup(); return 0; } static const struct of_device_id qmi_device_match[] = { {.compatible = "qcom,qmi-cooling-devices"}, {} }; static struct platform_driver qmi_device_driver = { .probe = qmi_device_probe, .remove = qmi_device_remove, .driver = { .name = QMI_CDEV_DRIVER, .of_match_table = qmi_device_match, }, }; static int __init qmi_device_init(void) { return platform_driver_register(&qmi_device_driver); } module_init(qmi_device_init); static void __exit qmi_device_exit(void) { platform_driver_unregister(&qmi_device_driver); } module_exit(qmi_device_exit); MODULE_LICENSE("GPL v2"); MODULE_DESCRIPTION("QTI QMI cooling device driver");
