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> 184dea2d1aSSukadev Bhattiprolu 194dea2d1aSSukadev Bhattiprolu #include "vas.h" 204dea2d1aSSukadev Bhattiprolu 21ece4e512SSukadev Bhattiprolu DEFINE_MUTEX(vas_mutex); 224dea2d1aSSukadev Bhattiprolu static LIST_HEAD(vas_instances); 234dea2d1aSSukadev Bhattiprolu 24ca03258bSSukadev Bhattiprolu static DEFINE_PER_CPU(int, cpu_vas_id); 25ca03258bSSukadev Bhattiprolu 264dea2d1aSSukadev Bhattiprolu static int init_vas_instance(struct platform_device *pdev) 274dea2d1aSSukadev Bhattiprolu { 28ca03258bSSukadev Bhattiprolu int rc, cpu, vasid; 294dea2d1aSSukadev Bhattiprolu struct resource *res; 304dea2d1aSSukadev Bhattiprolu struct vas_instance *vinst; 314dea2d1aSSukadev Bhattiprolu struct device_node *dn = pdev->dev.of_node; 324dea2d1aSSukadev Bhattiprolu 334dea2d1aSSukadev Bhattiprolu rc = of_property_read_u32(dn, "ibm,vas-id", &vasid); 344dea2d1aSSukadev Bhattiprolu if (rc) { 354dea2d1aSSukadev Bhattiprolu pr_err("No ibm,vas-id property for %s?\n", pdev->name); 364dea2d1aSSukadev Bhattiprolu return -ENODEV; 374dea2d1aSSukadev Bhattiprolu } 384dea2d1aSSukadev Bhattiprolu 394dea2d1aSSukadev Bhattiprolu if (pdev->num_resources != 4) { 404dea2d1aSSukadev Bhattiprolu pr_err("Unexpected DT configuration for [%s, %d]\n", 414dea2d1aSSukadev Bhattiprolu pdev->name, vasid); 424dea2d1aSSukadev Bhattiprolu return -ENODEV; 434dea2d1aSSukadev Bhattiprolu } 444dea2d1aSSukadev Bhattiprolu 454dea2d1aSSukadev Bhattiprolu vinst = kzalloc(sizeof(*vinst), GFP_KERNEL); 464dea2d1aSSukadev Bhattiprolu if (!vinst) 474dea2d1aSSukadev Bhattiprolu return -ENOMEM; 484dea2d1aSSukadev Bhattiprolu 494dea2d1aSSukadev Bhattiprolu INIT_LIST_HEAD(&vinst->node); 504dea2d1aSSukadev Bhattiprolu ida_init(&vinst->ida); 514dea2d1aSSukadev Bhattiprolu mutex_init(&vinst->mutex); 524dea2d1aSSukadev Bhattiprolu vinst->vas_id = vasid; 534dea2d1aSSukadev Bhattiprolu vinst->pdev = pdev; 544dea2d1aSSukadev Bhattiprolu 554dea2d1aSSukadev Bhattiprolu res = &pdev->resource[0]; 564dea2d1aSSukadev Bhattiprolu vinst->hvwc_bar_start = res->start; 574dea2d1aSSukadev Bhattiprolu 584dea2d1aSSukadev Bhattiprolu res = &pdev->resource[1]; 594dea2d1aSSukadev Bhattiprolu vinst->uwc_bar_start = res->start; 604dea2d1aSSukadev Bhattiprolu 614dea2d1aSSukadev Bhattiprolu res = &pdev->resource[2]; 624dea2d1aSSukadev Bhattiprolu vinst->paste_base_addr = res->start; 634dea2d1aSSukadev Bhattiprolu 644dea2d1aSSukadev Bhattiprolu res = &pdev->resource[3]; 654dea2d1aSSukadev Bhattiprolu if (res->end > 62) { 664dea2d1aSSukadev Bhattiprolu pr_err("Bad 'paste_win_id_shift' in DT, %llx\n", res->end); 674dea2d1aSSukadev Bhattiprolu goto free_vinst; 684dea2d1aSSukadev Bhattiprolu } 694dea2d1aSSukadev Bhattiprolu 704dea2d1aSSukadev Bhattiprolu vinst->paste_win_id_shift = 63 - res->end; 714dea2d1aSSukadev Bhattiprolu 724dea2d1aSSukadev Bhattiprolu pr_devel("Initialized instance [%s, %d], paste_base 0x%llx, " 734dea2d1aSSukadev Bhattiprolu "paste_win_id_shift 0x%llx\n", pdev->name, vasid, 744dea2d1aSSukadev Bhattiprolu vinst->paste_base_addr, vinst->paste_win_id_shift); 754dea2d1aSSukadev Bhattiprolu 76ca03258bSSukadev Bhattiprolu for_each_possible_cpu(cpu) { 77ca03258bSSukadev Bhattiprolu if (cpu_to_chip_id(cpu) == of_get_ibm_chip_id(dn)) 78ca03258bSSukadev Bhattiprolu per_cpu(cpu_vas_id, cpu) = vasid; 79ca03258bSSukadev Bhattiprolu } 80ca03258bSSukadev Bhattiprolu 814dea2d1aSSukadev Bhattiprolu mutex_lock(&vas_mutex); 824dea2d1aSSukadev Bhattiprolu list_add(&vinst->node, &vas_instances); 834dea2d1aSSukadev Bhattiprolu mutex_unlock(&vas_mutex); 844dea2d1aSSukadev Bhattiprolu 85ece4e512SSukadev Bhattiprolu vas_instance_init_dbgdir(vinst); 86ece4e512SSukadev Bhattiprolu 874dea2d1aSSukadev Bhattiprolu dev_set_drvdata(&pdev->dev, vinst); 884dea2d1aSSukadev Bhattiprolu 894dea2d1aSSukadev Bhattiprolu return 0; 904dea2d1aSSukadev Bhattiprolu 914dea2d1aSSukadev Bhattiprolu free_vinst: 924dea2d1aSSukadev Bhattiprolu kfree(vinst); 934dea2d1aSSukadev Bhattiprolu return -ENODEV; 944dea2d1aSSukadev Bhattiprolu 954dea2d1aSSukadev Bhattiprolu } 964dea2d1aSSukadev Bhattiprolu 974dea2d1aSSukadev Bhattiprolu /* 984dea2d1aSSukadev Bhattiprolu * Although this is read/used multiple times, it is written to only 994dea2d1aSSukadev Bhattiprolu * during initialization. 1004dea2d1aSSukadev Bhattiprolu */ 1014dea2d1aSSukadev Bhattiprolu struct vas_instance *find_vas_instance(int vasid) 1024dea2d1aSSukadev Bhattiprolu { 1034dea2d1aSSukadev Bhattiprolu struct list_head *ent; 1044dea2d1aSSukadev Bhattiprolu struct vas_instance *vinst; 1054dea2d1aSSukadev Bhattiprolu 1064dea2d1aSSukadev Bhattiprolu mutex_lock(&vas_mutex); 107ca03258bSSukadev Bhattiprolu 108ca03258bSSukadev Bhattiprolu if (vasid == -1) 109ca03258bSSukadev Bhattiprolu vasid = per_cpu(cpu_vas_id, smp_processor_id()); 110ca03258bSSukadev Bhattiprolu 1114dea2d1aSSukadev Bhattiprolu list_for_each(ent, &vas_instances) { 1124dea2d1aSSukadev Bhattiprolu vinst = list_entry(ent, struct vas_instance, node); 1134dea2d1aSSukadev Bhattiprolu if (vinst->vas_id == vasid) { 1144dea2d1aSSukadev Bhattiprolu mutex_unlock(&vas_mutex); 1154dea2d1aSSukadev Bhattiprolu return vinst; 1164dea2d1aSSukadev Bhattiprolu } 1174dea2d1aSSukadev Bhattiprolu } 1184dea2d1aSSukadev Bhattiprolu mutex_unlock(&vas_mutex); 1194dea2d1aSSukadev Bhattiprolu 1204dea2d1aSSukadev Bhattiprolu pr_devel("Instance %d not found\n", vasid); 1214dea2d1aSSukadev Bhattiprolu return NULL; 1224dea2d1aSSukadev Bhattiprolu } 1234dea2d1aSSukadev Bhattiprolu 124d4ef61b5SSukadev Bhattiprolu int chip_to_vas_id(int chipid) 125d4ef61b5SSukadev Bhattiprolu { 126d4ef61b5SSukadev Bhattiprolu int cpu; 127d4ef61b5SSukadev Bhattiprolu 128d4ef61b5SSukadev Bhattiprolu for_each_possible_cpu(cpu) { 129d4ef61b5SSukadev Bhattiprolu if (cpu_to_chip_id(cpu) == chipid) 130d4ef61b5SSukadev Bhattiprolu return per_cpu(cpu_vas_id, cpu); 131d4ef61b5SSukadev Bhattiprolu } 132d4ef61b5SSukadev Bhattiprolu return -1; 133d4ef61b5SSukadev Bhattiprolu } 13462b49c42SSukadev Bhattiprolu EXPORT_SYMBOL(chip_to_vas_id); 135d4ef61b5SSukadev Bhattiprolu 1364dea2d1aSSukadev Bhattiprolu static int vas_probe(struct platform_device *pdev) 1374dea2d1aSSukadev Bhattiprolu { 1384dea2d1aSSukadev Bhattiprolu return init_vas_instance(pdev); 1394dea2d1aSSukadev Bhattiprolu } 1404dea2d1aSSukadev Bhattiprolu 1414dea2d1aSSukadev Bhattiprolu static const struct of_device_id powernv_vas_match[] = { 1424dea2d1aSSukadev Bhattiprolu { .compatible = "ibm,vas",}, 1434dea2d1aSSukadev Bhattiprolu {}, 1444dea2d1aSSukadev Bhattiprolu }; 1454dea2d1aSSukadev Bhattiprolu 1464dea2d1aSSukadev Bhattiprolu static struct platform_driver vas_driver = { 1474dea2d1aSSukadev Bhattiprolu .driver = { 1484dea2d1aSSukadev Bhattiprolu .name = "vas", 1494dea2d1aSSukadev Bhattiprolu .of_match_table = powernv_vas_match, 1504dea2d1aSSukadev Bhattiprolu }, 1514dea2d1aSSukadev Bhattiprolu .probe = vas_probe, 1524dea2d1aSSukadev Bhattiprolu }; 1534dea2d1aSSukadev Bhattiprolu 1544dea2d1aSSukadev Bhattiprolu static int __init vas_init(void) 1554dea2d1aSSukadev Bhattiprolu { 1564dea2d1aSSukadev Bhattiprolu int found = 0; 1574dea2d1aSSukadev Bhattiprolu struct device_node *dn; 1584dea2d1aSSukadev Bhattiprolu 1594dea2d1aSSukadev Bhattiprolu platform_driver_register(&vas_driver); 1604dea2d1aSSukadev Bhattiprolu 1614dea2d1aSSukadev Bhattiprolu for_each_compatible_node(dn, NULL, "ibm,vas") { 1624dea2d1aSSukadev Bhattiprolu of_platform_device_create(dn, NULL, NULL); 1634dea2d1aSSukadev Bhattiprolu found++; 1644dea2d1aSSukadev Bhattiprolu } 1654dea2d1aSSukadev Bhattiprolu 16645ddea8aSSukadev Bhattiprolu if (!found) { 16745ddea8aSSukadev Bhattiprolu platform_driver_unregister(&vas_driver); 1684dea2d1aSSukadev Bhattiprolu return -ENODEV; 16945ddea8aSSukadev Bhattiprolu } 1704dea2d1aSSukadev Bhattiprolu 1714dea2d1aSSukadev Bhattiprolu pr_devel("Found %d instances\n", found); 1724dea2d1aSSukadev Bhattiprolu 1734dea2d1aSSukadev Bhattiprolu return 0; 1744dea2d1aSSukadev Bhattiprolu } 1754dea2d1aSSukadev Bhattiprolu device_initcall(vas_init); 176