162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* Copyright(c) 2017-2018 Intel Corporation. All rights reserved. */ 362306a36Sopenharmony_ci#include <linux/memremap.h> 462306a36Sopenharmony_ci#include <linux/device.h> 562306a36Sopenharmony_ci#include <linux/mutex.h> 662306a36Sopenharmony_ci#include <linux/list.h> 762306a36Sopenharmony_ci#include <linux/slab.h> 862306a36Sopenharmony_ci#include <linux/dax.h> 962306a36Sopenharmony_ci#include <linux/io.h> 1062306a36Sopenharmony_ci#include "dax-private.h" 1162306a36Sopenharmony_ci#include "bus.h" 1262306a36Sopenharmony_ci 1362306a36Sopenharmony_cistatic DEFINE_MUTEX(dax_bus_lock); 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_ci#define DAX_NAME_LEN 30 1662306a36Sopenharmony_cistruct dax_id { 1762306a36Sopenharmony_ci struct list_head list; 1862306a36Sopenharmony_ci char dev_name[DAX_NAME_LEN]; 1962306a36Sopenharmony_ci}; 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_cistatic int dax_bus_uevent(const struct device *dev, struct kobj_uevent_env *env) 2262306a36Sopenharmony_ci{ 2362306a36Sopenharmony_ci /* 2462306a36Sopenharmony_ci * We only ever expect to handle device-dax instances, i.e. the 2562306a36Sopenharmony_ci * @type argument to MODULE_ALIAS_DAX_DEVICE() is always zero 2662306a36Sopenharmony_ci */ 2762306a36Sopenharmony_ci return add_uevent_var(env, "MODALIAS=" DAX_DEVICE_MODALIAS_FMT, 0); 2862306a36Sopenharmony_ci} 2962306a36Sopenharmony_ci 3062306a36Sopenharmony_cistatic struct dax_device_driver *to_dax_drv(struct device_driver *drv) 3162306a36Sopenharmony_ci{ 3262306a36Sopenharmony_ci return container_of(drv, struct dax_device_driver, drv); 3362306a36Sopenharmony_ci} 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_cistatic struct dax_id *__dax_match_id(struct dax_device_driver *dax_drv, 3662306a36Sopenharmony_ci const char *dev_name) 3762306a36Sopenharmony_ci{ 3862306a36Sopenharmony_ci struct dax_id *dax_id; 3962306a36Sopenharmony_ci 4062306a36Sopenharmony_ci lockdep_assert_held(&dax_bus_lock); 4162306a36Sopenharmony_ci 4262306a36Sopenharmony_ci list_for_each_entry(dax_id, &dax_drv->ids, list) 4362306a36Sopenharmony_ci if (sysfs_streq(dax_id->dev_name, dev_name)) 4462306a36Sopenharmony_ci return dax_id; 4562306a36Sopenharmony_ci return NULL; 4662306a36Sopenharmony_ci} 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_cistatic int dax_match_id(struct dax_device_driver *dax_drv, struct device *dev) 4962306a36Sopenharmony_ci{ 5062306a36Sopenharmony_ci int match; 5162306a36Sopenharmony_ci 5262306a36Sopenharmony_ci mutex_lock(&dax_bus_lock); 5362306a36Sopenharmony_ci match = !!__dax_match_id(dax_drv, dev_name(dev)); 5462306a36Sopenharmony_ci mutex_unlock(&dax_bus_lock); 5562306a36Sopenharmony_ci 5662306a36Sopenharmony_ci return match; 5762306a36Sopenharmony_ci} 5862306a36Sopenharmony_ci 5962306a36Sopenharmony_cistatic int dax_match_type(struct dax_device_driver *dax_drv, struct device *dev) 6062306a36Sopenharmony_ci{ 6162306a36Sopenharmony_ci enum dax_driver_type type = DAXDRV_DEVICE_TYPE; 6262306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev); 6362306a36Sopenharmony_ci 6462306a36Sopenharmony_ci if (dev_dax->region->res.flags & IORESOURCE_DAX_KMEM) 6562306a36Sopenharmony_ci type = DAXDRV_KMEM_TYPE; 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_ci if (dax_drv->type == type) 6862306a36Sopenharmony_ci return 1; 6962306a36Sopenharmony_ci 7062306a36Sopenharmony_ci /* default to device mode if dax_kmem is disabled */ 7162306a36Sopenharmony_ci if (dax_drv->type == DAXDRV_DEVICE_TYPE && 7262306a36Sopenharmony_ci !IS_ENABLED(CONFIG_DEV_DAX_KMEM)) 7362306a36Sopenharmony_ci return 1; 7462306a36Sopenharmony_ci 7562306a36Sopenharmony_ci return 0; 7662306a36Sopenharmony_ci} 7762306a36Sopenharmony_ci 7862306a36Sopenharmony_cienum id_action { 7962306a36Sopenharmony_ci ID_REMOVE, 8062306a36Sopenharmony_ci ID_ADD, 8162306a36Sopenharmony_ci}; 8262306a36Sopenharmony_ci 8362306a36Sopenharmony_cistatic ssize_t do_id_store(struct device_driver *drv, const char *buf, 8462306a36Sopenharmony_ci size_t count, enum id_action action) 8562306a36Sopenharmony_ci{ 8662306a36Sopenharmony_ci struct dax_device_driver *dax_drv = to_dax_drv(drv); 8762306a36Sopenharmony_ci unsigned int region_id, id; 8862306a36Sopenharmony_ci char devname[DAX_NAME_LEN]; 8962306a36Sopenharmony_ci struct dax_id *dax_id; 9062306a36Sopenharmony_ci ssize_t rc = count; 9162306a36Sopenharmony_ci int fields; 9262306a36Sopenharmony_ci 9362306a36Sopenharmony_ci fields = sscanf(buf, "dax%d.%d", ®ion_id, &id); 9462306a36Sopenharmony_ci if (fields != 2) 9562306a36Sopenharmony_ci return -EINVAL; 9662306a36Sopenharmony_ci sprintf(devname, "dax%d.%d", region_id, id); 9762306a36Sopenharmony_ci if (!sysfs_streq(buf, devname)) 9862306a36Sopenharmony_ci return -EINVAL; 9962306a36Sopenharmony_ci 10062306a36Sopenharmony_ci mutex_lock(&dax_bus_lock); 10162306a36Sopenharmony_ci dax_id = __dax_match_id(dax_drv, buf); 10262306a36Sopenharmony_ci if (!dax_id) { 10362306a36Sopenharmony_ci if (action == ID_ADD) { 10462306a36Sopenharmony_ci dax_id = kzalloc(sizeof(*dax_id), GFP_KERNEL); 10562306a36Sopenharmony_ci if (dax_id) { 10662306a36Sopenharmony_ci strncpy(dax_id->dev_name, buf, DAX_NAME_LEN); 10762306a36Sopenharmony_ci list_add(&dax_id->list, &dax_drv->ids); 10862306a36Sopenharmony_ci } else 10962306a36Sopenharmony_ci rc = -ENOMEM; 11062306a36Sopenharmony_ci } 11162306a36Sopenharmony_ci } else if (action == ID_REMOVE) { 11262306a36Sopenharmony_ci list_del(&dax_id->list); 11362306a36Sopenharmony_ci kfree(dax_id); 11462306a36Sopenharmony_ci } 11562306a36Sopenharmony_ci mutex_unlock(&dax_bus_lock); 11662306a36Sopenharmony_ci 11762306a36Sopenharmony_ci if (rc < 0) 11862306a36Sopenharmony_ci return rc; 11962306a36Sopenharmony_ci if (action == ID_ADD) 12062306a36Sopenharmony_ci rc = driver_attach(drv); 12162306a36Sopenharmony_ci if (rc) 12262306a36Sopenharmony_ci return rc; 12362306a36Sopenharmony_ci return count; 12462306a36Sopenharmony_ci} 12562306a36Sopenharmony_ci 12662306a36Sopenharmony_cistatic ssize_t new_id_store(struct device_driver *drv, const char *buf, 12762306a36Sopenharmony_ci size_t count) 12862306a36Sopenharmony_ci{ 12962306a36Sopenharmony_ci return do_id_store(drv, buf, count, ID_ADD); 13062306a36Sopenharmony_ci} 13162306a36Sopenharmony_cistatic DRIVER_ATTR_WO(new_id); 13262306a36Sopenharmony_ci 13362306a36Sopenharmony_cistatic ssize_t remove_id_store(struct device_driver *drv, const char *buf, 13462306a36Sopenharmony_ci size_t count) 13562306a36Sopenharmony_ci{ 13662306a36Sopenharmony_ci return do_id_store(drv, buf, count, ID_REMOVE); 13762306a36Sopenharmony_ci} 13862306a36Sopenharmony_cistatic DRIVER_ATTR_WO(remove_id); 13962306a36Sopenharmony_ci 14062306a36Sopenharmony_cistatic struct attribute *dax_drv_attrs[] = { 14162306a36Sopenharmony_ci &driver_attr_new_id.attr, 14262306a36Sopenharmony_ci &driver_attr_remove_id.attr, 14362306a36Sopenharmony_ci NULL, 14462306a36Sopenharmony_ci}; 14562306a36Sopenharmony_ciATTRIBUTE_GROUPS(dax_drv); 14662306a36Sopenharmony_ci 14762306a36Sopenharmony_cistatic int dax_bus_match(struct device *dev, struct device_driver *drv); 14862306a36Sopenharmony_ci 14962306a36Sopenharmony_ci/* 15062306a36Sopenharmony_ci * Static dax regions are regions created by an external subsystem 15162306a36Sopenharmony_ci * nvdimm where a single range is assigned. Its boundaries are by the external 15262306a36Sopenharmony_ci * subsystem and are usually limited to one physical memory range. For example, 15362306a36Sopenharmony_ci * for PMEM it is usually defined by NVDIMM Namespace boundaries (i.e. a 15462306a36Sopenharmony_ci * single contiguous range) 15562306a36Sopenharmony_ci * 15662306a36Sopenharmony_ci * On dynamic dax regions, the assigned region can be partitioned by dax core 15762306a36Sopenharmony_ci * into multiple subdivisions. A subdivision is represented into one 15862306a36Sopenharmony_ci * /dev/daxN.M device composed by one or more potentially discontiguous ranges. 15962306a36Sopenharmony_ci * 16062306a36Sopenharmony_ci * When allocating a dax region, drivers must set whether it's static 16162306a36Sopenharmony_ci * (IORESOURCE_DAX_STATIC). On static dax devices, the @pgmap is pre-assigned 16262306a36Sopenharmony_ci * to dax core when calling devm_create_dev_dax(), whereas in dynamic dax 16362306a36Sopenharmony_ci * devices it is NULL but afterwards allocated by dax core on device ->probe(). 16462306a36Sopenharmony_ci * Care is needed to make sure that dynamic dax devices are torn down with a 16562306a36Sopenharmony_ci * cleared @pgmap field (see kill_dev_dax()). 16662306a36Sopenharmony_ci */ 16762306a36Sopenharmony_cistatic bool is_static(struct dax_region *dax_region) 16862306a36Sopenharmony_ci{ 16962306a36Sopenharmony_ci return (dax_region->res.flags & IORESOURCE_DAX_STATIC) != 0; 17062306a36Sopenharmony_ci} 17162306a36Sopenharmony_ci 17262306a36Sopenharmony_cibool static_dev_dax(struct dev_dax *dev_dax) 17362306a36Sopenharmony_ci{ 17462306a36Sopenharmony_ci return is_static(dev_dax->region); 17562306a36Sopenharmony_ci} 17662306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(static_dev_dax); 17762306a36Sopenharmony_ci 17862306a36Sopenharmony_cistatic u64 dev_dax_size(struct dev_dax *dev_dax) 17962306a36Sopenharmony_ci{ 18062306a36Sopenharmony_ci u64 size = 0; 18162306a36Sopenharmony_ci int i; 18262306a36Sopenharmony_ci 18362306a36Sopenharmony_ci device_lock_assert(&dev_dax->dev); 18462306a36Sopenharmony_ci 18562306a36Sopenharmony_ci for (i = 0; i < dev_dax->nr_range; i++) 18662306a36Sopenharmony_ci size += range_len(&dev_dax->ranges[i].range); 18762306a36Sopenharmony_ci 18862306a36Sopenharmony_ci return size; 18962306a36Sopenharmony_ci} 19062306a36Sopenharmony_ci 19162306a36Sopenharmony_cistatic int dax_bus_probe(struct device *dev) 19262306a36Sopenharmony_ci{ 19362306a36Sopenharmony_ci struct dax_device_driver *dax_drv = to_dax_drv(dev->driver); 19462306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev); 19562306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 19662306a36Sopenharmony_ci int rc; 19762306a36Sopenharmony_ci 19862306a36Sopenharmony_ci if (dev_dax_size(dev_dax) == 0 || dev_dax->id < 0) 19962306a36Sopenharmony_ci return -ENXIO; 20062306a36Sopenharmony_ci 20162306a36Sopenharmony_ci rc = dax_drv->probe(dev_dax); 20262306a36Sopenharmony_ci 20362306a36Sopenharmony_ci if (rc || is_static(dax_region)) 20462306a36Sopenharmony_ci return rc; 20562306a36Sopenharmony_ci 20662306a36Sopenharmony_ci /* 20762306a36Sopenharmony_ci * Track new seed creation only after successful probe of the 20862306a36Sopenharmony_ci * previous seed. 20962306a36Sopenharmony_ci */ 21062306a36Sopenharmony_ci if (dax_region->seed == dev) 21162306a36Sopenharmony_ci dax_region->seed = NULL; 21262306a36Sopenharmony_ci 21362306a36Sopenharmony_ci return 0; 21462306a36Sopenharmony_ci} 21562306a36Sopenharmony_ci 21662306a36Sopenharmony_cistatic void dax_bus_remove(struct device *dev) 21762306a36Sopenharmony_ci{ 21862306a36Sopenharmony_ci struct dax_device_driver *dax_drv = to_dax_drv(dev->driver); 21962306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev); 22062306a36Sopenharmony_ci 22162306a36Sopenharmony_ci if (dax_drv->remove) 22262306a36Sopenharmony_ci dax_drv->remove(dev_dax); 22362306a36Sopenharmony_ci} 22462306a36Sopenharmony_ci 22562306a36Sopenharmony_cistatic struct bus_type dax_bus_type = { 22662306a36Sopenharmony_ci .name = "dax", 22762306a36Sopenharmony_ci .uevent = dax_bus_uevent, 22862306a36Sopenharmony_ci .match = dax_bus_match, 22962306a36Sopenharmony_ci .probe = dax_bus_probe, 23062306a36Sopenharmony_ci .remove = dax_bus_remove, 23162306a36Sopenharmony_ci .drv_groups = dax_drv_groups, 23262306a36Sopenharmony_ci}; 23362306a36Sopenharmony_ci 23462306a36Sopenharmony_cistatic int dax_bus_match(struct device *dev, struct device_driver *drv) 23562306a36Sopenharmony_ci{ 23662306a36Sopenharmony_ci struct dax_device_driver *dax_drv = to_dax_drv(drv); 23762306a36Sopenharmony_ci 23862306a36Sopenharmony_ci if (dax_match_id(dax_drv, dev)) 23962306a36Sopenharmony_ci return 1; 24062306a36Sopenharmony_ci return dax_match_type(dax_drv, dev); 24162306a36Sopenharmony_ci} 24262306a36Sopenharmony_ci 24362306a36Sopenharmony_ci/* 24462306a36Sopenharmony_ci * Rely on the fact that drvdata is set before the attributes are 24562306a36Sopenharmony_ci * registered, and that the attributes are unregistered before drvdata 24662306a36Sopenharmony_ci * is cleared to assume that drvdata is always valid. 24762306a36Sopenharmony_ci */ 24862306a36Sopenharmony_cistatic ssize_t id_show(struct device *dev, 24962306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 25062306a36Sopenharmony_ci{ 25162306a36Sopenharmony_ci struct dax_region *dax_region = dev_get_drvdata(dev); 25262306a36Sopenharmony_ci 25362306a36Sopenharmony_ci return sprintf(buf, "%d\n", dax_region->id); 25462306a36Sopenharmony_ci} 25562306a36Sopenharmony_cistatic DEVICE_ATTR_RO(id); 25662306a36Sopenharmony_ci 25762306a36Sopenharmony_cistatic ssize_t region_size_show(struct device *dev, 25862306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 25962306a36Sopenharmony_ci{ 26062306a36Sopenharmony_ci struct dax_region *dax_region = dev_get_drvdata(dev); 26162306a36Sopenharmony_ci 26262306a36Sopenharmony_ci return sprintf(buf, "%llu\n", (unsigned long long) 26362306a36Sopenharmony_ci resource_size(&dax_region->res)); 26462306a36Sopenharmony_ci} 26562306a36Sopenharmony_cistatic struct device_attribute dev_attr_region_size = __ATTR(size, 0444, 26662306a36Sopenharmony_ci region_size_show, NULL); 26762306a36Sopenharmony_ci 26862306a36Sopenharmony_cistatic ssize_t region_align_show(struct device *dev, 26962306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 27062306a36Sopenharmony_ci{ 27162306a36Sopenharmony_ci struct dax_region *dax_region = dev_get_drvdata(dev); 27262306a36Sopenharmony_ci 27362306a36Sopenharmony_ci return sprintf(buf, "%u\n", dax_region->align); 27462306a36Sopenharmony_ci} 27562306a36Sopenharmony_cistatic struct device_attribute dev_attr_region_align = 27662306a36Sopenharmony_ci __ATTR(align, 0400, region_align_show, NULL); 27762306a36Sopenharmony_ci 27862306a36Sopenharmony_ci#define for_each_dax_region_resource(dax_region, res) \ 27962306a36Sopenharmony_ci for (res = (dax_region)->res.child; res; res = res->sibling) 28062306a36Sopenharmony_ci 28162306a36Sopenharmony_cistatic unsigned long long dax_region_avail_size(struct dax_region *dax_region) 28262306a36Sopenharmony_ci{ 28362306a36Sopenharmony_ci resource_size_t size = resource_size(&dax_region->res); 28462306a36Sopenharmony_ci struct resource *res; 28562306a36Sopenharmony_ci 28662306a36Sopenharmony_ci device_lock_assert(dax_region->dev); 28762306a36Sopenharmony_ci 28862306a36Sopenharmony_ci for_each_dax_region_resource(dax_region, res) 28962306a36Sopenharmony_ci size -= resource_size(res); 29062306a36Sopenharmony_ci return size; 29162306a36Sopenharmony_ci} 29262306a36Sopenharmony_ci 29362306a36Sopenharmony_cistatic ssize_t available_size_show(struct device *dev, 29462306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 29562306a36Sopenharmony_ci{ 29662306a36Sopenharmony_ci struct dax_region *dax_region = dev_get_drvdata(dev); 29762306a36Sopenharmony_ci unsigned long long size; 29862306a36Sopenharmony_ci 29962306a36Sopenharmony_ci device_lock(dev); 30062306a36Sopenharmony_ci size = dax_region_avail_size(dax_region); 30162306a36Sopenharmony_ci device_unlock(dev); 30262306a36Sopenharmony_ci 30362306a36Sopenharmony_ci return sprintf(buf, "%llu\n", size); 30462306a36Sopenharmony_ci} 30562306a36Sopenharmony_cistatic DEVICE_ATTR_RO(available_size); 30662306a36Sopenharmony_ci 30762306a36Sopenharmony_cistatic ssize_t seed_show(struct device *dev, 30862306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 30962306a36Sopenharmony_ci{ 31062306a36Sopenharmony_ci struct dax_region *dax_region = dev_get_drvdata(dev); 31162306a36Sopenharmony_ci struct device *seed; 31262306a36Sopenharmony_ci ssize_t rc; 31362306a36Sopenharmony_ci 31462306a36Sopenharmony_ci if (is_static(dax_region)) 31562306a36Sopenharmony_ci return -EINVAL; 31662306a36Sopenharmony_ci 31762306a36Sopenharmony_ci device_lock(dev); 31862306a36Sopenharmony_ci seed = dax_region->seed; 31962306a36Sopenharmony_ci rc = sprintf(buf, "%s\n", seed ? dev_name(seed) : ""); 32062306a36Sopenharmony_ci device_unlock(dev); 32162306a36Sopenharmony_ci 32262306a36Sopenharmony_ci return rc; 32362306a36Sopenharmony_ci} 32462306a36Sopenharmony_cistatic DEVICE_ATTR_RO(seed); 32562306a36Sopenharmony_ci 32662306a36Sopenharmony_cistatic ssize_t create_show(struct device *dev, 32762306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 32862306a36Sopenharmony_ci{ 32962306a36Sopenharmony_ci struct dax_region *dax_region = dev_get_drvdata(dev); 33062306a36Sopenharmony_ci struct device *youngest; 33162306a36Sopenharmony_ci ssize_t rc; 33262306a36Sopenharmony_ci 33362306a36Sopenharmony_ci if (is_static(dax_region)) 33462306a36Sopenharmony_ci return -EINVAL; 33562306a36Sopenharmony_ci 33662306a36Sopenharmony_ci device_lock(dev); 33762306a36Sopenharmony_ci youngest = dax_region->youngest; 33862306a36Sopenharmony_ci rc = sprintf(buf, "%s\n", youngest ? dev_name(youngest) : ""); 33962306a36Sopenharmony_ci device_unlock(dev); 34062306a36Sopenharmony_ci 34162306a36Sopenharmony_ci return rc; 34262306a36Sopenharmony_ci} 34362306a36Sopenharmony_ci 34462306a36Sopenharmony_cistatic ssize_t create_store(struct device *dev, struct device_attribute *attr, 34562306a36Sopenharmony_ci const char *buf, size_t len) 34662306a36Sopenharmony_ci{ 34762306a36Sopenharmony_ci struct dax_region *dax_region = dev_get_drvdata(dev); 34862306a36Sopenharmony_ci unsigned long long avail; 34962306a36Sopenharmony_ci ssize_t rc; 35062306a36Sopenharmony_ci int val; 35162306a36Sopenharmony_ci 35262306a36Sopenharmony_ci if (is_static(dax_region)) 35362306a36Sopenharmony_ci return -EINVAL; 35462306a36Sopenharmony_ci 35562306a36Sopenharmony_ci rc = kstrtoint(buf, 0, &val); 35662306a36Sopenharmony_ci if (rc) 35762306a36Sopenharmony_ci return rc; 35862306a36Sopenharmony_ci if (val != 1) 35962306a36Sopenharmony_ci return -EINVAL; 36062306a36Sopenharmony_ci 36162306a36Sopenharmony_ci device_lock(dev); 36262306a36Sopenharmony_ci avail = dax_region_avail_size(dax_region); 36362306a36Sopenharmony_ci if (avail == 0) 36462306a36Sopenharmony_ci rc = -ENOSPC; 36562306a36Sopenharmony_ci else { 36662306a36Sopenharmony_ci struct dev_dax_data data = { 36762306a36Sopenharmony_ci .dax_region = dax_region, 36862306a36Sopenharmony_ci .size = 0, 36962306a36Sopenharmony_ci .id = -1, 37062306a36Sopenharmony_ci }; 37162306a36Sopenharmony_ci struct dev_dax *dev_dax = devm_create_dev_dax(&data); 37262306a36Sopenharmony_ci 37362306a36Sopenharmony_ci if (IS_ERR(dev_dax)) 37462306a36Sopenharmony_ci rc = PTR_ERR(dev_dax); 37562306a36Sopenharmony_ci else { 37662306a36Sopenharmony_ci /* 37762306a36Sopenharmony_ci * In support of crafting multiple new devices 37862306a36Sopenharmony_ci * simultaneously multiple seeds can be created, 37962306a36Sopenharmony_ci * but only the first one that has not been 38062306a36Sopenharmony_ci * successfully bound is tracked as the region 38162306a36Sopenharmony_ci * seed. 38262306a36Sopenharmony_ci */ 38362306a36Sopenharmony_ci if (!dax_region->seed) 38462306a36Sopenharmony_ci dax_region->seed = &dev_dax->dev; 38562306a36Sopenharmony_ci dax_region->youngest = &dev_dax->dev; 38662306a36Sopenharmony_ci rc = len; 38762306a36Sopenharmony_ci } 38862306a36Sopenharmony_ci } 38962306a36Sopenharmony_ci device_unlock(dev); 39062306a36Sopenharmony_ci 39162306a36Sopenharmony_ci return rc; 39262306a36Sopenharmony_ci} 39362306a36Sopenharmony_cistatic DEVICE_ATTR_RW(create); 39462306a36Sopenharmony_ci 39562306a36Sopenharmony_civoid kill_dev_dax(struct dev_dax *dev_dax) 39662306a36Sopenharmony_ci{ 39762306a36Sopenharmony_ci struct dax_device *dax_dev = dev_dax->dax_dev; 39862306a36Sopenharmony_ci struct inode *inode = dax_inode(dax_dev); 39962306a36Sopenharmony_ci 40062306a36Sopenharmony_ci kill_dax(dax_dev); 40162306a36Sopenharmony_ci unmap_mapping_range(inode->i_mapping, 0, 0, 1); 40262306a36Sopenharmony_ci 40362306a36Sopenharmony_ci /* 40462306a36Sopenharmony_ci * Dynamic dax region have the pgmap allocated via dev_kzalloc() 40562306a36Sopenharmony_ci * and thus freed by devm. Clear the pgmap to not have stale pgmap 40662306a36Sopenharmony_ci * ranges on probe() from previous reconfigurations of region devices. 40762306a36Sopenharmony_ci */ 40862306a36Sopenharmony_ci if (!static_dev_dax(dev_dax)) 40962306a36Sopenharmony_ci dev_dax->pgmap = NULL; 41062306a36Sopenharmony_ci} 41162306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(kill_dev_dax); 41262306a36Sopenharmony_ci 41362306a36Sopenharmony_cistatic void trim_dev_dax_range(struct dev_dax *dev_dax) 41462306a36Sopenharmony_ci{ 41562306a36Sopenharmony_ci int i = dev_dax->nr_range - 1; 41662306a36Sopenharmony_ci struct range *range = &dev_dax->ranges[i].range; 41762306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 41862306a36Sopenharmony_ci 41962306a36Sopenharmony_ci device_lock_assert(dax_region->dev); 42062306a36Sopenharmony_ci dev_dbg(&dev_dax->dev, "delete range[%d]: %#llx:%#llx\n", i, 42162306a36Sopenharmony_ci (unsigned long long)range->start, 42262306a36Sopenharmony_ci (unsigned long long)range->end); 42362306a36Sopenharmony_ci 42462306a36Sopenharmony_ci __release_region(&dax_region->res, range->start, range_len(range)); 42562306a36Sopenharmony_ci if (--dev_dax->nr_range == 0) { 42662306a36Sopenharmony_ci kfree(dev_dax->ranges); 42762306a36Sopenharmony_ci dev_dax->ranges = NULL; 42862306a36Sopenharmony_ci } 42962306a36Sopenharmony_ci} 43062306a36Sopenharmony_ci 43162306a36Sopenharmony_cistatic void free_dev_dax_ranges(struct dev_dax *dev_dax) 43262306a36Sopenharmony_ci{ 43362306a36Sopenharmony_ci while (dev_dax->nr_range) 43462306a36Sopenharmony_ci trim_dev_dax_range(dev_dax); 43562306a36Sopenharmony_ci} 43662306a36Sopenharmony_ci 43762306a36Sopenharmony_cistatic void unregister_dev_dax(void *dev) 43862306a36Sopenharmony_ci{ 43962306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev); 44062306a36Sopenharmony_ci 44162306a36Sopenharmony_ci dev_dbg(dev, "%s\n", __func__); 44262306a36Sopenharmony_ci 44362306a36Sopenharmony_ci kill_dev_dax(dev_dax); 44462306a36Sopenharmony_ci device_del(dev); 44562306a36Sopenharmony_ci free_dev_dax_ranges(dev_dax); 44662306a36Sopenharmony_ci put_device(dev); 44762306a36Sopenharmony_ci} 44862306a36Sopenharmony_ci 44962306a36Sopenharmony_cistatic void dax_region_free(struct kref *kref) 45062306a36Sopenharmony_ci{ 45162306a36Sopenharmony_ci struct dax_region *dax_region; 45262306a36Sopenharmony_ci 45362306a36Sopenharmony_ci dax_region = container_of(kref, struct dax_region, kref); 45462306a36Sopenharmony_ci kfree(dax_region); 45562306a36Sopenharmony_ci} 45662306a36Sopenharmony_ci 45762306a36Sopenharmony_cistatic void dax_region_put(struct dax_region *dax_region) 45862306a36Sopenharmony_ci{ 45962306a36Sopenharmony_ci kref_put(&dax_region->kref, dax_region_free); 46062306a36Sopenharmony_ci} 46162306a36Sopenharmony_ci 46262306a36Sopenharmony_ci/* a return value >= 0 indicates this invocation invalidated the id */ 46362306a36Sopenharmony_cistatic int __free_dev_dax_id(struct dev_dax *dev_dax) 46462306a36Sopenharmony_ci{ 46562306a36Sopenharmony_ci struct device *dev = &dev_dax->dev; 46662306a36Sopenharmony_ci struct dax_region *dax_region; 46762306a36Sopenharmony_ci int rc = dev_dax->id; 46862306a36Sopenharmony_ci 46962306a36Sopenharmony_ci device_lock_assert(dev); 47062306a36Sopenharmony_ci 47162306a36Sopenharmony_ci if (!dev_dax->dyn_id || dev_dax->id < 0) 47262306a36Sopenharmony_ci return -1; 47362306a36Sopenharmony_ci dax_region = dev_dax->region; 47462306a36Sopenharmony_ci ida_free(&dax_region->ida, dev_dax->id); 47562306a36Sopenharmony_ci dax_region_put(dax_region); 47662306a36Sopenharmony_ci dev_dax->id = -1; 47762306a36Sopenharmony_ci return rc; 47862306a36Sopenharmony_ci} 47962306a36Sopenharmony_ci 48062306a36Sopenharmony_cistatic int free_dev_dax_id(struct dev_dax *dev_dax) 48162306a36Sopenharmony_ci{ 48262306a36Sopenharmony_ci struct device *dev = &dev_dax->dev; 48362306a36Sopenharmony_ci int rc; 48462306a36Sopenharmony_ci 48562306a36Sopenharmony_ci device_lock(dev); 48662306a36Sopenharmony_ci rc = __free_dev_dax_id(dev_dax); 48762306a36Sopenharmony_ci device_unlock(dev); 48862306a36Sopenharmony_ci return rc; 48962306a36Sopenharmony_ci} 49062306a36Sopenharmony_ci 49162306a36Sopenharmony_cistatic int alloc_dev_dax_id(struct dev_dax *dev_dax) 49262306a36Sopenharmony_ci{ 49362306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 49462306a36Sopenharmony_ci int id; 49562306a36Sopenharmony_ci 49662306a36Sopenharmony_ci id = ida_alloc(&dax_region->ida, GFP_KERNEL); 49762306a36Sopenharmony_ci if (id < 0) 49862306a36Sopenharmony_ci return id; 49962306a36Sopenharmony_ci kref_get(&dax_region->kref); 50062306a36Sopenharmony_ci dev_dax->dyn_id = true; 50162306a36Sopenharmony_ci dev_dax->id = id; 50262306a36Sopenharmony_ci return id; 50362306a36Sopenharmony_ci} 50462306a36Sopenharmony_ci 50562306a36Sopenharmony_cistatic ssize_t delete_store(struct device *dev, struct device_attribute *attr, 50662306a36Sopenharmony_ci const char *buf, size_t len) 50762306a36Sopenharmony_ci{ 50862306a36Sopenharmony_ci struct dax_region *dax_region = dev_get_drvdata(dev); 50962306a36Sopenharmony_ci struct dev_dax *dev_dax; 51062306a36Sopenharmony_ci struct device *victim; 51162306a36Sopenharmony_ci bool do_del = false; 51262306a36Sopenharmony_ci int rc; 51362306a36Sopenharmony_ci 51462306a36Sopenharmony_ci if (is_static(dax_region)) 51562306a36Sopenharmony_ci return -EINVAL; 51662306a36Sopenharmony_ci 51762306a36Sopenharmony_ci victim = device_find_child_by_name(dax_region->dev, buf); 51862306a36Sopenharmony_ci if (!victim) 51962306a36Sopenharmony_ci return -ENXIO; 52062306a36Sopenharmony_ci 52162306a36Sopenharmony_ci device_lock(dev); 52262306a36Sopenharmony_ci device_lock(victim); 52362306a36Sopenharmony_ci dev_dax = to_dev_dax(victim); 52462306a36Sopenharmony_ci if (victim->driver || dev_dax_size(dev_dax)) 52562306a36Sopenharmony_ci rc = -EBUSY; 52662306a36Sopenharmony_ci else { 52762306a36Sopenharmony_ci /* 52862306a36Sopenharmony_ci * Invalidate the device so it does not become active 52962306a36Sopenharmony_ci * again, but always preserve device-id-0 so that 53062306a36Sopenharmony_ci * /sys/bus/dax/ is guaranteed to be populated while any 53162306a36Sopenharmony_ci * dax_region is registered. 53262306a36Sopenharmony_ci */ 53362306a36Sopenharmony_ci if (dev_dax->id > 0) { 53462306a36Sopenharmony_ci do_del = __free_dev_dax_id(dev_dax) >= 0; 53562306a36Sopenharmony_ci rc = len; 53662306a36Sopenharmony_ci if (dax_region->seed == victim) 53762306a36Sopenharmony_ci dax_region->seed = NULL; 53862306a36Sopenharmony_ci if (dax_region->youngest == victim) 53962306a36Sopenharmony_ci dax_region->youngest = NULL; 54062306a36Sopenharmony_ci } else 54162306a36Sopenharmony_ci rc = -EBUSY; 54262306a36Sopenharmony_ci } 54362306a36Sopenharmony_ci device_unlock(victim); 54462306a36Sopenharmony_ci 54562306a36Sopenharmony_ci /* won the race to invalidate the device, clean it up */ 54662306a36Sopenharmony_ci if (do_del) 54762306a36Sopenharmony_ci devm_release_action(dev, unregister_dev_dax, victim); 54862306a36Sopenharmony_ci device_unlock(dev); 54962306a36Sopenharmony_ci put_device(victim); 55062306a36Sopenharmony_ci 55162306a36Sopenharmony_ci return rc; 55262306a36Sopenharmony_ci} 55362306a36Sopenharmony_cistatic DEVICE_ATTR_WO(delete); 55462306a36Sopenharmony_ci 55562306a36Sopenharmony_cistatic umode_t dax_region_visible(struct kobject *kobj, struct attribute *a, 55662306a36Sopenharmony_ci int n) 55762306a36Sopenharmony_ci{ 55862306a36Sopenharmony_ci struct device *dev = container_of(kobj, struct device, kobj); 55962306a36Sopenharmony_ci struct dax_region *dax_region = dev_get_drvdata(dev); 56062306a36Sopenharmony_ci 56162306a36Sopenharmony_ci if (is_static(dax_region)) 56262306a36Sopenharmony_ci if (a == &dev_attr_available_size.attr 56362306a36Sopenharmony_ci || a == &dev_attr_create.attr 56462306a36Sopenharmony_ci || a == &dev_attr_seed.attr 56562306a36Sopenharmony_ci || a == &dev_attr_delete.attr) 56662306a36Sopenharmony_ci return 0; 56762306a36Sopenharmony_ci return a->mode; 56862306a36Sopenharmony_ci} 56962306a36Sopenharmony_ci 57062306a36Sopenharmony_cistatic struct attribute *dax_region_attributes[] = { 57162306a36Sopenharmony_ci &dev_attr_available_size.attr, 57262306a36Sopenharmony_ci &dev_attr_region_size.attr, 57362306a36Sopenharmony_ci &dev_attr_region_align.attr, 57462306a36Sopenharmony_ci &dev_attr_create.attr, 57562306a36Sopenharmony_ci &dev_attr_seed.attr, 57662306a36Sopenharmony_ci &dev_attr_delete.attr, 57762306a36Sopenharmony_ci &dev_attr_id.attr, 57862306a36Sopenharmony_ci NULL, 57962306a36Sopenharmony_ci}; 58062306a36Sopenharmony_ci 58162306a36Sopenharmony_cistatic const struct attribute_group dax_region_attribute_group = { 58262306a36Sopenharmony_ci .name = "dax_region", 58362306a36Sopenharmony_ci .attrs = dax_region_attributes, 58462306a36Sopenharmony_ci .is_visible = dax_region_visible, 58562306a36Sopenharmony_ci}; 58662306a36Sopenharmony_ci 58762306a36Sopenharmony_cistatic const struct attribute_group *dax_region_attribute_groups[] = { 58862306a36Sopenharmony_ci &dax_region_attribute_group, 58962306a36Sopenharmony_ci NULL, 59062306a36Sopenharmony_ci}; 59162306a36Sopenharmony_ci 59262306a36Sopenharmony_cistatic void dax_region_unregister(void *region) 59362306a36Sopenharmony_ci{ 59462306a36Sopenharmony_ci struct dax_region *dax_region = region; 59562306a36Sopenharmony_ci 59662306a36Sopenharmony_ci sysfs_remove_groups(&dax_region->dev->kobj, 59762306a36Sopenharmony_ci dax_region_attribute_groups); 59862306a36Sopenharmony_ci dax_region_put(dax_region); 59962306a36Sopenharmony_ci} 60062306a36Sopenharmony_ci 60162306a36Sopenharmony_cistruct dax_region *alloc_dax_region(struct device *parent, int region_id, 60262306a36Sopenharmony_ci struct range *range, int target_node, unsigned int align, 60362306a36Sopenharmony_ci unsigned long flags) 60462306a36Sopenharmony_ci{ 60562306a36Sopenharmony_ci struct dax_region *dax_region; 60662306a36Sopenharmony_ci 60762306a36Sopenharmony_ci /* 60862306a36Sopenharmony_ci * The DAX core assumes that it can store its private data in 60962306a36Sopenharmony_ci * parent->driver_data. This WARN is a reminder / safeguard for 61062306a36Sopenharmony_ci * developers of device-dax drivers. 61162306a36Sopenharmony_ci */ 61262306a36Sopenharmony_ci if (dev_get_drvdata(parent)) { 61362306a36Sopenharmony_ci dev_WARN(parent, "dax core failed to setup private data\n"); 61462306a36Sopenharmony_ci return NULL; 61562306a36Sopenharmony_ci } 61662306a36Sopenharmony_ci 61762306a36Sopenharmony_ci if (!IS_ALIGNED(range->start, align) 61862306a36Sopenharmony_ci || !IS_ALIGNED(range_len(range), align)) 61962306a36Sopenharmony_ci return NULL; 62062306a36Sopenharmony_ci 62162306a36Sopenharmony_ci dax_region = kzalloc(sizeof(*dax_region), GFP_KERNEL); 62262306a36Sopenharmony_ci if (!dax_region) 62362306a36Sopenharmony_ci return NULL; 62462306a36Sopenharmony_ci 62562306a36Sopenharmony_ci dev_set_drvdata(parent, dax_region); 62662306a36Sopenharmony_ci kref_init(&dax_region->kref); 62762306a36Sopenharmony_ci dax_region->id = region_id; 62862306a36Sopenharmony_ci dax_region->align = align; 62962306a36Sopenharmony_ci dax_region->dev = parent; 63062306a36Sopenharmony_ci dax_region->target_node = target_node; 63162306a36Sopenharmony_ci ida_init(&dax_region->ida); 63262306a36Sopenharmony_ci dax_region->res = (struct resource) { 63362306a36Sopenharmony_ci .start = range->start, 63462306a36Sopenharmony_ci .end = range->end, 63562306a36Sopenharmony_ci .flags = IORESOURCE_MEM | flags, 63662306a36Sopenharmony_ci }; 63762306a36Sopenharmony_ci 63862306a36Sopenharmony_ci if (sysfs_create_groups(&parent->kobj, dax_region_attribute_groups)) { 63962306a36Sopenharmony_ci kfree(dax_region); 64062306a36Sopenharmony_ci return NULL; 64162306a36Sopenharmony_ci } 64262306a36Sopenharmony_ci 64362306a36Sopenharmony_ci if (devm_add_action_or_reset(parent, dax_region_unregister, dax_region)) 64462306a36Sopenharmony_ci return NULL; 64562306a36Sopenharmony_ci return dax_region; 64662306a36Sopenharmony_ci} 64762306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(alloc_dax_region); 64862306a36Sopenharmony_ci 64962306a36Sopenharmony_cistatic void dax_mapping_release(struct device *dev) 65062306a36Sopenharmony_ci{ 65162306a36Sopenharmony_ci struct dax_mapping *mapping = to_dax_mapping(dev); 65262306a36Sopenharmony_ci struct device *parent = dev->parent; 65362306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(parent); 65462306a36Sopenharmony_ci 65562306a36Sopenharmony_ci ida_free(&dev_dax->ida, mapping->id); 65662306a36Sopenharmony_ci kfree(mapping); 65762306a36Sopenharmony_ci put_device(parent); 65862306a36Sopenharmony_ci} 65962306a36Sopenharmony_ci 66062306a36Sopenharmony_cistatic void unregister_dax_mapping(void *data) 66162306a36Sopenharmony_ci{ 66262306a36Sopenharmony_ci struct device *dev = data; 66362306a36Sopenharmony_ci struct dax_mapping *mapping = to_dax_mapping(dev); 66462306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev->parent); 66562306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 66662306a36Sopenharmony_ci 66762306a36Sopenharmony_ci dev_dbg(dev, "%s\n", __func__); 66862306a36Sopenharmony_ci 66962306a36Sopenharmony_ci device_lock_assert(dax_region->dev); 67062306a36Sopenharmony_ci 67162306a36Sopenharmony_ci dev_dax->ranges[mapping->range_id].mapping = NULL; 67262306a36Sopenharmony_ci mapping->range_id = -1; 67362306a36Sopenharmony_ci 67462306a36Sopenharmony_ci device_unregister(dev); 67562306a36Sopenharmony_ci} 67662306a36Sopenharmony_ci 67762306a36Sopenharmony_cistatic struct dev_dax_range *get_dax_range(struct device *dev) 67862306a36Sopenharmony_ci{ 67962306a36Sopenharmony_ci struct dax_mapping *mapping = to_dax_mapping(dev); 68062306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev->parent); 68162306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 68262306a36Sopenharmony_ci 68362306a36Sopenharmony_ci device_lock(dax_region->dev); 68462306a36Sopenharmony_ci if (mapping->range_id < 0) { 68562306a36Sopenharmony_ci device_unlock(dax_region->dev); 68662306a36Sopenharmony_ci return NULL; 68762306a36Sopenharmony_ci } 68862306a36Sopenharmony_ci 68962306a36Sopenharmony_ci return &dev_dax->ranges[mapping->range_id]; 69062306a36Sopenharmony_ci} 69162306a36Sopenharmony_ci 69262306a36Sopenharmony_cistatic void put_dax_range(struct dev_dax_range *dax_range) 69362306a36Sopenharmony_ci{ 69462306a36Sopenharmony_ci struct dax_mapping *mapping = dax_range->mapping; 69562306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(mapping->dev.parent); 69662306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 69762306a36Sopenharmony_ci 69862306a36Sopenharmony_ci device_unlock(dax_region->dev); 69962306a36Sopenharmony_ci} 70062306a36Sopenharmony_ci 70162306a36Sopenharmony_cistatic ssize_t start_show(struct device *dev, 70262306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 70362306a36Sopenharmony_ci{ 70462306a36Sopenharmony_ci struct dev_dax_range *dax_range; 70562306a36Sopenharmony_ci ssize_t rc; 70662306a36Sopenharmony_ci 70762306a36Sopenharmony_ci dax_range = get_dax_range(dev); 70862306a36Sopenharmony_ci if (!dax_range) 70962306a36Sopenharmony_ci return -ENXIO; 71062306a36Sopenharmony_ci rc = sprintf(buf, "%#llx\n", dax_range->range.start); 71162306a36Sopenharmony_ci put_dax_range(dax_range); 71262306a36Sopenharmony_ci 71362306a36Sopenharmony_ci return rc; 71462306a36Sopenharmony_ci} 71562306a36Sopenharmony_cistatic DEVICE_ATTR(start, 0400, start_show, NULL); 71662306a36Sopenharmony_ci 71762306a36Sopenharmony_cistatic ssize_t end_show(struct device *dev, 71862306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 71962306a36Sopenharmony_ci{ 72062306a36Sopenharmony_ci struct dev_dax_range *dax_range; 72162306a36Sopenharmony_ci ssize_t rc; 72262306a36Sopenharmony_ci 72362306a36Sopenharmony_ci dax_range = get_dax_range(dev); 72462306a36Sopenharmony_ci if (!dax_range) 72562306a36Sopenharmony_ci return -ENXIO; 72662306a36Sopenharmony_ci rc = sprintf(buf, "%#llx\n", dax_range->range.end); 72762306a36Sopenharmony_ci put_dax_range(dax_range); 72862306a36Sopenharmony_ci 72962306a36Sopenharmony_ci return rc; 73062306a36Sopenharmony_ci} 73162306a36Sopenharmony_cistatic DEVICE_ATTR(end, 0400, end_show, NULL); 73262306a36Sopenharmony_ci 73362306a36Sopenharmony_cistatic ssize_t pgoff_show(struct device *dev, 73462306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 73562306a36Sopenharmony_ci{ 73662306a36Sopenharmony_ci struct dev_dax_range *dax_range; 73762306a36Sopenharmony_ci ssize_t rc; 73862306a36Sopenharmony_ci 73962306a36Sopenharmony_ci dax_range = get_dax_range(dev); 74062306a36Sopenharmony_ci if (!dax_range) 74162306a36Sopenharmony_ci return -ENXIO; 74262306a36Sopenharmony_ci rc = sprintf(buf, "%#lx\n", dax_range->pgoff); 74362306a36Sopenharmony_ci put_dax_range(dax_range); 74462306a36Sopenharmony_ci 74562306a36Sopenharmony_ci return rc; 74662306a36Sopenharmony_ci} 74762306a36Sopenharmony_cistatic DEVICE_ATTR(page_offset, 0400, pgoff_show, NULL); 74862306a36Sopenharmony_ci 74962306a36Sopenharmony_cistatic struct attribute *dax_mapping_attributes[] = { 75062306a36Sopenharmony_ci &dev_attr_start.attr, 75162306a36Sopenharmony_ci &dev_attr_end.attr, 75262306a36Sopenharmony_ci &dev_attr_page_offset.attr, 75362306a36Sopenharmony_ci NULL, 75462306a36Sopenharmony_ci}; 75562306a36Sopenharmony_ci 75662306a36Sopenharmony_cistatic const struct attribute_group dax_mapping_attribute_group = { 75762306a36Sopenharmony_ci .attrs = dax_mapping_attributes, 75862306a36Sopenharmony_ci}; 75962306a36Sopenharmony_ci 76062306a36Sopenharmony_cistatic const struct attribute_group *dax_mapping_attribute_groups[] = { 76162306a36Sopenharmony_ci &dax_mapping_attribute_group, 76262306a36Sopenharmony_ci NULL, 76362306a36Sopenharmony_ci}; 76462306a36Sopenharmony_ci 76562306a36Sopenharmony_cistatic struct device_type dax_mapping_type = { 76662306a36Sopenharmony_ci .release = dax_mapping_release, 76762306a36Sopenharmony_ci .groups = dax_mapping_attribute_groups, 76862306a36Sopenharmony_ci}; 76962306a36Sopenharmony_ci 77062306a36Sopenharmony_cistatic int devm_register_dax_mapping(struct dev_dax *dev_dax, int range_id) 77162306a36Sopenharmony_ci{ 77262306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 77362306a36Sopenharmony_ci struct dax_mapping *mapping; 77462306a36Sopenharmony_ci struct device *dev; 77562306a36Sopenharmony_ci int rc; 77662306a36Sopenharmony_ci 77762306a36Sopenharmony_ci device_lock_assert(dax_region->dev); 77862306a36Sopenharmony_ci 77962306a36Sopenharmony_ci if (dev_WARN_ONCE(&dev_dax->dev, !dax_region->dev->driver, 78062306a36Sopenharmony_ci "region disabled\n")) 78162306a36Sopenharmony_ci return -ENXIO; 78262306a36Sopenharmony_ci 78362306a36Sopenharmony_ci mapping = kzalloc(sizeof(*mapping), GFP_KERNEL); 78462306a36Sopenharmony_ci if (!mapping) 78562306a36Sopenharmony_ci return -ENOMEM; 78662306a36Sopenharmony_ci mapping->range_id = range_id; 78762306a36Sopenharmony_ci mapping->id = ida_alloc(&dev_dax->ida, GFP_KERNEL); 78862306a36Sopenharmony_ci if (mapping->id < 0) { 78962306a36Sopenharmony_ci kfree(mapping); 79062306a36Sopenharmony_ci return -ENOMEM; 79162306a36Sopenharmony_ci } 79262306a36Sopenharmony_ci dev_dax->ranges[range_id].mapping = mapping; 79362306a36Sopenharmony_ci dev = &mapping->dev; 79462306a36Sopenharmony_ci device_initialize(dev); 79562306a36Sopenharmony_ci dev->parent = &dev_dax->dev; 79662306a36Sopenharmony_ci get_device(dev->parent); 79762306a36Sopenharmony_ci dev->type = &dax_mapping_type; 79862306a36Sopenharmony_ci dev_set_name(dev, "mapping%d", mapping->id); 79962306a36Sopenharmony_ci rc = device_add(dev); 80062306a36Sopenharmony_ci if (rc) { 80162306a36Sopenharmony_ci put_device(dev); 80262306a36Sopenharmony_ci return rc; 80362306a36Sopenharmony_ci } 80462306a36Sopenharmony_ci 80562306a36Sopenharmony_ci rc = devm_add_action_or_reset(dax_region->dev, unregister_dax_mapping, 80662306a36Sopenharmony_ci dev); 80762306a36Sopenharmony_ci if (rc) 80862306a36Sopenharmony_ci return rc; 80962306a36Sopenharmony_ci return 0; 81062306a36Sopenharmony_ci} 81162306a36Sopenharmony_ci 81262306a36Sopenharmony_cistatic int alloc_dev_dax_range(struct dev_dax *dev_dax, u64 start, 81362306a36Sopenharmony_ci resource_size_t size) 81462306a36Sopenharmony_ci{ 81562306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 81662306a36Sopenharmony_ci struct resource *res = &dax_region->res; 81762306a36Sopenharmony_ci struct device *dev = &dev_dax->dev; 81862306a36Sopenharmony_ci struct dev_dax_range *ranges; 81962306a36Sopenharmony_ci unsigned long pgoff = 0; 82062306a36Sopenharmony_ci struct resource *alloc; 82162306a36Sopenharmony_ci int i, rc; 82262306a36Sopenharmony_ci 82362306a36Sopenharmony_ci device_lock_assert(dax_region->dev); 82462306a36Sopenharmony_ci 82562306a36Sopenharmony_ci /* handle the seed alloc special case */ 82662306a36Sopenharmony_ci if (!size) { 82762306a36Sopenharmony_ci if (dev_WARN_ONCE(dev, dev_dax->nr_range, 82862306a36Sopenharmony_ci "0-size allocation must be first\n")) 82962306a36Sopenharmony_ci return -EBUSY; 83062306a36Sopenharmony_ci /* nr_range == 0 is elsewhere special cased as 0-size device */ 83162306a36Sopenharmony_ci return 0; 83262306a36Sopenharmony_ci } 83362306a36Sopenharmony_ci 83462306a36Sopenharmony_ci alloc = __request_region(res, start, size, dev_name(dev), 0); 83562306a36Sopenharmony_ci if (!alloc) 83662306a36Sopenharmony_ci return -ENOMEM; 83762306a36Sopenharmony_ci 83862306a36Sopenharmony_ci ranges = krealloc(dev_dax->ranges, sizeof(*ranges) 83962306a36Sopenharmony_ci * (dev_dax->nr_range + 1), GFP_KERNEL); 84062306a36Sopenharmony_ci if (!ranges) { 84162306a36Sopenharmony_ci __release_region(res, alloc->start, resource_size(alloc)); 84262306a36Sopenharmony_ci return -ENOMEM; 84362306a36Sopenharmony_ci } 84462306a36Sopenharmony_ci 84562306a36Sopenharmony_ci for (i = 0; i < dev_dax->nr_range; i++) 84662306a36Sopenharmony_ci pgoff += PHYS_PFN(range_len(&ranges[i].range)); 84762306a36Sopenharmony_ci dev_dax->ranges = ranges; 84862306a36Sopenharmony_ci ranges[dev_dax->nr_range++] = (struct dev_dax_range) { 84962306a36Sopenharmony_ci .pgoff = pgoff, 85062306a36Sopenharmony_ci .range = { 85162306a36Sopenharmony_ci .start = alloc->start, 85262306a36Sopenharmony_ci .end = alloc->end, 85362306a36Sopenharmony_ci }, 85462306a36Sopenharmony_ci }; 85562306a36Sopenharmony_ci 85662306a36Sopenharmony_ci dev_dbg(dev, "alloc range[%d]: %pa:%pa\n", dev_dax->nr_range - 1, 85762306a36Sopenharmony_ci &alloc->start, &alloc->end); 85862306a36Sopenharmony_ci /* 85962306a36Sopenharmony_ci * A dev_dax instance must be registered before mapping device 86062306a36Sopenharmony_ci * children can be added. Defer to devm_create_dev_dax() to add 86162306a36Sopenharmony_ci * the initial mapping device. 86262306a36Sopenharmony_ci */ 86362306a36Sopenharmony_ci if (!device_is_registered(&dev_dax->dev)) 86462306a36Sopenharmony_ci return 0; 86562306a36Sopenharmony_ci 86662306a36Sopenharmony_ci rc = devm_register_dax_mapping(dev_dax, dev_dax->nr_range - 1); 86762306a36Sopenharmony_ci if (rc) 86862306a36Sopenharmony_ci trim_dev_dax_range(dev_dax); 86962306a36Sopenharmony_ci 87062306a36Sopenharmony_ci return rc; 87162306a36Sopenharmony_ci} 87262306a36Sopenharmony_ci 87362306a36Sopenharmony_cistatic int adjust_dev_dax_range(struct dev_dax *dev_dax, struct resource *res, resource_size_t size) 87462306a36Sopenharmony_ci{ 87562306a36Sopenharmony_ci int last_range = dev_dax->nr_range - 1; 87662306a36Sopenharmony_ci struct dev_dax_range *dax_range = &dev_dax->ranges[last_range]; 87762306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 87862306a36Sopenharmony_ci bool is_shrink = resource_size(res) > size; 87962306a36Sopenharmony_ci struct range *range = &dax_range->range; 88062306a36Sopenharmony_ci struct device *dev = &dev_dax->dev; 88162306a36Sopenharmony_ci int rc; 88262306a36Sopenharmony_ci 88362306a36Sopenharmony_ci device_lock_assert(dax_region->dev); 88462306a36Sopenharmony_ci 88562306a36Sopenharmony_ci if (dev_WARN_ONCE(dev, !size, "deletion is handled by dev_dax_shrink\n")) 88662306a36Sopenharmony_ci return -EINVAL; 88762306a36Sopenharmony_ci 88862306a36Sopenharmony_ci rc = adjust_resource(res, range->start, size); 88962306a36Sopenharmony_ci if (rc) 89062306a36Sopenharmony_ci return rc; 89162306a36Sopenharmony_ci 89262306a36Sopenharmony_ci *range = (struct range) { 89362306a36Sopenharmony_ci .start = range->start, 89462306a36Sopenharmony_ci .end = range->start + size - 1, 89562306a36Sopenharmony_ci }; 89662306a36Sopenharmony_ci 89762306a36Sopenharmony_ci dev_dbg(dev, "%s range[%d]: %#llx:%#llx\n", is_shrink ? "shrink" : "extend", 89862306a36Sopenharmony_ci last_range, (unsigned long long) range->start, 89962306a36Sopenharmony_ci (unsigned long long) range->end); 90062306a36Sopenharmony_ci 90162306a36Sopenharmony_ci return 0; 90262306a36Sopenharmony_ci} 90362306a36Sopenharmony_ci 90462306a36Sopenharmony_cistatic ssize_t size_show(struct device *dev, 90562306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 90662306a36Sopenharmony_ci{ 90762306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev); 90862306a36Sopenharmony_ci unsigned long long size; 90962306a36Sopenharmony_ci 91062306a36Sopenharmony_ci device_lock(dev); 91162306a36Sopenharmony_ci size = dev_dax_size(dev_dax); 91262306a36Sopenharmony_ci device_unlock(dev); 91362306a36Sopenharmony_ci 91462306a36Sopenharmony_ci return sprintf(buf, "%llu\n", size); 91562306a36Sopenharmony_ci} 91662306a36Sopenharmony_ci 91762306a36Sopenharmony_cistatic bool alloc_is_aligned(struct dev_dax *dev_dax, resource_size_t size) 91862306a36Sopenharmony_ci{ 91962306a36Sopenharmony_ci /* 92062306a36Sopenharmony_ci * The minimum mapping granularity for a device instance is a 92162306a36Sopenharmony_ci * single subsection, unless the arch says otherwise. 92262306a36Sopenharmony_ci */ 92362306a36Sopenharmony_ci return IS_ALIGNED(size, max_t(unsigned long, dev_dax->align, memremap_compat_align())); 92462306a36Sopenharmony_ci} 92562306a36Sopenharmony_ci 92662306a36Sopenharmony_cistatic int dev_dax_shrink(struct dev_dax *dev_dax, resource_size_t size) 92762306a36Sopenharmony_ci{ 92862306a36Sopenharmony_ci resource_size_t to_shrink = dev_dax_size(dev_dax) - size; 92962306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 93062306a36Sopenharmony_ci struct device *dev = &dev_dax->dev; 93162306a36Sopenharmony_ci int i; 93262306a36Sopenharmony_ci 93362306a36Sopenharmony_ci for (i = dev_dax->nr_range - 1; i >= 0; i--) { 93462306a36Sopenharmony_ci struct range *range = &dev_dax->ranges[i].range; 93562306a36Sopenharmony_ci struct dax_mapping *mapping = dev_dax->ranges[i].mapping; 93662306a36Sopenharmony_ci struct resource *adjust = NULL, *res; 93762306a36Sopenharmony_ci resource_size_t shrink; 93862306a36Sopenharmony_ci 93962306a36Sopenharmony_ci shrink = min_t(u64, to_shrink, range_len(range)); 94062306a36Sopenharmony_ci if (shrink >= range_len(range)) { 94162306a36Sopenharmony_ci devm_release_action(dax_region->dev, 94262306a36Sopenharmony_ci unregister_dax_mapping, &mapping->dev); 94362306a36Sopenharmony_ci trim_dev_dax_range(dev_dax); 94462306a36Sopenharmony_ci to_shrink -= shrink; 94562306a36Sopenharmony_ci if (!to_shrink) 94662306a36Sopenharmony_ci break; 94762306a36Sopenharmony_ci continue; 94862306a36Sopenharmony_ci } 94962306a36Sopenharmony_ci 95062306a36Sopenharmony_ci for_each_dax_region_resource(dax_region, res) 95162306a36Sopenharmony_ci if (strcmp(res->name, dev_name(dev)) == 0 95262306a36Sopenharmony_ci && res->start == range->start) { 95362306a36Sopenharmony_ci adjust = res; 95462306a36Sopenharmony_ci break; 95562306a36Sopenharmony_ci } 95662306a36Sopenharmony_ci 95762306a36Sopenharmony_ci if (dev_WARN_ONCE(dev, !adjust || i != dev_dax->nr_range - 1, 95862306a36Sopenharmony_ci "failed to find matching resource\n")) 95962306a36Sopenharmony_ci return -ENXIO; 96062306a36Sopenharmony_ci return adjust_dev_dax_range(dev_dax, adjust, range_len(range) 96162306a36Sopenharmony_ci - shrink); 96262306a36Sopenharmony_ci } 96362306a36Sopenharmony_ci return 0; 96462306a36Sopenharmony_ci} 96562306a36Sopenharmony_ci 96662306a36Sopenharmony_ci/* 96762306a36Sopenharmony_ci * Only allow adjustments that preserve the relative pgoff of existing 96862306a36Sopenharmony_ci * allocations. I.e. the dev_dax->ranges array is ordered by increasing pgoff. 96962306a36Sopenharmony_ci */ 97062306a36Sopenharmony_cistatic bool adjust_ok(struct dev_dax *dev_dax, struct resource *res) 97162306a36Sopenharmony_ci{ 97262306a36Sopenharmony_ci struct dev_dax_range *last; 97362306a36Sopenharmony_ci int i; 97462306a36Sopenharmony_ci 97562306a36Sopenharmony_ci if (dev_dax->nr_range == 0) 97662306a36Sopenharmony_ci return false; 97762306a36Sopenharmony_ci if (strcmp(res->name, dev_name(&dev_dax->dev)) != 0) 97862306a36Sopenharmony_ci return false; 97962306a36Sopenharmony_ci last = &dev_dax->ranges[dev_dax->nr_range - 1]; 98062306a36Sopenharmony_ci if (last->range.start != res->start || last->range.end != res->end) 98162306a36Sopenharmony_ci return false; 98262306a36Sopenharmony_ci for (i = 0; i < dev_dax->nr_range - 1; i++) { 98362306a36Sopenharmony_ci struct dev_dax_range *dax_range = &dev_dax->ranges[i]; 98462306a36Sopenharmony_ci 98562306a36Sopenharmony_ci if (dax_range->pgoff > last->pgoff) 98662306a36Sopenharmony_ci return false; 98762306a36Sopenharmony_ci } 98862306a36Sopenharmony_ci 98962306a36Sopenharmony_ci return true; 99062306a36Sopenharmony_ci} 99162306a36Sopenharmony_ci 99262306a36Sopenharmony_cistatic ssize_t dev_dax_resize(struct dax_region *dax_region, 99362306a36Sopenharmony_ci struct dev_dax *dev_dax, resource_size_t size) 99462306a36Sopenharmony_ci{ 99562306a36Sopenharmony_ci resource_size_t avail = dax_region_avail_size(dax_region), to_alloc; 99662306a36Sopenharmony_ci resource_size_t dev_size = dev_dax_size(dev_dax); 99762306a36Sopenharmony_ci struct resource *region_res = &dax_region->res; 99862306a36Sopenharmony_ci struct device *dev = &dev_dax->dev; 99962306a36Sopenharmony_ci struct resource *res, *first; 100062306a36Sopenharmony_ci resource_size_t alloc = 0; 100162306a36Sopenharmony_ci int rc; 100262306a36Sopenharmony_ci 100362306a36Sopenharmony_ci if (dev->driver) 100462306a36Sopenharmony_ci return -EBUSY; 100562306a36Sopenharmony_ci if (size == dev_size) 100662306a36Sopenharmony_ci return 0; 100762306a36Sopenharmony_ci if (size > dev_size && size - dev_size > avail) 100862306a36Sopenharmony_ci return -ENOSPC; 100962306a36Sopenharmony_ci if (size < dev_size) 101062306a36Sopenharmony_ci return dev_dax_shrink(dev_dax, size); 101162306a36Sopenharmony_ci 101262306a36Sopenharmony_ci to_alloc = size - dev_size; 101362306a36Sopenharmony_ci if (dev_WARN_ONCE(dev, !alloc_is_aligned(dev_dax, to_alloc), 101462306a36Sopenharmony_ci "resize of %pa misaligned\n", &to_alloc)) 101562306a36Sopenharmony_ci return -ENXIO; 101662306a36Sopenharmony_ci 101762306a36Sopenharmony_ci /* 101862306a36Sopenharmony_ci * Expand the device into the unused portion of the region. This 101962306a36Sopenharmony_ci * may involve adjusting the end of an existing resource, or 102062306a36Sopenharmony_ci * allocating a new resource. 102162306a36Sopenharmony_ci */ 102262306a36Sopenharmony_ciretry: 102362306a36Sopenharmony_ci first = region_res->child; 102462306a36Sopenharmony_ci if (!first) 102562306a36Sopenharmony_ci return alloc_dev_dax_range(dev_dax, dax_region->res.start, to_alloc); 102662306a36Sopenharmony_ci 102762306a36Sopenharmony_ci rc = -ENOSPC; 102862306a36Sopenharmony_ci for (res = first; res; res = res->sibling) { 102962306a36Sopenharmony_ci struct resource *next = res->sibling; 103062306a36Sopenharmony_ci 103162306a36Sopenharmony_ci /* space at the beginning of the region */ 103262306a36Sopenharmony_ci if (res == first && res->start > dax_region->res.start) { 103362306a36Sopenharmony_ci alloc = min(res->start - dax_region->res.start, to_alloc); 103462306a36Sopenharmony_ci rc = alloc_dev_dax_range(dev_dax, dax_region->res.start, alloc); 103562306a36Sopenharmony_ci break; 103662306a36Sopenharmony_ci } 103762306a36Sopenharmony_ci 103862306a36Sopenharmony_ci alloc = 0; 103962306a36Sopenharmony_ci /* space between allocations */ 104062306a36Sopenharmony_ci if (next && next->start > res->end + 1) 104162306a36Sopenharmony_ci alloc = min(next->start - (res->end + 1), to_alloc); 104262306a36Sopenharmony_ci 104362306a36Sopenharmony_ci /* space at the end of the region */ 104462306a36Sopenharmony_ci if (!alloc && !next && res->end < region_res->end) 104562306a36Sopenharmony_ci alloc = min(region_res->end - res->end, to_alloc); 104662306a36Sopenharmony_ci 104762306a36Sopenharmony_ci if (!alloc) 104862306a36Sopenharmony_ci continue; 104962306a36Sopenharmony_ci 105062306a36Sopenharmony_ci if (adjust_ok(dev_dax, res)) { 105162306a36Sopenharmony_ci rc = adjust_dev_dax_range(dev_dax, res, resource_size(res) + alloc); 105262306a36Sopenharmony_ci break; 105362306a36Sopenharmony_ci } 105462306a36Sopenharmony_ci rc = alloc_dev_dax_range(dev_dax, res->end + 1, alloc); 105562306a36Sopenharmony_ci break; 105662306a36Sopenharmony_ci } 105762306a36Sopenharmony_ci if (rc) 105862306a36Sopenharmony_ci return rc; 105962306a36Sopenharmony_ci to_alloc -= alloc; 106062306a36Sopenharmony_ci if (to_alloc) 106162306a36Sopenharmony_ci goto retry; 106262306a36Sopenharmony_ci return 0; 106362306a36Sopenharmony_ci} 106462306a36Sopenharmony_ci 106562306a36Sopenharmony_cistatic ssize_t size_store(struct device *dev, struct device_attribute *attr, 106662306a36Sopenharmony_ci const char *buf, size_t len) 106762306a36Sopenharmony_ci{ 106862306a36Sopenharmony_ci ssize_t rc; 106962306a36Sopenharmony_ci unsigned long long val; 107062306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev); 107162306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 107262306a36Sopenharmony_ci 107362306a36Sopenharmony_ci rc = kstrtoull(buf, 0, &val); 107462306a36Sopenharmony_ci if (rc) 107562306a36Sopenharmony_ci return rc; 107662306a36Sopenharmony_ci 107762306a36Sopenharmony_ci if (!alloc_is_aligned(dev_dax, val)) { 107862306a36Sopenharmony_ci dev_dbg(dev, "%s: size: %lld misaligned\n", __func__, val); 107962306a36Sopenharmony_ci return -EINVAL; 108062306a36Sopenharmony_ci } 108162306a36Sopenharmony_ci 108262306a36Sopenharmony_ci device_lock(dax_region->dev); 108362306a36Sopenharmony_ci if (!dax_region->dev->driver) { 108462306a36Sopenharmony_ci device_unlock(dax_region->dev); 108562306a36Sopenharmony_ci return -ENXIO; 108662306a36Sopenharmony_ci } 108762306a36Sopenharmony_ci device_lock(dev); 108862306a36Sopenharmony_ci rc = dev_dax_resize(dax_region, dev_dax, val); 108962306a36Sopenharmony_ci device_unlock(dev); 109062306a36Sopenharmony_ci device_unlock(dax_region->dev); 109162306a36Sopenharmony_ci 109262306a36Sopenharmony_ci return rc == 0 ? len : rc; 109362306a36Sopenharmony_ci} 109462306a36Sopenharmony_cistatic DEVICE_ATTR_RW(size); 109562306a36Sopenharmony_ci 109662306a36Sopenharmony_cistatic ssize_t range_parse(const char *opt, size_t len, struct range *range) 109762306a36Sopenharmony_ci{ 109862306a36Sopenharmony_ci unsigned long long addr = 0; 109962306a36Sopenharmony_ci char *start, *end, *str; 110062306a36Sopenharmony_ci ssize_t rc = -EINVAL; 110162306a36Sopenharmony_ci 110262306a36Sopenharmony_ci str = kstrdup(opt, GFP_KERNEL); 110362306a36Sopenharmony_ci if (!str) 110462306a36Sopenharmony_ci return rc; 110562306a36Sopenharmony_ci 110662306a36Sopenharmony_ci end = str; 110762306a36Sopenharmony_ci start = strsep(&end, "-"); 110862306a36Sopenharmony_ci if (!start || !end) 110962306a36Sopenharmony_ci goto err; 111062306a36Sopenharmony_ci 111162306a36Sopenharmony_ci rc = kstrtoull(start, 16, &addr); 111262306a36Sopenharmony_ci if (rc) 111362306a36Sopenharmony_ci goto err; 111462306a36Sopenharmony_ci range->start = addr; 111562306a36Sopenharmony_ci 111662306a36Sopenharmony_ci rc = kstrtoull(end, 16, &addr); 111762306a36Sopenharmony_ci if (rc) 111862306a36Sopenharmony_ci goto err; 111962306a36Sopenharmony_ci range->end = addr; 112062306a36Sopenharmony_ci 112162306a36Sopenharmony_cierr: 112262306a36Sopenharmony_ci kfree(str); 112362306a36Sopenharmony_ci return rc; 112462306a36Sopenharmony_ci} 112562306a36Sopenharmony_ci 112662306a36Sopenharmony_cistatic ssize_t mapping_store(struct device *dev, struct device_attribute *attr, 112762306a36Sopenharmony_ci const char *buf, size_t len) 112862306a36Sopenharmony_ci{ 112962306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev); 113062306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 113162306a36Sopenharmony_ci size_t to_alloc; 113262306a36Sopenharmony_ci struct range r; 113362306a36Sopenharmony_ci ssize_t rc; 113462306a36Sopenharmony_ci 113562306a36Sopenharmony_ci rc = range_parse(buf, len, &r); 113662306a36Sopenharmony_ci if (rc) 113762306a36Sopenharmony_ci return rc; 113862306a36Sopenharmony_ci 113962306a36Sopenharmony_ci rc = -ENXIO; 114062306a36Sopenharmony_ci device_lock(dax_region->dev); 114162306a36Sopenharmony_ci if (!dax_region->dev->driver) { 114262306a36Sopenharmony_ci device_unlock(dax_region->dev); 114362306a36Sopenharmony_ci return rc; 114462306a36Sopenharmony_ci } 114562306a36Sopenharmony_ci device_lock(dev); 114662306a36Sopenharmony_ci 114762306a36Sopenharmony_ci to_alloc = range_len(&r); 114862306a36Sopenharmony_ci if (alloc_is_aligned(dev_dax, to_alloc)) 114962306a36Sopenharmony_ci rc = alloc_dev_dax_range(dev_dax, r.start, to_alloc); 115062306a36Sopenharmony_ci device_unlock(dev); 115162306a36Sopenharmony_ci device_unlock(dax_region->dev); 115262306a36Sopenharmony_ci 115362306a36Sopenharmony_ci return rc == 0 ? len : rc; 115462306a36Sopenharmony_ci} 115562306a36Sopenharmony_cistatic DEVICE_ATTR_WO(mapping); 115662306a36Sopenharmony_ci 115762306a36Sopenharmony_cistatic ssize_t align_show(struct device *dev, 115862306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 115962306a36Sopenharmony_ci{ 116062306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev); 116162306a36Sopenharmony_ci 116262306a36Sopenharmony_ci return sprintf(buf, "%d\n", dev_dax->align); 116362306a36Sopenharmony_ci} 116462306a36Sopenharmony_ci 116562306a36Sopenharmony_cistatic ssize_t dev_dax_validate_align(struct dev_dax *dev_dax) 116662306a36Sopenharmony_ci{ 116762306a36Sopenharmony_ci struct device *dev = &dev_dax->dev; 116862306a36Sopenharmony_ci int i; 116962306a36Sopenharmony_ci 117062306a36Sopenharmony_ci for (i = 0; i < dev_dax->nr_range; i++) { 117162306a36Sopenharmony_ci size_t len = range_len(&dev_dax->ranges[i].range); 117262306a36Sopenharmony_ci 117362306a36Sopenharmony_ci if (!alloc_is_aligned(dev_dax, len)) { 117462306a36Sopenharmony_ci dev_dbg(dev, "%s: align %u invalid for range %d\n", 117562306a36Sopenharmony_ci __func__, dev_dax->align, i); 117662306a36Sopenharmony_ci return -EINVAL; 117762306a36Sopenharmony_ci } 117862306a36Sopenharmony_ci } 117962306a36Sopenharmony_ci 118062306a36Sopenharmony_ci return 0; 118162306a36Sopenharmony_ci} 118262306a36Sopenharmony_ci 118362306a36Sopenharmony_cistatic ssize_t align_store(struct device *dev, struct device_attribute *attr, 118462306a36Sopenharmony_ci const char *buf, size_t len) 118562306a36Sopenharmony_ci{ 118662306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev); 118762306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 118862306a36Sopenharmony_ci unsigned long val, align_save; 118962306a36Sopenharmony_ci ssize_t rc; 119062306a36Sopenharmony_ci 119162306a36Sopenharmony_ci rc = kstrtoul(buf, 0, &val); 119262306a36Sopenharmony_ci if (rc) 119362306a36Sopenharmony_ci return -ENXIO; 119462306a36Sopenharmony_ci 119562306a36Sopenharmony_ci if (!dax_align_valid(val)) 119662306a36Sopenharmony_ci return -EINVAL; 119762306a36Sopenharmony_ci 119862306a36Sopenharmony_ci device_lock(dax_region->dev); 119962306a36Sopenharmony_ci if (!dax_region->dev->driver) { 120062306a36Sopenharmony_ci device_unlock(dax_region->dev); 120162306a36Sopenharmony_ci return -ENXIO; 120262306a36Sopenharmony_ci } 120362306a36Sopenharmony_ci 120462306a36Sopenharmony_ci device_lock(dev); 120562306a36Sopenharmony_ci if (dev->driver) { 120662306a36Sopenharmony_ci rc = -EBUSY; 120762306a36Sopenharmony_ci goto out_unlock; 120862306a36Sopenharmony_ci } 120962306a36Sopenharmony_ci 121062306a36Sopenharmony_ci align_save = dev_dax->align; 121162306a36Sopenharmony_ci dev_dax->align = val; 121262306a36Sopenharmony_ci rc = dev_dax_validate_align(dev_dax); 121362306a36Sopenharmony_ci if (rc) 121462306a36Sopenharmony_ci dev_dax->align = align_save; 121562306a36Sopenharmony_ciout_unlock: 121662306a36Sopenharmony_ci device_unlock(dev); 121762306a36Sopenharmony_ci device_unlock(dax_region->dev); 121862306a36Sopenharmony_ci return rc == 0 ? len : rc; 121962306a36Sopenharmony_ci} 122062306a36Sopenharmony_cistatic DEVICE_ATTR_RW(align); 122162306a36Sopenharmony_ci 122262306a36Sopenharmony_cistatic int dev_dax_target_node(struct dev_dax *dev_dax) 122362306a36Sopenharmony_ci{ 122462306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 122562306a36Sopenharmony_ci 122662306a36Sopenharmony_ci return dax_region->target_node; 122762306a36Sopenharmony_ci} 122862306a36Sopenharmony_ci 122962306a36Sopenharmony_cistatic ssize_t target_node_show(struct device *dev, 123062306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 123162306a36Sopenharmony_ci{ 123262306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev); 123362306a36Sopenharmony_ci 123462306a36Sopenharmony_ci return sprintf(buf, "%d\n", dev_dax_target_node(dev_dax)); 123562306a36Sopenharmony_ci} 123662306a36Sopenharmony_cistatic DEVICE_ATTR_RO(target_node); 123762306a36Sopenharmony_ci 123862306a36Sopenharmony_cistatic ssize_t resource_show(struct device *dev, 123962306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 124062306a36Sopenharmony_ci{ 124162306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev); 124262306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 124362306a36Sopenharmony_ci unsigned long long start; 124462306a36Sopenharmony_ci 124562306a36Sopenharmony_ci if (dev_dax->nr_range < 1) 124662306a36Sopenharmony_ci start = dax_region->res.start; 124762306a36Sopenharmony_ci else 124862306a36Sopenharmony_ci start = dev_dax->ranges[0].range.start; 124962306a36Sopenharmony_ci 125062306a36Sopenharmony_ci return sprintf(buf, "%#llx\n", start); 125162306a36Sopenharmony_ci} 125262306a36Sopenharmony_cistatic DEVICE_ATTR(resource, 0400, resource_show, NULL); 125362306a36Sopenharmony_ci 125462306a36Sopenharmony_cistatic ssize_t modalias_show(struct device *dev, struct device_attribute *attr, 125562306a36Sopenharmony_ci char *buf) 125662306a36Sopenharmony_ci{ 125762306a36Sopenharmony_ci /* 125862306a36Sopenharmony_ci * We only ever expect to handle device-dax instances, i.e. the 125962306a36Sopenharmony_ci * @type argument to MODULE_ALIAS_DAX_DEVICE() is always zero 126062306a36Sopenharmony_ci */ 126162306a36Sopenharmony_ci return sprintf(buf, DAX_DEVICE_MODALIAS_FMT "\n", 0); 126262306a36Sopenharmony_ci} 126362306a36Sopenharmony_cistatic DEVICE_ATTR_RO(modalias); 126462306a36Sopenharmony_ci 126562306a36Sopenharmony_cistatic ssize_t numa_node_show(struct device *dev, 126662306a36Sopenharmony_ci struct device_attribute *attr, char *buf) 126762306a36Sopenharmony_ci{ 126862306a36Sopenharmony_ci return sprintf(buf, "%d\n", dev_to_node(dev)); 126962306a36Sopenharmony_ci} 127062306a36Sopenharmony_cistatic DEVICE_ATTR_RO(numa_node); 127162306a36Sopenharmony_ci 127262306a36Sopenharmony_cistatic umode_t dev_dax_visible(struct kobject *kobj, struct attribute *a, int n) 127362306a36Sopenharmony_ci{ 127462306a36Sopenharmony_ci struct device *dev = container_of(kobj, struct device, kobj); 127562306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev); 127662306a36Sopenharmony_ci struct dax_region *dax_region = dev_dax->region; 127762306a36Sopenharmony_ci 127862306a36Sopenharmony_ci if (a == &dev_attr_target_node.attr && dev_dax_target_node(dev_dax) < 0) 127962306a36Sopenharmony_ci return 0; 128062306a36Sopenharmony_ci if (a == &dev_attr_numa_node.attr && !IS_ENABLED(CONFIG_NUMA)) 128162306a36Sopenharmony_ci return 0; 128262306a36Sopenharmony_ci if (a == &dev_attr_mapping.attr && is_static(dax_region)) 128362306a36Sopenharmony_ci return 0; 128462306a36Sopenharmony_ci if ((a == &dev_attr_align.attr || 128562306a36Sopenharmony_ci a == &dev_attr_size.attr) && is_static(dax_region)) 128662306a36Sopenharmony_ci return 0444; 128762306a36Sopenharmony_ci return a->mode; 128862306a36Sopenharmony_ci} 128962306a36Sopenharmony_ci 129062306a36Sopenharmony_cistatic struct attribute *dev_dax_attributes[] = { 129162306a36Sopenharmony_ci &dev_attr_modalias.attr, 129262306a36Sopenharmony_ci &dev_attr_size.attr, 129362306a36Sopenharmony_ci &dev_attr_mapping.attr, 129462306a36Sopenharmony_ci &dev_attr_target_node.attr, 129562306a36Sopenharmony_ci &dev_attr_align.attr, 129662306a36Sopenharmony_ci &dev_attr_resource.attr, 129762306a36Sopenharmony_ci &dev_attr_numa_node.attr, 129862306a36Sopenharmony_ci NULL, 129962306a36Sopenharmony_ci}; 130062306a36Sopenharmony_ci 130162306a36Sopenharmony_cistatic const struct attribute_group dev_dax_attribute_group = { 130262306a36Sopenharmony_ci .attrs = dev_dax_attributes, 130362306a36Sopenharmony_ci .is_visible = dev_dax_visible, 130462306a36Sopenharmony_ci}; 130562306a36Sopenharmony_ci 130662306a36Sopenharmony_cistatic const struct attribute_group *dax_attribute_groups[] = { 130762306a36Sopenharmony_ci &dev_dax_attribute_group, 130862306a36Sopenharmony_ci NULL, 130962306a36Sopenharmony_ci}; 131062306a36Sopenharmony_ci 131162306a36Sopenharmony_cistatic void dev_dax_release(struct device *dev) 131262306a36Sopenharmony_ci{ 131362306a36Sopenharmony_ci struct dev_dax *dev_dax = to_dev_dax(dev); 131462306a36Sopenharmony_ci struct dax_device *dax_dev = dev_dax->dax_dev; 131562306a36Sopenharmony_ci 131662306a36Sopenharmony_ci put_dax(dax_dev); 131762306a36Sopenharmony_ci free_dev_dax_id(dev_dax); 131862306a36Sopenharmony_ci kfree(dev_dax->pgmap); 131962306a36Sopenharmony_ci kfree(dev_dax); 132062306a36Sopenharmony_ci} 132162306a36Sopenharmony_ci 132262306a36Sopenharmony_cistatic const struct device_type dev_dax_type = { 132362306a36Sopenharmony_ci .release = dev_dax_release, 132462306a36Sopenharmony_ci .groups = dax_attribute_groups, 132562306a36Sopenharmony_ci}; 132662306a36Sopenharmony_ci 132762306a36Sopenharmony_cistruct dev_dax *devm_create_dev_dax(struct dev_dax_data *data) 132862306a36Sopenharmony_ci{ 132962306a36Sopenharmony_ci struct dax_region *dax_region = data->dax_region; 133062306a36Sopenharmony_ci struct device *parent = dax_region->dev; 133162306a36Sopenharmony_ci struct dax_device *dax_dev; 133262306a36Sopenharmony_ci struct dev_dax *dev_dax; 133362306a36Sopenharmony_ci struct inode *inode; 133462306a36Sopenharmony_ci struct device *dev; 133562306a36Sopenharmony_ci int rc; 133662306a36Sopenharmony_ci 133762306a36Sopenharmony_ci dev_dax = kzalloc(sizeof(*dev_dax), GFP_KERNEL); 133862306a36Sopenharmony_ci if (!dev_dax) 133962306a36Sopenharmony_ci return ERR_PTR(-ENOMEM); 134062306a36Sopenharmony_ci 134162306a36Sopenharmony_ci dev_dax->region = dax_region; 134262306a36Sopenharmony_ci if (is_static(dax_region)) { 134362306a36Sopenharmony_ci if (dev_WARN_ONCE(parent, data->id < 0, 134462306a36Sopenharmony_ci "dynamic id specified to static region\n")) { 134562306a36Sopenharmony_ci rc = -EINVAL; 134662306a36Sopenharmony_ci goto err_id; 134762306a36Sopenharmony_ci } 134862306a36Sopenharmony_ci 134962306a36Sopenharmony_ci dev_dax->id = data->id; 135062306a36Sopenharmony_ci } else { 135162306a36Sopenharmony_ci if (dev_WARN_ONCE(parent, data->id >= 0, 135262306a36Sopenharmony_ci "static id specified to dynamic region\n")) { 135362306a36Sopenharmony_ci rc = -EINVAL; 135462306a36Sopenharmony_ci goto err_id; 135562306a36Sopenharmony_ci } 135662306a36Sopenharmony_ci 135762306a36Sopenharmony_ci rc = alloc_dev_dax_id(dev_dax); 135862306a36Sopenharmony_ci if (rc < 0) 135962306a36Sopenharmony_ci goto err_id; 136062306a36Sopenharmony_ci } 136162306a36Sopenharmony_ci 136262306a36Sopenharmony_ci dev = &dev_dax->dev; 136362306a36Sopenharmony_ci device_initialize(dev); 136462306a36Sopenharmony_ci dev_set_name(dev, "dax%d.%d", dax_region->id, dev_dax->id); 136562306a36Sopenharmony_ci 136662306a36Sopenharmony_ci rc = alloc_dev_dax_range(dev_dax, dax_region->res.start, data->size); 136762306a36Sopenharmony_ci if (rc) 136862306a36Sopenharmony_ci goto err_range; 136962306a36Sopenharmony_ci 137062306a36Sopenharmony_ci if (data->pgmap) { 137162306a36Sopenharmony_ci dev_WARN_ONCE(parent, !is_static(dax_region), 137262306a36Sopenharmony_ci "custom dev_pagemap requires a static dax_region\n"); 137362306a36Sopenharmony_ci 137462306a36Sopenharmony_ci dev_dax->pgmap = kmemdup(data->pgmap, 137562306a36Sopenharmony_ci sizeof(struct dev_pagemap), GFP_KERNEL); 137662306a36Sopenharmony_ci if (!dev_dax->pgmap) { 137762306a36Sopenharmony_ci rc = -ENOMEM; 137862306a36Sopenharmony_ci goto err_pgmap; 137962306a36Sopenharmony_ci } 138062306a36Sopenharmony_ci } 138162306a36Sopenharmony_ci 138262306a36Sopenharmony_ci /* 138362306a36Sopenharmony_ci * No dax_operations since there is no access to this device outside of 138462306a36Sopenharmony_ci * mmap of the resulting character device. 138562306a36Sopenharmony_ci */ 138662306a36Sopenharmony_ci dax_dev = alloc_dax(dev_dax, NULL); 138762306a36Sopenharmony_ci if (IS_ERR(dax_dev)) { 138862306a36Sopenharmony_ci rc = PTR_ERR(dax_dev); 138962306a36Sopenharmony_ci goto err_alloc_dax; 139062306a36Sopenharmony_ci } 139162306a36Sopenharmony_ci set_dax_synchronous(dax_dev); 139262306a36Sopenharmony_ci set_dax_nocache(dax_dev); 139362306a36Sopenharmony_ci set_dax_nomc(dax_dev); 139462306a36Sopenharmony_ci 139562306a36Sopenharmony_ci /* a device_dax instance is dead while the driver is not attached */ 139662306a36Sopenharmony_ci kill_dax(dax_dev); 139762306a36Sopenharmony_ci 139862306a36Sopenharmony_ci dev_dax->dax_dev = dax_dev; 139962306a36Sopenharmony_ci dev_dax->target_node = dax_region->target_node; 140062306a36Sopenharmony_ci dev_dax->align = dax_region->align; 140162306a36Sopenharmony_ci ida_init(&dev_dax->ida); 140262306a36Sopenharmony_ci 140362306a36Sopenharmony_ci inode = dax_inode(dax_dev); 140462306a36Sopenharmony_ci dev->devt = inode->i_rdev; 140562306a36Sopenharmony_ci dev->bus = &dax_bus_type; 140662306a36Sopenharmony_ci dev->parent = parent; 140762306a36Sopenharmony_ci dev->type = &dev_dax_type; 140862306a36Sopenharmony_ci 140962306a36Sopenharmony_ci rc = device_add(dev); 141062306a36Sopenharmony_ci if (rc) { 141162306a36Sopenharmony_ci kill_dev_dax(dev_dax); 141262306a36Sopenharmony_ci put_device(dev); 141362306a36Sopenharmony_ci return ERR_PTR(rc); 141462306a36Sopenharmony_ci } 141562306a36Sopenharmony_ci 141662306a36Sopenharmony_ci rc = devm_add_action_or_reset(dax_region->dev, unregister_dev_dax, dev); 141762306a36Sopenharmony_ci if (rc) 141862306a36Sopenharmony_ci return ERR_PTR(rc); 141962306a36Sopenharmony_ci 142062306a36Sopenharmony_ci /* register mapping device for the initial allocation range */ 142162306a36Sopenharmony_ci if (dev_dax->nr_range && range_len(&dev_dax->ranges[0].range)) { 142262306a36Sopenharmony_ci rc = devm_register_dax_mapping(dev_dax, 0); 142362306a36Sopenharmony_ci if (rc) 142462306a36Sopenharmony_ci return ERR_PTR(rc); 142562306a36Sopenharmony_ci } 142662306a36Sopenharmony_ci 142762306a36Sopenharmony_ci return dev_dax; 142862306a36Sopenharmony_ci 142962306a36Sopenharmony_cierr_alloc_dax: 143062306a36Sopenharmony_ci kfree(dev_dax->pgmap); 143162306a36Sopenharmony_cierr_pgmap: 143262306a36Sopenharmony_ci free_dev_dax_ranges(dev_dax); 143362306a36Sopenharmony_cierr_range: 143462306a36Sopenharmony_ci free_dev_dax_id(dev_dax); 143562306a36Sopenharmony_cierr_id: 143662306a36Sopenharmony_ci kfree(dev_dax); 143762306a36Sopenharmony_ci 143862306a36Sopenharmony_ci return ERR_PTR(rc); 143962306a36Sopenharmony_ci} 144062306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(devm_create_dev_dax); 144162306a36Sopenharmony_ci 144262306a36Sopenharmony_ciint __dax_driver_register(struct dax_device_driver *dax_drv, 144362306a36Sopenharmony_ci struct module *module, const char *mod_name) 144462306a36Sopenharmony_ci{ 144562306a36Sopenharmony_ci struct device_driver *drv = &dax_drv->drv; 144662306a36Sopenharmony_ci 144762306a36Sopenharmony_ci /* 144862306a36Sopenharmony_ci * dax_bus_probe() calls dax_drv->probe() unconditionally. 144962306a36Sopenharmony_ci * So better be safe than sorry and ensure it is provided. 145062306a36Sopenharmony_ci */ 145162306a36Sopenharmony_ci if (!dax_drv->probe) 145262306a36Sopenharmony_ci return -EINVAL; 145362306a36Sopenharmony_ci 145462306a36Sopenharmony_ci INIT_LIST_HEAD(&dax_drv->ids); 145562306a36Sopenharmony_ci drv->owner = module; 145662306a36Sopenharmony_ci drv->name = mod_name; 145762306a36Sopenharmony_ci drv->mod_name = mod_name; 145862306a36Sopenharmony_ci drv->bus = &dax_bus_type; 145962306a36Sopenharmony_ci 146062306a36Sopenharmony_ci return driver_register(drv); 146162306a36Sopenharmony_ci} 146262306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(__dax_driver_register); 146362306a36Sopenharmony_ci 146462306a36Sopenharmony_civoid dax_driver_unregister(struct dax_device_driver *dax_drv) 146562306a36Sopenharmony_ci{ 146662306a36Sopenharmony_ci struct device_driver *drv = &dax_drv->drv; 146762306a36Sopenharmony_ci struct dax_id *dax_id, *_id; 146862306a36Sopenharmony_ci 146962306a36Sopenharmony_ci mutex_lock(&dax_bus_lock); 147062306a36Sopenharmony_ci list_for_each_entry_safe(dax_id, _id, &dax_drv->ids, list) { 147162306a36Sopenharmony_ci list_del(&dax_id->list); 147262306a36Sopenharmony_ci kfree(dax_id); 147362306a36Sopenharmony_ci } 147462306a36Sopenharmony_ci mutex_unlock(&dax_bus_lock); 147562306a36Sopenharmony_ci driver_unregister(drv); 147662306a36Sopenharmony_ci} 147762306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(dax_driver_unregister); 147862306a36Sopenharmony_ci 147962306a36Sopenharmony_ciint __init dax_bus_init(void) 148062306a36Sopenharmony_ci{ 148162306a36Sopenharmony_ci return bus_register(&dax_bus_type); 148262306a36Sopenharmony_ci} 148362306a36Sopenharmony_ci 148462306a36Sopenharmony_civoid __exit dax_bus_exit(void) 148562306a36Sopenharmony_ci{ 148662306a36Sopenharmony_ci bus_unregister(&dax_bus_type); 148762306a36Sopenharmony_ci} 1488