12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * Copyright (c) 2022-2023, Qualcomm Innovation Center, Inc. All rights reserved.
- */
- #define pr_fmt(fmt) "%s: " fmt, __func__
- #include <linux/vmalloc.h>
- #include <linux/uaccess.h>
- #include <linux/delay.h>
- #include <linux/input.h>
- #include <linux/input/mt.h>
- #include <linux/of_gpio.h>
- #include <linux/of_graph.h>
- #include <linux/of_device.h>
- #include <linux/sysfs.h>
- #include <linux/sort.h>
- #include <linux/atomic.h>
- #include <linux/pinctrl/qcom-pinctrl.h>
- #include <linux/pm.h>
- #include <linux/pm_runtime.h>
- #include <linux/component.h>
- #include <linux/sched.h>
- #include <linux/version.h>
- #include <linux/types.h>
- #include <linux/regulator/consumer.h>
- #include <linux/debugfs.h>
- #include <linux/wait.h>
- #include <linux/time.h>
- #include "qts_core.h"
- static struct qts_data_entries *qts_data_entries;
- struct drm_panel *active_panel;
- static void qts_trusted_touch_abort_handler(struct qts_data *qts_data, int error);
- static struct gh_acl_desc *qts_vm_get_acl(enum gh_vm_names vm_name)
- {
- struct gh_acl_desc *acl_desc;
- gh_vmid_t vmid;
- #if (KERNEL_VERSION(6, 1, 0) <= LINUX_VERSION_CODE)
- ghd_rm_get_vmid(vm_name, &vmid);
- #else
- gh_rm_get_vmid(vm_name, &vmid);
- #endif
- acl_desc = kzalloc(offsetof(struct gh_acl_desc, acl_entries[1]),
- GFP_KERNEL);
- if (!acl_desc)
- return ERR_PTR(ENOMEM);
- acl_desc->n_acl_entries = 1;
- acl_desc->acl_entries[0].vmid = vmid;
- acl_desc->acl_entries[0].perms = GH_RM_ACL_R | GH_RM_ACL_W;
- return acl_desc;
- }
- static struct gh_sgl_desc *qts_vm_get_sgl(struct trusted_touch_vm_info *vm_info)
- {
- struct gh_sgl_desc *sgl_desc;
- int i;
- sgl_desc = kzalloc(offsetof(struct gh_sgl_desc,
- sgl_entries[vm_info->iomem_list_size]), GFP_KERNEL);
- if (!sgl_desc)
- return ERR_PTR(ENOMEM);
- sgl_desc->n_sgl_entries = vm_info->iomem_list_size;
- for (i = 0; i < vm_info->iomem_list_size; i++) {
- sgl_desc->sgl_entries[i].ipa_base = vm_info->iomem_bases[i];
- sgl_desc->sgl_entries[i].size = vm_info->iomem_sizes[i];
- }
- return sgl_desc;
- }
- static int qts_populate_vm_info_iomem(struct qts_data *qts_data)
- {
- int i, gpio, rc = 0;
- int num_regs, num_sizes, num_gpios, list_size;
- struct resource res;
- struct device_node *np = qts_data->dev->of_node;
- struct trusted_touch_vm_info *vm_info = qts_data->vm_info;
- num_regs = of_property_count_u32_elems(np, "qts,trusted-touch-io-bases");
- if (num_regs < 0) {
- pr_err("Invalid number of IO regions specified\n");
- return -EINVAL;
- }
- num_sizes = of_property_count_u32_elems(np, "qts,trusted-touch-io-sizes");
- if (num_sizes < 0) {
- pr_err("Invalid number of IO regions specified\n");
- return -EINVAL;
- }
- if (num_regs != num_sizes) {
- pr_err("IO bases and sizes array lengths mismatch\n");
- return -EINVAL;
- }
- num_gpios = of_gpio_named_count(np, "qts,trusted-touch-vm-gpio-list");
- if (num_gpios < 0) {
- pr_warn("Ignoring invalid trusted gpio list: %d\n", num_gpios);
- num_gpios = 0;
- }
- list_size = num_regs + num_gpios;
- vm_info->iomem_list_size = list_size;
- vm_info->iomem_bases = devm_kcalloc(qts_data->dev, list_size, sizeof(*vm_info->iomem_bases),
- GFP_KERNEL);
- if (!vm_info->iomem_bases)
- return -ENOMEM;
- vm_info->iomem_sizes = devm_kcalloc(qts_data->dev, list_size, sizeof(*vm_info->iomem_sizes),
- GFP_KERNEL);
- if (!vm_info->iomem_sizes)
- return -ENOMEM;
- for (i = 0; i < num_gpios; ++i) {
- gpio = of_get_named_gpio(np, "qts,trusted-touch-vm-gpio-list", i);
- if (gpio < 0 || !gpio_is_valid(gpio)) {
- pr_err("Invalid gpio %d at position %d\n", gpio, i);
- return gpio;
- }
- if (!msm_gpio_get_pin_address(gpio, &res)) {
- pr_err("Failed to retrieve gpio-%d resource\n", gpio);
- return -ENODATA;
- }
- vm_info->iomem_bases[i] = res.start;
- vm_info->iomem_sizes[i] = resource_size(&res);
- }
- rc = of_property_read_u32_array(np, "qts,trusted-touch-io-bases",
- &vm_info->iomem_bases[i], list_size - i);
- if (rc) {
- pr_err("Failed to read trusted touch io bases:%d\n", rc);
- return rc;
- }
- rc = of_property_read_u32_array(np, "qts,trusted-touch-io-sizes",
- &vm_info->iomem_sizes[i], list_size - i);
- if (rc) {
- pr_err("Failed to read trusted touch io sizes:%d\n", rc);
- return rc;
- }
- return 0;
- }
- static int qts_populate_vm_info(struct qts_data *qts_data)
- {
- int rc;
- struct trusted_touch_vm_info *vm_info;
- struct device_node *np = qts_data->dev->of_node;
- vm_info = devm_kzalloc(qts_data->dev, sizeof(struct trusted_touch_vm_info), GFP_KERNEL);
- if (!vm_info)
- return -ENOMEM;
- qts_data->vm_info = vm_info;
- vm_info->vm_name = GH_TRUSTED_VM;
- rc = of_property_read_u32(np, "qts,trusted-touch-spi-irq", &vm_info->hw_irq);
- if (rc) {
- pr_err("Failed to read trusted touch SPI irq:%d\n", rc);
- return rc;
- }
- rc = qts_populate_vm_info_iomem(qts_data);
- if (rc) {
- pr_err("Failed to read trusted touch mmio ranges:%d\n", rc);
- return rc;
- }
- rc = of_property_read_string(np, "qts,trusted-touch-type",
- &vm_info->trusted_touch_type);
- if (rc) {
- pr_warn("No trusted touch type selection mode\n");
- vm_info->mem_tag = GH_MEM_NOTIFIER_TAG_TOUCH_PRIMARY;
- vm_info->irq_label = GH_IRQ_LABEL_TRUSTED_TOUCH_PRIMARY;
- rc = 0;
- } else if (!strcmp(vm_info->trusted_touch_type, "primary")) {
- vm_info->mem_tag = GH_MEM_NOTIFIER_TAG_TOUCH_PRIMARY;
- vm_info->irq_label = GH_IRQ_LABEL_TRUSTED_TOUCH_PRIMARY;
- } else if (!strcmp(vm_info->trusted_touch_type, "secondary")) {
- vm_info->mem_tag = GH_MEM_NOTIFIER_TAG_TOUCH_SECONDARY;
- vm_info->irq_label = GH_IRQ_LABEL_TRUSTED_TOUCH_SECONDARY;
- }
- return 0;
- }
- static void qts_destroy_vm_info(struct qts_data *qts_data)
- {
- kfree(qts_data->vm_info->iomem_sizes);
- kfree(qts_data->vm_info->iomem_bases);
- kfree(qts_data->vm_info);
- }
- static void qts_vm_deinit(struct qts_data *qts_data)
- {
- if (qts_data->vm_info->mem_cookie)
- gh_mem_notifier_unregister(qts_data->vm_info->mem_cookie);
- qts_destroy_vm_info(qts_data);
- }
- static int qts_trusted_touch_get_vm_state(struct qts_data *qts_data)
- {
- return atomic_read(&qts_data->vm_info->vm_state);
- }
- static void qts_trusted_touch_set_vm_state(struct qts_data *qts_data,
- int state)
- {
- pr_debug("state %d\n", state);
- atomic_set(&qts_data->vm_info->vm_state, state);
- }
- #ifdef CONFIG_ARCH_QTI_VM
- static int qts_vm_mem_release(struct qts_data *qts_data);
- static void qts_trusted_touch_tvm_vm_mode_disable(struct qts_data *qts_data);
- static void qts_trusted_touch_abort_tvm(struct qts_data *qts_data);
- static void qts_trusted_touch_event_notify(struct qts_data *qts_data, int event);
- static void qts_irq_enable(struct qts_data *qts_data, bool en)
- {
- if (en) {
- if (qts_data->irq_disabled) {
- pr_debug("qts irq enable\n");
- enable_irq(qts_data->irq);
- qts_data->irq_disabled = false;
- }
- } else {
- if (!qts_data->irq_disabled) {
- pr_debug("qts irq disable\n");
- disable_irq_nosync(qts_data->irq);
- qts_data->irq_disabled = true;
- }
- }
- }
- static irqreturn_t qts_irq_handler(int irq, void *data)
- {
- struct qts_data *qts_data = data;
- if (!mutex_trylock(&qts_data->transition_lock))
- return IRQ_HANDLED;
- qts_data->vendor_ops.irq_handler(irq, qts_data->vendor_data);
- mutex_unlock(&qts_data->transition_lock);
- return IRQ_HANDLED;
- }
- static int qts_irq_registration(struct qts_data *qts_data)
- {
- int ret = 0;
- qts_data->irq_gpio_flags = IRQF_TRIGGER_RISING;
- pr_debug("irq:%d, flag:%x\n", qts_data->irq, qts_data->irq_gpio_flags);
- ret = request_threaded_irq(qts_data->irq, NULL, qts_irq_handler,
- qts_data->irq_gpio_flags | IRQF_ONESHOT,
- QTS_NAME, qts_data);
- if (ret != 0)
- pr_err("request_threaded_irq failed\n");
- if (ret == 0)
- qts_irq_enable(qts_data, false);
- return ret;
- }
- void qts_trusted_touch_tvm_i2c_failure_report(struct qts_data *qts_data)
- {
- pr_warn("initiating trusted touch abort due to i2c failure\n");
- qts_trusted_touch_abort_handler(qts_data, TRUSTED_TOUCH_EVENT_I2C_FAILURE);
- }
- static void qts_trusted_touch_reset_gpio_toggle(struct qts_data *qts_data)
- {
- void __iomem *base;
- if (qts_data->bus_type != QTS_BUS_TYPE_I2C)
- return;
- base = ioremap(TOUCH_RESET_GPIO_BASE, TOUCH_RESET_GPIO_SIZE);
- writel_relaxed(0x1, base + TOUCH_RESET_GPIO_OFFSET);
- /* wait until toggle to finish*/
- wmb();
- writel_relaxed(0x0, base + TOUCH_RESET_GPIO_OFFSET);
- /* wait until toggle to finish*/
- wmb();
- iounmap(base);
- }
- static void qts_trusted_touch_intr_gpio_toggle(struct qts_data *qts_data,
- bool enable)
- {
- void __iomem *base;
- u32 val;
- if (qts_data->bus_type != QTS_BUS_TYPE_I2C)
- return;
- base = ioremap(TOUCH_INTR_GPIO_BASE, TOUCH_INTR_GPIO_SIZE);
- val = readl_relaxed(base + TOUCH_RESET_GPIO_OFFSET);
- if (enable) {
- val |= BIT(0);
- writel_relaxed(val, base + TOUCH_INTR_GPIO_OFFSET);
- /* wait until toggle to finish*/
- wmb();
- } else {
- val &= ~BIT(0);
- writel_relaxed(val, base + TOUCH_INTR_GPIO_OFFSET);
- /* wait until toggle to finish*/
- wmb();
- }
- iounmap(base);
- }
- static int qts_sgl_cmp(const void *a, const void *b)
- {
- struct gh_sgl_entry *left = (struct gh_sgl_entry *)a;
- struct gh_sgl_entry *right = (struct gh_sgl_entry *)b;
- return (left->ipa_base - right->ipa_base);
- }
- static int qts_vm_compare_sgl_desc(struct gh_sgl_desc *expected,
- struct gh_sgl_desc *received)
- {
- int idx;
- if (expected->n_sgl_entries != received->n_sgl_entries)
- return -E2BIG;
- sort(received->sgl_entries, received->n_sgl_entries,
- sizeof(received->sgl_entries[0]), qts_sgl_cmp, NULL);
- sort(expected->sgl_entries, expected->n_sgl_entries,
- sizeof(expected->sgl_entries[0]), qts_sgl_cmp, NULL);
- for (idx = 0; idx < expected->n_sgl_entries; idx++) {
- struct gh_sgl_entry *left = &expected->sgl_entries[idx];
- struct gh_sgl_entry *right = &received->sgl_entries[idx];
- if ((left->ipa_base != right->ipa_base) ||
- (left->size != right->size)) {
- pr_err("sgl mismatch: left_base:%d right base:%d left size:%d right size:%d\n",
- left->ipa_base, right->ipa_base, left->size, right->size);
- return -EINVAL;
- }
- }
- return 0;
- }
- static int qts_vm_handle_vm_hardware(struct qts_data *qts_data)
- {
- int rc = 0;
- if (atomic_read(&qts_data->delayed_tvm_probe_pending)) {
- rc = qts_irq_registration(qts_data);
- if (rc) {
- pr_err("irq registration failure on TVM!\n");
- return rc;
- }
- atomic_set(&qts_data->delayed_tvm_probe_pending, 0);
- }
- qts_irq_enable(qts_data, true);
- qts_trusted_touch_set_vm_state(qts_data, TVM_INTERRUPT_ENABLED);
- return rc;
- }
- static void qts_trusted_touch_tvm_vm_mode_enable(struct qts_data *qts_data)
- {
- struct gh_sgl_desc *sgl_desc, *expected_sgl_desc;
- struct gh_acl_desc *acl_desc;
- struct irq_data *irq_data;
- int rc = 0;
- int irq = 0;
- mutex_lock(&qts_data->transition_lock);
- if (qts_trusted_touch_get_vm_state(qts_data) != TVM_ALL_RESOURCES_LENT_NOTIFIED) {
- pr_info("All lend notifications not received\n");
- qts_trusted_touch_event_notify(qts_data,
- TRUSTED_TOUCH_EVENT_NOTIFICATIONS_PENDING);
- mutex_unlock(&qts_data->transition_lock);
- return;
- }
- if (qts_data->vendor_ops.pre_le_tui_enable)
- qts_data->vendor_ops.pre_le_tui_enable(qts_data->vendor_data);
- acl_desc = qts_vm_get_acl(GH_TRUSTED_VM);
- if (IS_ERR(acl_desc)) {
- pr_err("failed to populated acl data:rc=%d\n", PTR_ERR(acl_desc));
- goto accept_fail;
- }
- sgl_desc = gh_rm_mem_accept(qts_data->vm_info->vm_mem_handle,
- GH_RM_MEM_TYPE_IO,
- GH_RM_TRANS_TYPE_LEND,
- GH_RM_MEM_ACCEPT_VALIDATE_ACL_ATTRS |
- GH_RM_MEM_ACCEPT_VALIDATE_LABEL |
- GH_RM_MEM_ACCEPT_DONE, TRUSTED_TOUCH_MEM_LABEL,
- acl_desc, NULL, NULL, 0);
- if (IS_ERR_OR_NULL(sgl_desc)) {
- pr_err("failed to do mem accept :rc=%d\n", PTR_ERR(sgl_desc));
- goto acl_fail;
- }
- qts_trusted_touch_set_vm_state(qts_data, TVM_IOMEM_ACCEPTED);
- /* Initiate session on tvm */
- if (qts_data->bus_type == QTS_BUS_TYPE_I2C)
- rc = pm_runtime_get_sync(qts_data->client->adapter->dev.parent);
- else
- rc = pm_runtime_get_sync(qts_data->spi->master->dev.parent);
- if (rc < 0) {
- pr_err("failed to get sync rc:%d\n", rc);
- goto sgl_fail;
- }
- qts_trusted_touch_set_vm_state(qts_data, TVM_I2C_SESSION_ACQUIRED);
- expected_sgl_desc = qts_vm_get_sgl(qts_data->vm_info);
- if (qts_vm_compare_sgl_desc(expected_sgl_desc, sgl_desc)) {
- pr_err("IO sg list does not match\n");
- goto sgl_cmp_fail;
- }
- kfree(expected_sgl_desc);
- kfree(acl_desc);
- kfree(sgl_desc);
- irq = gh_irq_accept(qts_data->vm_info->irq_label, -1, IRQ_TYPE_EDGE_RISING);
- qts_trusted_touch_intr_gpio_toggle(qts_data, false);
- if (irq < 0) {
- pr_err("failed to accept irq\n");
- goto accept_fail;
- }
- qts_trusted_touch_set_vm_state(qts_data, TVM_IRQ_ACCEPTED);
- irq_data = irq_get_irq_data(irq);
- if (!irq_data) {
- pr_err("Invalid irq data for trusted touch\n");
- goto accept_fail;
- }
- if (!irq_data->hwirq) {
- pr_err("Invalid irq in irq data\n");
- goto accept_fail;
- }
- if (irq_data->hwirq != qts_data->vm_info->hw_irq) {
- pr_err("Invalid irq lent\n");
- goto accept_fail;
- }
- pr_debug("irq:returned from accept:%d\n", irq);
- qts_data->irq = irq;
- rc = qts_vm_handle_vm_hardware(qts_data);
- if (rc) {
- pr_err("Delayed probe failure on TVM!\n");
- goto accept_fail;
- }
- atomic_set(&qts_data->trusted_touch_enabled, 1);
- if (qts_data->vendor_ops.post_le_tui_enable)
- qts_data->vendor_ops.post_le_tui_enable(qts_data->vendor_data);
- pr_info("Irq, iomem are accepted and trusted touch enabled\n");
- mutex_unlock(&qts_data->transition_lock);
- return;
- sgl_cmp_fail:
- kfree(expected_sgl_desc);
- sgl_fail:
- kfree(sgl_desc);
- acl_fail:
- kfree(acl_desc);
- accept_fail:
- qts_trusted_touch_abort_handler(qts_data,
- TRUSTED_TOUCH_EVENT_ACCEPT_FAILURE);
- mutex_unlock(&qts_data->transition_lock);
- }
- static void qts_vm_irq_on_lend_callback(void *data,
- unsigned long notif_type,
- enum gh_irq_label label)
- {
- struct qts_data *qts_data = data;
- pr_debug("received irq lend request for label:%d\n", label);
- if (qts_trusted_touch_get_vm_state(qts_data) == TVM_IOMEM_LENT_NOTIFIED)
- qts_trusted_touch_set_vm_state(qts_data, TVM_ALL_RESOURCES_LENT_NOTIFIED);
- else
- qts_trusted_touch_set_vm_state(qts_data, TVM_IRQ_LENT_NOTIFIED);
- }
- static void qts_vm_mem_on_lend_handler(enum gh_mem_notifier_tag tag,
- unsigned long notif_type, void *entry_data, void *notif_msg)
- {
- struct gh_rm_notif_mem_shared_payload *payload;
- struct trusted_touch_vm_info *vm_info;
- struct qts_data *qts_data;
- qts_data = (struct qts_data *)entry_data;
- vm_info = qts_data->vm_info;
- if (!vm_info) {
- pr_err("Invalid vm_info\n");
- return;
- }
- if (notif_type != GH_RM_NOTIF_MEM_SHARED ||
- tag != vm_info->mem_tag) {
- pr_err("Invalid command passed from rm\n");
- return;
- }
- if (!entry_data || !notif_msg) {
- pr_err("Invalid entry data passed from rm\n");
- return;
- }
- payload = (struct gh_rm_notif_mem_shared_payload *)notif_msg;
- if (payload->trans_type != GH_RM_TRANS_TYPE_LEND ||
- payload->label != TRUSTED_TOUCH_MEM_LABEL) {
- pr_err("Invalid label or transaction type\n");
- return;
- }
- vm_info->vm_mem_handle = payload->mem_handle;
- pr_debug("received mem lend request with handle:%d\n", vm_info->vm_mem_handle);
- if (qts_trusted_touch_get_vm_state(qts_data) == TVM_IRQ_LENT_NOTIFIED)
- qts_trusted_touch_set_vm_state(qts_data, TVM_ALL_RESOURCES_LENT_NOTIFIED);
- else
- qts_trusted_touch_set_vm_state(qts_data, TVM_IOMEM_LENT_NOTIFIED);
- }
- static int qts_vm_mem_release(struct qts_data *qts_data)
- {
- int rc = 0;
- if (!qts_data->vm_info->vm_mem_handle) {
- pr_err("Invalid memory handle\n");
- return -EINVAL;
- }
- rc = gh_rm_mem_release(qts_data->vm_info->vm_mem_handle, 0);
- if (rc)
- pr_err("VM mem release failed: rc=%d\n", rc);
- rc = gh_rm_mem_notify(qts_data->vm_info->vm_mem_handle,
- GH_RM_MEM_NOTIFY_OWNER_RELEASED,
- qts_data->vm_info->mem_tag, 0);
- if (rc)
- pr_err("Failed to notify mem release to PVM: rc=%d\n", rc);
- pr_debug("vm mem release success\n");
- qts_data->vm_info->vm_mem_handle = 0;
- return rc;
- }
- static void qts_trusted_touch_tvm_vm_mode_disable(struct qts_data *qts_data)
- {
- int rc = 0;
- mutex_lock(&qts_data->transition_lock);
- if (atomic_read(&qts_data->trusted_touch_abort_status)) {
- qts_trusted_touch_abort_tvm(qts_data);
- mutex_unlock(&qts_data->transition_lock);
- return;
- }
- if (qts_data->vendor_ops.pre_le_tui_disable)
- qts_data->vendor_ops.pre_le_tui_disable(qts_data->vendor_data);
- qts_irq_enable(qts_data, false);
- qts_trusted_touch_set_vm_state(qts_data, TVM_INTERRUPT_DISABLED);
- rc = gh_irq_release(qts_data->vm_info->irq_label);
- if (rc) {
- pr_err("Failed to release irq rc:%d\n", rc);
- goto error;
- } else {
- qts_trusted_touch_set_vm_state(qts_data, TVM_IRQ_RELEASED);
- }
- rc = gh_irq_release_notify(qts_data->vm_info->irq_label);
- if (rc)
- pr_err("Failed to notify release irq rc:%d\n", rc);
- pr_debug("vm irq release success\n");
- if (qts_data->bus_type == QTS_BUS_TYPE_I2C)
- pm_runtime_put_sync(qts_data->client->adapter->dev.parent);
- else
- pm_runtime_put_sync(qts_data->spi->master->dev.parent);
- qts_trusted_touch_set_vm_state(qts_data, TVM_I2C_SESSION_RELEASED);
- rc = qts_vm_mem_release(qts_data);
- if (rc) {
- pr_err("Failed to release mem rc:%d\n", rc);
- goto error;
- } else {
- qts_trusted_touch_set_vm_state(qts_data, TVM_IOMEM_RELEASED);
- }
- qts_trusted_touch_set_vm_state(qts_data, TRUSTED_TOUCH_TVM_INIT);
- atomic_set(&qts_data->trusted_touch_enabled, 0);
- if (qts_data->vendor_ops.post_le_tui_disable)
- qts_data->vendor_ops.post_le_tui_disable(qts_data->vendor_data);
- pr_info("Irq, iomem are released and trusted touch disabled\n");
- mutex_unlock(&qts_data->transition_lock);
- return;
- error:
- qts_trusted_touch_abort_handler(qts_data,
- TRUSTED_TOUCH_EVENT_RELEASE_FAILURE);
- mutex_unlock(&qts_data->transition_lock);
- }
- static int qts_handle_trusted_touch_tvm(struct qts_data *qts_data, int value)
- {
- int err = 0;
- switch (value) {
- case 0:
- if ((atomic_read(&qts_data->trusted_touch_enabled) == 0) &&
- (atomic_read(&qts_data->trusted_touch_abort_status) == 0)) {
- pr_err("Trusted touch is already disabled\n");
- break;
- }
- if (atomic_read(&qts_data->trusted_touch_mode) ==
- TRUSTED_TOUCH_VM_MODE) {
- qts_trusted_touch_tvm_vm_mode_disable(qts_data);
- } else {
- pr_err("Unsupported trusted touch mode\n");
- }
- break;
- case 1:
- if (atomic_read(&qts_data->trusted_touch_enabled)) {
- pr_err("Trusted touch usecase underway\n");
- err = -EBUSY;
- break;
- }
- if (atomic_read(&qts_data->trusted_touch_mode) ==
- TRUSTED_TOUCH_VM_MODE) {
- qts_trusted_touch_tvm_vm_mode_enable(qts_data);
- } else {
- pr_err("Unsupported trusted touch mode\n");
- }
- break;
- default:
- pr_err("unsupported value: %lu\n", value);
- err = -EINVAL;
- break;
- }
- return err;
- }
- static void qts_trusted_touch_abort_tvm(struct qts_data *qts_data)
- {
- int rc = 0;
- int vm_state = qts_trusted_touch_get_vm_state(qts_data);
- if (vm_state >= TRUSTED_TOUCH_TVM_STATE_MAX) {
- pr_err("invalid tvm driver state: %d\n", vm_state);
- return;
- }
- switch (vm_state) {
- case TVM_INTERRUPT_ENABLED:
- qts_irq_enable(qts_data, false);
- fallthrough;
- case TVM_IRQ_ACCEPTED:
- case TVM_INTERRUPT_DISABLED:
- rc = gh_irq_release(qts_data->vm_info->irq_label);
- if (rc)
- pr_err("Failed to release irq rc:%d\n", rc);
- rc = gh_irq_release_notify(qts_data->vm_info->irq_label);
- if (rc)
- pr_err("Failed to notify irq release rc:%d\n", rc);
- fallthrough;
- case TVM_I2C_SESSION_ACQUIRED:
- case TVM_IOMEM_ACCEPTED:
- case TVM_IRQ_RELEASED:
- if (qts_data->bus_type == QTS_BUS_TYPE_I2C)
- pm_runtime_put_sync(qts_data->client->adapter->dev.parent);
- else
- pm_runtime_put_sync(qts_data->spi->master->dev.parent);
- fallthrough;
- case TVM_I2C_SESSION_RELEASED:
- rc = qts_vm_mem_release(qts_data);
- if (rc)
- pr_err("Failed to release mem rc:%d\n", rc);
- fallthrough;
- case TVM_IOMEM_RELEASED:
- case TVM_ALL_RESOURCES_LENT_NOTIFIED:
- case TRUSTED_TOUCH_TVM_INIT:
- case TVM_IRQ_LENT_NOTIFIED:
- case TVM_IOMEM_LENT_NOTIFIED:
- atomic_set(&qts_data->trusted_touch_enabled, 0);
- }
- atomic_set(&qts_data->trusted_touch_abort_status, 0);
- qts_trusted_touch_set_vm_state(qts_data, TRUSTED_TOUCH_TVM_INIT);
- }
- #else
- static void qts_bus_put(struct qts_data *qts_data);
- static int qts_enable_reg(struct qts_data *qts_data, bool enable);
- static void qts_trusted_touch_abort_pvm(struct qts_data *qts_data)
- {
- int rc = 0;
- int vm_state = qts_trusted_touch_get_vm_state(qts_data);
- if (vm_state >= TRUSTED_TOUCH_PVM_STATE_MAX) {
- pr_err("Invalid driver state: %d\n", vm_state);
- return;
- }
- switch (vm_state) {
- case PVM_IRQ_RELEASE_NOTIFIED:
- case PVM_ALL_RESOURCES_RELEASE_NOTIFIED:
- case PVM_IRQ_LENT:
- case PVM_IRQ_LENT_NOTIFIED:
- rc = gh_irq_reclaim(qts_data->vm_info->irq_label);
- if (rc) {
- pr_err("failed to reclaim irq on pvm rc:%d\n", rc);
- return;
- }
- fallthrough;
- case PVM_IRQ_RECLAIMED:
- case PVM_IOMEM_LENT:
- case PVM_IOMEM_LENT_NOTIFIED:
- case PVM_IOMEM_RELEASE_NOTIFIED:
- #if (KERNEL_VERSION(6, 1, 0) <= LINUX_VERSION_CODE)
- rc = ghd_rm_mem_reclaim(qts_data->vm_info->vm_mem_handle, 0);
- #else
- rc = gh_rm_mem_reclaim(qts_data->vm_info->vm_mem_handle, 0);
- #endif
- if (rc) {
- pr_err("failed to reclaim iomem on pvm rc:%d\n", rc);
- qts_trusted_touch_set_vm_state(qts_data, PVM_IOMEM_RELEASE_NOTIFIED);
- return;
- }
- qts_data->vm_info->vm_mem_handle = 0;
- fallthrough;
- case PVM_IOMEM_RECLAIMED:
- case PVM_INTERRUPT_DISABLED:
- if (qts_data->vendor_ops.enable_touch_irq)
- qts_data->vendor_ops.enable_touch_irq(qts_data->vendor_data, true);
- fallthrough;
- case PVM_I2C_RESOURCE_ACQUIRED:
- case PVM_INTERRUPT_ENABLED:
- qts_bus_put(qts_data);
- fallthrough;
- case TRUSTED_TOUCH_PVM_INIT:
- case PVM_I2C_RESOURCE_RELEASED:
- atomic_set(&qts_data->trusted_touch_enabled, 0);
- atomic_set(&qts_data->trusted_touch_transition, 0);
- }
- atomic_set(&qts_data->trusted_touch_abort_status, 0);
- qts_trusted_touch_set_vm_state(qts_data, TRUSTED_TOUCH_PVM_INIT);
- }
- static int qts_clk_prepare_enable(struct qts_data *qts_data)
- {
- int ret;
- ret = clk_prepare_enable(qts_data->iface_clk);
- if (ret) {
- pr_err("error on clk_prepare_enable(iface_clk):%d\n", ret);
- return ret;
- }
- ret = clk_prepare_enable(qts_data->core_clk);
- if (ret) {
- clk_disable_unprepare(qts_data->iface_clk);
- pr_err("error clk_prepare_enable(core_clk):%d\n", ret);
- }
- return ret;
- }
- static void qts_clk_disable_unprepare(struct qts_data *qts_data)
- {
- clk_disable_unprepare(qts_data->core_clk);
- clk_disable_unprepare(qts_data->iface_clk);
- }
- static int qts_bus_get(struct qts_data *qts_data)
- {
- int rc = 0;
- struct device *dev = NULL;
- if (qts_data->schedule_suspend)
- cancel_work_sync(&qts_data->suspend_work);
- if (qts_data->schedule_resume)
- cancel_work_sync(&qts_data->resume_work);
- reinit_completion(&qts_data->trusted_touch_powerdown);
- qts_enable_reg(qts_data, true);
- if (qts_data->bus_type == QTS_BUS_TYPE_I2C)
- dev = qts_data->client->adapter->dev.parent;
- else
- dev = qts_data->spi->master->dev.parent;
- mutex_lock(&qts_data->qts_clk_io_ctrl_mutex);
- rc = pm_runtime_get_sync(dev);
- if (rc >= 0 && qts_data->core_clk != NULL &&
- qts_data->iface_clk != NULL) {
- rc = qts_clk_prepare_enable(qts_data);
- if (rc)
- pm_runtime_put_sync(dev);
- }
- mutex_unlock(&qts_data->qts_clk_io_ctrl_mutex);
- return rc;
- }
- static void qts_bus_put(struct qts_data *qts_data)
- {
- struct device *dev = NULL;
- if (qts_data->bus_type == QTS_BUS_TYPE_I2C)
- dev = qts_data->client->adapter->dev.parent;
- else
- dev = qts_data->spi->master->dev.parent;
- mutex_lock(&qts_data->qts_clk_io_ctrl_mutex);
- if (qts_data->core_clk != NULL && qts_data->iface_clk != NULL)
- qts_clk_disable_unprepare(qts_data);
- pm_runtime_put_sync(dev);
- mutex_unlock(&qts_data->qts_clk_io_ctrl_mutex);
- complete(&qts_data->trusted_touch_powerdown);
- qts_enable_reg(qts_data, false);
- }
- static struct gh_notify_vmid_desc *qts_vm_get_vmid(gh_vmid_t vmid)
- {
- struct gh_notify_vmid_desc *vmid_desc;
- vmid_desc = kzalloc(offsetof(struct gh_notify_vmid_desc,
- vmid_entries[1]), GFP_KERNEL);
- if (!vmid_desc)
- return ERR_PTR(ENOMEM);
- vmid_desc->n_vmid_entries = 1;
- vmid_desc->vmid_entries[0].vmid = vmid;
- return vmid_desc;
- }
- static void qts_trusted_touch_pvm_vm_mode_disable(struct qts_data *qts_data)
- {
- int rc = 0;
- atomic_set(&qts_data->trusted_touch_transition, 1);
- if (atomic_read(&qts_data->trusted_touch_abort_status)) {
- qts_trusted_touch_abort_pvm(qts_data);
- return;
- }
- if (qts_trusted_touch_get_vm_state(qts_data) != PVM_ALL_RESOURCES_RELEASE_NOTIFIED)
- pr_info("all release notifications are not received yet\n");
- if (qts_data->vendor_ops.pre_la_tui_disable)
- qts_data->vendor_ops.pre_la_tui_disable(qts_data->vendor_data);
- #if (KERNEL_VERSION(6, 1, 0) <= LINUX_VERSION_CODE)
- rc = ghd_rm_mem_reclaim(qts_data->vm_info->vm_mem_handle, 0);
- #else
- rc = gh_rm_mem_reclaim(qts_data->vm_info->vm_mem_handle, 0);
- #endif
- if (rc) {
- pr_err("Trusted touch VM mem reclaim failed rc:%d\n", rc);
- goto error;
- }
- qts_trusted_touch_set_vm_state(qts_data, PVM_IOMEM_RECLAIMED);
- qts_data->vm_info->vm_mem_handle = 0;
- pr_debug("vm mem reclaim success!\n");
- rc = gh_irq_reclaim(qts_data->vm_info->irq_label);
- if (rc) {
- pr_err("failed to reclaim irq on pvm rc:%d\n", rc);
- goto error;
- }
- qts_trusted_touch_set_vm_state(qts_data, PVM_IRQ_RECLAIMED);
- pr_debug("vm irq reclaim success!\n");
- if (qts_data->vendor_ops.enable_touch_irq)
- qts_data->vendor_ops.enable_touch_irq(qts_data->vendor_data, true);
- qts_trusted_touch_set_vm_state(qts_data, PVM_INTERRUPT_ENABLED);
- qts_bus_put(qts_data);
- atomic_set(&qts_data->trusted_touch_transition, 0);
- qts_trusted_touch_set_vm_state(qts_data, PVM_I2C_RESOURCE_RELEASED);
- qts_trusted_touch_set_vm_state(qts_data, TRUSTED_TOUCH_PVM_INIT);
- atomic_set(&qts_data->trusted_touch_enabled, 0);
- if (qts_data->vendor_ops.post_la_tui_disable)
- qts_data->vendor_ops.post_la_tui_disable(qts_data->vendor_data);
- pr_info("Irq, iomem are reclaimed and trusted touch disabled\n");
- return;
- error:
- qts_trusted_touch_abort_handler(qts_data,
- TRUSTED_TOUCH_EVENT_RECLAIM_FAILURE);
- }
- static void qts_vm_irq_on_release_callback(void *data,
- unsigned long notif_type,
- enum gh_irq_label label)
- {
- struct qts_data *qts_data = data;
- if (notif_type != GH_RM_NOTIF_VM_IRQ_RELEASED) {
- pr_err("invalid notification type\n");
- return;
- }
- if (qts_trusted_touch_get_vm_state(qts_data) == PVM_IOMEM_RELEASE_NOTIFIED)
- qts_trusted_touch_set_vm_state(qts_data, PVM_ALL_RESOURCES_RELEASE_NOTIFIED);
- else
- qts_trusted_touch_set_vm_state(qts_data, PVM_IRQ_RELEASE_NOTIFIED);
- }
- static void qts_vm_mem_on_release_handler(enum gh_mem_notifier_tag tag,
- unsigned long notif_type, void *entry_data, void *notif_msg)
- {
- struct gh_rm_notif_mem_released_payload *release_payload;
- struct trusted_touch_vm_info *vm_info;
- struct qts_data *qts_data;
- qts_data = (struct qts_data *)entry_data;
- vm_info = qts_data->vm_info;
- if (!vm_info) {
- pr_err("Invalid vm_info\n");
- return;
- }
- if (notif_type != GH_RM_NOTIF_MEM_RELEASED) {
- pr_err("Invalid notification type\n");
- return;
- }
- if (tag != vm_info->mem_tag) {
- pr_err("Invalid tag\n");
- return;
- }
- if (!entry_data || !notif_msg) {
- pr_err("Invalid data or notification message\n");
- return;
- }
- release_payload = (struct gh_rm_notif_mem_released_payload *)notif_msg;
- if (release_payload->mem_handle != vm_info->vm_mem_handle) {
- pr_err("Invalid mem handle detected\n");
- return;
- }
- if (qts_trusted_touch_get_vm_state(qts_data) == PVM_IRQ_RELEASE_NOTIFIED)
- qts_trusted_touch_set_vm_state(qts_data, PVM_ALL_RESOURCES_RELEASE_NOTIFIED);
- else
- qts_trusted_touch_set_vm_state(qts_data, PVM_IOMEM_RELEASE_NOTIFIED);
- }
- static int qts_vm_mem_lend(struct qts_data *qts_data)
- {
- struct gh_acl_desc *acl_desc;
- struct gh_sgl_desc *sgl_desc;
- struct gh_notify_vmid_desc *vmid_desc;
- gh_memparcel_handle_t mem_handle;
- gh_vmid_t trusted_vmid;
- int rc = 0;
- acl_desc = qts_vm_get_acl(GH_TRUSTED_VM);
- if (IS_ERR(acl_desc)) {
- pr_err("Failed to get acl of IO memories for Trusted touch\n");
- rc = PTR_ERR(acl_desc);
- return rc;
- }
- sgl_desc = qts_vm_get_sgl(qts_data->vm_info);
- if (IS_ERR(sgl_desc)) {
- pr_err("Failed to get sgl of IO memories for Trusted touch\n");
- rc = PTR_ERR(sgl_desc);
- goto sgl_error;
- }
- #if (KERNEL_VERSION(6, 1, 0) <= LINUX_VERSION_CODE)
- rc = ghd_rm_mem_lend(GH_RM_MEM_TYPE_IO, 0, TRUSTED_TOUCH_MEM_LABEL,
- acl_desc, sgl_desc, NULL, &mem_handle);
- #else
- rc = gh_rm_mem_lend(GH_RM_MEM_TYPE_IO, 0, TRUSTED_TOUCH_MEM_LABEL,
- acl_desc, sgl_desc, NULL, &mem_handle);
- #endif
- if (rc) {
- pr_err("Failed to lend IO memories for Trusted touch rc:%d\n", rc);
- goto error;
- }
- pr_debug("vm mem lend success\n");
- qts_trusted_touch_set_vm_state(qts_data, PVM_IOMEM_LENT);
- #if (KERNEL_VERSION(6, 1, 0) <= LINUX_VERSION_CODE)
- ghd_rm_get_vmid(GH_TRUSTED_VM, &trusted_vmid);
- #else
- gh_rm_get_vmid(GH_TRUSTED_VM, &trusted_vmid);
- #endif
- vmid_desc = qts_vm_get_vmid(trusted_vmid);
- rc = gh_rm_mem_notify(mem_handle, GH_RM_MEM_NOTIFY_RECIPIENT_SHARED,
- qts_data->vm_info->mem_tag, vmid_desc);
- if (rc) {
- pr_err("Failed to notify mem lend to hypervisor rc:%d\n", rc);
- goto vmid_error;
- }
- qts_trusted_touch_set_vm_state(qts_data, PVM_IOMEM_LENT_NOTIFIED);
- qts_data->vm_info->vm_mem_handle = mem_handle;
- vmid_error:
- kfree(vmid_desc);
- error:
- kfree(sgl_desc);
- sgl_error:
- kfree(acl_desc);
- return rc;
- }
- static int qts_trusted_touch_pvm_vm_mode_enable(struct qts_data *qts_data)
- {
- int rc = 0;
- struct trusted_touch_vm_info *vm_info = qts_data->vm_info;
- atomic_set(&qts_data->trusted_touch_transition, 1);
- mutex_lock(&qts_data->transition_lock);
- if (qts_data->suspended) {
- pr_err("Invalid power state for operation\n");
- atomic_set(&qts_data->trusted_touch_transition, 0);
- rc = -EPERM;
- goto error;
- }
- if (qts_data->vendor_ops.pre_la_tui_enable)
- qts_data->vendor_ops.pre_la_tui_enable(qts_data->vendor_data);
- /* i2c session start and resource acquire */
- if (qts_bus_get(qts_data) < 0) {
- pr_err("qts_bus_get failed\n");
- rc = -EIO;
- goto error;
- }
- qts_trusted_touch_set_vm_state(qts_data, PVM_I2C_RESOURCE_ACQUIRED);
- if (qts_data->vendor_ops.enable_touch_irq)
- qts_data->vendor_ops.enable_touch_irq(qts_data->vendor_data, false);
- qts_trusted_touch_set_vm_state(qts_data, PVM_INTERRUPT_DISABLED);
- rc = qts_vm_mem_lend(qts_data);
- if (rc) {
- pr_err("Failed to lend memory\n");
- goto abort_handler;
- }
- pr_debug("vm mem lend success\n");
- if (atomic_read(&qts_data->delayed_pvm_probe_pending)) {
- if (qts_data->vendor_ops.get_irq_num)
- qts_data->irq = qts_data->vendor_ops.get_irq_num(qts_data->vendor_data);
- atomic_set(&qts_data->delayed_tvm_probe_pending, 0);
- }
- rc = gh_irq_lend_v2(vm_info->irq_label, vm_info->vm_name,
- qts_data->irq, &qts_vm_irq_on_release_callback, qts_data);
- if (rc) {
- pr_err("Failed to lend irq\n");
- goto abort_handler;
- }
- pr_debug("vm irq lend success for irq:%d\n", qts_data->irq);
- qts_trusted_touch_set_vm_state(qts_data, PVM_IRQ_LENT);
- rc = gh_irq_lend_notify(vm_info->irq_label);
- if (rc) {
- pr_err("Failed to notify irq\n");
- goto abort_handler;
- }
- qts_trusted_touch_set_vm_state(qts_data, PVM_IRQ_LENT_NOTIFIED);
- if (qts_data->vendor_ops.post_la_tui_enable)
- qts_data->vendor_ops.post_la_tui_enable(qts_data->vendor_data);
- mutex_unlock(&qts_data->transition_lock);
- atomic_set(&qts_data->trusted_touch_transition, 0);
- atomic_set(&qts_data->trusted_touch_enabled, 1);
- pr_info("Irq, iomem are lent and trusted touch enabled\n");
- return rc;
- abort_handler:
- qts_trusted_touch_abort_handler(qts_data, TRUSTED_TOUCH_EVENT_LEND_FAILURE);
- error:
- mutex_unlock(&qts_data->transition_lock);
- return rc;
- }
- static int qts_handle_trusted_touch_pvm(struct qts_data *qts_data, int value)
- {
- int err = 0;
- switch (value) {
- case 0:
- if (atomic_read(&qts_data->trusted_touch_enabled) == 0 &&
- (atomic_read(&qts_data->trusted_touch_abort_status) == 0)) {
- pr_err("Trusted touch is already disabled\n");
- break;
- }
- if (atomic_read(&qts_data->trusted_touch_mode) ==
- TRUSTED_TOUCH_VM_MODE) {
- qts_trusted_touch_pvm_vm_mode_disable(qts_data);
- } else {
- pr_err("Unsupported trusted touch mode\n");
- }
- break;
- case 1:
- if (atomic_read(&qts_data->trusted_touch_enabled)) {
- pr_err("Trusted touch usecase underway\n");
- err = -EBUSY;
- break;
- }
- if (atomic_read(&qts_data->trusted_touch_mode) ==
- TRUSTED_TOUCH_VM_MODE) {
- err = qts_trusted_touch_pvm_vm_mode_enable(qts_data);
- } else {
- pr_err("Unsupported trusted touch mode\n");
- }
- break;
- default:
- pr_err("unsupported value: %lu\n", value);
- err = -EINVAL;
- break;
- }
- return err;
- }
- #endif
- static void qts_trusted_touch_event_notify(struct qts_data *qts_data, int event)
- {
- atomic_set(&qts_data->trusted_touch_event, event);
- sysfs_notify(&qts_data->dev->kobj, NULL, "trusted_touch_event");
- }
- static void qts_trusted_touch_abort_handler(struct qts_data *qts_data, int error)
- {
- atomic_set(&qts_data->trusted_touch_abort_status, error);
- pr_info("TUI session aborted with failure:%d\n", error);
- qts_trusted_touch_event_notify(qts_data, error);
- #ifdef CONFIG_ARCH_QTI_VM
- pr_info("Resetting touch controller\n");
- if (qts_trusted_touch_get_vm_state(qts_data) >= TVM_IOMEM_ACCEPTED &&
- error == TRUSTED_TOUCH_EVENT_I2C_FAILURE) {
- pr_info("Resetting touch controller\n");
- qts_trusted_touch_reset_gpio_toggle(qts_data);
- }
- #endif
- }
- static int qts_vm_init(struct qts_data *qts_data)
- {
- int rc = 0;
- struct trusted_touch_vm_info *vm_info;
- void *mem_cookie;
- rc = qts_populate_vm_info(qts_data);
- if (rc) {
- pr_err("Cannot setup vm pipeline\n");
- rc = -EINVAL;
- goto fail;
- }
- vm_info = qts_data->vm_info;
- #ifdef CONFIG_ARCH_QTI_VM
- mem_cookie = gh_mem_notifier_register(vm_info->mem_tag,
- qts_vm_mem_on_lend_handler, qts_data);
- if (!mem_cookie) {
- pr_err("Failed to register on lend mem notifier\n");
- rc = -EINVAL;
- goto init_fail;
- }
- vm_info->mem_cookie = mem_cookie;
- rc = gh_irq_wait_for_lend_v2(vm_info->irq_label, GH_PRIMARY_VM,
- &qts_vm_irq_on_lend_callback, qts_data);
- qts_trusted_touch_set_vm_state(qts_data, TRUSTED_TOUCH_TVM_INIT);
- #else
- mem_cookie = gh_mem_notifier_register(vm_info->mem_tag,
- qts_vm_mem_on_release_handler, qts_data);
- if (!mem_cookie) {
- pr_err("Failed to register on release mem notifier\n");
- rc = -EINVAL;
- goto init_fail;
- }
- vm_info->mem_cookie = mem_cookie;
- qts_trusted_touch_set_vm_state(qts_data, TRUSTED_TOUCH_PVM_INIT);
- #endif
- return rc;
- init_fail:
- qts_vm_deinit(qts_data);
- fail:
- return rc;
- }
- static void qts_dt_parse_trusted_touch_info(struct qts_data *qts_data)
- {
- struct device_node *np = qts_data->dev->of_node;
- int rc = 0;
- const char *selection;
- const char *environment;
- rc = of_property_read_string(np, "qts,trusted-touch-mode", &selection);
- if (rc) {
- pr_err("No trusted touch mode selection made\n");
- atomic_set(&qts_data->trusted_touch_mode,
- TRUSTED_TOUCH_MODE_NONE);
- return;
- }
- if (!strcmp(selection, "vm_mode")) {
- atomic_set(&qts_data->trusted_touch_mode,
- TRUSTED_TOUCH_VM_MODE);
- pr_debug("Selected trusted touch mode to VM mode\n");
- } else {
- atomic_set(&qts_data->trusted_touch_mode,
- TRUSTED_TOUCH_MODE_NONE);
- pr_err("Invalid trusted_touch mode\n");
- }
- rc = of_property_read_string(np, "qts,touch-environment",
- &environment);
- if (rc)
- pr_err("No trusted touch mode environment\n");
- qts_data->touch_environment = environment;
- qts_data->tui_supported = true;
- pr_debug("Trusted touch environment:%s\n", qts_data->touch_environment);
- }
- static void qts_trusted_touch_init(struct qts_data *qts_data)
- {
- int rc = 0;
- atomic_set(&qts_data->trusted_touch_initialized, 0);
- qts_dt_parse_trusted_touch_info(qts_data);
- if (atomic_read(&qts_data->trusted_touch_mode) == TRUSTED_TOUCH_MODE_NONE)
- return;
- init_completion(&qts_data->trusted_touch_powerdown);
- /* Get clocks */
- qts_data->core_clk = devm_clk_get(qts_data->dev->parent, "m-ahb");
- if (IS_ERR(qts_data->core_clk)) {
- qts_data->core_clk = NULL;
- pr_err("core_clk is not defined\n");
- }
- qts_data->iface_clk = devm_clk_get(qts_data->dev->parent, "se-clk");
- if (IS_ERR(qts_data->iface_clk)) {
- qts_data->iface_clk = NULL;
- pr_err("iface_clk is not defined\n");
- }
- if (atomic_read(&qts_data->trusted_touch_mode) ==
- TRUSTED_TOUCH_VM_MODE) {
- rc = qts_vm_init(qts_data);
- if (rc)
- pr_err("Failed to init VM\n");
- }
- atomic_set(&qts_data->trusted_touch_initialized, 1);
- }
- static bool qts_ts_is_primary(struct kobject *kobj)
- {
- char *path = NULL;
- if (!kobj)
- return true;
- path = kobject_get_path(kobj, GFP_KERNEL);
- if (strstr(path, "primary"))
- return true;
- else
- return false;
- }
- static ssize_t trusted_touch_enable_show(struct kobject *kobj, struct kobj_attribute *attr,
- char *buf)
- {
- struct qts_data *qts_data;
- u32 idx = qts_ts_is_primary(kobj) ? 0 : 1;
- qts_data = &qts_data_entries->info[idx];
- return scnprintf(buf, PAGE_SIZE, "%d",
- atomic_read(&qts_data->trusted_touch_enabled));
- }
- static ssize_t trusted_touch_enable_store(struct kobject *kobj, struct kobj_attribute *attr,
- const char *buf, size_t count)
- {
- struct qts_data *qts_data;
- unsigned long value;
- int err = 0;
- u32 idx = qts_ts_is_primary(kobj) ? 0 : 1;
- if (count > 2)
- return -EINVAL;
- err = kstrtoul(buf, 10, &value);
- if (err != 0)
- return err;
- qts_data = &qts_data_entries->info[idx];
- if (!atomic_read(&qts_data->trusted_touch_initialized))
- return -EIO;
- pr_info("TUI trusted_touch_enable:%d\n", value);
- #ifdef CONFIG_ARCH_QTI_VM
- err = qts_handle_trusted_touch_tvm(qts_data, value);
- if (err) {
- pr_err("Failed to handle trusted touch in tvm\n");
- return -EINVAL;
- }
- #else
- err = qts_handle_trusted_touch_pvm(qts_data, value);
- if (err) {
- pr_err("Failed to handle trusted touch in pvm\n");
- return -EINVAL;
- }
- #endif
- err = count;
- return err;
- }
- static ssize_t trusted_touch_event_show(struct kobject *kobj, struct kobj_attribute *attr,
- char *buf)
- {
- struct qts_data *qts_data;
- u32 idx = qts_ts_is_primary(kobj) ? 0 : 1;
- qts_data = &qts_data_entries->info[idx];
- return scnprintf(buf, PAGE_SIZE, "%d",
- atomic_read(&qts_data->trusted_touch_event));
- }
- static ssize_t trusted_touch_event_store(struct kobject *kobj, struct kobj_attribute *attr,
- const char *buf, size_t count)
- {
- struct qts_data *qts_data;
- unsigned long value;
- int err = 0;
- u32 idx = qts_ts_is_primary(kobj) ? 0 : 1;
- if (count > 2)
- return -EINVAL;
- err = kstrtoul(buf, 10, &value);
- if (err != 0)
- return err;
- qts_data = &qts_data_entries->info[idx];
- if (!atomic_read(&qts_data->trusted_touch_initialized))
- return -EIO;
- if (value)
- return -EIO;
- atomic_set(&qts_data->trusted_touch_event, value);
- return count;
- }
- static ssize_t trusted_touch_type_show(struct kobject *kobj, struct kobj_attribute *attr, char *buf)
- {
- struct qts_data *qts_data;
- u32 idx = qts_ts_is_primary(kobj) ? 0 : 1;
- qts_data = &qts_data_entries->info[idx];
- return scnprintf(buf, PAGE_SIZE, "%s", qts_data->vm_info->trusted_touch_type);
- }
- static ssize_t trusted_touch_device_path_show(struct kobject *kobj,
- struct kobj_attribute *attr, char *buf)
- {
- struct qts_data *qts_data;
- char *path = NULL;
- u32 idx = qts_ts_is_primary(kobj) ? 0 : 1;
- qts_data = &qts_data_entries->info[idx];
- if (qts_data && qts_data->dev)
- path = kobject_get_path(&qts_data->dev->kobj, GFP_KERNEL);
- return scnprintf(buf, PAGE_SIZE, "%s", path ? path : "");
- }
- static struct kobj_attribute trusted_touch_enable_attr =
- __ATTR(trusted_touch_enable, 0664, trusted_touch_enable_show, trusted_touch_enable_store);
- static struct kobj_attribute trusted_touch_event_attr =
- __ATTR(trusted_touch_event, 0664, trusted_touch_event_show, trusted_touch_event_store);
- static struct kobj_attribute trusted_touch_type_attr =
- __ATTR(trusted_touch_type, 0664, trusted_touch_type_show, NULL);
- static struct kobj_attribute trusted_touch_device_path_attr =
- __ATTR(trusted_touch_device_path, 0444, trusted_touch_device_path_show, NULL);
- static struct attribute *qts_attributes[] = {
- &trusted_touch_enable_attr.attr,
- &trusted_touch_event_attr.attr,
- &trusted_touch_type_attr.attr,
- &trusted_touch_device_path_attr.attr,
- NULL,
- };
- static struct attribute_group qts_attribute_group = {
- .attrs = qts_attributes,
- };
- static int qts_create_sysfs(struct qts_data *qts_data)
- {
- int ret = 0;
- struct kobject *qts_kobj;
- struct kobject *client_kobj;
- qts_kobj = &qts_data_entries->qts_kset->kobj;
- if (qts_data->client_type == QTS_CLIENT_PRIMARY_TOUCH) {
- client_kobj = kobject_create_and_add("primary", qts_kobj);
- if (!client_kobj) {
- pr_err("primary kobject_create_and_add failed\n");
- return -ENOMEM;
- }
- ret = sysfs_create_group(client_kobj, &qts_attribute_group);
- if (ret) {
- pr_err("[EX]: sysfs_create_group() failed!!\n");
- sysfs_remove_group(client_kobj, &qts_attribute_group);
- return -ENOMEM;
- }
- } else if (qts_data->client_type == QTS_CLIENT_SECONDARY_TOUCH) {
- client_kobj = kobject_create_and_add("secondary", qts_kobj);
- if (!client_kobj) {
- pr_err("secondary kobject_create_and_add failed\n");
- return -ENOMEM;
- }
- ret = sysfs_create_group(client_kobj, &qts_attribute_group);
- if (ret) {
- pr_err("[EX]: sysfs_create_group() failed!!\n");
- sysfs_remove_group(client_kobj, &qts_attribute_group);
- return -ENOMEM;
- }
- }
- pr_debug("sysfs_create_group() succeeded\n");
- return ret;
- }
- static int qts_ts_check_dt(struct device_node *np)
- {
- int i;
- int count;
- struct device_node *node;
- struct drm_panel *panel;
- count = of_count_phandle_with_args(np, "panel", NULL);
- if (count <= 0)
- return 0;
- for (i = 0; i < count; i++) {
- node = of_parse_phandle(np, "panel", i);
- panel = of_drm_find_panel(node);
- of_node_put(node);
- if (!IS_ERR(panel)) {
- active_panel = panel;
- return 0;
- }
- }
- return PTR_ERR(panel);
- }
- static void qts_power_source_init(struct qts_data *qts_data)
- {
- qts_data->vdd = regulator_get(qts_data->dev, "vdd");
- if (IS_ERR_OR_NULL(qts_data->vdd))
- pr_debug("get vdd regulator failed\n");
- qts_data->avdd = regulator_get(qts_data->dev, "avdd");
- if (IS_ERR_OR_NULL(qts_data->avdd))
- pr_debug("get avdd regulator failed\n");
- }
- #ifndef CONFIG_ARCH_QTI_VM
- static int qts_enable_reg(struct qts_data *qts_data, bool enable)
- {
- int ret = 0;
- if (IS_ERR_OR_NULL(qts_data->vdd)) {
- pr_err("vdd is invalid\n");
- return ret;
- }
- if (enable) {
- ret = regulator_enable(qts_data->vdd);
- if (ret) {
- pr_err("enable vdd regulator failed,ret=%d\n", ret);
- goto error;
- }
- if (!IS_ERR_OR_NULL(qts_data->avdd)) {
- ret = regulator_enable(qts_data->avdd);
- if (ret) {
- pr_err("enable avdd regulator failed,ret=%d\n", ret);
- goto error_avdd_en;
- }
- }
- } else {
- ret = regulator_disable(qts_data->vdd);
- if (ret)
- pr_err("disable vdd regulator failed,ret=%d\n", ret);
- if (!IS_ERR_OR_NULL(qts_data->avdd)) {
- ret = regulator_disable(qts_data->avdd);
- if (ret)
- pr_err("disable avdd regulator failed,ret=%d\n", ret);
- }
- }
- pr_debug("enable %d completed\n", enable);
- return ret;
- error_avdd_en:
- (void)regulator_disable(qts_data->vdd);
- error:
- return ret;
- }
- #endif
- static void qts_ts_suspend(struct qts_data *qts_data)
- {
- int rc = 0;
- if (qts_data->suspended) {
- pr_warn("already in suspend state\n");
- return;
- }
- if (qts_data->tui_supported) {
- if (atomic_read(&qts_data->trusted_touch_transition)
- || atomic_read(&qts_data->trusted_touch_enabled))
- wait_for_completion_interruptible(&qts_data->trusted_touch_powerdown);
- }
- mutex_lock(&qts_data->transition_lock);
- rc = qts_data->vendor_ops.suspend(qts_data->vendor_data);
- if (rc)
- pr_err("suspend failed, rc = %d\n", rc);
- qts_data->suspended = true;
- mutex_unlock(&qts_data->transition_lock);
- }
- static void qts_ts_resume(struct qts_data *qts_data)
- {
- int rc = 0;
- if (!qts_data->suspended) {
- pr_warn("Already in awake state\n");
- return;
- }
- if (qts_data->tui_supported)
- if (atomic_read(&qts_data->trusted_touch_transition))
- wait_for_completion_interruptible(&qts_data->trusted_touch_powerdown);
- mutex_lock(&qts_data->transition_lock);
- rc = qts_data->vendor_ops.resume(qts_data->vendor_data);
- if (rc)
- pr_err("resume failed, rc = %d\n", rc);
- qts_data->suspended = false;
- mutex_unlock(&qts_data->transition_lock);
- }
- static void qts_resume_work(struct work_struct *work)
- {
- struct qts_data *qts_data = container_of(work, struct qts_data,
- resume_work);
- qts_ts_resume(qts_data);
- }
- static void qts_suspend_work(struct work_struct *work)
- {
- struct qts_data *qts_data = container_of(work, struct qts_data,
- suspend_work);
- qts_ts_suspend(qts_data);
- }
- static void qts_panel_notifier_callback(enum panel_event_notifier_tag tag,
- struct panel_event_notification *notification, void *client_data)
- {
- struct qts_data *qts_data = client_data;
- if (!notification) {
- pr_err("Invalid notification\n");
- return;
- }
- pr_debug("Notification type:%d, early_trigger:%d\n",
- notification->notif_type, notification->notif_data.early_trigger);
- switch (notification->notif_type) {
- case DRM_PANEL_EVENT_UNBLANK:
- if (notification->notif_data.early_trigger) {
- pr_debug("resume notification pre commit\n");
- } else {
- if (qts_data->schedule_resume)
- queue_work(qts_data->ts_workqueue, &qts_data->resume_work);
- else
- qts_ts_resume(qts_data);
- }
- break;
- case DRM_PANEL_EVENT_BLANK:
- if (notification->notif_data.early_trigger) {
- if (qts_data->schedule_resume)
- cancel_work_sync(&qts_data->resume_work);
- if (qts_data->schedule_suspend)
- queue_work(qts_data->ts_workqueue, &qts_data->suspend_work);
- else
- qts_ts_suspend(qts_data);
- } else {
- pr_debug("suspend notification post commit\n");
- }
- break;
- case DRM_PANEL_EVENT_BLANK_LP:
- pr_debug("received lp event\n");
- break;
- case DRM_PANEL_EVENT_FPS_CHANGE:
- pr_debug("Received fps change old fps:%d new fps:%d\n",
- notification->notif_data.old_fps,
- notification->notif_data.new_fps);
- break;
- default:
- pr_debug("notification serviced :%d\n",
- notification->notif_type);
- break;
- }
- }
- static void qts_ts_register_for_panel_events(struct qts_data *qts_data)
- {
- void *cookie = NULL;
- if (qts_data->client_type != QTS_CLIENT_PRIMARY_TOUCH) {
- pr_err("Invalid touch type\n");
- return;
- }
- cookie = panel_event_notifier_register(PANEL_EVENT_NOTIFICATION_PRIMARY,
- PANEL_EVENT_NOTIFIER_CLIENT_PRIMARY_TOUCH, qts_data->panel,
- &qts_panel_notifier_callback, qts_data);
- if (!cookie) {
- pr_err("Failed to register for panel events\n");
- return;
- }
- pr_debug("registered for panel notifications panel: 0x%x\n", qts_data->panel);
- qts_data->notifier_cookie = cookie;
- }
- int qts_client_register(struct qts_vendor_data qts_vendor_data)
- {
- struct qts_data *qts_data;
- struct device_node *dp;
- int rc = 0;
- if (!qts_data_entries) {
- pr_debug("QTS client register\n");
- qts_data_entries = kzalloc(sizeof(*qts_data_entries), GFP_KERNEL);
- if (!qts_data_entries) {
- pr_err("mem allocation failed\n");
- return -EPROBE_DEFER;
- }
- mutex_init(&qts_data_entries->qts_data_entries_lock);
- qts_data_entries->qts_kset = kset_create_and_add("qts", NULL, kernel_kobj);
- if (!qts_data_entries->qts_kset) {
- pr_err("qts kset create failed\n");
- return -ENOMEM;
- }
- }
- mutex_lock(&qts_data_entries->qts_data_entries_lock);
- if (qts_vendor_data.bus_type == QTS_BUS_TYPE_I2C)
- dp = qts_vendor_data.client->dev.of_node;
- else
- dp = qts_vendor_data.spi->dev.of_node;
- rc = qts_ts_check_dt(dp);
- if (rc) {
- pr_debug("qts_ts_check_dt failed, rc = %d\n", rc);
- goto qts_register_end;
- }
- pr_debug("QTS client register starts\n");
- qts_data = &qts_data_entries->info[qts_vendor_data.client_type];
- qts_data->client = qts_vendor_data.client;
- qts_data->spi = qts_vendor_data.spi;
- if (qts_vendor_data.bus_type == QTS_BUS_TYPE_I2C)
- qts_data->dev = &qts_data->client->dev;
- else
- qts_data->dev = &qts_data->spi->dev;
- qts_data->bus_type = qts_vendor_data.bus_type;
- qts_data->client_type = qts_vendor_data.client_type;
- qts_data->dp = dp;
- qts_data->vendor_data = qts_vendor_data.vendor_data;
- qts_data->panel = active_panel;
- qts_data->vendor_ops = qts_vendor_data.qts_vendor_ops;
- qts_data->schedule_suspend = qts_vendor_data.schedule_suspend;
- qts_data->schedule_resume = qts_vendor_data.schedule_resume;
- qts_trusted_touch_init(qts_data);
- mutex_init(&(qts_data->qts_clk_io_ctrl_mutex));
- if (qts_data->tui_supported)
- qts_create_sysfs(qts_data);
- mutex_init(&qts_data->transition_lock);
- #ifdef CONFIG_ARCH_QTI_VM
- atomic_set(&qts_data->delayed_tvm_probe_pending, 1);
- goto qts_register_end;
- #else
- atomic_set(&qts_data->delayed_pvm_probe_pending, 1);
- #endif
- qts_power_source_init(qts_data);
- qts_data->ts_workqueue = create_singlethread_workqueue("qts_wq");
- if (!qts_data->ts_workqueue)
- pr_err("create qts workqueue fail\n");
- if (qts_data->ts_workqueue && qts_data->schedule_resume)
- INIT_WORK(&qts_data->resume_work, qts_resume_work);
- if (qts_data->ts_workqueue && qts_data->schedule_suspend)
- INIT_WORK(&qts_data->suspend_work, qts_suspend_work);
- qts_ts_register_for_panel_events(qts_data);
- qts_register_end:
- pr_debug("client register end\n");
- mutex_unlock(&qts_data_entries->qts_data_entries_lock);
- return rc;
- }
- EXPORT_SYMBOL(qts_client_register);
|