16bc75619SDan Williams /* 26bc75619SDan Williams * Copyright(c) 2013-2015 Intel Corporation. All rights reserved. 36bc75619SDan Williams * 46bc75619SDan Williams * This program is free software; you can redistribute it and/or modify 56bc75619SDan Williams * it under the terms of version 2 of the GNU General Public License as 66bc75619SDan Williams * published by the Free Software Foundation. 76bc75619SDan Williams * 86bc75619SDan Williams * This program is distributed in the hope that it will be useful, but 96bc75619SDan Williams * WITHOUT ANY WARRANTY; without even the implied warranty of 106bc75619SDan Williams * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 116bc75619SDan Williams * General Public License for more details. 126bc75619SDan Williams */ 136bc75619SDan Williams #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 146bc75619SDan Williams #include <linux/platform_device.h> 156bc75619SDan Williams #include <linux/dma-mapping.h> 16d8d378faSDan Williams #include <linux/workqueue.h> 176bc75619SDan Williams #include <linux/libnvdimm.h> 186bc75619SDan Williams #include <linux/vmalloc.h> 196bc75619SDan Williams #include <linux/device.h> 206bc75619SDan Williams #include <linux/module.h> 2120985164SVishal Verma #include <linux/mutex.h> 226bc75619SDan Williams #include <linux/ndctl.h> 236bc75619SDan Williams #include <linux/sizes.h> 2420985164SVishal Verma #include <linux/list.h> 256bc75619SDan Williams #include <linux/slab.h> 26*a7de92daSDan Williams #include <nd-core.h> 276bc75619SDan Williams #include <nfit.h> 286bc75619SDan Williams #include <nd.h> 296bc75619SDan Williams #include "nfit_test.h" 306bc75619SDan Williams 316bc75619SDan Williams /* 326bc75619SDan Williams * Generate an NFIT table to describe the following topology: 336bc75619SDan Williams * 346bc75619SDan Williams * BUS0: Interleaved PMEM regions, and aliasing with BLK regions 356bc75619SDan Williams * 366bc75619SDan Williams * (a) (b) DIMM BLK-REGION 376bc75619SDan Williams * +----------+--------------+----------+---------+ 386bc75619SDan Williams * +------+ | blk2.0 | pm0.0 | blk2.1 | pm1.0 | 0 region2 396bc75619SDan Williams * | imc0 +--+- - - - - region0 - - - -+----------+ + 406bc75619SDan Williams * +--+---+ | blk3.0 | pm0.0 | blk3.1 | pm1.0 | 1 region3 416bc75619SDan Williams * | +----------+--------------v----------v v 426bc75619SDan Williams * +--+---+ | | 436bc75619SDan Williams * | cpu0 | region1 446bc75619SDan Williams * +--+---+ | | 456bc75619SDan Williams * | +-------------------------^----------^ ^ 466bc75619SDan Williams * +--+---+ | blk4.0 | pm1.0 | 2 region4 476bc75619SDan Williams * | imc1 +--+-------------------------+----------+ + 486bc75619SDan Williams * +------+ | blk5.0 | pm1.0 | 3 region5 496bc75619SDan Williams * +-------------------------+----------+-+-------+ 506bc75619SDan Williams * 5120985164SVishal Verma * +--+---+ 5220985164SVishal Verma * | cpu1 | 5320985164SVishal Verma * +--+---+ (Hotplug DIMM) 5420985164SVishal Verma * | +----------------------------------------------+ 5520985164SVishal Verma * +--+---+ | blk6.0/pm7.0 | 4 region6/7 5620985164SVishal Verma * | imc0 +--+----------------------------------------------+ 5720985164SVishal Verma * +------+ 5820985164SVishal Verma * 5920985164SVishal Verma * 606bc75619SDan Williams * *) In this layout we have four dimms and two memory controllers in one 616bc75619SDan Williams * socket. Each unique interface (BLK or PMEM) to DPA space 626bc75619SDan Williams * is identified by a region device with a dynamically assigned id. 636bc75619SDan Williams * 646bc75619SDan Williams * *) The first portion of dimm0 and dimm1 are interleaved as REGION0. 656bc75619SDan Williams * A single PMEM namespace "pm0.0" is created using half of the 666bc75619SDan Williams * REGION0 SPA-range. REGION0 spans dimm0 and dimm1. PMEM namespace 676bc75619SDan Williams * allocate from from the bottom of a region. The unallocated 686bc75619SDan Williams * portion of REGION0 aliases with REGION2 and REGION3. That 696bc75619SDan Williams * unallacted capacity is reclaimed as BLK namespaces ("blk2.0" and 706bc75619SDan Williams * "blk3.0") starting at the base of each DIMM to offset (a) in those 716bc75619SDan Williams * DIMMs. "pm0.0", "blk2.0" and "blk3.0" are free-form readable 726bc75619SDan Williams * names that can be assigned to a namespace. 736bc75619SDan Williams * 746bc75619SDan Williams * *) In the last portion of dimm0 and dimm1 we have an interleaved 756bc75619SDan Williams * SPA range, REGION1, that spans those two dimms as well as dimm2 766bc75619SDan Williams * and dimm3. Some of REGION1 allocated to a PMEM namespace named 776bc75619SDan Williams * "pm1.0" the rest is reclaimed in 4 BLK namespaces (for each 786bc75619SDan Williams * dimm in the interleave set), "blk2.1", "blk3.1", "blk4.0", and 796bc75619SDan Williams * "blk5.0". 806bc75619SDan Williams * 816bc75619SDan Williams * *) The portion of dimm2 and dimm3 that do not participate in the 826bc75619SDan Williams * REGION1 interleaved SPA range (i.e. the DPA address below offset 836bc75619SDan Williams * (b) are also included in the "blk4.0" and "blk5.0" namespaces. 846bc75619SDan Williams * Note, that BLK namespaces need not be contiguous in DPA-space, and 856bc75619SDan Williams * can consume aliased capacity from multiple interleave sets. 866bc75619SDan Williams * 876bc75619SDan Williams * BUS1: Legacy NVDIMM (single contiguous range) 886bc75619SDan Williams * 896bc75619SDan Williams * region2 906bc75619SDan Williams * +---------------------+ 916bc75619SDan Williams * |---------------------| 926bc75619SDan Williams * || pm2.0 || 936bc75619SDan Williams * |---------------------| 946bc75619SDan Williams * +---------------------+ 956bc75619SDan Williams * 966bc75619SDan Williams * *) A NFIT-table may describe a simple system-physical-address range 976bc75619SDan Williams * with no BLK aliasing. This type of region may optionally 986bc75619SDan Williams * reference an NVDIMM. 996bc75619SDan Williams */ 1006bc75619SDan Williams enum { 10120985164SVishal Verma NUM_PM = 3, 10220985164SVishal Verma NUM_DCR = 5, 10385d3fa02SDan Williams NUM_HINTS = 8, 1046bc75619SDan Williams NUM_BDW = NUM_DCR, 1056bc75619SDan Williams NUM_SPA = NUM_PM + NUM_DCR + NUM_BDW, 1066bc75619SDan Williams NUM_MEM = NUM_DCR + NUM_BDW + 2 /* spa0 iset */ + 4 /* spa1 iset */, 1076bc75619SDan Williams DIMM_SIZE = SZ_32M, 1086bc75619SDan Williams LABEL_SIZE = SZ_128K, 1097bfe97c7SDan Williams SPA_VCD_SIZE = SZ_4M, 1106bc75619SDan Williams SPA0_SIZE = DIMM_SIZE, 1116bc75619SDan Williams SPA1_SIZE = DIMM_SIZE*2, 1126bc75619SDan Williams SPA2_SIZE = DIMM_SIZE, 1136bc75619SDan Williams BDW_SIZE = 64 << 8, 1146bc75619SDan Williams DCR_SIZE = 12, 1156bc75619SDan Williams NUM_NFITS = 2, /* permit testing multiple NFITs per system */ 1166bc75619SDan Williams }; 1176bc75619SDan Williams 1186bc75619SDan Williams struct nfit_test_dcr { 1196bc75619SDan Williams __le64 bdw_addr; 1206bc75619SDan Williams __le32 bdw_status; 1216bc75619SDan Williams __u8 aperature[BDW_SIZE]; 1226bc75619SDan Williams }; 1236bc75619SDan Williams 1246bc75619SDan Williams #define NFIT_DIMM_HANDLE(node, socket, imc, chan, dimm) \ 1256bc75619SDan Williams (((node & 0xfff) << 16) | ((socket & 0xf) << 12) \ 1266bc75619SDan Williams | ((imc & 0xf) << 8) | ((chan & 0xf) << 4) | (dimm & 0xf)) 1276bc75619SDan Williams 1286bc75619SDan Williams static u32 handle[NUM_DCR] = { 1296bc75619SDan Williams [0] = NFIT_DIMM_HANDLE(0, 0, 0, 0, 0), 1306bc75619SDan Williams [1] = NFIT_DIMM_HANDLE(0, 0, 0, 0, 1), 1316bc75619SDan Williams [2] = NFIT_DIMM_HANDLE(0, 0, 1, 0, 0), 1326bc75619SDan Williams [3] = NFIT_DIMM_HANDLE(0, 0, 1, 0, 1), 13320985164SVishal Verma [4] = NFIT_DIMM_HANDLE(0, 1, 0, 0, 0), 1346bc75619SDan Williams }; 1356bc75619SDan Williams 13673606afdSDan Williams static unsigned long dimm_fail_cmd_flags[NUM_DCR]; 13773606afdSDan Williams 1386bc75619SDan Williams struct nfit_test { 1396bc75619SDan Williams struct acpi_nfit_desc acpi_desc; 1406bc75619SDan Williams struct platform_device pdev; 1416bc75619SDan Williams struct list_head resources; 1426bc75619SDan Williams void *nfit_buf; 1436bc75619SDan Williams dma_addr_t nfit_dma; 1446bc75619SDan Williams size_t nfit_size; 1456bc75619SDan Williams int num_dcr; 1466bc75619SDan Williams int num_pm; 1476bc75619SDan Williams void **dimm; 1486bc75619SDan Williams dma_addr_t *dimm_dma; 1499d27a87eSDan Williams void **flush; 1509d27a87eSDan Williams dma_addr_t *flush_dma; 1516bc75619SDan Williams void **label; 1526bc75619SDan Williams dma_addr_t *label_dma; 1536bc75619SDan Williams void **spa_set; 1546bc75619SDan Williams dma_addr_t *spa_set_dma; 1556bc75619SDan Williams struct nfit_test_dcr **dcr; 1566bc75619SDan Williams dma_addr_t *dcr_dma; 1576bc75619SDan Williams int (*alloc)(struct nfit_test *t); 1586bc75619SDan Williams void (*setup)(struct nfit_test *t); 15920985164SVishal Verma int setup_hotplug; 160c14a868aSDan Williams union acpi_object **_fit; 161c14a868aSDan Williams dma_addr_t _fit_dma; 162f471f1a7SDan Williams struct ars_state { 163f471f1a7SDan Williams struct nd_cmd_ars_status *ars_status; 164f471f1a7SDan Williams unsigned long deadline; 165f471f1a7SDan Williams spinlock_t lock; 166f471f1a7SDan Williams } ars_state; 167231bf117SDan Williams struct device *dimm_dev[NUM_DCR]; 1686bc75619SDan Williams }; 1696bc75619SDan Williams 1706bc75619SDan Williams static struct nfit_test *to_nfit_test(struct device *dev) 1716bc75619SDan Williams { 1726bc75619SDan Williams struct platform_device *pdev = to_platform_device(dev); 1736bc75619SDan Williams 1746bc75619SDan Williams return container_of(pdev, struct nfit_test, pdev); 1756bc75619SDan Williams } 1766bc75619SDan Williams 17739c686b8SVishal Verma static int nfit_test_cmd_get_config_size(struct nd_cmd_get_config_size *nd_cmd, 1786bc75619SDan Williams unsigned int buf_len) 1796bc75619SDan Williams { 1806bc75619SDan Williams if (buf_len < sizeof(*nd_cmd)) 1816bc75619SDan Williams return -EINVAL; 18239c686b8SVishal Verma 1836bc75619SDan Williams nd_cmd->status = 0; 1846bc75619SDan Williams nd_cmd->config_size = LABEL_SIZE; 1856bc75619SDan Williams nd_cmd->max_xfer = SZ_4K; 18639c686b8SVishal Verma 18739c686b8SVishal Verma return 0; 1886bc75619SDan Williams } 18939c686b8SVishal Verma 19039c686b8SVishal Verma static int nfit_test_cmd_get_config_data(struct nd_cmd_get_config_data_hdr 19139c686b8SVishal Verma *nd_cmd, unsigned int buf_len, void *label) 19239c686b8SVishal Verma { 1936bc75619SDan Williams unsigned int len, offset = nd_cmd->in_offset; 19439c686b8SVishal Verma int rc; 1956bc75619SDan Williams 1966bc75619SDan Williams if (buf_len < sizeof(*nd_cmd)) 1976bc75619SDan Williams return -EINVAL; 1986bc75619SDan Williams if (offset >= LABEL_SIZE) 1996bc75619SDan Williams return -EINVAL; 2006bc75619SDan Williams if (nd_cmd->in_length + sizeof(*nd_cmd) > buf_len) 2016bc75619SDan Williams return -EINVAL; 2026bc75619SDan Williams 2036bc75619SDan Williams nd_cmd->status = 0; 2046bc75619SDan Williams len = min(nd_cmd->in_length, LABEL_SIZE - offset); 20539c686b8SVishal Verma memcpy(nd_cmd->out_buf, label + offset, len); 2066bc75619SDan Williams rc = buf_len - sizeof(*nd_cmd) - len; 20739c686b8SVishal Verma 20839c686b8SVishal Verma return rc; 2096bc75619SDan Williams } 21039c686b8SVishal Verma 21139c686b8SVishal Verma static int nfit_test_cmd_set_config_data(struct nd_cmd_set_config_hdr *nd_cmd, 21239c686b8SVishal Verma unsigned int buf_len, void *label) 21339c686b8SVishal Verma { 2146bc75619SDan Williams unsigned int len, offset = nd_cmd->in_offset; 2156bc75619SDan Williams u32 *status; 21639c686b8SVishal Verma int rc; 2176bc75619SDan Williams 2186bc75619SDan Williams if (buf_len < sizeof(*nd_cmd)) 2196bc75619SDan Williams return -EINVAL; 2206bc75619SDan Williams if (offset >= LABEL_SIZE) 2216bc75619SDan Williams return -EINVAL; 2226bc75619SDan Williams if (nd_cmd->in_length + sizeof(*nd_cmd) + 4 > buf_len) 2236bc75619SDan Williams return -EINVAL; 2246bc75619SDan Williams 22539c686b8SVishal Verma status = (void *)nd_cmd + nd_cmd->in_length + sizeof(*nd_cmd); 2266bc75619SDan Williams *status = 0; 2276bc75619SDan Williams len = min(nd_cmd->in_length, LABEL_SIZE - offset); 22839c686b8SVishal Verma memcpy(label + offset, nd_cmd->in_buf, len); 2296bc75619SDan Williams rc = buf_len - sizeof(*nd_cmd) - (len + 4); 23039c686b8SVishal Verma 23139c686b8SVishal Verma return rc; 2326bc75619SDan Williams } 23339c686b8SVishal Verma 234747ffe11SDan Williams #define NFIT_TEST_ARS_RECORDS 4 235d4f32367SDan Williams #define NFIT_TEST_CLEAR_ERR_UNIT 256 236747ffe11SDan Williams 23739c686b8SVishal Verma static int nfit_test_cmd_ars_cap(struct nd_cmd_ars_cap *nd_cmd, 23839c686b8SVishal Verma unsigned int buf_len) 23939c686b8SVishal Verma { 24039c686b8SVishal Verma if (buf_len < sizeof(*nd_cmd)) 24139c686b8SVishal Verma return -EINVAL; 24239c686b8SVishal Verma 243747ffe11SDan Williams nd_cmd->max_ars_out = sizeof(struct nd_cmd_ars_status) 244747ffe11SDan Williams + NFIT_TEST_ARS_RECORDS * sizeof(struct nd_ars_record); 24539c686b8SVishal Verma nd_cmd->status = (ND_ARS_PERSISTENT | ND_ARS_VOLATILE) << 16; 246d4f32367SDan Williams nd_cmd->clear_err_unit = NFIT_TEST_CLEAR_ERR_UNIT; 24739c686b8SVishal Verma 24839c686b8SVishal Verma return 0; 24939c686b8SVishal Verma } 25039c686b8SVishal Verma 251f471f1a7SDan Williams /* 252f471f1a7SDan Williams * Initialize the ars_state to return an ars_result 1 second in the future with 253f471f1a7SDan Williams * a 4K error range in the middle of the requested address range. 254f471f1a7SDan Williams */ 255f471f1a7SDan Williams static void post_ars_status(struct ars_state *ars_state, u64 addr, u64 len) 25639c686b8SVishal Verma { 257f471f1a7SDan Williams struct nd_cmd_ars_status *ars_status; 258f471f1a7SDan Williams struct nd_ars_record *ars_record; 259f471f1a7SDan Williams 260f471f1a7SDan Williams ars_state->deadline = jiffies + 1*HZ; 261f471f1a7SDan Williams ars_status = ars_state->ars_status; 262f471f1a7SDan Williams ars_status->status = 0; 263f471f1a7SDan Williams ars_status->out_length = sizeof(struct nd_cmd_ars_status) 264f471f1a7SDan Williams + sizeof(struct nd_ars_record); 265f471f1a7SDan Williams ars_status->address = addr; 266f471f1a7SDan Williams ars_status->length = len; 267f471f1a7SDan Williams ars_status->type = ND_ARS_PERSISTENT; 268f471f1a7SDan Williams ars_status->num_records = 1; 269f471f1a7SDan Williams ars_record = &ars_status->records[0]; 270f471f1a7SDan Williams ars_record->handle = 0; 271f471f1a7SDan Williams ars_record->err_address = addr + len / 2; 272f471f1a7SDan Williams ars_record->length = SZ_4K; 273f471f1a7SDan Williams } 274f471f1a7SDan Williams 275f471f1a7SDan Williams static int nfit_test_cmd_ars_start(struct ars_state *ars_state, 276f471f1a7SDan Williams struct nd_cmd_ars_start *ars_start, unsigned int buf_len, 277f471f1a7SDan Williams int *cmd_rc) 278f471f1a7SDan Williams { 279f471f1a7SDan Williams if (buf_len < sizeof(*ars_start)) 28039c686b8SVishal Verma return -EINVAL; 28139c686b8SVishal Verma 282f471f1a7SDan Williams spin_lock(&ars_state->lock); 283f471f1a7SDan Williams if (time_before(jiffies, ars_state->deadline)) { 284f471f1a7SDan Williams ars_start->status = NFIT_ARS_START_BUSY; 285f471f1a7SDan Williams *cmd_rc = -EBUSY; 286f471f1a7SDan Williams } else { 287f471f1a7SDan Williams ars_start->status = 0; 288f471f1a7SDan Williams ars_start->scrub_time = 1; 289f471f1a7SDan Williams post_ars_status(ars_state, ars_start->address, 290f471f1a7SDan Williams ars_start->length); 291f471f1a7SDan Williams *cmd_rc = 0; 292f471f1a7SDan Williams } 293f471f1a7SDan Williams spin_unlock(&ars_state->lock); 29439c686b8SVishal Verma 29539c686b8SVishal Verma return 0; 29639c686b8SVishal Verma } 29739c686b8SVishal Verma 298f471f1a7SDan Williams static int nfit_test_cmd_ars_status(struct ars_state *ars_state, 299f471f1a7SDan Williams struct nd_cmd_ars_status *ars_status, unsigned int buf_len, 300f471f1a7SDan Williams int *cmd_rc) 30139c686b8SVishal Verma { 302f471f1a7SDan Williams if (buf_len < ars_state->ars_status->out_length) 30339c686b8SVishal Verma return -EINVAL; 30439c686b8SVishal Verma 305f471f1a7SDan Williams spin_lock(&ars_state->lock); 306f471f1a7SDan Williams if (time_before(jiffies, ars_state->deadline)) { 307f471f1a7SDan Williams memset(ars_status, 0, buf_len); 308f471f1a7SDan Williams ars_status->status = NFIT_ARS_STATUS_BUSY; 309f471f1a7SDan Williams ars_status->out_length = sizeof(*ars_status); 310f471f1a7SDan Williams *cmd_rc = -EBUSY; 311f471f1a7SDan Williams } else { 312f471f1a7SDan Williams memcpy(ars_status, ars_state->ars_status, 313f471f1a7SDan Williams ars_state->ars_status->out_length); 314f471f1a7SDan Williams *cmd_rc = 0; 315f471f1a7SDan Williams } 316f471f1a7SDan Williams spin_unlock(&ars_state->lock); 31739c686b8SVishal Verma return 0; 31839c686b8SVishal Verma } 31939c686b8SVishal Verma 320d4f32367SDan Williams static int nfit_test_cmd_clear_error(struct nd_cmd_clear_error *clear_err, 321d4f32367SDan Williams unsigned int buf_len, int *cmd_rc) 322d4f32367SDan Williams { 323d4f32367SDan Williams const u64 mask = NFIT_TEST_CLEAR_ERR_UNIT - 1; 324d4f32367SDan Williams if (buf_len < sizeof(*clear_err)) 325d4f32367SDan Williams return -EINVAL; 326d4f32367SDan Williams 327d4f32367SDan Williams if ((clear_err->address & mask) || (clear_err->length & mask)) 328d4f32367SDan Williams return -EINVAL; 329d4f32367SDan Williams 330d4f32367SDan Williams /* 331d4f32367SDan Williams * Report 'all clear' success for all commands even though a new 332d4f32367SDan Williams * scrub will find errors again. This is enough to have the 333d4f32367SDan Williams * error removed from the 'badblocks' tracking in the pmem 334d4f32367SDan Williams * driver. 335d4f32367SDan Williams */ 336d4f32367SDan Williams clear_err->status = 0; 337d4f32367SDan Williams clear_err->cleared = clear_err->length; 338d4f32367SDan Williams *cmd_rc = 0; 339d4f32367SDan Williams return 0; 340d4f32367SDan Williams } 341d4f32367SDan Williams 342baa51277SDan Williams static int nfit_test_cmd_smart(struct nd_cmd_smart *smart, unsigned int buf_len) 343baa51277SDan Williams { 344baa51277SDan Williams static const struct nd_smart_payload smart_data = { 345baa51277SDan Williams .flags = ND_SMART_HEALTH_VALID | ND_SMART_TEMP_VALID 346baa51277SDan Williams | ND_SMART_SPARES_VALID | ND_SMART_ALARM_VALID 347baa51277SDan Williams | ND_SMART_USED_VALID | ND_SMART_SHUTDOWN_VALID, 348baa51277SDan Williams .health = ND_SMART_NON_CRITICAL_HEALTH, 349baa51277SDan Williams .temperature = 23 * 16, 350baa51277SDan Williams .spares = 75, 351baa51277SDan Williams .alarm_flags = ND_SMART_SPARE_TRIP | ND_SMART_TEMP_TRIP, 352baa51277SDan Williams .life_used = 5, 353baa51277SDan Williams .shutdown_state = 0, 354baa51277SDan Williams .vendor_size = 0, 355baa51277SDan Williams }; 356baa51277SDan Williams 357baa51277SDan Williams if (buf_len < sizeof(*smart)) 358baa51277SDan Williams return -EINVAL; 359baa51277SDan Williams memcpy(smart->data, &smart_data, sizeof(smart_data)); 360baa51277SDan Williams return 0; 361baa51277SDan Williams } 362baa51277SDan Williams 363baa51277SDan Williams static int nfit_test_cmd_smart_threshold(struct nd_cmd_smart_threshold *smart_t, 364baa51277SDan Williams unsigned int buf_len) 365baa51277SDan Williams { 366baa51277SDan Williams static const struct nd_smart_threshold_payload smart_t_data = { 367baa51277SDan Williams .alarm_control = ND_SMART_SPARE_TRIP | ND_SMART_TEMP_TRIP, 368baa51277SDan Williams .temperature = 40 * 16, 369baa51277SDan Williams .spares = 5, 370baa51277SDan Williams }; 371baa51277SDan Williams 372baa51277SDan Williams if (buf_len < sizeof(*smart_t)) 373baa51277SDan Williams return -EINVAL; 374baa51277SDan Williams memcpy(smart_t->data, &smart_t_data, sizeof(smart_t_data)); 375baa51277SDan Williams return 0; 376baa51277SDan Williams } 377baa51277SDan Williams 37839c686b8SVishal Verma static int nfit_test_ctl(struct nvdimm_bus_descriptor *nd_desc, 37939c686b8SVishal Verma struct nvdimm *nvdimm, unsigned int cmd, void *buf, 380aef25338SDan Williams unsigned int buf_len, int *cmd_rc) 38139c686b8SVishal Verma { 38239c686b8SVishal Verma struct acpi_nfit_desc *acpi_desc = to_acpi_desc(nd_desc); 38339c686b8SVishal Verma struct nfit_test *t = container_of(acpi_desc, typeof(*t), acpi_desc); 3846634fb06SDan Williams unsigned int func = cmd; 385f471f1a7SDan Williams int i, rc = 0, __cmd_rc; 386f471f1a7SDan Williams 387f471f1a7SDan Williams if (!cmd_rc) 388f471f1a7SDan Williams cmd_rc = &__cmd_rc; 389f471f1a7SDan Williams *cmd_rc = 0; 39039c686b8SVishal Verma 39139c686b8SVishal Verma if (nvdimm) { 39239c686b8SVishal Verma struct nfit_mem *nfit_mem = nvdimm_provider_data(nvdimm); 393e3654ecaSDan Williams unsigned long cmd_mask = nvdimm_cmd_mask(nvdimm); 39439c686b8SVishal Verma 3956634fb06SDan Williams if (!nfit_mem) 3966634fb06SDan Williams return -ENOTTY; 3976634fb06SDan Williams 3986634fb06SDan Williams if (cmd == ND_CMD_CALL) { 3996634fb06SDan Williams struct nd_cmd_pkg *call_pkg = buf; 4006634fb06SDan Williams 4016634fb06SDan Williams buf_len = call_pkg->nd_size_in + call_pkg->nd_size_out; 4026634fb06SDan Williams buf = (void *) call_pkg->nd_payload; 4036634fb06SDan Williams func = call_pkg->nd_command; 4046634fb06SDan Williams if (call_pkg->nd_family != nfit_mem->family) 4056634fb06SDan Williams return -ENOTTY; 4066634fb06SDan Williams } 4076634fb06SDan Williams 4086634fb06SDan Williams if (!test_bit(cmd, &cmd_mask) 4096634fb06SDan Williams || !test_bit(func, &nfit_mem->dsm_mask)) 41039c686b8SVishal Verma return -ENOTTY; 41139c686b8SVishal Verma 41239c686b8SVishal Verma /* lookup label space for the given dimm */ 41339c686b8SVishal Verma for (i = 0; i < ARRAY_SIZE(handle); i++) 41439c686b8SVishal Verma if (__to_nfit_memdev(nfit_mem)->device_handle == 41539c686b8SVishal Verma handle[i]) 41639c686b8SVishal Verma break; 41739c686b8SVishal Verma if (i >= ARRAY_SIZE(handle)) 41839c686b8SVishal Verma return -ENXIO; 41939c686b8SVishal Verma 42073606afdSDan Williams if ((1 << func) & dimm_fail_cmd_flags[i]) 42173606afdSDan Williams return -EIO; 42273606afdSDan Williams 4236634fb06SDan Williams switch (func) { 42439c686b8SVishal Verma case ND_CMD_GET_CONFIG_SIZE: 42539c686b8SVishal Verma rc = nfit_test_cmd_get_config_size(buf, buf_len); 42639c686b8SVishal Verma break; 42739c686b8SVishal Verma case ND_CMD_GET_CONFIG_DATA: 42839c686b8SVishal Verma rc = nfit_test_cmd_get_config_data(buf, buf_len, 42939c686b8SVishal Verma t->label[i]); 43039c686b8SVishal Verma break; 43139c686b8SVishal Verma case ND_CMD_SET_CONFIG_DATA: 43239c686b8SVishal Verma rc = nfit_test_cmd_set_config_data(buf, buf_len, 43339c686b8SVishal Verma t->label[i]); 43439c686b8SVishal Verma break; 435baa51277SDan Williams case ND_CMD_SMART: 436baa51277SDan Williams rc = nfit_test_cmd_smart(buf, buf_len); 437baa51277SDan Williams break; 438baa51277SDan Williams case ND_CMD_SMART_THRESHOLD: 439baa51277SDan Williams rc = nfit_test_cmd_smart_threshold(buf, buf_len); 440231bf117SDan Williams device_lock(&t->pdev.dev); 441231bf117SDan Williams __acpi_nvdimm_notify(t->dimm_dev[i], 0x81); 442231bf117SDan Williams device_unlock(&t->pdev.dev); 443baa51277SDan Williams break; 4446bc75619SDan Williams default: 4456bc75619SDan Williams return -ENOTTY; 4466bc75619SDan Williams } 44739c686b8SVishal Verma } else { 448f471f1a7SDan Williams struct ars_state *ars_state = &t->ars_state; 449f471f1a7SDan Williams 450e3654ecaSDan Williams if (!nd_desc || !test_bit(cmd, &nd_desc->cmd_mask)) 45139c686b8SVishal Verma return -ENOTTY; 45239c686b8SVishal Verma 4536634fb06SDan Williams switch (func) { 45439c686b8SVishal Verma case ND_CMD_ARS_CAP: 45539c686b8SVishal Verma rc = nfit_test_cmd_ars_cap(buf, buf_len); 45639c686b8SVishal Verma break; 45739c686b8SVishal Verma case ND_CMD_ARS_START: 458f471f1a7SDan Williams rc = nfit_test_cmd_ars_start(ars_state, buf, buf_len, 459f471f1a7SDan Williams cmd_rc); 46039c686b8SVishal Verma break; 46139c686b8SVishal Verma case ND_CMD_ARS_STATUS: 462f471f1a7SDan Williams rc = nfit_test_cmd_ars_status(ars_state, buf, buf_len, 463f471f1a7SDan Williams cmd_rc); 46439c686b8SVishal Verma break; 465d4f32367SDan Williams case ND_CMD_CLEAR_ERROR: 466d4f32367SDan Williams rc = nfit_test_cmd_clear_error(buf, buf_len, cmd_rc); 467d4f32367SDan Williams break; 46839c686b8SVishal Verma default: 46939c686b8SVishal Verma return -ENOTTY; 47039c686b8SVishal Verma } 47139c686b8SVishal Verma } 4726bc75619SDan Williams 4736bc75619SDan Williams return rc; 4746bc75619SDan Williams } 4756bc75619SDan Williams 4766bc75619SDan Williams static DEFINE_SPINLOCK(nfit_test_lock); 4776bc75619SDan Williams static struct nfit_test *instances[NUM_NFITS]; 4786bc75619SDan Williams 4796bc75619SDan Williams static void release_nfit_res(void *data) 4806bc75619SDan Williams { 4816bc75619SDan Williams struct nfit_test_resource *nfit_res = data; 4826bc75619SDan Williams 4836bc75619SDan Williams spin_lock(&nfit_test_lock); 4846bc75619SDan Williams list_del(&nfit_res->list); 4856bc75619SDan Williams spin_unlock(&nfit_test_lock); 4866bc75619SDan Williams 4876bc75619SDan Williams vfree(nfit_res->buf); 4886bc75619SDan Williams kfree(nfit_res); 4896bc75619SDan Williams } 4906bc75619SDan Williams 4916bc75619SDan Williams static void *__test_alloc(struct nfit_test *t, size_t size, dma_addr_t *dma, 4926bc75619SDan Williams void *buf) 4936bc75619SDan Williams { 4946bc75619SDan Williams struct device *dev = &t->pdev.dev; 4956bc75619SDan Williams struct nfit_test_resource *nfit_res = kzalloc(sizeof(*nfit_res), 4966bc75619SDan Williams GFP_KERNEL); 4976bc75619SDan Williams int rc; 4986bc75619SDan Williams 499bd4cd745SDan Williams if (!buf || !nfit_res) 5006bc75619SDan Williams goto err; 5016bc75619SDan Williams rc = devm_add_action(dev, release_nfit_res, nfit_res); 5026bc75619SDan Williams if (rc) 5036bc75619SDan Williams goto err; 5046bc75619SDan Williams INIT_LIST_HEAD(&nfit_res->list); 5056bc75619SDan Williams memset(buf, 0, size); 5066bc75619SDan Williams nfit_res->dev = dev; 5076bc75619SDan Williams nfit_res->buf = buf; 508bd4cd745SDan Williams nfit_res->res.start = *dma; 509bd4cd745SDan Williams nfit_res->res.end = *dma + size - 1; 510bd4cd745SDan Williams nfit_res->res.name = "NFIT"; 511bd4cd745SDan Williams spin_lock_init(&nfit_res->lock); 512bd4cd745SDan Williams INIT_LIST_HEAD(&nfit_res->requests); 5136bc75619SDan Williams spin_lock(&nfit_test_lock); 5146bc75619SDan Williams list_add(&nfit_res->list, &t->resources); 5156bc75619SDan Williams spin_unlock(&nfit_test_lock); 5166bc75619SDan Williams 5176bc75619SDan Williams return nfit_res->buf; 5186bc75619SDan Williams err: 519ee8520feSDan Williams if (buf) 5206bc75619SDan Williams vfree(buf); 5216bc75619SDan Williams kfree(nfit_res); 5226bc75619SDan Williams return NULL; 5236bc75619SDan Williams } 5246bc75619SDan Williams 5256bc75619SDan Williams static void *test_alloc(struct nfit_test *t, size_t size, dma_addr_t *dma) 5266bc75619SDan Williams { 5276bc75619SDan Williams void *buf = vmalloc(size); 5286bc75619SDan Williams 5296bc75619SDan Williams *dma = (unsigned long) buf; 5306bc75619SDan Williams return __test_alloc(t, size, dma, buf); 5316bc75619SDan Williams } 5326bc75619SDan Williams 5336bc75619SDan Williams static struct nfit_test_resource *nfit_test_lookup(resource_size_t addr) 5346bc75619SDan Williams { 5356bc75619SDan Williams int i; 5366bc75619SDan Williams 5376bc75619SDan Williams for (i = 0; i < ARRAY_SIZE(instances); i++) { 5386bc75619SDan Williams struct nfit_test_resource *n, *nfit_res = NULL; 5396bc75619SDan Williams struct nfit_test *t = instances[i]; 5406bc75619SDan Williams 5416bc75619SDan Williams if (!t) 5426bc75619SDan Williams continue; 5436bc75619SDan Williams spin_lock(&nfit_test_lock); 5446bc75619SDan Williams list_for_each_entry(n, &t->resources, list) { 545bd4cd745SDan Williams if (addr >= n->res.start && (addr < n->res.start 546bd4cd745SDan Williams + resource_size(&n->res))) { 5476bc75619SDan Williams nfit_res = n; 5486bc75619SDan Williams break; 5496bc75619SDan Williams } else if (addr >= (unsigned long) n->buf 5506bc75619SDan Williams && (addr < (unsigned long) n->buf 551bd4cd745SDan Williams + resource_size(&n->res))) { 5526bc75619SDan Williams nfit_res = n; 5536bc75619SDan Williams break; 5546bc75619SDan Williams } 5556bc75619SDan Williams } 5566bc75619SDan Williams spin_unlock(&nfit_test_lock); 5576bc75619SDan Williams if (nfit_res) 5586bc75619SDan Williams return nfit_res; 5596bc75619SDan Williams } 5606bc75619SDan Williams 5616bc75619SDan Williams return NULL; 5626bc75619SDan Williams } 5636bc75619SDan Williams 564f471f1a7SDan Williams static int ars_state_init(struct device *dev, struct ars_state *ars_state) 565f471f1a7SDan Williams { 566f471f1a7SDan Williams ars_state->ars_status = devm_kzalloc(dev, 567f471f1a7SDan Williams sizeof(struct nd_cmd_ars_status) 568f471f1a7SDan Williams + sizeof(struct nd_ars_record) * NFIT_TEST_ARS_RECORDS, 569f471f1a7SDan Williams GFP_KERNEL); 570f471f1a7SDan Williams if (!ars_state->ars_status) 571f471f1a7SDan Williams return -ENOMEM; 572f471f1a7SDan Williams spin_lock_init(&ars_state->lock); 573f471f1a7SDan Williams return 0; 574f471f1a7SDan Williams } 575f471f1a7SDan Williams 576231bf117SDan Williams static void put_dimms(void *data) 577231bf117SDan Williams { 578231bf117SDan Williams struct device **dimm_dev = data; 579231bf117SDan Williams int i; 580231bf117SDan Williams 581231bf117SDan Williams for (i = 0; i < NUM_DCR; i++) 582231bf117SDan Williams if (dimm_dev[i]) 583231bf117SDan Williams device_unregister(dimm_dev[i]); 584231bf117SDan Williams } 585231bf117SDan Williams 586231bf117SDan Williams static struct class *nfit_test_dimm; 587231bf117SDan Williams 58873606afdSDan Williams static int dimm_name_to_id(struct device *dev) 58973606afdSDan Williams { 59073606afdSDan Williams int dimm; 59173606afdSDan Williams 59273606afdSDan Williams if (sscanf(dev_name(dev), "test_dimm%d", &dimm) != 1 59373606afdSDan Williams || dimm >= NUM_DCR || dimm < 0) 59473606afdSDan Williams return -ENXIO; 59573606afdSDan Williams return dimm; 59673606afdSDan Williams } 59773606afdSDan Williams 59873606afdSDan Williams 59973606afdSDan Williams static ssize_t handle_show(struct device *dev, struct device_attribute *attr, 60073606afdSDan Williams char *buf) 60173606afdSDan Williams { 60273606afdSDan Williams int dimm = dimm_name_to_id(dev); 60373606afdSDan Williams 60473606afdSDan Williams if (dimm < 0) 60573606afdSDan Williams return dimm; 60673606afdSDan Williams 60773606afdSDan Williams return sprintf(buf, "%#x", handle[dimm]); 60873606afdSDan Williams } 60973606afdSDan Williams DEVICE_ATTR_RO(handle); 61073606afdSDan Williams 61173606afdSDan Williams static ssize_t fail_cmd_show(struct device *dev, struct device_attribute *attr, 61273606afdSDan Williams char *buf) 61373606afdSDan Williams { 61473606afdSDan Williams int dimm = dimm_name_to_id(dev); 61573606afdSDan Williams 61673606afdSDan Williams if (dimm < 0) 61773606afdSDan Williams return dimm; 61873606afdSDan Williams 61973606afdSDan Williams return sprintf(buf, "%#lx\n", dimm_fail_cmd_flags[dimm]); 62073606afdSDan Williams } 62173606afdSDan Williams 62273606afdSDan Williams static ssize_t fail_cmd_store(struct device *dev, struct device_attribute *attr, 62373606afdSDan Williams const char *buf, size_t size) 62473606afdSDan Williams { 62573606afdSDan Williams int dimm = dimm_name_to_id(dev); 62673606afdSDan Williams unsigned long val; 62773606afdSDan Williams ssize_t rc; 62873606afdSDan Williams 62973606afdSDan Williams if (dimm < 0) 63073606afdSDan Williams return dimm; 63173606afdSDan Williams 63273606afdSDan Williams rc = kstrtol(buf, 0, &val); 63373606afdSDan Williams if (rc) 63473606afdSDan Williams return rc; 63573606afdSDan Williams 63673606afdSDan Williams dimm_fail_cmd_flags[dimm] = val; 63773606afdSDan Williams return size; 63873606afdSDan Williams } 63973606afdSDan Williams static DEVICE_ATTR_RW(fail_cmd); 64073606afdSDan Williams 64173606afdSDan Williams static struct attribute *nfit_test_dimm_attributes[] = { 64273606afdSDan Williams &dev_attr_fail_cmd.attr, 64373606afdSDan Williams &dev_attr_handle.attr, 64473606afdSDan Williams NULL, 64573606afdSDan Williams }; 64673606afdSDan Williams 64773606afdSDan Williams static struct attribute_group nfit_test_dimm_attribute_group = { 64873606afdSDan Williams .attrs = nfit_test_dimm_attributes, 64973606afdSDan Williams }; 65073606afdSDan Williams 65173606afdSDan Williams static const struct attribute_group *nfit_test_dimm_attribute_groups[] = { 65273606afdSDan Williams &nfit_test_dimm_attribute_group, 65373606afdSDan Williams NULL, 65473606afdSDan Williams }; 65573606afdSDan Williams 6566bc75619SDan Williams static int nfit_test0_alloc(struct nfit_test *t) 6576bc75619SDan Williams { 6586b577c9dSLinda Knippers size_t nfit_size = sizeof(struct acpi_nfit_system_address) * NUM_SPA 6596bc75619SDan Williams + sizeof(struct acpi_nfit_memory_map) * NUM_MEM 6606bc75619SDan Williams + sizeof(struct acpi_nfit_control_region) * NUM_DCR 6613b87356fSDan Williams + offsetof(struct acpi_nfit_control_region, 6623b87356fSDan Williams window_size) * NUM_DCR 6639d27a87eSDan Williams + sizeof(struct acpi_nfit_data_region) * NUM_BDW 66485d3fa02SDan Williams + (sizeof(struct acpi_nfit_flush_address) 66585d3fa02SDan Williams + sizeof(u64) * NUM_HINTS) * NUM_DCR; 6666bc75619SDan Williams int i; 6676bc75619SDan Williams 6686bc75619SDan Williams t->nfit_buf = test_alloc(t, nfit_size, &t->nfit_dma); 6696bc75619SDan Williams if (!t->nfit_buf) 6706bc75619SDan Williams return -ENOMEM; 6716bc75619SDan Williams t->nfit_size = nfit_size; 6726bc75619SDan Williams 673ee8520feSDan Williams t->spa_set[0] = test_alloc(t, SPA0_SIZE, &t->spa_set_dma[0]); 6746bc75619SDan Williams if (!t->spa_set[0]) 6756bc75619SDan Williams return -ENOMEM; 6766bc75619SDan Williams 677ee8520feSDan Williams t->spa_set[1] = test_alloc(t, SPA1_SIZE, &t->spa_set_dma[1]); 6786bc75619SDan Williams if (!t->spa_set[1]) 6796bc75619SDan Williams return -ENOMEM; 6806bc75619SDan Williams 681ee8520feSDan Williams t->spa_set[2] = test_alloc(t, SPA0_SIZE, &t->spa_set_dma[2]); 68220985164SVishal Verma if (!t->spa_set[2]) 68320985164SVishal Verma return -ENOMEM; 68420985164SVishal Verma 6856bc75619SDan Williams for (i = 0; i < NUM_DCR; i++) { 6866bc75619SDan Williams t->dimm[i] = test_alloc(t, DIMM_SIZE, &t->dimm_dma[i]); 6876bc75619SDan Williams if (!t->dimm[i]) 6886bc75619SDan Williams return -ENOMEM; 6896bc75619SDan Williams 6906bc75619SDan Williams t->label[i] = test_alloc(t, LABEL_SIZE, &t->label_dma[i]); 6916bc75619SDan Williams if (!t->label[i]) 6926bc75619SDan Williams return -ENOMEM; 6936bc75619SDan Williams sprintf(t->label[i], "label%d", i); 6949d27a87eSDan Williams 6959d15ce9cSDan Williams t->flush[i] = test_alloc(t, max(PAGE_SIZE, 6969d15ce9cSDan Williams sizeof(u64) * NUM_HINTS), 69785d3fa02SDan Williams &t->flush_dma[i]); 6989d27a87eSDan Williams if (!t->flush[i]) 6999d27a87eSDan Williams return -ENOMEM; 7006bc75619SDan Williams } 7016bc75619SDan Williams 7026bc75619SDan Williams for (i = 0; i < NUM_DCR; i++) { 7036bc75619SDan Williams t->dcr[i] = test_alloc(t, LABEL_SIZE, &t->dcr_dma[i]); 7046bc75619SDan Williams if (!t->dcr[i]) 7056bc75619SDan Williams return -ENOMEM; 7066bc75619SDan Williams } 7076bc75619SDan Williams 708c14a868aSDan Williams t->_fit = test_alloc(t, sizeof(union acpi_object **), &t->_fit_dma); 709c14a868aSDan Williams if (!t->_fit) 710c14a868aSDan Williams return -ENOMEM; 711c14a868aSDan Williams 712231bf117SDan Williams if (devm_add_action_or_reset(&t->pdev.dev, put_dimms, t->dimm_dev)) 713231bf117SDan Williams return -ENOMEM; 714231bf117SDan Williams for (i = 0; i < NUM_DCR; i++) { 71573606afdSDan Williams t->dimm_dev[i] = device_create_with_groups(nfit_test_dimm, 71673606afdSDan Williams &t->pdev.dev, 0, NULL, 71773606afdSDan Williams nfit_test_dimm_attribute_groups, 71873606afdSDan Williams "test_dimm%d", i); 719231bf117SDan Williams if (!t->dimm_dev[i]) 720231bf117SDan Williams return -ENOMEM; 721231bf117SDan Williams } 722231bf117SDan Williams 723f471f1a7SDan Williams return ars_state_init(&t->pdev.dev, &t->ars_state); 7246bc75619SDan Williams } 7256bc75619SDan Williams 7266bc75619SDan Williams static int nfit_test1_alloc(struct nfit_test *t) 7276bc75619SDan Williams { 7287bfe97c7SDan Williams size_t nfit_size = sizeof(struct acpi_nfit_system_address) * 2 7296bc75619SDan Williams + sizeof(struct acpi_nfit_memory_map) 7303b87356fSDan Williams + offsetof(struct acpi_nfit_control_region, window_size); 7316bc75619SDan Williams 7326bc75619SDan Williams t->nfit_buf = test_alloc(t, nfit_size, &t->nfit_dma); 7336bc75619SDan Williams if (!t->nfit_buf) 7346bc75619SDan Williams return -ENOMEM; 7356bc75619SDan Williams t->nfit_size = nfit_size; 7366bc75619SDan Williams 737ee8520feSDan Williams t->spa_set[0] = test_alloc(t, SPA2_SIZE, &t->spa_set_dma[0]); 7386bc75619SDan Williams if (!t->spa_set[0]) 7396bc75619SDan Williams return -ENOMEM; 7406bc75619SDan Williams 7417bfe97c7SDan Williams t->spa_set[1] = test_alloc(t, SPA_VCD_SIZE, &t->spa_set_dma[1]); 7427bfe97c7SDan Williams if (!t->spa_set[1]) 7437bfe97c7SDan Williams return -ENOMEM; 7447bfe97c7SDan Williams 745f471f1a7SDan Williams return ars_state_init(&t->pdev.dev, &t->ars_state); 7466bc75619SDan Williams } 7476bc75619SDan Williams 7485dc68e55SDan Williams static void dcr_common_init(struct acpi_nfit_control_region *dcr) 7495dc68e55SDan Williams { 7505dc68e55SDan Williams dcr->vendor_id = 0xabcd; 7515dc68e55SDan Williams dcr->device_id = 0; 7525dc68e55SDan Williams dcr->revision_id = 1; 7535dc68e55SDan Williams dcr->valid_fields = 1; 7545dc68e55SDan Williams dcr->manufacturing_location = 0xa; 7555dc68e55SDan Williams dcr->manufacturing_date = cpu_to_be16(2016); 7565dc68e55SDan Williams } 7575dc68e55SDan Williams 7586bc75619SDan Williams static void nfit_test0_setup(struct nfit_test *t) 7596bc75619SDan Williams { 76085d3fa02SDan Williams const int flush_hint_size = sizeof(struct acpi_nfit_flush_address) 76185d3fa02SDan Williams + (sizeof(u64) * NUM_HINTS); 7626bc75619SDan Williams struct acpi_nfit_desc *acpi_desc; 7636bc75619SDan Williams struct acpi_nfit_memory_map *memdev; 7646bc75619SDan Williams void *nfit_buf = t->nfit_buf; 7656bc75619SDan Williams struct acpi_nfit_system_address *spa; 7666bc75619SDan Williams struct acpi_nfit_control_region *dcr; 7676bc75619SDan Williams struct acpi_nfit_data_region *bdw; 7689d27a87eSDan Williams struct acpi_nfit_flush_address *flush; 76985d3fa02SDan Williams unsigned int offset, i; 7706bc75619SDan Williams 7716bc75619SDan Williams /* 7726bc75619SDan Williams * spa0 (interleave first half of dimm0 and dimm1, note storage 7736bc75619SDan Williams * does not actually alias the related block-data-window 7746bc75619SDan Williams * regions) 7756bc75619SDan Williams */ 7766b577c9dSLinda Knippers spa = nfit_buf; 7776bc75619SDan Williams spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 7786bc75619SDan Williams spa->header.length = sizeof(*spa); 7796bc75619SDan Williams memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_PM), 16); 7806bc75619SDan Williams spa->range_index = 0+1; 7816bc75619SDan Williams spa->address = t->spa_set_dma[0]; 7826bc75619SDan Williams spa->length = SPA0_SIZE; 7836bc75619SDan Williams 7846bc75619SDan Williams /* 7856bc75619SDan Williams * spa1 (interleave last half of the 4 DIMMS, note storage 7866bc75619SDan Williams * does not actually alias the related block-data-window 7876bc75619SDan Williams * regions) 7886bc75619SDan Williams */ 7896b577c9dSLinda Knippers spa = nfit_buf + sizeof(*spa); 7906bc75619SDan Williams spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 7916bc75619SDan Williams spa->header.length = sizeof(*spa); 7926bc75619SDan Williams memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_PM), 16); 7936bc75619SDan Williams spa->range_index = 1+1; 7946bc75619SDan Williams spa->address = t->spa_set_dma[1]; 7956bc75619SDan Williams spa->length = SPA1_SIZE; 7966bc75619SDan Williams 7976bc75619SDan Williams /* spa2 (dcr0) dimm0 */ 7986b577c9dSLinda Knippers spa = nfit_buf + sizeof(*spa) * 2; 7996bc75619SDan Williams spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 8006bc75619SDan Williams spa->header.length = sizeof(*spa); 8016bc75619SDan Williams memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_DCR), 16); 8026bc75619SDan Williams spa->range_index = 2+1; 8036bc75619SDan Williams spa->address = t->dcr_dma[0]; 8046bc75619SDan Williams spa->length = DCR_SIZE; 8056bc75619SDan Williams 8066bc75619SDan Williams /* spa3 (dcr1) dimm1 */ 8076b577c9dSLinda Knippers spa = nfit_buf + sizeof(*spa) * 3; 8086bc75619SDan Williams spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 8096bc75619SDan Williams spa->header.length = sizeof(*spa); 8106bc75619SDan Williams memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_DCR), 16); 8116bc75619SDan Williams spa->range_index = 3+1; 8126bc75619SDan Williams spa->address = t->dcr_dma[1]; 8136bc75619SDan Williams spa->length = DCR_SIZE; 8146bc75619SDan Williams 8156bc75619SDan Williams /* spa4 (dcr2) dimm2 */ 8166b577c9dSLinda Knippers spa = nfit_buf + sizeof(*spa) * 4; 8176bc75619SDan Williams spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 8186bc75619SDan Williams spa->header.length = sizeof(*spa); 8196bc75619SDan Williams memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_DCR), 16); 8206bc75619SDan Williams spa->range_index = 4+1; 8216bc75619SDan Williams spa->address = t->dcr_dma[2]; 8226bc75619SDan Williams spa->length = DCR_SIZE; 8236bc75619SDan Williams 8246bc75619SDan Williams /* spa5 (dcr3) dimm3 */ 8256b577c9dSLinda Knippers spa = nfit_buf + sizeof(*spa) * 5; 8266bc75619SDan Williams spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 8276bc75619SDan Williams spa->header.length = sizeof(*spa); 8286bc75619SDan Williams memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_DCR), 16); 8296bc75619SDan Williams spa->range_index = 5+1; 8306bc75619SDan Williams spa->address = t->dcr_dma[3]; 8316bc75619SDan Williams spa->length = DCR_SIZE; 8326bc75619SDan Williams 8336bc75619SDan Williams /* spa6 (bdw for dcr0) dimm0 */ 8346b577c9dSLinda Knippers spa = nfit_buf + sizeof(*spa) * 6; 8356bc75619SDan Williams spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 8366bc75619SDan Williams spa->header.length = sizeof(*spa); 8376bc75619SDan Williams memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_BDW), 16); 8386bc75619SDan Williams spa->range_index = 6+1; 8396bc75619SDan Williams spa->address = t->dimm_dma[0]; 8406bc75619SDan Williams spa->length = DIMM_SIZE; 8416bc75619SDan Williams 8426bc75619SDan Williams /* spa7 (bdw for dcr1) dimm1 */ 8436b577c9dSLinda Knippers spa = nfit_buf + sizeof(*spa) * 7; 8446bc75619SDan Williams spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 8456bc75619SDan Williams spa->header.length = sizeof(*spa); 8466bc75619SDan Williams memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_BDW), 16); 8476bc75619SDan Williams spa->range_index = 7+1; 8486bc75619SDan Williams spa->address = t->dimm_dma[1]; 8496bc75619SDan Williams spa->length = DIMM_SIZE; 8506bc75619SDan Williams 8516bc75619SDan Williams /* spa8 (bdw for dcr2) dimm2 */ 8526b577c9dSLinda Knippers spa = nfit_buf + sizeof(*spa) * 8; 8536bc75619SDan Williams spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 8546bc75619SDan Williams spa->header.length = sizeof(*spa); 8556bc75619SDan Williams memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_BDW), 16); 8566bc75619SDan Williams spa->range_index = 8+1; 8576bc75619SDan Williams spa->address = t->dimm_dma[2]; 8586bc75619SDan Williams spa->length = DIMM_SIZE; 8596bc75619SDan Williams 8606bc75619SDan Williams /* spa9 (bdw for dcr3) dimm3 */ 8616b577c9dSLinda Knippers spa = nfit_buf + sizeof(*spa) * 9; 8626bc75619SDan Williams spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 8636bc75619SDan Williams spa->header.length = sizeof(*spa); 8646bc75619SDan Williams memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_BDW), 16); 8656bc75619SDan Williams spa->range_index = 9+1; 8666bc75619SDan Williams spa->address = t->dimm_dma[3]; 8676bc75619SDan Williams spa->length = DIMM_SIZE; 8686bc75619SDan Williams 8696b577c9dSLinda Knippers offset = sizeof(*spa) * 10; 8706bc75619SDan Williams /* mem-region0 (spa0, dimm0) */ 8716bc75619SDan Williams memdev = nfit_buf + offset; 8726bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 8736bc75619SDan Williams memdev->header.length = sizeof(*memdev); 8746bc75619SDan Williams memdev->device_handle = handle[0]; 8756bc75619SDan Williams memdev->physical_id = 0; 8766bc75619SDan Williams memdev->region_id = 0; 8776bc75619SDan Williams memdev->range_index = 0+1; 8783b87356fSDan Williams memdev->region_index = 4+1; 8796bc75619SDan Williams memdev->region_size = SPA0_SIZE/2; 8806bc75619SDan Williams memdev->region_offset = t->spa_set_dma[0]; 8816bc75619SDan Williams memdev->address = 0; 8826bc75619SDan Williams memdev->interleave_index = 0; 8836bc75619SDan Williams memdev->interleave_ways = 2; 8846bc75619SDan Williams 8856bc75619SDan Williams /* mem-region1 (spa0, dimm1) */ 8866bc75619SDan Williams memdev = nfit_buf + offset + sizeof(struct acpi_nfit_memory_map); 8876bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 8886bc75619SDan Williams memdev->header.length = sizeof(*memdev); 8896bc75619SDan Williams memdev->device_handle = handle[1]; 8906bc75619SDan Williams memdev->physical_id = 1; 8916bc75619SDan Williams memdev->region_id = 0; 8926bc75619SDan Williams memdev->range_index = 0+1; 8933b87356fSDan Williams memdev->region_index = 5+1; 8946bc75619SDan Williams memdev->region_size = SPA0_SIZE/2; 8956bc75619SDan Williams memdev->region_offset = t->spa_set_dma[0] + SPA0_SIZE/2; 8966bc75619SDan Williams memdev->address = 0; 8976bc75619SDan Williams memdev->interleave_index = 0; 8986bc75619SDan Williams memdev->interleave_ways = 2; 8996bc75619SDan Williams 9006bc75619SDan Williams /* mem-region2 (spa1, dimm0) */ 9016bc75619SDan Williams memdev = nfit_buf + offset + sizeof(struct acpi_nfit_memory_map) * 2; 9026bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 9036bc75619SDan Williams memdev->header.length = sizeof(*memdev); 9046bc75619SDan Williams memdev->device_handle = handle[0]; 9056bc75619SDan Williams memdev->physical_id = 0; 9066bc75619SDan Williams memdev->region_id = 1; 9076bc75619SDan Williams memdev->range_index = 1+1; 9083b87356fSDan Williams memdev->region_index = 4+1; 9096bc75619SDan Williams memdev->region_size = SPA1_SIZE/4; 9106bc75619SDan Williams memdev->region_offset = t->spa_set_dma[1]; 9116bc75619SDan Williams memdev->address = SPA0_SIZE/2; 9126bc75619SDan Williams memdev->interleave_index = 0; 9136bc75619SDan Williams memdev->interleave_ways = 4; 9146bc75619SDan Williams 9156bc75619SDan Williams /* mem-region3 (spa1, dimm1) */ 9166bc75619SDan Williams memdev = nfit_buf + offset + sizeof(struct acpi_nfit_memory_map) * 3; 9176bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 9186bc75619SDan Williams memdev->header.length = sizeof(*memdev); 9196bc75619SDan Williams memdev->device_handle = handle[1]; 9206bc75619SDan Williams memdev->physical_id = 1; 9216bc75619SDan Williams memdev->region_id = 1; 9226bc75619SDan Williams memdev->range_index = 1+1; 9233b87356fSDan Williams memdev->region_index = 5+1; 9246bc75619SDan Williams memdev->region_size = SPA1_SIZE/4; 9256bc75619SDan Williams memdev->region_offset = t->spa_set_dma[1] + SPA1_SIZE/4; 9266bc75619SDan Williams memdev->address = SPA0_SIZE/2; 9276bc75619SDan Williams memdev->interleave_index = 0; 9286bc75619SDan Williams memdev->interleave_ways = 4; 9296bc75619SDan Williams 9306bc75619SDan Williams /* mem-region4 (spa1, dimm2) */ 9316bc75619SDan Williams memdev = nfit_buf + offset + sizeof(struct acpi_nfit_memory_map) * 4; 9326bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 9336bc75619SDan Williams memdev->header.length = sizeof(*memdev); 9346bc75619SDan Williams memdev->device_handle = handle[2]; 9356bc75619SDan Williams memdev->physical_id = 2; 9366bc75619SDan Williams memdev->region_id = 0; 9376bc75619SDan Williams memdev->range_index = 1+1; 9383b87356fSDan Williams memdev->region_index = 6+1; 9396bc75619SDan Williams memdev->region_size = SPA1_SIZE/4; 9406bc75619SDan Williams memdev->region_offset = t->spa_set_dma[1] + 2*SPA1_SIZE/4; 9416bc75619SDan Williams memdev->address = SPA0_SIZE/2; 9426bc75619SDan Williams memdev->interleave_index = 0; 9436bc75619SDan Williams memdev->interleave_ways = 4; 9446bc75619SDan Williams 9456bc75619SDan Williams /* mem-region5 (spa1, dimm3) */ 9466bc75619SDan Williams memdev = nfit_buf + offset + sizeof(struct acpi_nfit_memory_map) * 5; 9476bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 9486bc75619SDan Williams memdev->header.length = sizeof(*memdev); 9496bc75619SDan Williams memdev->device_handle = handle[3]; 9506bc75619SDan Williams memdev->physical_id = 3; 9516bc75619SDan Williams memdev->region_id = 0; 9526bc75619SDan Williams memdev->range_index = 1+1; 9533b87356fSDan Williams memdev->region_index = 7+1; 9546bc75619SDan Williams memdev->region_size = SPA1_SIZE/4; 9556bc75619SDan Williams memdev->region_offset = t->spa_set_dma[1] + 3*SPA1_SIZE/4; 9566bc75619SDan Williams memdev->address = SPA0_SIZE/2; 9576bc75619SDan Williams memdev->interleave_index = 0; 9586bc75619SDan Williams memdev->interleave_ways = 4; 9596bc75619SDan Williams 9606bc75619SDan Williams /* mem-region6 (spa/dcr0, dimm0) */ 9616bc75619SDan Williams memdev = nfit_buf + offset + sizeof(struct acpi_nfit_memory_map) * 6; 9626bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 9636bc75619SDan Williams memdev->header.length = sizeof(*memdev); 9646bc75619SDan Williams memdev->device_handle = handle[0]; 9656bc75619SDan Williams memdev->physical_id = 0; 9666bc75619SDan Williams memdev->region_id = 0; 9676bc75619SDan Williams memdev->range_index = 2+1; 9686bc75619SDan Williams memdev->region_index = 0+1; 9696bc75619SDan Williams memdev->region_size = 0; 9706bc75619SDan Williams memdev->region_offset = 0; 9716bc75619SDan Williams memdev->address = 0; 9726bc75619SDan Williams memdev->interleave_index = 0; 9736bc75619SDan Williams memdev->interleave_ways = 1; 9746bc75619SDan Williams 9756bc75619SDan Williams /* mem-region7 (spa/dcr1, dimm1) */ 9766bc75619SDan Williams memdev = nfit_buf + offset + sizeof(struct acpi_nfit_memory_map) * 7; 9776bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 9786bc75619SDan Williams memdev->header.length = sizeof(*memdev); 9796bc75619SDan Williams memdev->device_handle = handle[1]; 9806bc75619SDan Williams memdev->physical_id = 1; 9816bc75619SDan Williams memdev->region_id = 0; 9826bc75619SDan Williams memdev->range_index = 3+1; 9836bc75619SDan Williams memdev->region_index = 1+1; 9846bc75619SDan Williams memdev->region_size = 0; 9856bc75619SDan Williams memdev->region_offset = 0; 9866bc75619SDan Williams memdev->address = 0; 9876bc75619SDan Williams memdev->interleave_index = 0; 9886bc75619SDan Williams memdev->interleave_ways = 1; 9896bc75619SDan Williams 9906bc75619SDan Williams /* mem-region8 (spa/dcr2, dimm2) */ 9916bc75619SDan Williams memdev = nfit_buf + offset + sizeof(struct acpi_nfit_memory_map) * 8; 9926bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 9936bc75619SDan Williams memdev->header.length = sizeof(*memdev); 9946bc75619SDan Williams memdev->device_handle = handle[2]; 9956bc75619SDan Williams memdev->physical_id = 2; 9966bc75619SDan Williams memdev->region_id = 0; 9976bc75619SDan Williams memdev->range_index = 4+1; 9986bc75619SDan Williams memdev->region_index = 2+1; 9996bc75619SDan Williams memdev->region_size = 0; 10006bc75619SDan Williams memdev->region_offset = 0; 10016bc75619SDan Williams memdev->address = 0; 10026bc75619SDan Williams memdev->interleave_index = 0; 10036bc75619SDan Williams memdev->interleave_ways = 1; 10046bc75619SDan Williams 10056bc75619SDan Williams /* mem-region9 (spa/dcr3, dimm3) */ 10066bc75619SDan Williams memdev = nfit_buf + offset + sizeof(struct acpi_nfit_memory_map) * 9; 10076bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 10086bc75619SDan Williams memdev->header.length = sizeof(*memdev); 10096bc75619SDan Williams memdev->device_handle = handle[3]; 10106bc75619SDan Williams memdev->physical_id = 3; 10116bc75619SDan Williams memdev->region_id = 0; 10126bc75619SDan Williams memdev->range_index = 5+1; 10136bc75619SDan Williams memdev->region_index = 3+1; 10146bc75619SDan Williams memdev->region_size = 0; 10156bc75619SDan Williams memdev->region_offset = 0; 10166bc75619SDan Williams memdev->address = 0; 10176bc75619SDan Williams memdev->interleave_index = 0; 10186bc75619SDan Williams memdev->interleave_ways = 1; 10196bc75619SDan Williams 10206bc75619SDan Williams /* mem-region10 (spa/bdw0, dimm0) */ 10216bc75619SDan Williams memdev = nfit_buf + offset + sizeof(struct acpi_nfit_memory_map) * 10; 10226bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 10236bc75619SDan Williams memdev->header.length = sizeof(*memdev); 10246bc75619SDan Williams memdev->device_handle = handle[0]; 10256bc75619SDan Williams memdev->physical_id = 0; 10266bc75619SDan Williams memdev->region_id = 0; 10276bc75619SDan Williams memdev->range_index = 6+1; 10286bc75619SDan Williams memdev->region_index = 0+1; 10296bc75619SDan Williams memdev->region_size = 0; 10306bc75619SDan Williams memdev->region_offset = 0; 10316bc75619SDan Williams memdev->address = 0; 10326bc75619SDan Williams memdev->interleave_index = 0; 10336bc75619SDan Williams memdev->interleave_ways = 1; 10346bc75619SDan Williams 10356bc75619SDan Williams /* mem-region11 (spa/bdw1, dimm1) */ 10366bc75619SDan Williams memdev = nfit_buf + offset + sizeof(struct acpi_nfit_memory_map) * 11; 10376bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 10386bc75619SDan Williams memdev->header.length = sizeof(*memdev); 10396bc75619SDan Williams memdev->device_handle = handle[1]; 10406bc75619SDan Williams memdev->physical_id = 1; 10416bc75619SDan Williams memdev->region_id = 0; 10426bc75619SDan Williams memdev->range_index = 7+1; 10436bc75619SDan Williams memdev->region_index = 1+1; 10446bc75619SDan Williams memdev->region_size = 0; 10456bc75619SDan Williams memdev->region_offset = 0; 10466bc75619SDan Williams memdev->address = 0; 10476bc75619SDan Williams memdev->interleave_index = 0; 10486bc75619SDan Williams memdev->interleave_ways = 1; 10496bc75619SDan Williams 10506bc75619SDan Williams /* mem-region12 (spa/bdw2, dimm2) */ 10516bc75619SDan Williams memdev = nfit_buf + offset + sizeof(struct acpi_nfit_memory_map) * 12; 10526bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 10536bc75619SDan Williams memdev->header.length = sizeof(*memdev); 10546bc75619SDan Williams memdev->device_handle = handle[2]; 10556bc75619SDan Williams memdev->physical_id = 2; 10566bc75619SDan Williams memdev->region_id = 0; 10576bc75619SDan Williams memdev->range_index = 8+1; 10586bc75619SDan Williams memdev->region_index = 2+1; 10596bc75619SDan Williams memdev->region_size = 0; 10606bc75619SDan Williams memdev->region_offset = 0; 10616bc75619SDan Williams memdev->address = 0; 10626bc75619SDan Williams memdev->interleave_index = 0; 10636bc75619SDan Williams memdev->interleave_ways = 1; 10646bc75619SDan Williams 10656bc75619SDan Williams /* mem-region13 (spa/dcr3, dimm3) */ 10666bc75619SDan Williams memdev = nfit_buf + offset + sizeof(struct acpi_nfit_memory_map) * 13; 10676bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 10686bc75619SDan Williams memdev->header.length = sizeof(*memdev); 10696bc75619SDan Williams memdev->device_handle = handle[3]; 10706bc75619SDan Williams memdev->physical_id = 3; 10716bc75619SDan Williams memdev->region_id = 0; 10726bc75619SDan Williams memdev->range_index = 9+1; 10736bc75619SDan Williams memdev->region_index = 3+1; 10746bc75619SDan Williams memdev->region_size = 0; 10756bc75619SDan Williams memdev->region_offset = 0; 10766bc75619SDan Williams memdev->address = 0; 10776bc75619SDan Williams memdev->interleave_index = 0; 10786bc75619SDan Williams memdev->interleave_ways = 1; 10796bc75619SDan Williams 10806bc75619SDan Williams offset = offset + sizeof(struct acpi_nfit_memory_map) * 14; 10813b87356fSDan Williams /* dcr-descriptor0: blk */ 10826bc75619SDan Williams dcr = nfit_buf + offset; 10836bc75619SDan Williams dcr->header.type = ACPI_NFIT_TYPE_CONTROL_REGION; 10846bc75619SDan Williams dcr->header.length = sizeof(struct acpi_nfit_control_region); 10856bc75619SDan Williams dcr->region_index = 0+1; 10865dc68e55SDan Williams dcr_common_init(dcr); 10876bc75619SDan Williams dcr->serial_number = ~handle[0]; 1088be26f9aeSDan Williams dcr->code = NFIT_FIC_BLK; 10896bc75619SDan Williams dcr->windows = 1; 10906bc75619SDan Williams dcr->window_size = DCR_SIZE; 10916bc75619SDan Williams dcr->command_offset = 0; 10926bc75619SDan Williams dcr->command_size = 8; 10936bc75619SDan Williams dcr->status_offset = 8; 10946bc75619SDan Williams dcr->status_size = 4; 10956bc75619SDan Williams 10963b87356fSDan Williams /* dcr-descriptor1: blk */ 10976bc75619SDan Williams dcr = nfit_buf + offset + sizeof(struct acpi_nfit_control_region); 10986bc75619SDan Williams dcr->header.type = ACPI_NFIT_TYPE_CONTROL_REGION; 10996bc75619SDan Williams dcr->header.length = sizeof(struct acpi_nfit_control_region); 11006bc75619SDan Williams dcr->region_index = 1+1; 11015dc68e55SDan Williams dcr_common_init(dcr); 11026bc75619SDan Williams dcr->serial_number = ~handle[1]; 1103be26f9aeSDan Williams dcr->code = NFIT_FIC_BLK; 11046bc75619SDan Williams dcr->windows = 1; 11056bc75619SDan Williams dcr->window_size = DCR_SIZE; 11066bc75619SDan Williams dcr->command_offset = 0; 11076bc75619SDan Williams dcr->command_size = 8; 11086bc75619SDan Williams dcr->status_offset = 8; 11096bc75619SDan Williams dcr->status_size = 4; 11106bc75619SDan Williams 11113b87356fSDan Williams /* dcr-descriptor2: blk */ 11126bc75619SDan Williams dcr = nfit_buf + offset + sizeof(struct acpi_nfit_control_region) * 2; 11136bc75619SDan Williams dcr->header.type = ACPI_NFIT_TYPE_CONTROL_REGION; 11146bc75619SDan Williams dcr->header.length = sizeof(struct acpi_nfit_control_region); 11156bc75619SDan Williams dcr->region_index = 2+1; 11165dc68e55SDan Williams dcr_common_init(dcr); 11176bc75619SDan Williams dcr->serial_number = ~handle[2]; 1118be26f9aeSDan Williams dcr->code = NFIT_FIC_BLK; 11196bc75619SDan Williams dcr->windows = 1; 11206bc75619SDan Williams dcr->window_size = DCR_SIZE; 11216bc75619SDan Williams dcr->command_offset = 0; 11226bc75619SDan Williams dcr->command_size = 8; 11236bc75619SDan Williams dcr->status_offset = 8; 11246bc75619SDan Williams dcr->status_size = 4; 11256bc75619SDan Williams 11263b87356fSDan Williams /* dcr-descriptor3: blk */ 11276bc75619SDan Williams dcr = nfit_buf + offset + sizeof(struct acpi_nfit_control_region) * 3; 11286bc75619SDan Williams dcr->header.type = ACPI_NFIT_TYPE_CONTROL_REGION; 11296bc75619SDan Williams dcr->header.length = sizeof(struct acpi_nfit_control_region); 11306bc75619SDan Williams dcr->region_index = 3+1; 11315dc68e55SDan Williams dcr_common_init(dcr); 11326bc75619SDan Williams dcr->serial_number = ~handle[3]; 1133be26f9aeSDan Williams dcr->code = NFIT_FIC_BLK; 11346bc75619SDan Williams dcr->windows = 1; 11356bc75619SDan Williams dcr->window_size = DCR_SIZE; 11366bc75619SDan Williams dcr->command_offset = 0; 11376bc75619SDan Williams dcr->command_size = 8; 11386bc75619SDan Williams dcr->status_offset = 8; 11396bc75619SDan Williams dcr->status_size = 4; 11406bc75619SDan Williams 11416bc75619SDan Williams offset = offset + sizeof(struct acpi_nfit_control_region) * 4; 11423b87356fSDan Williams /* dcr-descriptor0: pmem */ 11433b87356fSDan Williams dcr = nfit_buf + offset; 11443b87356fSDan Williams dcr->header.type = ACPI_NFIT_TYPE_CONTROL_REGION; 11453b87356fSDan Williams dcr->header.length = offsetof(struct acpi_nfit_control_region, 11463b87356fSDan Williams window_size); 11473b87356fSDan Williams dcr->region_index = 4+1; 11485dc68e55SDan Williams dcr_common_init(dcr); 11493b87356fSDan Williams dcr->serial_number = ~handle[0]; 11503b87356fSDan Williams dcr->code = NFIT_FIC_BYTEN; 11513b87356fSDan Williams dcr->windows = 0; 11523b87356fSDan Williams 11533b87356fSDan Williams /* dcr-descriptor1: pmem */ 11543b87356fSDan Williams dcr = nfit_buf + offset + offsetof(struct acpi_nfit_control_region, 11553b87356fSDan Williams window_size); 11563b87356fSDan Williams dcr->header.type = ACPI_NFIT_TYPE_CONTROL_REGION; 11573b87356fSDan Williams dcr->header.length = offsetof(struct acpi_nfit_control_region, 11583b87356fSDan Williams window_size); 11593b87356fSDan Williams dcr->region_index = 5+1; 11605dc68e55SDan Williams dcr_common_init(dcr); 11613b87356fSDan Williams dcr->serial_number = ~handle[1]; 11623b87356fSDan Williams dcr->code = NFIT_FIC_BYTEN; 11633b87356fSDan Williams dcr->windows = 0; 11643b87356fSDan Williams 11653b87356fSDan Williams /* dcr-descriptor2: pmem */ 11663b87356fSDan Williams dcr = nfit_buf + offset + offsetof(struct acpi_nfit_control_region, 11673b87356fSDan Williams window_size) * 2; 11683b87356fSDan Williams dcr->header.type = ACPI_NFIT_TYPE_CONTROL_REGION; 11693b87356fSDan Williams dcr->header.length = offsetof(struct acpi_nfit_control_region, 11703b87356fSDan Williams window_size); 11713b87356fSDan Williams dcr->region_index = 6+1; 11725dc68e55SDan Williams dcr_common_init(dcr); 11733b87356fSDan Williams dcr->serial_number = ~handle[2]; 11743b87356fSDan Williams dcr->code = NFIT_FIC_BYTEN; 11753b87356fSDan Williams dcr->windows = 0; 11763b87356fSDan Williams 11773b87356fSDan Williams /* dcr-descriptor3: pmem */ 11783b87356fSDan Williams dcr = nfit_buf + offset + offsetof(struct acpi_nfit_control_region, 11793b87356fSDan Williams window_size) * 3; 11803b87356fSDan Williams dcr->header.type = ACPI_NFIT_TYPE_CONTROL_REGION; 11813b87356fSDan Williams dcr->header.length = offsetof(struct acpi_nfit_control_region, 11823b87356fSDan Williams window_size); 11833b87356fSDan Williams dcr->region_index = 7+1; 11845dc68e55SDan Williams dcr_common_init(dcr); 11853b87356fSDan Williams dcr->serial_number = ~handle[3]; 11863b87356fSDan Williams dcr->code = NFIT_FIC_BYTEN; 11873b87356fSDan Williams dcr->windows = 0; 11883b87356fSDan Williams 11893b87356fSDan Williams offset = offset + offsetof(struct acpi_nfit_control_region, 11903b87356fSDan Williams window_size) * 4; 11916bc75619SDan Williams /* bdw0 (spa/dcr0, dimm0) */ 11926bc75619SDan Williams bdw = nfit_buf + offset; 11936bc75619SDan Williams bdw->header.type = ACPI_NFIT_TYPE_DATA_REGION; 11946bc75619SDan Williams bdw->header.length = sizeof(struct acpi_nfit_data_region); 11956bc75619SDan Williams bdw->region_index = 0+1; 11966bc75619SDan Williams bdw->windows = 1; 11976bc75619SDan Williams bdw->offset = 0; 11986bc75619SDan Williams bdw->size = BDW_SIZE; 11996bc75619SDan Williams bdw->capacity = DIMM_SIZE; 12006bc75619SDan Williams bdw->start_address = 0; 12016bc75619SDan Williams 12026bc75619SDan Williams /* bdw1 (spa/dcr1, dimm1) */ 12036bc75619SDan Williams bdw = nfit_buf + offset + sizeof(struct acpi_nfit_data_region); 12046bc75619SDan Williams bdw->header.type = ACPI_NFIT_TYPE_DATA_REGION; 12056bc75619SDan Williams bdw->header.length = sizeof(struct acpi_nfit_data_region); 12066bc75619SDan Williams bdw->region_index = 1+1; 12076bc75619SDan Williams bdw->windows = 1; 12086bc75619SDan Williams bdw->offset = 0; 12096bc75619SDan Williams bdw->size = BDW_SIZE; 12106bc75619SDan Williams bdw->capacity = DIMM_SIZE; 12116bc75619SDan Williams bdw->start_address = 0; 12126bc75619SDan Williams 12136bc75619SDan Williams /* bdw2 (spa/dcr2, dimm2) */ 12146bc75619SDan Williams bdw = nfit_buf + offset + sizeof(struct acpi_nfit_data_region) * 2; 12156bc75619SDan Williams bdw->header.type = ACPI_NFIT_TYPE_DATA_REGION; 12166bc75619SDan Williams bdw->header.length = sizeof(struct acpi_nfit_data_region); 12176bc75619SDan Williams bdw->region_index = 2+1; 12186bc75619SDan Williams bdw->windows = 1; 12196bc75619SDan Williams bdw->offset = 0; 12206bc75619SDan Williams bdw->size = BDW_SIZE; 12216bc75619SDan Williams bdw->capacity = DIMM_SIZE; 12226bc75619SDan Williams bdw->start_address = 0; 12236bc75619SDan Williams 12246bc75619SDan Williams /* bdw3 (spa/dcr3, dimm3) */ 12256bc75619SDan Williams bdw = nfit_buf + offset + sizeof(struct acpi_nfit_data_region) * 3; 12266bc75619SDan Williams bdw->header.type = ACPI_NFIT_TYPE_DATA_REGION; 12276bc75619SDan Williams bdw->header.length = sizeof(struct acpi_nfit_data_region); 12286bc75619SDan Williams bdw->region_index = 3+1; 12296bc75619SDan Williams bdw->windows = 1; 12306bc75619SDan Williams bdw->offset = 0; 12316bc75619SDan Williams bdw->size = BDW_SIZE; 12326bc75619SDan Williams bdw->capacity = DIMM_SIZE; 12336bc75619SDan Williams bdw->start_address = 0; 12346bc75619SDan Williams 12359d27a87eSDan Williams offset = offset + sizeof(struct acpi_nfit_data_region) * 4; 12369d27a87eSDan Williams /* flush0 (dimm0) */ 12379d27a87eSDan Williams flush = nfit_buf + offset; 12389d27a87eSDan Williams flush->header.type = ACPI_NFIT_TYPE_FLUSH_ADDRESS; 123985d3fa02SDan Williams flush->header.length = flush_hint_size; 12409d27a87eSDan Williams flush->device_handle = handle[0]; 124185d3fa02SDan Williams flush->hint_count = NUM_HINTS; 124285d3fa02SDan Williams for (i = 0; i < NUM_HINTS; i++) 124385d3fa02SDan Williams flush->hint_address[i] = t->flush_dma[0] + i * sizeof(u64); 12449d27a87eSDan Williams 12459d27a87eSDan Williams /* flush1 (dimm1) */ 124685d3fa02SDan Williams flush = nfit_buf + offset + flush_hint_size * 1; 12479d27a87eSDan Williams flush->header.type = ACPI_NFIT_TYPE_FLUSH_ADDRESS; 124885d3fa02SDan Williams flush->header.length = flush_hint_size; 12499d27a87eSDan Williams flush->device_handle = handle[1]; 125085d3fa02SDan Williams flush->hint_count = NUM_HINTS; 125185d3fa02SDan Williams for (i = 0; i < NUM_HINTS; i++) 125285d3fa02SDan Williams flush->hint_address[i] = t->flush_dma[1] + i * sizeof(u64); 12539d27a87eSDan Williams 12549d27a87eSDan Williams /* flush2 (dimm2) */ 125585d3fa02SDan Williams flush = nfit_buf + offset + flush_hint_size * 2; 12569d27a87eSDan Williams flush->header.type = ACPI_NFIT_TYPE_FLUSH_ADDRESS; 125785d3fa02SDan Williams flush->header.length = flush_hint_size; 12589d27a87eSDan Williams flush->device_handle = handle[2]; 125985d3fa02SDan Williams flush->hint_count = NUM_HINTS; 126085d3fa02SDan Williams for (i = 0; i < NUM_HINTS; i++) 126185d3fa02SDan Williams flush->hint_address[i] = t->flush_dma[2] + i * sizeof(u64); 12629d27a87eSDan Williams 12639d27a87eSDan Williams /* flush3 (dimm3) */ 126485d3fa02SDan Williams flush = nfit_buf + offset + flush_hint_size * 3; 12659d27a87eSDan Williams flush->header.type = ACPI_NFIT_TYPE_FLUSH_ADDRESS; 126685d3fa02SDan Williams flush->header.length = flush_hint_size; 12679d27a87eSDan Williams flush->device_handle = handle[3]; 126885d3fa02SDan Williams flush->hint_count = NUM_HINTS; 126985d3fa02SDan Williams for (i = 0; i < NUM_HINTS; i++) 127085d3fa02SDan Williams flush->hint_address[i] = t->flush_dma[3] + i * sizeof(u64); 12719d27a87eSDan Williams 127220985164SVishal Verma if (t->setup_hotplug) { 127385d3fa02SDan Williams offset = offset + flush_hint_size * 4; 12743b87356fSDan Williams /* dcr-descriptor4: blk */ 127520985164SVishal Verma dcr = nfit_buf + offset; 127620985164SVishal Verma dcr->header.type = ACPI_NFIT_TYPE_CONTROL_REGION; 127720985164SVishal Verma dcr->header.length = sizeof(struct acpi_nfit_control_region); 12783b87356fSDan Williams dcr->region_index = 8+1; 12795dc68e55SDan Williams dcr_common_init(dcr); 128020985164SVishal Verma dcr->serial_number = ~handle[4]; 1281be26f9aeSDan Williams dcr->code = NFIT_FIC_BLK; 128220985164SVishal Verma dcr->windows = 1; 128320985164SVishal Verma dcr->window_size = DCR_SIZE; 128420985164SVishal Verma dcr->command_offset = 0; 128520985164SVishal Verma dcr->command_size = 8; 128620985164SVishal Verma dcr->status_offset = 8; 128720985164SVishal Verma dcr->status_size = 4; 128820985164SVishal Verma 128920985164SVishal Verma offset = offset + sizeof(struct acpi_nfit_control_region); 12903b87356fSDan Williams /* dcr-descriptor4: pmem */ 12913b87356fSDan Williams dcr = nfit_buf + offset; 12923b87356fSDan Williams dcr->header.type = ACPI_NFIT_TYPE_CONTROL_REGION; 12933b87356fSDan Williams dcr->header.length = offsetof(struct acpi_nfit_control_region, 12943b87356fSDan Williams window_size); 12953b87356fSDan Williams dcr->region_index = 9+1; 12965dc68e55SDan Williams dcr_common_init(dcr); 12973b87356fSDan Williams dcr->serial_number = ~handle[4]; 12983b87356fSDan Williams dcr->code = NFIT_FIC_BYTEN; 12993b87356fSDan Williams dcr->windows = 0; 13003b87356fSDan Williams 13013b87356fSDan Williams offset = offset + offsetof(struct acpi_nfit_control_region, 13023b87356fSDan Williams window_size); 130320985164SVishal Verma /* bdw4 (spa/dcr4, dimm4) */ 130420985164SVishal Verma bdw = nfit_buf + offset; 130520985164SVishal Verma bdw->header.type = ACPI_NFIT_TYPE_DATA_REGION; 130620985164SVishal Verma bdw->header.length = sizeof(struct acpi_nfit_data_region); 13073b87356fSDan Williams bdw->region_index = 8+1; 130820985164SVishal Verma bdw->windows = 1; 130920985164SVishal Verma bdw->offset = 0; 131020985164SVishal Verma bdw->size = BDW_SIZE; 131120985164SVishal Verma bdw->capacity = DIMM_SIZE; 131220985164SVishal Verma bdw->start_address = 0; 131320985164SVishal Verma 131420985164SVishal Verma offset = offset + sizeof(struct acpi_nfit_data_region); 131520985164SVishal Verma /* spa10 (dcr4) dimm4 */ 131620985164SVishal Verma spa = nfit_buf + offset; 131720985164SVishal Verma spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 131820985164SVishal Verma spa->header.length = sizeof(*spa); 131920985164SVishal Verma memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_DCR), 16); 132020985164SVishal Verma spa->range_index = 10+1; 132120985164SVishal Verma spa->address = t->dcr_dma[4]; 132220985164SVishal Verma spa->length = DCR_SIZE; 132320985164SVishal Verma 132420985164SVishal Verma /* 132520985164SVishal Verma * spa11 (single-dimm interleave for hotplug, note storage 132620985164SVishal Verma * does not actually alias the related block-data-window 132720985164SVishal Verma * regions) 132820985164SVishal Verma */ 132920985164SVishal Verma spa = nfit_buf + offset + sizeof(*spa); 133020985164SVishal Verma spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 133120985164SVishal Verma spa->header.length = sizeof(*spa); 133220985164SVishal Verma memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_PM), 16); 133320985164SVishal Verma spa->range_index = 11+1; 133420985164SVishal Verma spa->address = t->spa_set_dma[2]; 133520985164SVishal Verma spa->length = SPA0_SIZE; 133620985164SVishal Verma 133720985164SVishal Verma /* spa12 (bdw for dcr4) dimm4 */ 133820985164SVishal Verma spa = nfit_buf + offset + sizeof(*spa) * 2; 133920985164SVishal Verma spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 134020985164SVishal Verma spa->header.length = sizeof(*spa); 134120985164SVishal Verma memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_BDW), 16); 134220985164SVishal Verma spa->range_index = 12+1; 134320985164SVishal Verma spa->address = t->dimm_dma[4]; 134420985164SVishal Verma spa->length = DIMM_SIZE; 134520985164SVishal Verma 134620985164SVishal Verma offset = offset + sizeof(*spa) * 3; 134720985164SVishal Verma /* mem-region14 (spa/dcr4, dimm4) */ 134820985164SVishal Verma memdev = nfit_buf + offset; 134920985164SVishal Verma memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 135020985164SVishal Verma memdev->header.length = sizeof(*memdev); 135120985164SVishal Verma memdev->device_handle = handle[4]; 135220985164SVishal Verma memdev->physical_id = 4; 135320985164SVishal Verma memdev->region_id = 0; 135420985164SVishal Verma memdev->range_index = 10+1; 13553b87356fSDan Williams memdev->region_index = 8+1; 135620985164SVishal Verma memdev->region_size = 0; 135720985164SVishal Verma memdev->region_offset = 0; 135820985164SVishal Verma memdev->address = 0; 135920985164SVishal Verma memdev->interleave_index = 0; 136020985164SVishal Verma memdev->interleave_ways = 1; 136120985164SVishal Verma 136220985164SVishal Verma /* mem-region15 (spa0, dimm4) */ 136320985164SVishal Verma memdev = nfit_buf + offset + 136420985164SVishal Verma sizeof(struct acpi_nfit_memory_map); 136520985164SVishal Verma memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 136620985164SVishal Verma memdev->header.length = sizeof(*memdev); 136720985164SVishal Verma memdev->device_handle = handle[4]; 136820985164SVishal Verma memdev->physical_id = 4; 136920985164SVishal Verma memdev->region_id = 0; 137020985164SVishal Verma memdev->range_index = 11+1; 13713b87356fSDan Williams memdev->region_index = 9+1; 137220985164SVishal Verma memdev->region_size = SPA0_SIZE; 137320985164SVishal Verma memdev->region_offset = t->spa_set_dma[2]; 137420985164SVishal Verma memdev->address = 0; 137520985164SVishal Verma memdev->interleave_index = 0; 137620985164SVishal Verma memdev->interleave_ways = 1; 137720985164SVishal Verma 13783b87356fSDan Williams /* mem-region16 (spa/bdw4, dimm4) */ 137920985164SVishal Verma memdev = nfit_buf + offset + 138020985164SVishal Verma sizeof(struct acpi_nfit_memory_map) * 2; 138120985164SVishal Verma memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 138220985164SVishal Verma memdev->header.length = sizeof(*memdev); 138320985164SVishal Verma memdev->device_handle = handle[4]; 138420985164SVishal Verma memdev->physical_id = 4; 138520985164SVishal Verma memdev->region_id = 0; 138620985164SVishal Verma memdev->range_index = 12+1; 13873b87356fSDan Williams memdev->region_index = 8+1; 138820985164SVishal Verma memdev->region_size = 0; 138920985164SVishal Verma memdev->region_offset = 0; 139020985164SVishal Verma memdev->address = 0; 139120985164SVishal Verma memdev->interleave_index = 0; 139220985164SVishal Verma memdev->interleave_ways = 1; 139320985164SVishal Verma 139420985164SVishal Verma offset = offset + sizeof(struct acpi_nfit_memory_map) * 3; 139520985164SVishal Verma /* flush3 (dimm4) */ 139620985164SVishal Verma flush = nfit_buf + offset; 139720985164SVishal Verma flush->header.type = ACPI_NFIT_TYPE_FLUSH_ADDRESS; 139885d3fa02SDan Williams flush->header.length = flush_hint_size; 139920985164SVishal Verma flush->device_handle = handle[4]; 140085d3fa02SDan Williams flush->hint_count = NUM_HINTS; 140185d3fa02SDan Williams for (i = 0; i < NUM_HINTS; i++) 140285d3fa02SDan Williams flush->hint_address[i] = t->flush_dma[4] 140385d3fa02SDan Williams + i * sizeof(u64); 140420985164SVishal Verma } 140520985164SVishal Verma 1406f471f1a7SDan Williams post_ars_status(&t->ars_state, t->spa_set_dma[0], SPA0_SIZE); 1407f471f1a7SDan Williams 14086bc75619SDan Williams acpi_desc = &t->acpi_desc; 1409e3654ecaSDan Williams set_bit(ND_CMD_GET_CONFIG_SIZE, &acpi_desc->dimm_cmd_force_en); 1410e3654ecaSDan Williams set_bit(ND_CMD_GET_CONFIG_DATA, &acpi_desc->dimm_cmd_force_en); 1411e3654ecaSDan Williams set_bit(ND_CMD_SET_CONFIG_DATA, &acpi_desc->dimm_cmd_force_en); 14121f716d05SDan Williams set_bit(ND_CMD_SMART, &acpi_desc->dimm_cmd_force_en); 1413e3654ecaSDan Williams set_bit(ND_CMD_ARS_CAP, &acpi_desc->bus_cmd_force_en); 1414e3654ecaSDan Williams set_bit(ND_CMD_ARS_START, &acpi_desc->bus_cmd_force_en); 1415e3654ecaSDan Williams set_bit(ND_CMD_ARS_STATUS, &acpi_desc->bus_cmd_force_en); 1416e3654ecaSDan Williams set_bit(ND_CMD_CLEAR_ERROR, &acpi_desc->bus_cmd_force_en); 14171f716d05SDan Williams set_bit(ND_CMD_SMART_THRESHOLD, &acpi_desc->dimm_cmd_force_en); 14186bc75619SDan Williams } 14196bc75619SDan Williams 14206bc75619SDan Williams static void nfit_test1_setup(struct nfit_test *t) 14216bc75619SDan Williams { 14226b577c9dSLinda Knippers size_t offset; 14236bc75619SDan Williams void *nfit_buf = t->nfit_buf; 14246bc75619SDan Williams struct acpi_nfit_memory_map *memdev; 14256bc75619SDan Williams struct acpi_nfit_control_region *dcr; 14266bc75619SDan Williams struct acpi_nfit_system_address *spa; 1427d26f73f0SDan Williams struct acpi_nfit_desc *acpi_desc; 14286bc75619SDan Williams 14296b577c9dSLinda Knippers offset = 0; 14306bc75619SDan Williams /* spa0 (flat range with no bdw aliasing) */ 14316bc75619SDan Williams spa = nfit_buf + offset; 14326bc75619SDan Williams spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 14336bc75619SDan Williams spa->header.length = sizeof(*spa); 14346bc75619SDan Williams memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_PM), 16); 14356bc75619SDan Williams spa->range_index = 0+1; 14366bc75619SDan Williams spa->address = t->spa_set_dma[0]; 14376bc75619SDan Williams spa->length = SPA2_SIZE; 14386bc75619SDan Williams 14397bfe97c7SDan Williams /* virtual cd region */ 14407bfe97c7SDan Williams spa = nfit_buf + sizeof(*spa); 14417bfe97c7SDan Williams spa->header.type = ACPI_NFIT_TYPE_SYSTEM_ADDRESS; 14427bfe97c7SDan Williams spa->header.length = sizeof(*spa); 14437bfe97c7SDan Williams memcpy(spa->range_guid, to_nfit_uuid(NFIT_SPA_VCD), 16); 14447bfe97c7SDan Williams spa->range_index = 0; 14457bfe97c7SDan Williams spa->address = t->spa_set_dma[1]; 14467bfe97c7SDan Williams spa->length = SPA_VCD_SIZE; 14477bfe97c7SDan Williams 14487bfe97c7SDan Williams offset += sizeof(*spa) * 2; 14496bc75619SDan Williams /* mem-region0 (spa0, dimm0) */ 14506bc75619SDan Williams memdev = nfit_buf + offset; 14516bc75619SDan Williams memdev->header.type = ACPI_NFIT_TYPE_MEMORY_MAP; 14526bc75619SDan Williams memdev->header.length = sizeof(*memdev); 14536bc75619SDan Williams memdev->device_handle = 0; 14546bc75619SDan Williams memdev->physical_id = 0; 14556bc75619SDan Williams memdev->region_id = 0; 14566bc75619SDan Williams memdev->range_index = 0+1; 14576bc75619SDan Williams memdev->region_index = 0+1; 14586bc75619SDan Williams memdev->region_size = SPA2_SIZE; 14596bc75619SDan Williams memdev->region_offset = 0; 14606bc75619SDan Williams memdev->address = 0; 14616bc75619SDan Williams memdev->interleave_index = 0; 14626bc75619SDan Williams memdev->interleave_ways = 1; 146358138820SDan Williams memdev->flags = ACPI_NFIT_MEM_SAVE_FAILED | ACPI_NFIT_MEM_RESTORE_FAILED 146458138820SDan Williams | ACPI_NFIT_MEM_FLUSH_FAILED | ACPI_NFIT_MEM_HEALTH_OBSERVED 1465f4295796SDan Williams | ACPI_NFIT_MEM_NOT_ARMED; 14666bc75619SDan Williams 14676bc75619SDan Williams offset += sizeof(*memdev); 14686bc75619SDan Williams /* dcr-descriptor0 */ 14696bc75619SDan Williams dcr = nfit_buf + offset; 14706bc75619SDan Williams dcr->header.type = ACPI_NFIT_TYPE_CONTROL_REGION; 14713b87356fSDan Williams dcr->header.length = offsetof(struct acpi_nfit_control_region, 14723b87356fSDan Williams window_size); 14736bc75619SDan Williams dcr->region_index = 0+1; 14745dc68e55SDan Williams dcr_common_init(dcr); 14756bc75619SDan Williams dcr->serial_number = ~0; 1476be26f9aeSDan Williams dcr->code = NFIT_FIC_BYTE; 14776bc75619SDan Williams dcr->windows = 0; 1478d26f73f0SDan Williams 1479f471f1a7SDan Williams post_ars_status(&t->ars_state, t->spa_set_dma[0], SPA2_SIZE); 1480f471f1a7SDan Williams 1481d26f73f0SDan Williams acpi_desc = &t->acpi_desc; 1482e3654ecaSDan Williams set_bit(ND_CMD_ARS_CAP, &acpi_desc->bus_cmd_force_en); 1483e3654ecaSDan Williams set_bit(ND_CMD_ARS_START, &acpi_desc->bus_cmd_force_en); 1484e3654ecaSDan Williams set_bit(ND_CMD_ARS_STATUS, &acpi_desc->bus_cmd_force_en); 1485e3654ecaSDan Williams set_bit(ND_CMD_CLEAR_ERROR, &acpi_desc->bus_cmd_force_en); 14866bc75619SDan Williams } 14876bc75619SDan Williams 14886bc75619SDan Williams static int nfit_test_blk_do_io(struct nd_blk_region *ndbr, resource_size_t dpa, 14896bc75619SDan Williams void *iobuf, u64 len, int rw) 14906bc75619SDan Williams { 14916bc75619SDan Williams struct nfit_blk *nfit_blk = ndbr->blk_provider_data; 14926bc75619SDan Williams struct nfit_blk_mmio *mmio = &nfit_blk->mmio[BDW]; 14936bc75619SDan Williams struct nd_region *nd_region = &ndbr->nd_region; 14946bc75619SDan Williams unsigned int lane; 14956bc75619SDan Williams 14966bc75619SDan Williams lane = nd_region_acquire_lane(nd_region); 14976bc75619SDan Williams if (rw) 149867a3e8feSRoss Zwisler memcpy(mmio->addr.base + dpa, iobuf, len); 149967a3e8feSRoss Zwisler else { 150067a3e8feSRoss Zwisler memcpy(iobuf, mmio->addr.base + dpa, len); 150167a3e8feSRoss Zwisler 150267a3e8feSRoss Zwisler /* give us some some coverage of the mmio_flush_range() API */ 150367a3e8feSRoss Zwisler mmio_flush_range(mmio->addr.base + dpa, len); 150467a3e8feSRoss Zwisler } 15056bc75619SDan Williams nd_region_release_lane(nd_region, lane); 15066bc75619SDan Williams 15076bc75619SDan Williams return 0; 15086bc75619SDan Williams } 15096bc75619SDan Williams 1510*a7de92daSDan Williams static unsigned long nfit_ctl_handle; 1511*a7de92daSDan Williams 1512*a7de92daSDan Williams union acpi_object *result; 1513*a7de92daSDan Williams 1514*a7de92daSDan Williams static union acpi_object *nfit_test_evaluate_dsm(acpi_handle handle, 1515*a7de92daSDan Williams const u8 *uuid, u64 rev, u64 func, union acpi_object *argv4) 1516*a7de92daSDan Williams { 1517*a7de92daSDan Williams if (handle != &nfit_ctl_handle) 1518*a7de92daSDan Williams return ERR_PTR(-ENXIO); 1519*a7de92daSDan Williams 1520*a7de92daSDan Williams return result; 1521*a7de92daSDan Williams } 1522*a7de92daSDan Williams 1523*a7de92daSDan Williams static int setup_result(void *buf, size_t size) 1524*a7de92daSDan Williams { 1525*a7de92daSDan Williams result = kmalloc(sizeof(union acpi_object) + size, GFP_KERNEL); 1526*a7de92daSDan Williams if (!result) 1527*a7de92daSDan Williams return -ENOMEM; 1528*a7de92daSDan Williams result->package.type = ACPI_TYPE_BUFFER, 1529*a7de92daSDan Williams result->buffer.pointer = (void *) (result + 1); 1530*a7de92daSDan Williams result->buffer.length = size; 1531*a7de92daSDan Williams memcpy(result->buffer.pointer, buf, size); 1532*a7de92daSDan Williams memset(buf, 0, size); 1533*a7de92daSDan Williams return 0; 1534*a7de92daSDan Williams } 1535*a7de92daSDan Williams 1536*a7de92daSDan Williams static int nfit_ctl_test(struct device *dev) 1537*a7de92daSDan Williams { 1538*a7de92daSDan Williams int rc, cmd_rc; 1539*a7de92daSDan Williams struct nvdimm *nvdimm; 1540*a7de92daSDan Williams struct acpi_device *adev; 1541*a7de92daSDan Williams struct nfit_mem *nfit_mem; 1542*a7de92daSDan Williams struct nd_ars_record *record; 1543*a7de92daSDan Williams struct acpi_nfit_desc *acpi_desc; 1544*a7de92daSDan Williams const u64 test_val = 0x0123456789abcdefULL; 1545*a7de92daSDan Williams unsigned long mask, cmd_size, offset; 1546*a7de92daSDan Williams union { 1547*a7de92daSDan Williams struct nd_cmd_get_config_size cfg_size; 1548*a7de92daSDan Williams struct nd_cmd_ars_status ars_stat; 1549*a7de92daSDan Williams struct nd_cmd_ars_cap ars_cap; 1550*a7de92daSDan Williams char buf[sizeof(struct nd_cmd_ars_status) 1551*a7de92daSDan Williams + sizeof(struct nd_ars_record)]; 1552*a7de92daSDan Williams } cmds; 1553*a7de92daSDan Williams 1554*a7de92daSDan Williams adev = devm_kzalloc(dev, sizeof(*adev), GFP_KERNEL); 1555*a7de92daSDan Williams if (!adev) 1556*a7de92daSDan Williams return -ENOMEM; 1557*a7de92daSDan Williams *adev = (struct acpi_device) { 1558*a7de92daSDan Williams .handle = &nfit_ctl_handle, 1559*a7de92daSDan Williams .dev = { 1560*a7de92daSDan Williams .init_name = "test-adev", 1561*a7de92daSDan Williams }, 1562*a7de92daSDan Williams }; 1563*a7de92daSDan Williams 1564*a7de92daSDan Williams acpi_desc = devm_kzalloc(dev, sizeof(*acpi_desc), GFP_KERNEL); 1565*a7de92daSDan Williams if (!acpi_desc) 1566*a7de92daSDan Williams return -ENOMEM; 1567*a7de92daSDan Williams *acpi_desc = (struct acpi_nfit_desc) { 1568*a7de92daSDan Williams .nd_desc = { 1569*a7de92daSDan Williams .cmd_mask = 1UL << ND_CMD_ARS_CAP 1570*a7de92daSDan Williams | 1UL << ND_CMD_ARS_START 1571*a7de92daSDan Williams | 1UL << ND_CMD_ARS_STATUS 1572*a7de92daSDan Williams | 1UL << ND_CMD_CLEAR_ERROR, 1573*a7de92daSDan Williams .module = THIS_MODULE, 1574*a7de92daSDan Williams .provider_name = "ACPI.NFIT", 1575*a7de92daSDan Williams .ndctl = acpi_nfit_ctl, 1576*a7de92daSDan Williams }, 1577*a7de92daSDan Williams .dev = &adev->dev, 1578*a7de92daSDan Williams }; 1579*a7de92daSDan Williams 1580*a7de92daSDan Williams nfit_mem = devm_kzalloc(dev, sizeof(*nfit_mem), GFP_KERNEL); 1581*a7de92daSDan Williams if (!nfit_mem) 1582*a7de92daSDan Williams return -ENOMEM; 1583*a7de92daSDan Williams 1584*a7de92daSDan Williams mask = 1UL << ND_CMD_SMART | 1UL << ND_CMD_SMART_THRESHOLD 1585*a7de92daSDan Williams | 1UL << ND_CMD_DIMM_FLAGS | 1UL << ND_CMD_GET_CONFIG_SIZE 1586*a7de92daSDan Williams | 1UL << ND_CMD_GET_CONFIG_DATA | 1UL << ND_CMD_SET_CONFIG_DATA 1587*a7de92daSDan Williams | 1UL << ND_CMD_VENDOR; 1588*a7de92daSDan Williams *nfit_mem = (struct nfit_mem) { 1589*a7de92daSDan Williams .adev = adev, 1590*a7de92daSDan Williams .family = NVDIMM_FAMILY_INTEL, 1591*a7de92daSDan Williams .dsm_mask = mask, 1592*a7de92daSDan Williams }; 1593*a7de92daSDan Williams 1594*a7de92daSDan Williams nvdimm = devm_kzalloc(dev, sizeof(*nvdimm), GFP_KERNEL); 1595*a7de92daSDan Williams if (!nvdimm) 1596*a7de92daSDan Williams return -ENOMEM; 1597*a7de92daSDan Williams *nvdimm = (struct nvdimm) { 1598*a7de92daSDan Williams .provider_data = nfit_mem, 1599*a7de92daSDan Williams .cmd_mask = mask, 1600*a7de92daSDan Williams .dev = { 1601*a7de92daSDan Williams .init_name = "test-dimm", 1602*a7de92daSDan Williams }, 1603*a7de92daSDan Williams }; 1604*a7de92daSDan Williams 1605*a7de92daSDan Williams 1606*a7de92daSDan Williams /* basic checkout of a typical 'get config size' command */ 1607*a7de92daSDan Williams cmd_size = sizeof(cmds.cfg_size); 1608*a7de92daSDan Williams cmds.cfg_size = (struct nd_cmd_get_config_size) { 1609*a7de92daSDan Williams .status = 0, 1610*a7de92daSDan Williams .config_size = SZ_128K, 1611*a7de92daSDan Williams .max_xfer = SZ_4K, 1612*a7de92daSDan Williams }; 1613*a7de92daSDan Williams rc = setup_result(cmds.buf, cmd_size); 1614*a7de92daSDan Williams if (rc) 1615*a7de92daSDan Williams return rc; 1616*a7de92daSDan Williams rc = acpi_nfit_ctl(&acpi_desc->nd_desc, nvdimm, ND_CMD_GET_CONFIG_SIZE, 1617*a7de92daSDan Williams cmds.buf, cmd_size, &cmd_rc); 1618*a7de92daSDan Williams 1619*a7de92daSDan Williams if (rc < 0 || cmd_rc || cmds.cfg_size.status != 0 1620*a7de92daSDan Williams || cmds.cfg_size.config_size != SZ_128K 1621*a7de92daSDan Williams || cmds.cfg_size.max_xfer != SZ_4K) { 1622*a7de92daSDan Williams dev_dbg(dev, "%s: failed at: %d rc: %d cmd_rc: %d\n", 1623*a7de92daSDan Williams __func__, __LINE__, rc, cmd_rc); 1624*a7de92daSDan Williams return -EIO; 1625*a7de92daSDan Williams } 1626*a7de92daSDan Williams 1627*a7de92daSDan Williams 1628*a7de92daSDan Williams /* test ars_status with zero output */ 1629*a7de92daSDan Williams cmd_size = offsetof(struct nd_cmd_ars_status, address); 1630*a7de92daSDan Williams cmds.ars_stat = (struct nd_cmd_ars_status) { 1631*a7de92daSDan Williams .out_length = 0, 1632*a7de92daSDan Williams }; 1633*a7de92daSDan Williams rc = setup_result(cmds.buf, cmd_size); 1634*a7de92daSDan Williams if (rc) 1635*a7de92daSDan Williams return rc; 1636*a7de92daSDan Williams rc = acpi_nfit_ctl(&acpi_desc->nd_desc, NULL, ND_CMD_ARS_STATUS, 1637*a7de92daSDan Williams cmds.buf, cmd_size, &cmd_rc); 1638*a7de92daSDan Williams 1639*a7de92daSDan Williams if (rc < 0 || cmd_rc) { 1640*a7de92daSDan Williams dev_dbg(dev, "%s: failed at: %d rc: %d cmd_rc: %d\n", 1641*a7de92daSDan Williams __func__, __LINE__, rc, cmd_rc); 1642*a7de92daSDan Williams return -EIO; 1643*a7de92daSDan Williams } 1644*a7de92daSDan Williams 1645*a7de92daSDan Williams 1646*a7de92daSDan Williams /* test ars_cap with benign extended status */ 1647*a7de92daSDan Williams cmd_size = sizeof(cmds.ars_cap); 1648*a7de92daSDan Williams cmds.ars_cap = (struct nd_cmd_ars_cap) { 1649*a7de92daSDan Williams .status = ND_ARS_PERSISTENT << 16, 1650*a7de92daSDan Williams }; 1651*a7de92daSDan Williams offset = offsetof(struct nd_cmd_ars_cap, status); 1652*a7de92daSDan Williams rc = setup_result(cmds.buf + offset, cmd_size - offset); 1653*a7de92daSDan Williams if (rc) 1654*a7de92daSDan Williams return rc; 1655*a7de92daSDan Williams rc = acpi_nfit_ctl(&acpi_desc->nd_desc, NULL, ND_CMD_ARS_CAP, 1656*a7de92daSDan Williams cmds.buf, cmd_size, &cmd_rc); 1657*a7de92daSDan Williams 1658*a7de92daSDan Williams if (rc < 0 || cmd_rc) { 1659*a7de92daSDan Williams dev_dbg(dev, "%s: failed at: %d rc: %d cmd_rc: %d\n", 1660*a7de92daSDan Williams __func__, __LINE__, rc, cmd_rc); 1661*a7de92daSDan Williams return -EIO; 1662*a7de92daSDan Williams } 1663*a7de92daSDan Williams 1664*a7de92daSDan Williams 1665*a7de92daSDan Williams /* test ars_status with 'status' trimmed from 'out_length' */ 1666*a7de92daSDan Williams cmd_size = sizeof(cmds.ars_stat) + sizeof(struct nd_ars_record); 1667*a7de92daSDan Williams cmds.ars_stat = (struct nd_cmd_ars_status) { 1668*a7de92daSDan Williams .out_length = cmd_size - 4, 1669*a7de92daSDan Williams }; 1670*a7de92daSDan Williams record = &cmds.ars_stat.records[0]; 1671*a7de92daSDan Williams *record = (struct nd_ars_record) { 1672*a7de92daSDan Williams .length = test_val, 1673*a7de92daSDan Williams }; 1674*a7de92daSDan Williams rc = setup_result(cmds.buf, cmd_size); 1675*a7de92daSDan Williams if (rc) 1676*a7de92daSDan Williams return rc; 1677*a7de92daSDan Williams rc = acpi_nfit_ctl(&acpi_desc->nd_desc, NULL, ND_CMD_ARS_STATUS, 1678*a7de92daSDan Williams cmds.buf, cmd_size, &cmd_rc); 1679*a7de92daSDan Williams 1680*a7de92daSDan Williams if (rc < 0 || cmd_rc || record->length != test_val) { 1681*a7de92daSDan Williams dev_dbg(dev, "%s: failed at: %d rc: %d cmd_rc: %d\n", 1682*a7de92daSDan Williams __func__, __LINE__, rc, cmd_rc); 1683*a7de92daSDan Williams return -EIO; 1684*a7de92daSDan Williams } 1685*a7de92daSDan Williams 1686*a7de92daSDan Williams 1687*a7de92daSDan Williams /* test ars_status with 'Output (Size)' including 'status' */ 1688*a7de92daSDan Williams cmd_size = sizeof(cmds.ars_stat) + sizeof(struct nd_ars_record); 1689*a7de92daSDan Williams cmds.ars_stat = (struct nd_cmd_ars_status) { 1690*a7de92daSDan Williams .out_length = cmd_size, 1691*a7de92daSDan Williams }; 1692*a7de92daSDan Williams record = &cmds.ars_stat.records[0]; 1693*a7de92daSDan Williams *record = (struct nd_ars_record) { 1694*a7de92daSDan Williams .length = test_val, 1695*a7de92daSDan Williams }; 1696*a7de92daSDan Williams rc = setup_result(cmds.buf, cmd_size); 1697*a7de92daSDan Williams if (rc) 1698*a7de92daSDan Williams return rc; 1699*a7de92daSDan Williams rc = acpi_nfit_ctl(&acpi_desc->nd_desc, NULL, ND_CMD_ARS_STATUS, 1700*a7de92daSDan Williams cmds.buf, cmd_size, &cmd_rc); 1701*a7de92daSDan Williams 1702*a7de92daSDan Williams if (rc < 0 || cmd_rc || record->length != test_val) { 1703*a7de92daSDan Williams dev_dbg(dev, "%s: failed at: %d rc: %d cmd_rc: %d\n", 1704*a7de92daSDan Williams __func__, __LINE__, rc, cmd_rc); 1705*a7de92daSDan Williams return -EIO; 1706*a7de92daSDan Williams } 1707*a7de92daSDan Williams 1708*a7de92daSDan Williams 1709*a7de92daSDan Williams /* test extended status for get_config_size results in failure */ 1710*a7de92daSDan Williams cmd_size = sizeof(cmds.cfg_size); 1711*a7de92daSDan Williams cmds.cfg_size = (struct nd_cmd_get_config_size) { 1712*a7de92daSDan Williams .status = 1 << 16, 1713*a7de92daSDan Williams }; 1714*a7de92daSDan Williams rc = setup_result(cmds.buf, cmd_size); 1715*a7de92daSDan Williams if (rc) 1716*a7de92daSDan Williams return rc; 1717*a7de92daSDan Williams rc = acpi_nfit_ctl(&acpi_desc->nd_desc, nvdimm, ND_CMD_GET_CONFIG_SIZE, 1718*a7de92daSDan Williams cmds.buf, cmd_size, &cmd_rc); 1719*a7de92daSDan Williams 1720*a7de92daSDan Williams if (rc < 0 || cmd_rc >= 0) { 1721*a7de92daSDan Williams dev_dbg(dev, "%s: failed at: %d rc: %d cmd_rc: %d\n", 1722*a7de92daSDan Williams __func__, __LINE__, rc, cmd_rc); 1723*a7de92daSDan Williams return -EIO; 1724*a7de92daSDan Williams } 1725*a7de92daSDan Williams 1726*a7de92daSDan Williams return 0; 1727*a7de92daSDan Williams } 1728*a7de92daSDan Williams 17296bc75619SDan Williams static int nfit_test_probe(struct platform_device *pdev) 17306bc75619SDan Williams { 17316bc75619SDan Williams struct nvdimm_bus_descriptor *nd_desc; 17326bc75619SDan Williams struct acpi_nfit_desc *acpi_desc; 17336bc75619SDan Williams struct device *dev = &pdev->dev; 17346bc75619SDan Williams struct nfit_test *nfit_test; 1735231bf117SDan Williams struct nfit_mem *nfit_mem; 1736c14a868aSDan Williams union acpi_object *obj; 17376bc75619SDan Williams int rc; 17386bc75619SDan Williams 1739*a7de92daSDan Williams if (strcmp(dev_name(&pdev->dev), "nfit_test.0") == 0) { 1740*a7de92daSDan Williams rc = nfit_ctl_test(&pdev->dev); 1741*a7de92daSDan Williams if (rc) 1742*a7de92daSDan Williams return rc; 1743*a7de92daSDan Williams } 1744*a7de92daSDan Williams 17456bc75619SDan Williams nfit_test = to_nfit_test(&pdev->dev); 17466bc75619SDan Williams 17476bc75619SDan Williams /* common alloc */ 17486bc75619SDan Williams if (nfit_test->num_dcr) { 17496bc75619SDan Williams int num = nfit_test->num_dcr; 17506bc75619SDan Williams 17516bc75619SDan Williams nfit_test->dimm = devm_kcalloc(dev, num, sizeof(void *), 17526bc75619SDan Williams GFP_KERNEL); 17536bc75619SDan Williams nfit_test->dimm_dma = devm_kcalloc(dev, num, sizeof(dma_addr_t), 17546bc75619SDan Williams GFP_KERNEL); 17559d27a87eSDan Williams nfit_test->flush = devm_kcalloc(dev, num, sizeof(void *), 17569d27a87eSDan Williams GFP_KERNEL); 17579d27a87eSDan Williams nfit_test->flush_dma = devm_kcalloc(dev, num, sizeof(dma_addr_t), 17589d27a87eSDan Williams GFP_KERNEL); 17596bc75619SDan Williams nfit_test->label = devm_kcalloc(dev, num, sizeof(void *), 17606bc75619SDan Williams GFP_KERNEL); 17616bc75619SDan Williams nfit_test->label_dma = devm_kcalloc(dev, num, 17626bc75619SDan Williams sizeof(dma_addr_t), GFP_KERNEL); 17636bc75619SDan Williams nfit_test->dcr = devm_kcalloc(dev, num, 17646bc75619SDan Williams sizeof(struct nfit_test_dcr *), GFP_KERNEL); 17656bc75619SDan Williams nfit_test->dcr_dma = devm_kcalloc(dev, num, 17666bc75619SDan Williams sizeof(dma_addr_t), GFP_KERNEL); 17676bc75619SDan Williams if (nfit_test->dimm && nfit_test->dimm_dma && nfit_test->label 17686bc75619SDan Williams && nfit_test->label_dma && nfit_test->dcr 17699d27a87eSDan Williams && nfit_test->dcr_dma && nfit_test->flush 17709d27a87eSDan Williams && nfit_test->flush_dma) 17716bc75619SDan Williams /* pass */; 17726bc75619SDan Williams else 17736bc75619SDan Williams return -ENOMEM; 17746bc75619SDan Williams } 17756bc75619SDan Williams 17766bc75619SDan Williams if (nfit_test->num_pm) { 17776bc75619SDan Williams int num = nfit_test->num_pm; 17786bc75619SDan Williams 17796bc75619SDan Williams nfit_test->spa_set = devm_kcalloc(dev, num, sizeof(void *), 17806bc75619SDan Williams GFP_KERNEL); 17816bc75619SDan Williams nfit_test->spa_set_dma = devm_kcalloc(dev, num, 17826bc75619SDan Williams sizeof(dma_addr_t), GFP_KERNEL); 17836bc75619SDan Williams if (nfit_test->spa_set && nfit_test->spa_set_dma) 17846bc75619SDan Williams /* pass */; 17856bc75619SDan Williams else 17866bc75619SDan Williams return -ENOMEM; 17876bc75619SDan Williams } 17886bc75619SDan Williams 17896bc75619SDan Williams /* per-nfit specific alloc */ 17906bc75619SDan Williams if (nfit_test->alloc(nfit_test)) 17916bc75619SDan Williams return -ENOMEM; 17926bc75619SDan Williams 17936bc75619SDan Williams nfit_test->setup(nfit_test); 17946bc75619SDan Williams acpi_desc = &nfit_test->acpi_desc; 1795a61fe6f7SDan Williams acpi_nfit_desc_init(acpi_desc, &pdev->dev); 17966bc75619SDan Williams acpi_desc->blk_do_io = nfit_test_blk_do_io; 17976bc75619SDan Williams nd_desc = &acpi_desc->nd_desc; 1798a61fe6f7SDan Williams nd_desc->provider_name = NULL; 1799bc9775d8SDan Williams nd_desc->module = THIS_MODULE; 1800a61fe6f7SDan Williams nd_desc->ndctl = nfit_test_ctl; 18016bc75619SDan Williams 1802e7a11b44SDan Williams rc = acpi_nfit_init(acpi_desc, nfit_test->nfit_buf, 1803e7a11b44SDan Williams nfit_test->nfit_size); 180458cd71b4SDan Williams if (rc) 180520985164SVishal Verma return rc; 180620985164SVishal Verma 180720985164SVishal Verma if (nfit_test->setup != nfit_test0_setup) 180820985164SVishal Verma return 0; 180920985164SVishal Verma 181020985164SVishal Verma nfit_test->setup_hotplug = 1; 181120985164SVishal Verma nfit_test->setup(nfit_test); 181220985164SVishal Verma 1813c14a868aSDan Williams obj = kzalloc(sizeof(*obj), GFP_KERNEL); 1814c14a868aSDan Williams if (!obj) 1815c14a868aSDan Williams return -ENOMEM; 1816c14a868aSDan Williams obj->type = ACPI_TYPE_BUFFER; 1817c14a868aSDan Williams obj->buffer.length = nfit_test->nfit_size; 1818c14a868aSDan Williams obj->buffer.pointer = nfit_test->nfit_buf; 1819c14a868aSDan Williams *(nfit_test->_fit) = obj; 1820c14a868aSDan Williams __acpi_nfit_notify(&pdev->dev, nfit_test, 0x80); 1821231bf117SDan Williams 1822231bf117SDan Williams /* associate dimm devices with nfit_mem data for notification testing */ 1823231bf117SDan Williams mutex_lock(&acpi_desc->init_mutex); 1824231bf117SDan Williams list_for_each_entry(nfit_mem, &acpi_desc->dimms, list) { 1825231bf117SDan Williams u32 nfit_handle = __to_nfit_memdev(nfit_mem)->device_handle; 1826231bf117SDan Williams int i; 1827231bf117SDan Williams 1828231bf117SDan Williams for (i = 0; i < NUM_DCR; i++) 1829231bf117SDan Williams if (nfit_handle == handle[i]) 1830231bf117SDan Williams dev_set_drvdata(nfit_test->dimm_dev[i], 1831231bf117SDan Williams nfit_mem); 1832231bf117SDan Williams } 1833231bf117SDan Williams mutex_unlock(&acpi_desc->init_mutex); 18346bc75619SDan Williams 18356bc75619SDan Williams return 0; 18366bc75619SDan Williams } 18376bc75619SDan Williams 18386bc75619SDan Williams static int nfit_test_remove(struct platform_device *pdev) 18396bc75619SDan Williams { 18406bc75619SDan Williams return 0; 18416bc75619SDan Williams } 18426bc75619SDan Williams 18436bc75619SDan Williams static void nfit_test_release(struct device *dev) 18446bc75619SDan Williams { 18456bc75619SDan Williams struct nfit_test *nfit_test = to_nfit_test(dev); 18466bc75619SDan Williams 18476bc75619SDan Williams kfree(nfit_test); 18486bc75619SDan Williams } 18496bc75619SDan Williams 18506bc75619SDan Williams static const struct platform_device_id nfit_test_id[] = { 18516bc75619SDan Williams { KBUILD_MODNAME }, 18526bc75619SDan Williams { }, 18536bc75619SDan Williams }; 18546bc75619SDan Williams 18556bc75619SDan Williams static struct platform_driver nfit_test_driver = { 18566bc75619SDan Williams .probe = nfit_test_probe, 18576bc75619SDan Williams .remove = nfit_test_remove, 18586bc75619SDan Williams .driver = { 18596bc75619SDan Williams .name = KBUILD_MODNAME, 18606bc75619SDan Williams }, 18616bc75619SDan Williams .id_table = nfit_test_id, 18626bc75619SDan Williams }; 18636bc75619SDan Williams 18646bc75619SDan Williams static __init int nfit_test_init(void) 18656bc75619SDan Williams { 18666bc75619SDan Williams int rc, i; 18676bc75619SDan Williams 1868*a7de92daSDan Williams nfit_test_setup(nfit_test_lookup, nfit_test_evaluate_dsm); 1869231bf117SDan Williams 1870*a7de92daSDan Williams nfit_test_dimm = class_create(THIS_MODULE, "nfit_test_dimm"); 1871*a7de92daSDan Williams if (IS_ERR(nfit_test_dimm)) { 1872*a7de92daSDan Williams rc = PTR_ERR(nfit_test_dimm); 1873*a7de92daSDan Williams goto err_register; 1874*a7de92daSDan Williams } 18756bc75619SDan Williams 18766bc75619SDan Williams for (i = 0; i < NUM_NFITS; i++) { 18776bc75619SDan Williams struct nfit_test *nfit_test; 18786bc75619SDan Williams struct platform_device *pdev; 18796bc75619SDan Williams 18806bc75619SDan Williams nfit_test = kzalloc(sizeof(*nfit_test), GFP_KERNEL); 18816bc75619SDan Williams if (!nfit_test) { 18826bc75619SDan Williams rc = -ENOMEM; 18836bc75619SDan Williams goto err_register; 18846bc75619SDan Williams } 18856bc75619SDan Williams INIT_LIST_HEAD(&nfit_test->resources); 18866bc75619SDan Williams switch (i) { 18876bc75619SDan Williams case 0: 18886bc75619SDan Williams nfit_test->num_pm = NUM_PM; 18896bc75619SDan Williams nfit_test->num_dcr = NUM_DCR; 18906bc75619SDan Williams nfit_test->alloc = nfit_test0_alloc; 18916bc75619SDan Williams nfit_test->setup = nfit_test0_setup; 18926bc75619SDan Williams break; 18936bc75619SDan Williams case 1: 18946bc75619SDan Williams nfit_test->num_pm = 1; 18956bc75619SDan Williams nfit_test->alloc = nfit_test1_alloc; 18966bc75619SDan Williams nfit_test->setup = nfit_test1_setup; 18976bc75619SDan Williams break; 18986bc75619SDan Williams default: 18996bc75619SDan Williams rc = -EINVAL; 19006bc75619SDan Williams goto err_register; 19016bc75619SDan Williams } 19026bc75619SDan Williams pdev = &nfit_test->pdev; 19036bc75619SDan Williams pdev->name = KBUILD_MODNAME; 19046bc75619SDan Williams pdev->id = i; 19056bc75619SDan Williams pdev->dev.release = nfit_test_release; 19066bc75619SDan Williams rc = platform_device_register(pdev); 19076bc75619SDan Williams if (rc) { 19086bc75619SDan Williams put_device(&pdev->dev); 19096bc75619SDan Williams goto err_register; 19106bc75619SDan Williams } 19116bc75619SDan Williams 19126bc75619SDan Williams rc = dma_coerce_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64)); 19136bc75619SDan Williams if (rc) 19146bc75619SDan Williams goto err_register; 19156bc75619SDan Williams 19166bc75619SDan Williams instances[i] = nfit_test; 19176bc75619SDan Williams } 19186bc75619SDan Williams 19196bc75619SDan Williams rc = platform_driver_register(&nfit_test_driver); 19206bc75619SDan Williams if (rc) 19216bc75619SDan Williams goto err_register; 19226bc75619SDan Williams return 0; 19236bc75619SDan Williams 19246bc75619SDan Williams err_register: 19256bc75619SDan Williams for (i = 0; i < NUM_NFITS; i++) 19266bc75619SDan Williams if (instances[i]) 19276bc75619SDan Williams platform_device_unregister(&instances[i]->pdev); 19286bc75619SDan Williams nfit_test_teardown(); 19296bc75619SDan Williams return rc; 19306bc75619SDan Williams } 19316bc75619SDan Williams 19326bc75619SDan Williams static __exit void nfit_test_exit(void) 19336bc75619SDan Williams { 19346bc75619SDan Williams int i; 19356bc75619SDan Williams 19366bc75619SDan Williams platform_driver_unregister(&nfit_test_driver); 19376bc75619SDan Williams for (i = 0; i < NUM_NFITS; i++) 19386bc75619SDan Williams platform_device_unregister(&instances[i]->pdev); 19396bc75619SDan Williams nfit_test_teardown(); 1940231bf117SDan Williams class_destroy(nfit_test_dimm); 19416bc75619SDan Williams } 19426bc75619SDan Williams 19436bc75619SDan Williams module_init(nfit_test_init); 19446bc75619SDan Williams module_exit(nfit_test_exit); 19456bc75619SDan Williams MODULE_LICENSE("GPL v2"); 19466bc75619SDan Williams MODULE_AUTHOR("Intel Corporation"); 1947