12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 24dea2d1aSSukadev Bhattiprolu /* 34dea2d1aSSukadev Bhattiprolu * Copyright 2016-17 IBM Corp. 44dea2d1aSSukadev Bhattiprolu */ 54dea2d1aSSukadev Bhattiprolu 64dea2d1aSSukadev Bhattiprolu #define pr_fmt(fmt) "vas: " fmt 74dea2d1aSSukadev Bhattiprolu 84dea2d1aSSukadev Bhattiprolu #include <linux/module.h> 94dea2d1aSSukadev Bhattiprolu #include <linux/kernel.h> 104dea2d1aSSukadev Bhattiprolu #include <linux/export.h> 114dea2d1aSSukadev Bhattiprolu #include <linux/types.h> 124dea2d1aSSukadev Bhattiprolu #include <linux/slab.h> 134dea2d1aSSukadev Bhattiprolu #include <linux/platform_device.h> 144dea2d1aSSukadev Bhattiprolu #include <linux/of_platform.h> 154dea2d1aSSukadev Bhattiprolu #include <linux/of_address.h> 164dea2d1aSSukadev Bhattiprolu #include <linux/of.h> 17ca03258bSSukadev Bhattiprolu #include <asm/prom.h> 18c20e1e29SHaren Myneni #include <asm/xive.h> 194dea2d1aSSukadev Bhattiprolu 204dea2d1aSSukadev Bhattiprolu #include "vas.h" 214dea2d1aSSukadev Bhattiprolu 22ece4e512SSukadev Bhattiprolu DEFINE_MUTEX(vas_mutex); 234dea2d1aSSukadev Bhattiprolu static LIST_HEAD(vas_instances); 244dea2d1aSSukadev Bhattiprolu 25ca03258bSSukadev Bhattiprolu static DEFINE_PER_CPU(int, cpu_vas_id); 26ca03258bSSukadev Bhattiprolu 270d17de03SHaren Myneni static int vas_irq_fault_window_setup(struct vas_instance *vinst) 280d17de03SHaren Myneni { 290d17de03SHaren Myneni return vas_setup_fault_window(vinst); 300d17de03SHaren Myneni } 310d17de03SHaren Myneni 324dea2d1aSSukadev Bhattiprolu static int init_vas_instance(struct platform_device *pdev) 334dea2d1aSSukadev Bhattiprolu { 344dea2d1aSSukadev Bhattiprolu struct device_node *dn = pdev->dev.of_node; 35c20e1e29SHaren Myneni struct vas_instance *vinst; 36c20e1e29SHaren Myneni struct xive_irq_data *xd; 37c20e1e29SHaren Myneni uint32_t chipid, hwirq; 38c20e1e29SHaren Myneni struct resource *res; 39c20e1e29SHaren Myneni int rc, cpu, vasid; 404dea2d1aSSukadev Bhattiprolu 414dea2d1aSSukadev Bhattiprolu rc = of_property_read_u32(dn, "ibm,vas-id", &vasid); 424dea2d1aSSukadev Bhattiprolu if (rc) { 434dea2d1aSSukadev Bhattiprolu pr_err("No ibm,vas-id property for %s?\n", pdev->name); 444dea2d1aSSukadev Bhattiprolu return -ENODEV; 454dea2d1aSSukadev Bhattiprolu } 464dea2d1aSSukadev Bhattiprolu 47c20e1e29SHaren Myneni rc = of_property_read_u32(dn, "ibm,chip-id", &chipid); 48c20e1e29SHaren Myneni if (rc) { 49c20e1e29SHaren Myneni pr_err("No ibm,chip-id property for %s?\n", pdev->name); 50c20e1e29SHaren Myneni return -ENODEV; 51c20e1e29SHaren Myneni } 52c20e1e29SHaren Myneni 534dea2d1aSSukadev Bhattiprolu if (pdev->num_resources != 4) { 544dea2d1aSSukadev Bhattiprolu pr_err("Unexpected DT configuration for [%s, %d]\n", 554dea2d1aSSukadev Bhattiprolu pdev->name, vasid); 564dea2d1aSSukadev Bhattiprolu return -ENODEV; 574dea2d1aSSukadev Bhattiprolu } 584dea2d1aSSukadev Bhattiprolu 594dea2d1aSSukadev Bhattiprolu vinst = kzalloc(sizeof(*vinst), GFP_KERNEL); 604dea2d1aSSukadev Bhattiprolu if (!vinst) 614dea2d1aSSukadev Bhattiprolu return -ENOMEM; 624dea2d1aSSukadev Bhattiprolu 634dea2d1aSSukadev Bhattiprolu INIT_LIST_HEAD(&vinst->node); 644dea2d1aSSukadev Bhattiprolu ida_init(&vinst->ida); 654dea2d1aSSukadev Bhattiprolu mutex_init(&vinst->mutex); 664dea2d1aSSukadev Bhattiprolu vinst->vas_id = vasid; 674dea2d1aSSukadev Bhattiprolu vinst->pdev = pdev; 684dea2d1aSSukadev Bhattiprolu 694dea2d1aSSukadev Bhattiprolu res = &pdev->resource[0]; 704dea2d1aSSukadev Bhattiprolu vinst->hvwc_bar_start = res->start; 714dea2d1aSSukadev Bhattiprolu 724dea2d1aSSukadev Bhattiprolu res = &pdev->resource[1]; 734dea2d1aSSukadev Bhattiprolu vinst->uwc_bar_start = res->start; 744dea2d1aSSukadev Bhattiprolu 754dea2d1aSSukadev Bhattiprolu res = &pdev->resource[2]; 764dea2d1aSSukadev Bhattiprolu vinst->paste_base_addr = res->start; 774dea2d1aSSukadev Bhattiprolu 784dea2d1aSSukadev Bhattiprolu res = &pdev->resource[3]; 794dea2d1aSSukadev Bhattiprolu if (res->end > 62) { 804dea2d1aSSukadev Bhattiprolu pr_err("Bad 'paste_win_id_shift' in DT, %llx\n", res->end); 814dea2d1aSSukadev Bhattiprolu goto free_vinst; 824dea2d1aSSukadev Bhattiprolu } 834dea2d1aSSukadev Bhattiprolu 844dea2d1aSSukadev Bhattiprolu vinst->paste_win_id_shift = 63 - res->end; 854dea2d1aSSukadev Bhattiprolu 86c20e1e29SHaren Myneni hwirq = xive_native_alloc_irq_on_chip(chipid); 87c20e1e29SHaren Myneni if (!hwirq) { 88c20e1e29SHaren Myneni pr_err("Inst%d: Unable to allocate global irq for chip %d\n", 89c20e1e29SHaren Myneni vinst->vas_id, chipid); 90c20e1e29SHaren Myneni return -ENOENT; 91c20e1e29SHaren Myneni } 92c20e1e29SHaren Myneni 93c20e1e29SHaren Myneni vinst->virq = irq_create_mapping(NULL, hwirq); 94c20e1e29SHaren Myneni if (!vinst->virq) { 95c20e1e29SHaren Myneni pr_err("Inst%d: Unable to map global irq %d\n", 96c20e1e29SHaren Myneni vinst->vas_id, hwirq); 97c20e1e29SHaren Myneni return -EINVAL; 98c20e1e29SHaren Myneni } 99c20e1e29SHaren Myneni 100c20e1e29SHaren Myneni xd = irq_get_handler_data(vinst->virq); 101c20e1e29SHaren Myneni if (!xd) { 102c20e1e29SHaren Myneni pr_err("Inst%d: Invalid virq %d\n", 103c20e1e29SHaren Myneni vinst->vas_id, vinst->virq); 104c20e1e29SHaren Myneni return -EINVAL; 105c20e1e29SHaren Myneni } 106c20e1e29SHaren Myneni 107c20e1e29SHaren Myneni vinst->irq_port = xd->trig_page; 108c20e1e29SHaren Myneni pr_devel("Initialized instance [%s, %d] paste_base 0x%llx paste_win_id_shift 0x%llx IRQ %d Port 0x%llx\n", 109c20e1e29SHaren Myneni pdev->name, vasid, vinst->paste_base_addr, 110c20e1e29SHaren Myneni vinst->paste_win_id_shift, vinst->virq, 111c20e1e29SHaren Myneni vinst->irq_port); 1124dea2d1aSSukadev Bhattiprolu 113ca03258bSSukadev Bhattiprolu for_each_possible_cpu(cpu) { 114ca03258bSSukadev Bhattiprolu if (cpu_to_chip_id(cpu) == of_get_ibm_chip_id(dn)) 115ca03258bSSukadev Bhattiprolu per_cpu(cpu_vas_id, cpu) = vasid; 116ca03258bSSukadev Bhattiprolu } 117ca03258bSSukadev Bhattiprolu 1184dea2d1aSSukadev Bhattiprolu mutex_lock(&vas_mutex); 1194dea2d1aSSukadev Bhattiprolu list_add(&vinst->node, &vas_instances); 1204dea2d1aSSukadev Bhattiprolu mutex_unlock(&vas_mutex); 1214dea2d1aSSukadev Bhattiprolu 1220d17de03SHaren Myneni /* 1230d17de03SHaren Myneni * IRQ and fault handling setup is needed only for user space 1240d17de03SHaren Myneni * send windows. 1250d17de03SHaren Myneni */ 1260d17de03SHaren Myneni if (vinst->virq) { 1270d17de03SHaren Myneni rc = vas_irq_fault_window_setup(vinst); 1280d17de03SHaren Myneni /* 1290d17de03SHaren Myneni * Fault window is used only for user space send windows. 1300d17de03SHaren Myneni * So if vinst->virq is NULL, tx_win_open returns -ENODEV 1310d17de03SHaren Myneni * for user space. 1320d17de03SHaren Myneni */ 1330d17de03SHaren Myneni if (rc) 1340d17de03SHaren Myneni vinst->virq = 0; 1350d17de03SHaren Myneni } 1360d17de03SHaren Myneni 137ece4e512SSukadev Bhattiprolu vas_instance_init_dbgdir(vinst); 138ece4e512SSukadev Bhattiprolu 1394dea2d1aSSukadev Bhattiprolu dev_set_drvdata(&pdev->dev, vinst); 1404dea2d1aSSukadev Bhattiprolu 1414dea2d1aSSukadev Bhattiprolu return 0; 1424dea2d1aSSukadev Bhattiprolu 1434dea2d1aSSukadev Bhattiprolu free_vinst: 1444dea2d1aSSukadev Bhattiprolu kfree(vinst); 1454dea2d1aSSukadev Bhattiprolu return -ENODEV; 1464dea2d1aSSukadev Bhattiprolu 1474dea2d1aSSukadev Bhattiprolu } 1484dea2d1aSSukadev Bhattiprolu 1494dea2d1aSSukadev Bhattiprolu /* 1504dea2d1aSSukadev Bhattiprolu * Although this is read/used multiple times, it is written to only 1514dea2d1aSSukadev Bhattiprolu * during initialization. 1524dea2d1aSSukadev Bhattiprolu */ 1534dea2d1aSSukadev Bhattiprolu struct vas_instance *find_vas_instance(int vasid) 1544dea2d1aSSukadev Bhattiprolu { 1554dea2d1aSSukadev Bhattiprolu struct list_head *ent; 1564dea2d1aSSukadev Bhattiprolu struct vas_instance *vinst; 1574dea2d1aSSukadev Bhattiprolu 1584dea2d1aSSukadev Bhattiprolu mutex_lock(&vas_mutex); 159ca03258bSSukadev Bhattiprolu 160ca03258bSSukadev Bhattiprolu if (vasid == -1) 161ca03258bSSukadev Bhattiprolu vasid = per_cpu(cpu_vas_id, smp_processor_id()); 162ca03258bSSukadev Bhattiprolu 1634dea2d1aSSukadev Bhattiprolu list_for_each(ent, &vas_instances) { 1644dea2d1aSSukadev Bhattiprolu vinst = list_entry(ent, struct vas_instance, node); 1654dea2d1aSSukadev Bhattiprolu if (vinst->vas_id == vasid) { 1664dea2d1aSSukadev Bhattiprolu mutex_unlock(&vas_mutex); 1674dea2d1aSSukadev Bhattiprolu return vinst; 1684dea2d1aSSukadev Bhattiprolu } 1694dea2d1aSSukadev Bhattiprolu } 1704dea2d1aSSukadev Bhattiprolu mutex_unlock(&vas_mutex); 1714dea2d1aSSukadev Bhattiprolu 1724dea2d1aSSukadev Bhattiprolu pr_devel("Instance %d not found\n", vasid); 1734dea2d1aSSukadev Bhattiprolu return NULL; 1744dea2d1aSSukadev Bhattiprolu } 1754dea2d1aSSukadev Bhattiprolu 176d4ef61b5SSukadev Bhattiprolu int chip_to_vas_id(int chipid) 177d4ef61b5SSukadev Bhattiprolu { 178d4ef61b5SSukadev Bhattiprolu int cpu; 179d4ef61b5SSukadev Bhattiprolu 180d4ef61b5SSukadev Bhattiprolu for_each_possible_cpu(cpu) { 181d4ef61b5SSukadev Bhattiprolu if (cpu_to_chip_id(cpu) == chipid) 182d4ef61b5SSukadev Bhattiprolu return per_cpu(cpu_vas_id, cpu); 183d4ef61b5SSukadev Bhattiprolu } 184d4ef61b5SSukadev Bhattiprolu return -1; 185d4ef61b5SSukadev Bhattiprolu } 18662b49c42SSukadev Bhattiprolu EXPORT_SYMBOL(chip_to_vas_id); 187d4ef61b5SSukadev Bhattiprolu 1884dea2d1aSSukadev Bhattiprolu static int vas_probe(struct platform_device *pdev) 1894dea2d1aSSukadev Bhattiprolu { 1904dea2d1aSSukadev Bhattiprolu return init_vas_instance(pdev); 1914dea2d1aSSukadev Bhattiprolu } 1924dea2d1aSSukadev Bhattiprolu 1934dea2d1aSSukadev Bhattiprolu static const struct of_device_id powernv_vas_match[] = { 1944dea2d1aSSukadev Bhattiprolu { .compatible = "ibm,vas",}, 1954dea2d1aSSukadev Bhattiprolu {}, 1964dea2d1aSSukadev Bhattiprolu }; 1974dea2d1aSSukadev Bhattiprolu 1984dea2d1aSSukadev Bhattiprolu static struct platform_driver vas_driver = { 1994dea2d1aSSukadev Bhattiprolu .driver = { 2004dea2d1aSSukadev Bhattiprolu .name = "vas", 2014dea2d1aSSukadev Bhattiprolu .of_match_table = powernv_vas_match, 2024dea2d1aSSukadev Bhattiprolu }, 2034dea2d1aSSukadev Bhattiprolu .probe = vas_probe, 2044dea2d1aSSukadev Bhattiprolu }; 2054dea2d1aSSukadev Bhattiprolu 2064dea2d1aSSukadev Bhattiprolu static int __init vas_init(void) 2074dea2d1aSSukadev Bhattiprolu { 2084dea2d1aSSukadev Bhattiprolu int found = 0; 2094dea2d1aSSukadev Bhattiprolu struct device_node *dn; 2104dea2d1aSSukadev Bhattiprolu 2114dea2d1aSSukadev Bhattiprolu platform_driver_register(&vas_driver); 2124dea2d1aSSukadev Bhattiprolu 2134dea2d1aSSukadev Bhattiprolu for_each_compatible_node(dn, NULL, "ibm,vas") { 2144dea2d1aSSukadev Bhattiprolu of_platform_device_create(dn, NULL, NULL); 2154dea2d1aSSukadev Bhattiprolu found++; 2164dea2d1aSSukadev Bhattiprolu } 2174dea2d1aSSukadev Bhattiprolu 21845ddea8aSSukadev Bhattiprolu if (!found) { 21945ddea8aSSukadev Bhattiprolu platform_driver_unregister(&vas_driver); 2204dea2d1aSSukadev Bhattiprolu return -ENODEV; 22145ddea8aSSukadev Bhattiprolu } 2224dea2d1aSSukadev Bhattiprolu 2234dea2d1aSSukadev Bhattiprolu pr_devel("Found %d instances\n", found); 2244dea2d1aSSukadev Bhattiprolu 2254dea2d1aSSukadev Bhattiprolu return 0; 2264dea2d1aSSukadev Bhattiprolu } 2274dea2d1aSSukadev Bhattiprolu device_initcall(vas_init); 228