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 274dea2d1aSSukadev Bhattiprolu static int init_vas_instance(struct platform_device *pdev) 284dea2d1aSSukadev Bhattiprolu { 294dea2d1aSSukadev Bhattiprolu struct device_node *dn = pdev->dev.of_node; 30c20e1e29SHaren Myneni struct vas_instance *vinst; 31c20e1e29SHaren Myneni struct xive_irq_data *xd; 32c20e1e29SHaren Myneni uint32_t chipid, hwirq; 33c20e1e29SHaren Myneni struct resource *res; 34c20e1e29SHaren Myneni int rc, cpu, vasid; 354dea2d1aSSukadev Bhattiprolu 364dea2d1aSSukadev Bhattiprolu rc = of_property_read_u32(dn, "ibm,vas-id", &vasid); 374dea2d1aSSukadev Bhattiprolu if (rc) { 384dea2d1aSSukadev Bhattiprolu pr_err("No ibm,vas-id property for %s?\n", pdev->name); 394dea2d1aSSukadev Bhattiprolu return -ENODEV; 404dea2d1aSSukadev Bhattiprolu } 414dea2d1aSSukadev Bhattiprolu 42c20e1e29SHaren Myneni rc = of_property_read_u32(dn, "ibm,chip-id", &chipid); 43c20e1e29SHaren Myneni if (rc) { 44c20e1e29SHaren Myneni pr_err("No ibm,chip-id property for %s?\n", pdev->name); 45c20e1e29SHaren Myneni return -ENODEV; 46c20e1e29SHaren Myneni } 47c20e1e29SHaren Myneni 484dea2d1aSSukadev Bhattiprolu if (pdev->num_resources != 4) { 494dea2d1aSSukadev Bhattiprolu pr_err("Unexpected DT configuration for [%s, %d]\n", 504dea2d1aSSukadev Bhattiprolu pdev->name, vasid); 514dea2d1aSSukadev Bhattiprolu return -ENODEV; 524dea2d1aSSukadev Bhattiprolu } 534dea2d1aSSukadev Bhattiprolu 544dea2d1aSSukadev Bhattiprolu vinst = kzalloc(sizeof(*vinst), GFP_KERNEL); 554dea2d1aSSukadev Bhattiprolu if (!vinst) 564dea2d1aSSukadev Bhattiprolu return -ENOMEM; 574dea2d1aSSukadev Bhattiprolu 584dea2d1aSSukadev Bhattiprolu INIT_LIST_HEAD(&vinst->node); 594dea2d1aSSukadev Bhattiprolu ida_init(&vinst->ida); 604dea2d1aSSukadev Bhattiprolu mutex_init(&vinst->mutex); 614dea2d1aSSukadev Bhattiprolu vinst->vas_id = vasid; 624dea2d1aSSukadev Bhattiprolu vinst->pdev = pdev; 634dea2d1aSSukadev Bhattiprolu 644dea2d1aSSukadev Bhattiprolu res = &pdev->resource[0]; 654dea2d1aSSukadev Bhattiprolu vinst->hvwc_bar_start = res->start; 664dea2d1aSSukadev Bhattiprolu 674dea2d1aSSukadev Bhattiprolu res = &pdev->resource[1]; 684dea2d1aSSukadev Bhattiprolu vinst->uwc_bar_start = res->start; 694dea2d1aSSukadev Bhattiprolu 704dea2d1aSSukadev Bhattiprolu res = &pdev->resource[2]; 714dea2d1aSSukadev Bhattiprolu vinst->paste_base_addr = res->start; 724dea2d1aSSukadev Bhattiprolu 734dea2d1aSSukadev Bhattiprolu res = &pdev->resource[3]; 744dea2d1aSSukadev Bhattiprolu if (res->end > 62) { 754dea2d1aSSukadev Bhattiprolu pr_err("Bad 'paste_win_id_shift' in DT, %llx\n", res->end); 764dea2d1aSSukadev Bhattiprolu goto free_vinst; 774dea2d1aSSukadev Bhattiprolu } 784dea2d1aSSukadev Bhattiprolu 794dea2d1aSSukadev Bhattiprolu vinst->paste_win_id_shift = 63 - res->end; 804dea2d1aSSukadev Bhattiprolu 81c20e1e29SHaren Myneni hwirq = xive_native_alloc_irq_on_chip(chipid); 82c20e1e29SHaren Myneni if (!hwirq) { 83c20e1e29SHaren Myneni pr_err("Inst%d: Unable to allocate global irq for chip %d\n", 84c20e1e29SHaren Myneni vinst->vas_id, chipid); 85c20e1e29SHaren Myneni return -ENOENT; 86c20e1e29SHaren Myneni } 87c20e1e29SHaren Myneni 88c20e1e29SHaren Myneni vinst->virq = irq_create_mapping(NULL, hwirq); 89c20e1e29SHaren Myneni if (!vinst->virq) { 90c20e1e29SHaren Myneni pr_err("Inst%d: Unable to map global irq %d\n", 91c20e1e29SHaren Myneni vinst->vas_id, hwirq); 92c20e1e29SHaren Myneni return -EINVAL; 93c20e1e29SHaren Myneni } 94c20e1e29SHaren Myneni 95c20e1e29SHaren Myneni xd = irq_get_handler_data(vinst->virq); 96c20e1e29SHaren Myneni if (!xd) { 97c20e1e29SHaren Myneni pr_err("Inst%d: Invalid virq %d\n", 98c20e1e29SHaren Myneni vinst->vas_id, vinst->virq); 99c20e1e29SHaren Myneni return -EINVAL; 100c20e1e29SHaren Myneni } 101c20e1e29SHaren Myneni 102c20e1e29SHaren Myneni vinst->irq_port = xd->trig_page; 103c20e1e29SHaren Myneni pr_devel("Initialized instance [%s, %d] paste_base 0x%llx paste_win_id_shift 0x%llx IRQ %d Port 0x%llx\n", 104c20e1e29SHaren Myneni pdev->name, vasid, vinst->paste_base_addr, 105c20e1e29SHaren Myneni vinst->paste_win_id_shift, vinst->virq, 106c20e1e29SHaren Myneni vinst->irq_port); 1074dea2d1aSSukadev Bhattiprolu 108ca03258bSSukadev Bhattiprolu for_each_possible_cpu(cpu) { 109ca03258bSSukadev Bhattiprolu if (cpu_to_chip_id(cpu) == of_get_ibm_chip_id(dn)) 110ca03258bSSukadev Bhattiprolu per_cpu(cpu_vas_id, cpu) = vasid; 111ca03258bSSukadev Bhattiprolu } 112ca03258bSSukadev Bhattiprolu 1134dea2d1aSSukadev Bhattiprolu mutex_lock(&vas_mutex); 1144dea2d1aSSukadev Bhattiprolu list_add(&vinst->node, &vas_instances); 1154dea2d1aSSukadev Bhattiprolu mutex_unlock(&vas_mutex); 1164dea2d1aSSukadev Bhattiprolu 117ece4e512SSukadev Bhattiprolu vas_instance_init_dbgdir(vinst); 118ece4e512SSukadev Bhattiprolu 1194dea2d1aSSukadev Bhattiprolu dev_set_drvdata(&pdev->dev, vinst); 1204dea2d1aSSukadev Bhattiprolu 1214dea2d1aSSukadev Bhattiprolu return 0; 1224dea2d1aSSukadev Bhattiprolu 1234dea2d1aSSukadev Bhattiprolu free_vinst: 1244dea2d1aSSukadev Bhattiprolu kfree(vinst); 1254dea2d1aSSukadev Bhattiprolu return -ENODEV; 1264dea2d1aSSukadev Bhattiprolu 1274dea2d1aSSukadev Bhattiprolu } 1284dea2d1aSSukadev Bhattiprolu 1294dea2d1aSSukadev Bhattiprolu /* 1304dea2d1aSSukadev Bhattiprolu * Although this is read/used multiple times, it is written to only 1314dea2d1aSSukadev Bhattiprolu * during initialization. 1324dea2d1aSSukadev Bhattiprolu */ 1334dea2d1aSSukadev Bhattiprolu struct vas_instance *find_vas_instance(int vasid) 1344dea2d1aSSukadev Bhattiprolu { 1354dea2d1aSSukadev Bhattiprolu struct list_head *ent; 1364dea2d1aSSukadev Bhattiprolu struct vas_instance *vinst; 1374dea2d1aSSukadev Bhattiprolu 1384dea2d1aSSukadev Bhattiprolu mutex_lock(&vas_mutex); 139ca03258bSSukadev Bhattiprolu 140ca03258bSSukadev Bhattiprolu if (vasid == -1) 141ca03258bSSukadev Bhattiprolu vasid = per_cpu(cpu_vas_id, smp_processor_id()); 142ca03258bSSukadev Bhattiprolu 1434dea2d1aSSukadev Bhattiprolu list_for_each(ent, &vas_instances) { 1444dea2d1aSSukadev Bhattiprolu vinst = list_entry(ent, struct vas_instance, node); 1454dea2d1aSSukadev Bhattiprolu if (vinst->vas_id == vasid) { 1464dea2d1aSSukadev Bhattiprolu mutex_unlock(&vas_mutex); 1474dea2d1aSSukadev Bhattiprolu return vinst; 1484dea2d1aSSukadev Bhattiprolu } 1494dea2d1aSSukadev Bhattiprolu } 1504dea2d1aSSukadev Bhattiprolu mutex_unlock(&vas_mutex); 1514dea2d1aSSukadev Bhattiprolu 1524dea2d1aSSukadev Bhattiprolu pr_devel("Instance %d not found\n", vasid); 1534dea2d1aSSukadev Bhattiprolu return NULL; 1544dea2d1aSSukadev Bhattiprolu } 1554dea2d1aSSukadev Bhattiprolu 156d4ef61b5SSukadev Bhattiprolu int chip_to_vas_id(int chipid) 157d4ef61b5SSukadev Bhattiprolu { 158d4ef61b5SSukadev Bhattiprolu int cpu; 159d4ef61b5SSukadev Bhattiprolu 160d4ef61b5SSukadev Bhattiprolu for_each_possible_cpu(cpu) { 161d4ef61b5SSukadev Bhattiprolu if (cpu_to_chip_id(cpu) == chipid) 162d4ef61b5SSukadev Bhattiprolu return per_cpu(cpu_vas_id, cpu); 163d4ef61b5SSukadev Bhattiprolu } 164d4ef61b5SSukadev Bhattiprolu return -1; 165d4ef61b5SSukadev Bhattiprolu } 16662b49c42SSukadev Bhattiprolu EXPORT_SYMBOL(chip_to_vas_id); 167d4ef61b5SSukadev Bhattiprolu 1684dea2d1aSSukadev Bhattiprolu static int vas_probe(struct platform_device *pdev) 1694dea2d1aSSukadev Bhattiprolu { 1704dea2d1aSSukadev Bhattiprolu return init_vas_instance(pdev); 1714dea2d1aSSukadev Bhattiprolu } 1724dea2d1aSSukadev Bhattiprolu 1734dea2d1aSSukadev Bhattiprolu static const struct of_device_id powernv_vas_match[] = { 1744dea2d1aSSukadev Bhattiprolu { .compatible = "ibm,vas",}, 1754dea2d1aSSukadev Bhattiprolu {}, 1764dea2d1aSSukadev Bhattiprolu }; 1774dea2d1aSSukadev Bhattiprolu 1784dea2d1aSSukadev Bhattiprolu static struct platform_driver vas_driver = { 1794dea2d1aSSukadev Bhattiprolu .driver = { 1804dea2d1aSSukadev Bhattiprolu .name = "vas", 1814dea2d1aSSukadev Bhattiprolu .of_match_table = powernv_vas_match, 1824dea2d1aSSukadev Bhattiprolu }, 1834dea2d1aSSukadev Bhattiprolu .probe = vas_probe, 1844dea2d1aSSukadev Bhattiprolu }; 1854dea2d1aSSukadev Bhattiprolu 1864dea2d1aSSukadev Bhattiprolu static int __init vas_init(void) 1874dea2d1aSSukadev Bhattiprolu { 1884dea2d1aSSukadev Bhattiprolu int found = 0; 1894dea2d1aSSukadev Bhattiprolu struct device_node *dn; 1904dea2d1aSSukadev Bhattiprolu 1914dea2d1aSSukadev Bhattiprolu platform_driver_register(&vas_driver); 1924dea2d1aSSukadev Bhattiprolu 1934dea2d1aSSukadev Bhattiprolu for_each_compatible_node(dn, NULL, "ibm,vas") { 1944dea2d1aSSukadev Bhattiprolu of_platform_device_create(dn, NULL, NULL); 1954dea2d1aSSukadev Bhattiprolu found++; 1964dea2d1aSSukadev Bhattiprolu } 1974dea2d1aSSukadev Bhattiprolu 19845ddea8aSSukadev Bhattiprolu if (!found) { 19945ddea8aSSukadev Bhattiprolu platform_driver_unregister(&vas_driver); 2004dea2d1aSSukadev Bhattiprolu return -ENODEV; 20145ddea8aSSukadev Bhattiprolu } 2024dea2d1aSSukadev Bhattiprolu 2034dea2d1aSSukadev Bhattiprolu pr_devel("Found %d instances\n", found); 2044dea2d1aSSukadev Bhattiprolu 2054dea2d1aSSukadev Bhattiprolu return 0; 2064dea2d1aSSukadev Bhattiprolu } 2074dea2d1aSSukadev Bhattiprolu device_initcall(vas_init); 208