14dea2d1aSSukadev Bhattiprolu /* 24dea2d1aSSukadev Bhattiprolu * Copyright 2016-17 IBM Corp. 34dea2d1aSSukadev Bhattiprolu * 44dea2d1aSSukadev Bhattiprolu * This program is free software; you can redistribute it and/or 54dea2d1aSSukadev Bhattiprolu * modify it under the terms of the GNU General Public License 64dea2d1aSSukadev Bhattiprolu * as published by the Free Software Foundation; either version 74dea2d1aSSukadev Bhattiprolu * 2 of the License, or (at your option) any later version. 84dea2d1aSSukadev Bhattiprolu */ 94dea2d1aSSukadev Bhattiprolu 104dea2d1aSSukadev Bhattiprolu #define pr_fmt(fmt) "vas: " fmt 114dea2d1aSSukadev Bhattiprolu 124dea2d1aSSukadev Bhattiprolu #include <linux/module.h> 134dea2d1aSSukadev Bhattiprolu #include <linux/kernel.h> 144dea2d1aSSukadev Bhattiprolu #include <linux/export.h> 154dea2d1aSSukadev Bhattiprolu #include <linux/types.h> 164dea2d1aSSukadev Bhattiprolu #include <linux/slab.h> 174dea2d1aSSukadev Bhattiprolu #include <linux/platform_device.h> 184dea2d1aSSukadev Bhattiprolu #include <linux/of_platform.h> 194dea2d1aSSukadev Bhattiprolu #include <linux/of_address.h> 204dea2d1aSSukadev Bhattiprolu #include <linux/of.h> 21ca03258bSSukadev Bhattiprolu #include <asm/prom.h> 224dea2d1aSSukadev Bhattiprolu 234dea2d1aSSukadev Bhattiprolu #include "vas.h" 244dea2d1aSSukadev Bhattiprolu 254dea2d1aSSukadev Bhattiprolu static DEFINE_MUTEX(vas_mutex); 264dea2d1aSSukadev Bhattiprolu static LIST_HEAD(vas_instances); 274dea2d1aSSukadev Bhattiprolu 28ca03258bSSukadev Bhattiprolu static DEFINE_PER_CPU(int, cpu_vas_id); 29ca03258bSSukadev Bhattiprolu 304dea2d1aSSukadev Bhattiprolu static int init_vas_instance(struct platform_device *pdev) 314dea2d1aSSukadev Bhattiprolu { 32ca03258bSSukadev Bhattiprolu int rc, cpu, vasid; 334dea2d1aSSukadev Bhattiprolu struct resource *res; 344dea2d1aSSukadev Bhattiprolu struct vas_instance *vinst; 354dea2d1aSSukadev Bhattiprolu struct device_node *dn = pdev->dev.of_node; 364dea2d1aSSukadev Bhattiprolu 374dea2d1aSSukadev Bhattiprolu rc = of_property_read_u32(dn, "ibm,vas-id", &vasid); 384dea2d1aSSukadev Bhattiprolu if (rc) { 394dea2d1aSSukadev Bhattiprolu pr_err("No ibm,vas-id property for %s?\n", pdev->name); 404dea2d1aSSukadev Bhattiprolu return -ENODEV; 414dea2d1aSSukadev Bhattiprolu } 424dea2d1aSSukadev Bhattiprolu 434dea2d1aSSukadev Bhattiprolu if (pdev->num_resources != 4) { 444dea2d1aSSukadev Bhattiprolu pr_err("Unexpected DT configuration for [%s, %d]\n", 454dea2d1aSSukadev Bhattiprolu pdev->name, vasid); 464dea2d1aSSukadev Bhattiprolu return -ENODEV; 474dea2d1aSSukadev Bhattiprolu } 484dea2d1aSSukadev Bhattiprolu 494dea2d1aSSukadev Bhattiprolu vinst = kzalloc(sizeof(*vinst), GFP_KERNEL); 504dea2d1aSSukadev Bhattiprolu if (!vinst) 514dea2d1aSSukadev Bhattiprolu return -ENOMEM; 524dea2d1aSSukadev Bhattiprolu 534dea2d1aSSukadev Bhattiprolu INIT_LIST_HEAD(&vinst->node); 544dea2d1aSSukadev Bhattiprolu ida_init(&vinst->ida); 554dea2d1aSSukadev Bhattiprolu mutex_init(&vinst->mutex); 564dea2d1aSSukadev Bhattiprolu vinst->vas_id = vasid; 574dea2d1aSSukadev Bhattiprolu vinst->pdev = pdev; 584dea2d1aSSukadev Bhattiprolu 594dea2d1aSSukadev Bhattiprolu res = &pdev->resource[0]; 604dea2d1aSSukadev Bhattiprolu vinst->hvwc_bar_start = res->start; 614dea2d1aSSukadev Bhattiprolu 624dea2d1aSSukadev Bhattiprolu res = &pdev->resource[1]; 634dea2d1aSSukadev Bhattiprolu vinst->uwc_bar_start = res->start; 644dea2d1aSSukadev Bhattiprolu 654dea2d1aSSukadev Bhattiprolu res = &pdev->resource[2]; 664dea2d1aSSukadev Bhattiprolu vinst->paste_base_addr = res->start; 674dea2d1aSSukadev Bhattiprolu 684dea2d1aSSukadev Bhattiprolu res = &pdev->resource[3]; 694dea2d1aSSukadev Bhattiprolu if (res->end > 62) { 704dea2d1aSSukadev Bhattiprolu pr_err("Bad 'paste_win_id_shift' in DT, %llx\n", res->end); 714dea2d1aSSukadev Bhattiprolu goto free_vinst; 724dea2d1aSSukadev Bhattiprolu } 734dea2d1aSSukadev Bhattiprolu 744dea2d1aSSukadev Bhattiprolu vinst->paste_win_id_shift = 63 - res->end; 754dea2d1aSSukadev Bhattiprolu 764dea2d1aSSukadev Bhattiprolu pr_devel("Initialized instance [%s, %d], paste_base 0x%llx, " 774dea2d1aSSukadev Bhattiprolu "paste_win_id_shift 0x%llx\n", pdev->name, vasid, 784dea2d1aSSukadev Bhattiprolu vinst->paste_base_addr, vinst->paste_win_id_shift); 794dea2d1aSSukadev Bhattiprolu 80ca03258bSSukadev Bhattiprolu for_each_possible_cpu(cpu) { 81ca03258bSSukadev Bhattiprolu if (cpu_to_chip_id(cpu) == of_get_ibm_chip_id(dn)) 82ca03258bSSukadev Bhattiprolu per_cpu(cpu_vas_id, cpu) = vasid; 83ca03258bSSukadev Bhattiprolu } 84ca03258bSSukadev Bhattiprolu 854dea2d1aSSukadev Bhattiprolu mutex_lock(&vas_mutex); 864dea2d1aSSukadev Bhattiprolu list_add(&vinst->node, &vas_instances); 874dea2d1aSSukadev Bhattiprolu mutex_unlock(&vas_mutex); 884dea2d1aSSukadev Bhattiprolu 894dea2d1aSSukadev Bhattiprolu dev_set_drvdata(&pdev->dev, vinst); 904dea2d1aSSukadev Bhattiprolu 914dea2d1aSSukadev Bhattiprolu return 0; 924dea2d1aSSukadev Bhattiprolu 934dea2d1aSSukadev Bhattiprolu free_vinst: 944dea2d1aSSukadev Bhattiprolu kfree(vinst); 954dea2d1aSSukadev Bhattiprolu return -ENODEV; 964dea2d1aSSukadev Bhattiprolu 974dea2d1aSSukadev Bhattiprolu } 984dea2d1aSSukadev Bhattiprolu 994dea2d1aSSukadev Bhattiprolu /* 1004dea2d1aSSukadev Bhattiprolu * Although this is read/used multiple times, it is written to only 1014dea2d1aSSukadev Bhattiprolu * during initialization. 1024dea2d1aSSukadev Bhattiprolu */ 1034dea2d1aSSukadev Bhattiprolu struct vas_instance *find_vas_instance(int vasid) 1044dea2d1aSSukadev Bhattiprolu { 1054dea2d1aSSukadev Bhattiprolu struct list_head *ent; 1064dea2d1aSSukadev Bhattiprolu struct vas_instance *vinst; 1074dea2d1aSSukadev Bhattiprolu 1084dea2d1aSSukadev Bhattiprolu mutex_lock(&vas_mutex); 109ca03258bSSukadev Bhattiprolu 110ca03258bSSukadev Bhattiprolu if (vasid == -1) 111ca03258bSSukadev Bhattiprolu vasid = per_cpu(cpu_vas_id, smp_processor_id()); 112ca03258bSSukadev Bhattiprolu 1134dea2d1aSSukadev Bhattiprolu list_for_each(ent, &vas_instances) { 1144dea2d1aSSukadev Bhattiprolu vinst = list_entry(ent, struct vas_instance, node); 1154dea2d1aSSukadev Bhattiprolu if (vinst->vas_id == vasid) { 1164dea2d1aSSukadev Bhattiprolu mutex_unlock(&vas_mutex); 1174dea2d1aSSukadev Bhattiprolu return vinst; 1184dea2d1aSSukadev Bhattiprolu } 1194dea2d1aSSukadev Bhattiprolu } 1204dea2d1aSSukadev Bhattiprolu mutex_unlock(&vas_mutex); 1214dea2d1aSSukadev Bhattiprolu 1224dea2d1aSSukadev Bhattiprolu pr_devel("Instance %d not found\n", vasid); 1234dea2d1aSSukadev Bhattiprolu return NULL; 1244dea2d1aSSukadev Bhattiprolu } 1254dea2d1aSSukadev Bhattiprolu 1264dea2d1aSSukadev Bhattiprolu static int vas_probe(struct platform_device *pdev) 1274dea2d1aSSukadev Bhattiprolu { 1284dea2d1aSSukadev Bhattiprolu return init_vas_instance(pdev); 1294dea2d1aSSukadev Bhattiprolu } 1304dea2d1aSSukadev Bhattiprolu 1314dea2d1aSSukadev Bhattiprolu static const struct of_device_id powernv_vas_match[] = { 1324dea2d1aSSukadev Bhattiprolu { .compatible = "ibm,vas",}, 1334dea2d1aSSukadev Bhattiprolu {}, 1344dea2d1aSSukadev Bhattiprolu }; 1354dea2d1aSSukadev Bhattiprolu 1364dea2d1aSSukadev Bhattiprolu static struct platform_driver vas_driver = { 1374dea2d1aSSukadev Bhattiprolu .driver = { 1384dea2d1aSSukadev Bhattiprolu .name = "vas", 1394dea2d1aSSukadev Bhattiprolu .of_match_table = powernv_vas_match, 1404dea2d1aSSukadev Bhattiprolu }, 1414dea2d1aSSukadev Bhattiprolu .probe = vas_probe, 1424dea2d1aSSukadev Bhattiprolu }; 1434dea2d1aSSukadev Bhattiprolu 1444dea2d1aSSukadev Bhattiprolu static int __init vas_init(void) 1454dea2d1aSSukadev Bhattiprolu { 1464dea2d1aSSukadev Bhattiprolu int found = 0; 1474dea2d1aSSukadev Bhattiprolu struct device_node *dn; 1484dea2d1aSSukadev Bhattiprolu 1494dea2d1aSSukadev Bhattiprolu platform_driver_register(&vas_driver); 1504dea2d1aSSukadev Bhattiprolu 1514dea2d1aSSukadev Bhattiprolu for_each_compatible_node(dn, NULL, "ibm,vas") { 1524dea2d1aSSukadev Bhattiprolu of_platform_device_create(dn, NULL, NULL); 1534dea2d1aSSukadev Bhattiprolu found++; 1544dea2d1aSSukadev Bhattiprolu } 1554dea2d1aSSukadev Bhattiprolu 1564dea2d1aSSukadev Bhattiprolu if (!found) 1574dea2d1aSSukadev Bhattiprolu return -ENODEV; 1584dea2d1aSSukadev Bhattiprolu 1594dea2d1aSSukadev Bhattiprolu pr_devel("Found %d instances\n", found); 1604dea2d1aSSukadev Bhattiprolu 1614dea2d1aSSukadev Bhattiprolu return 0; 1624dea2d1aSSukadev Bhattiprolu } 1634dea2d1aSSukadev Bhattiprolu device_initcall(vas_init); 164