|  | // SPDX-License-Identifier: GPL-2.0-only | 
|  | /* | 
|  | * Block Translation Table | 
|  | * Copyright (c) 2014-2015, Intel Corporation. | 
|  | */ | 
|  | #include <linux/highmem.h> | 
|  | #include <linux/debugfs.h> | 
|  | #include <linux/blkdev.h> | 
|  | #include <linux/blk-integrity.h> | 
|  | #include <linux/pagemap.h> | 
|  | #include <linux/module.h> | 
|  | #include <linux/device.h> | 
|  | #include <linux/mutex.h> | 
|  | #include <linux/hdreg.h> | 
|  | #include <linux/sizes.h> | 
|  | #include <linux/ndctl.h> | 
|  | #include <linux/fs.h> | 
|  | #include <linux/nd.h> | 
|  | #include <linux/backing-dev.h> | 
|  | #include <linux/cleanup.h> | 
|  | #include "btt.h" | 
|  | #include "nd.h" | 
|  |  | 
|  | enum log_ent_request { | 
|  | LOG_NEW_ENT = 0, | 
|  | LOG_OLD_ENT | 
|  | }; | 
|  |  | 
|  | static struct device *to_dev(struct arena_info *arena) | 
|  | { | 
|  | return &arena->nd_btt->dev; | 
|  | } | 
|  |  | 
|  | static u64 adjust_initial_offset(struct nd_btt *nd_btt, u64 offset) | 
|  | { | 
|  | return offset + nd_btt->initial_offset; | 
|  | } | 
|  |  | 
|  | static int arena_read_bytes(struct arena_info *arena, resource_size_t offset, | 
|  | void *buf, size_t n, unsigned long flags) | 
|  | { | 
|  | struct nd_btt *nd_btt = arena->nd_btt; | 
|  | struct nd_namespace_common *ndns = nd_btt->ndns; | 
|  |  | 
|  | /* arena offsets may be shifted from the base of the device */ | 
|  | offset = adjust_initial_offset(nd_btt, offset); | 
|  | return nvdimm_read_bytes(ndns, offset, buf, n, flags); | 
|  | } | 
|  |  | 
|  | static int arena_write_bytes(struct arena_info *arena, resource_size_t offset, | 
|  | void *buf, size_t n, unsigned long flags) | 
|  | { | 
|  | struct nd_btt *nd_btt = arena->nd_btt; | 
|  | struct nd_namespace_common *ndns = nd_btt->ndns; | 
|  |  | 
|  | /* arena offsets may be shifted from the base of the device */ | 
|  | offset = adjust_initial_offset(nd_btt, offset); | 
|  | return nvdimm_write_bytes(ndns, offset, buf, n, flags); | 
|  | } | 
|  |  | 
|  | static int btt_info_write(struct arena_info *arena, struct btt_sb *super) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | /* | 
|  | * infooff and info2off should always be at least 512B aligned. | 
|  | * We rely on that to make sure rw_bytes does error clearing | 
|  | * correctly, so make sure that is the case. | 
|  | */ | 
|  | dev_WARN_ONCE(to_dev(arena), !IS_ALIGNED(arena->infooff, 512), | 
|  | "arena->infooff: %#llx is unaligned\n", arena->infooff); | 
|  | dev_WARN_ONCE(to_dev(arena), !IS_ALIGNED(arena->info2off, 512), | 
|  | "arena->info2off: %#llx is unaligned\n", arena->info2off); | 
|  |  | 
|  | ret = arena_write_bytes(arena, arena->info2off, super, | 
|  | sizeof(struct btt_sb), 0); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | return arena_write_bytes(arena, arena->infooff, super, | 
|  | sizeof(struct btt_sb), 0); | 
|  | } | 
|  |  | 
|  | static int btt_info_read(struct arena_info *arena, struct btt_sb *super) | 
|  | { | 
|  | return arena_read_bytes(arena, arena->infooff, super, | 
|  | sizeof(struct btt_sb), 0); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * 'raw' version of btt_map write | 
|  | * Assumptions: | 
|  | *   mapping is in little-endian | 
|  | *   mapping contains 'E' and 'Z' flags as desired | 
|  | */ | 
|  | static int __btt_map_write(struct arena_info *arena, u32 lba, __le32 mapping, | 
|  | unsigned long flags) | 
|  | { | 
|  | u64 ns_off = arena->mapoff + (lba * MAP_ENT_SIZE); | 
|  |  | 
|  | if (unlikely(lba >= arena->external_nlba)) | 
|  | dev_err_ratelimited(to_dev(arena), | 
|  | "%s: lba %#x out of range (max: %#x)\n", | 
|  | __func__, lba, arena->external_nlba); | 
|  | return arena_write_bytes(arena, ns_off, &mapping, MAP_ENT_SIZE, flags); | 
|  | } | 
|  |  | 
|  | static int btt_map_write(struct arena_info *arena, u32 lba, u32 mapping, | 
|  | u32 z_flag, u32 e_flag, unsigned long rwb_flags) | 
|  | { | 
|  | u32 ze; | 
|  | __le32 mapping_le; | 
|  |  | 
|  | /* | 
|  | * This 'mapping' is supposed to be just the LBA mapping, without | 
|  | * any flags set, so strip the flag bits. | 
|  | */ | 
|  | mapping = ent_lba(mapping); | 
|  |  | 
|  | ze = (z_flag << 1) + e_flag; | 
|  | switch (ze) { | 
|  | case 0: | 
|  | /* | 
|  | * We want to set neither of the Z or E flags, and | 
|  | * in the actual layout, this means setting the bit | 
|  | * positions of both to '1' to indicate a 'normal' | 
|  | * map entry | 
|  | */ | 
|  | mapping |= MAP_ENT_NORMAL; | 
|  | break; | 
|  | case 1: | 
|  | mapping |= (1 << MAP_ERR_SHIFT); | 
|  | break; | 
|  | case 2: | 
|  | mapping |= (1 << MAP_TRIM_SHIFT); | 
|  | break; | 
|  | default: | 
|  | /* | 
|  | * The case where Z and E are both sent in as '1' could be | 
|  | * construed as a valid 'normal' case, but we decide not to, | 
|  | * to avoid confusion | 
|  | */ | 
|  | dev_err_ratelimited(to_dev(arena), | 
|  | "Invalid use of Z and E flags\n"); | 
|  | return -EIO; | 
|  | } | 
|  |  | 
|  | mapping_le = cpu_to_le32(mapping); | 
|  | return __btt_map_write(arena, lba, mapping_le, rwb_flags); | 
|  | } | 
|  |  | 
|  | static int btt_map_read(struct arena_info *arena, u32 lba, u32 *mapping, | 
|  | int *trim, int *error, unsigned long rwb_flags) | 
|  | { | 
|  | int ret; | 
|  | __le32 in; | 
|  | u32 raw_mapping, postmap, ze, z_flag, e_flag; | 
|  | u64 ns_off = arena->mapoff + (lba * MAP_ENT_SIZE); | 
|  |  | 
|  | if (unlikely(lba >= arena->external_nlba)) | 
|  | dev_err_ratelimited(to_dev(arena), | 
|  | "%s: lba %#x out of range (max: %#x)\n", | 
|  | __func__, lba, arena->external_nlba); | 
|  |  | 
|  | ret = arena_read_bytes(arena, ns_off, &in, MAP_ENT_SIZE, rwb_flags); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | raw_mapping = le32_to_cpu(in); | 
|  |  | 
|  | z_flag = ent_z_flag(raw_mapping); | 
|  | e_flag = ent_e_flag(raw_mapping); | 
|  | ze = (z_flag << 1) + e_flag; | 
|  | postmap = ent_lba(raw_mapping); | 
|  |  | 
|  | /* Reuse the {z,e}_flag variables for *trim and *error */ | 
|  | z_flag = 0; | 
|  | e_flag = 0; | 
|  |  | 
|  | switch (ze) { | 
|  | case 0: | 
|  | /* Initial state. Return postmap = premap */ | 
|  | *mapping = lba; | 
|  | break; | 
|  | case 1: | 
|  | *mapping = postmap; | 
|  | e_flag = 1; | 
|  | break; | 
|  | case 2: | 
|  | *mapping = postmap; | 
|  | z_flag = 1; | 
|  | break; | 
|  | case 3: | 
|  | *mapping = postmap; | 
|  | break; | 
|  | default: | 
|  | return -EIO; | 
|  | } | 
|  |  | 
|  | if (trim) | 
|  | *trim = z_flag; | 
|  | if (error) | 
|  | *error = e_flag; | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static int btt_log_group_read(struct arena_info *arena, u32 lane, | 
|  | struct log_group *log) | 
|  | { | 
|  | return arena_read_bytes(arena, | 
|  | arena->logoff + (lane * LOG_GRP_SIZE), log, | 
|  | LOG_GRP_SIZE, 0); | 
|  | } | 
|  |  | 
|  | static struct dentry *debugfs_root; | 
|  |  | 
|  | static void arena_debugfs_init(struct arena_info *a, struct dentry *parent, | 
|  | int idx) | 
|  | { | 
|  | char dirname[32]; | 
|  | struct dentry *d; | 
|  |  | 
|  | /* If for some reason, parent bttN was not created, exit */ | 
|  | if (!parent) | 
|  | return; | 
|  |  | 
|  | snprintf(dirname, 32, "arena%d", idx); | 
|  | d = debugfs_create_dir(dirname, parent); | 
|  | if (IS_ERR_OR_NULL(d)) | 
|  | return; | 
|  | a->debugfs_dir = d; | 
|  |  | 
|  | debugfs_create_x64("size", S_IRUGO, d, &a->size); | 
|  | debugfs_create_x64("external_lba_start", S_IRUGO, d, | 
|  | &a->external_lba_start); | 
|  | debugfs_create_x32("internal_nlba", S_IRUGO, d, &a->internal_nlba); | 
|  | debugfs_create_u32("internal_lbasize", S_IRUGO, d, | 
|  | &a->internal_lbasize); | 
|  | debugfs_create_x32("external_nlba", S_IRUGO, d, &a->external_nlba); | 
|  | debugfs_create_u32("external_lbasize", S_IRUGO, d, | 
|  | &a->external_lbasize); | 
|  | debugfs_create_u32("nfree", S_IRUGO, d, &a->nfree); | 
|  | debugfs_create_u16("version_major", S_IRUGO, d, &a->version_major); | 
|  | debugfs_create_u16("version_minor", S_IRUGO, d, &a->version_minor); | 
|  | debugfs_create_x64("nextoff", S_IRUGO, d, &a->nextoff); | 
|  | debugfs_create_x64("infooff", S_IRUGO, d, &a->infooff); | 
|  | debugfs_create_x64("dataoff", S_IRUGO, d, &a->dataoff); | 
|  | debugfs_create_x64("mapoff", S_IRUGO, d, &a->mapoff); | 
|  | debugfs_create_x64("logoff", S_IRUGO, d, &a->logoff); | 
|  | debugfs_create_x64("info2off", S_IRUGO, d, &a->info2off); | 
|  | debugfs_create_x32("flags", S_IRUGO, d, &a->flags); | 
|  | debugfs_create_u32("log_index_0", S_IRUGO, d, &a->log_index[0]); | 
|  | debugfs_create_u32("log_index_1", S_IRUGO, d, &a->log_index[1]); | 
|  | } | 
|  |  | 
|  | static void btt_debugfs_init(struct btt *btt) | 
|  | { | 
|  | int i = 0; | 
|  | struct arena_info *arena; | 
|  |  | 
|  | btt->debugfs_dir = debugfs_create_dir(dev_name(&btt->nd_btt->dev), | 
|  | debugfs_root); | 
|  | if (IS_ERR_OR_NULL(btt->debugfs_dir)) | 
|  | return; | 
|  |  | 
|  | list_for_each_entry(arena, &btt->arena_list, list) { | 
|  | arena_debugfs_init(arena, btt->debugfs_dir, i); | 
|  | i++; | 
|  | } | 
|  | } | 
|  |  | 
|  | static u32 log_seq(struct log_group *log, int log_idx) | 
|  | { | 
|  | return le32_to_cpu(log->ent[log_idx].seq); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * This function accepts two log entries, and uses the | 
|  | * sequence number to find the 'older' entry. | 
|  | * It also updates the sequence number in this old entry to | 
|  | * make it the 'new' one if the mark_flag is set. | 
|  | * Finally, it returns which of the entries was the older one. | 
|  | * | 
|  | * TODO The logic feels a bit kludge-y. make it better.. | 
|  | */ | 
|  | static int btt_log_get_old(struct arena_info *a, struct log_group *log) | 
|  | { | 
|  | int idx0 = a->log_index[0]; | 
|  | int idx1 = a->log_index[1]; | 
|  | int old; | 
|  |  | 
|  | /* | 
|  | * the first ever time this is seen, the entry goes into [0] | 
|  | * the next time, the following logic works out to put this | 
|  | * (next) entry into [1] | 
|  | */ | 
|  | if (log_seq(log, idx0) == 0) { | 
|  | log->ent[idx0].seq = cpu_to_le32(1); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | if (log_seq(log, idx0) == log_seq(log, idx1)) | 
|  | return -EINVAL; | 
|  | if (log_seq(log, idx0) + log_seq(log, idx1) > 5) | 
|  | return -EINVAL; | 
|  |  | 
|  | if (log_seq(log, idx0) < log_seq(log, idx1)) { | 
|  | if ((log_seq(log, idx1) - log_seq(log, idx0)) == 1) | 
|  | old = 0; | 
|  | else | 
|  | old = 1; | 
|  | } else { | 
|  | if ((log_seq(log, idx0) - log_seq(log, idx1)) == 1) | 
|  | old = 1; | 
|  | else | 
|  | old = 0; | 
|  | } | 
|  |  | 
|  | return old; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * This function copies the desired (old/new) log entry into ent if | 
|  | * it is not NULL. It returns the sub-slot number (0 or 1) | 
|  | * where the desired log entry was found. Negative return values | 
|  | * indicate errors. | 
|  | */ | 
|  | static int btt_log_read(struct arena_info *arena, u32 lane, | 
|  | struct log_entry *ent, int old_flag) | 
|  | { | 
|  | int ret; | 
|  | int old_ent, ret_ent; | 
|  | struct log_group log; | 
|  |  | 
|  | ret = btt_log_group_read(arena, lane, &log); | 
|  | if (ret) | 
|  | return -EIO; | 
|  |  | 
|  | old_ent = btt_log_get_old(arena, &log); | 
|  | if (old_ent < 0 || old_ent > 1) { | 
|  | dev_err(to_dev(arena), | 
|  | "log corruption (%d): lane %d seq [%d, %d]\n", | 
|  | old_ent, lane, log.ent[arena->log_index[0]].seq, | 
|  | log.ent[arena->log_index[1]].seq); | 
|  | /* TODO set error state? */ | 
|  | return -EIO; | 
|  | } | 
|  |  | 
|  | ret_ent = (old_flag ? old_ent : (1 - old_ent)); | 
|  |  | 
|  | if (ent != NULL) | 
|  | memcpy(ent, &log.ent[arena->log_index[ret_ent]], LOG_ENT_SIZE); | 
|  |  | 
|  | return ret_ent; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * This function commits a log entry to media | 
|  | * It does _not_ prepare the freelist entry for the next write | 
|  | * btt_flog_write is the wrapper for updating the freelist elements | 
|  | */ | 
|  | static int __btt_log_write(struct arena_info *arena, u32 lane, | 
|  | u32 sub, struct log_entry *ent, unsigned long flags) | 
|  | { | 
|  | int ret; | 
|  | u32 group_slot = arena->log_index[sub]; | 
|  | unsigned int log_half = LOG_ENT_SIZE / 2; | 
|  | void *src = ent; | 
|  | u64 ns_off; | 
|  |  | 
|  | ns_off = arena->logoff + (lane * LOG_GRP_SIZE) + | 
|  | (group_slot * LOG_ENT_SIZE); | 
|  | /* split the 16B write into atomic, durable halves */ | 
|  | ret = arena_write_bytes(arena, ns_off, src, log_half, flags); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | ns_off += log_half; | 
|  | src += log_half; | 
|  | return arena_write_bytes(arena, ns_off, src, log_half, flags); | 
|  | } | 
|  |  | 
|  | static int btt_flog_write(struct arena_info *arena, u32 lane, u32 sub, | 
|  | struct log_entry *ent) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | ret = __btt_log_write(arena, lane, sub, ent, NVDIMM_IO_ATOMIC); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | /* prepare the next free entry */ | 
|  | arena->freelist[lane].sub = 1 - arena->freelist[lane].sub; | 
|  | if (++(arena->freelist[lane].seq) == 4) | 
|  | arena->freelist[lane].seq = 1; | 
|  | if (ent_e_flag(le32_to_cpu(ent->old_map))) | 
|  | arena->freelist[lane].has_err = 1; | 
|  | arena->freelist[lane].block = ent_lba(le32_to_cpu(ent->old_map)); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * This function initializes the BTT map to the initial state, which is | 
|  | * all-zeroes, and indicates an identity mapping | 
|  | */ | 
|  | static int btt_map_init(struct arena_info *arena) | 
|  | { | 
|  | int ret = -EINVAL; | 
|  | void *zerobuf; | 
|  | size_t offset = 0; | 
|  | size_t chunk_size = SZ_2M; | 
|  | size_t mapsize = arena->logoff - arena->mapoff; | 
|  |  | 
|  | zerobuf = kzalloc(chunk_size, GFP_KERNEL); | 
|  | if (!zerobuf) | 
|  | return -ENOMEM; | 
|  |  | 
|  | /* | 
|  | * mapoff should always be at least 512B  aligned. We rely on that to | 
|  | * make sure rw_bytes does error clearing correctly, so make sure that | 
|  | * is the case. | 
|  | */ | 
|  | dev_WARN_ONCE(to_dev(arena), !IS_ALIGNED(arena->mapoff, 512), | 
|  | "arena->mapoff: %#llx is unaligned\n", arena->mapoff); | 
|  |  | 
|  | while (mapsize) { | 
|  | size_t size = min(mapsize, chunk_size); | 
|  |  | 
|  | dev_WARN_ONCE(to_dev(arena), size < 512, | 
|  | "chunk size: %#zx is unaligned\n", size); | 
|  | ret = arena_write_bytes(arena, arena->mapoff + offset, zerobuf, | 
|  | size, 0); | 
|  | if (ret) | 
|  | goto free; | 
|  |  | 
|  | offset += size; | 
|  | mapsize -= size; | 
|  | cond_resched(); | 
|  | } | 
|  |  | 
|  | free: | 
|  | kfree(zerobuf); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * This function initializes the BTT log with 'fake' entries pointing | 
|  | * to the initial reserved set of blocks as being free | 
|  | */ | 
|  | static int btt_log_init(struct arena_info *arena) | 
|  | { | 
|  | size_t logsize = arena->info2off - arena->logoff; | 
|  | size_t chunk_size = SZ_4K, offset = 0; | 
|  | struct log_entry ent; | 
|  | void *zerobuf; | 
|  | int ret; | 
|  | u32 i; | 
|  |  | 
|  | zerobuf = kzalloc(chunk_size, GFP_KERNEL); | 
|  | if (!zerobuf) | 
|  | return -ENOMEM; | 
|  | /* | 
|  | * logoff should always be at least 512B  aligned. We rely on that to | 
|  | * make sure rw_bytes does error clearing correctly, so make sure that | 
|  | * is the case. | 
|  | */ | 
|  | dev_WARN_ONCE(to_dev(arena), !IS_ALIGNED(arena->logoff, 512), | 
|  | "arena->logoff: %#llx is unaligned\n", arena->logoff); | 
|  |  | 
|  | while (logsize) { | 
|  | size_t size = min(logsize, chunk_size); | 
|  |  | 
|  | dev_WARN_ONCE(to_dev(arena), size < 512, | 
|  | "chunk size: %#zx is unaligned\n", size); | 
|  | ret = arena_write_bytes(arena, arena->logoff + offset, zerobuf, | 
|  | size, 0); | 
|  | if (ret) | 
|  | goto free; | 
|  |  | 
|  | offset += size; | 
|  | logsize -= size; | 
|  | cond_resched(); | 
|  | } | 
|  |  | 
|  | for (i = 0; i < arena->nfree; i++) { | 
|  | ent.lba = cpu_to_le32(i); | 
|  | ent.old_map = cpu_to_le32(arena->external_nlba + i); | 
|  | ent.new_map = cpu_to_le32(arena->external_nlba + i); | 
|  | ent.seq = cpu_to_le32(LOG_SEQ_INIT); | 
|  | ret = __btt_log_write(arena, i, 0, &ent, 0); | 
|  | if (ret) | 
|  | goto free; | 
|  | } | 
|  |  | 
|  | free: | 
|  | kfree(zerobuf); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static u64 to_namespace_offset(struct arena_info *arena, u64 lba) | 
|  | { | 
|  | return arena->dataoff + ((u64)lba * arena->internal_lbasize); | 
|  | } | 
|  |  | 
|  | static int arena_clear_freelist_error(struct arena_info *arena, u32 lane) | 
|  | { | 
|  | int ret = 0; | 
|  |  | 
|  | if (arena->freelist[lane].has_err) { | 
|  | void *zero_page = page_address(ZERO_PAGE(0)); | 
|  | u32 lba = arena->freelist[lane].block; | 
|  | u64 nsoff = to_namespace_offset(arena, lba); | 
|  | unsigned long len = arena->sector_size; | 
|  |  | 
|  | mutex_lock(&arena->err_lock); | 
|  |  | 
|  | while (len) { | 
|  | unsigned long chunk = min(len, PAGE_SIZE); | 
|  |  | 
|  | ret = arena_write_bytes(arena, nsoff, zero_page, | 
|  | chunk, 0); | 
|  | if (ret) | 
|  | break; | 
|  | len -= chunk; | 
|  | nsoff += chunk; | 
|  | if (len == 0) | 
|  | arena->freelist[lane].has_err = 0; | 
|  | } | 
|  | mutex_unlock(&arena->err_lock); | 
|  | } | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static int btt_freelist_init(struct arena_info *arena) | 
|  | { | 
|  | int new, ret; | 
|  | struct log_entry log_new; | 
|  | u32 i, map_entry, log_oldmap, log_newmap; | 
|  |  | 
|  | arena->freelist = kcalloc(arena->nfree, sizeof(struct free_entry), | 
|  | GFP_KERNEL); | 
|  | if (!arena->freelist) | 
|  | return -ENOMEM; | 
|  |  | 
|  | for (i = 0; i < arena->nfree; i++) { | 
|  | new = btt_log_read(arena, i, &log_new, LOG_NEW_ENT); | 
|  | if (new < 0) | 
|  | return new; | 
|  |  | 
|  | /* old and new map entries with any flags stripped out */ | 
|  | log_oldmap = ent_lba(le32_to_cpu(log_new.old_map)); | 
|  | log_newmap = ent_lba(le32_to_cpu(log_new.new_map)); | 
|  |  | 
|  | /* sub points to the next one to be overwritten */ | 
|  | arena->freelist[i].sub = 1 - new; | 
|  | arena->freelist[i].seq = nd_inc_seq(le32_to_cpu(log_new.seq)); | 
|  | arena->freelist[i].block = log_oldmap; | 
|  |  | 
|  | /* | 
|  | * FIXME: if error clearing fails during init, we want to make | 
|  | * the BTT read-only | 
|  | */ | 
|  | if (ent_e_flag(le32_to_cpu(log_new.old_map)) && | 
|  | !ent_normal(le32_to_cpu(log_new.old_map))) { | 
|  | arena->freelist[i].has_err = 1; | 
|  | ret = arena_clear_freelist_error(arena, i); | 
|  | if (ret) | 
|  | dev_err_ratelimited(to_dev(arena), | 
|  | "Unable to clear known errors\n"); | 
|  | } | 
|  |  | 
|  | /* This implies a newly created or untouched flog entry */ | 
|  | if (log_oldmap == log_newmap) | 
|  | continue; | 
|  |  | 
|  | /* Check if map recovery is needed */ | 
|  | ret = btt_map_read(arena, le32_to_cpu(log_new.lba), &map_entry, | 
|  | NULL, NULL, 0); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | /* | 
|  | * The map_entry from btt_read_map is stripped of any flag bits, | 
|  | * so use the stripped out versions from the log as well for | 
|  | * testing whether recovery is needed. For restoration, use the | 
|  | * 'raw' version of the log entries as that captured what we | 
|  | * were going to write originally. | 
|  | */ | 
|  | if ((log_newmap != map_entry) && (log_oldmap == map_entry)) { | 
|  | /* | 
|  | * Last transaction wrote the flog, but wasn't able | 
|  | * to complete the map write. So fix up the map. | 
|  | */ | 
|  | ret = btt_map_write(arena, le32_to_cpu(log_new.lba), | 
|  | le32_to_cpu(log_new.new_map), 0, 0, 0); | 
|  | if (ret) | 
|  | return ret; | 
|  | } | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static bool ent_is_padding(struct log_entry *ent) | 
|  | { | 
|  | return (ent->lba == 0) && (ent->old_map == 0) && (ent->new_map == 0) | 
|  | && (ent->seq == 0); | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Detecting valid log indices: We read a log group (see the comments in btt.h | 
|  | * for a description of a 'log_group' and its 'slots'), and iterate over its | 
|  | * four slots. We expect that a padding slot will be all-zeroes, and use this | 
|  | * to detect a padding slot vs. an actual entry. | 
|  | * | 
|  | * If a log_group is in the initial state, i.e. hasn't been used since the | 
|  | * creation of this BTT layout, it will have three of the four slots with | 
|  | * zeroes. We skip over these log_groups for the detection of log_index. If | 
|  | * all log_groups are in the initial state (i.e. the BTT has never been | 
|  | * written to), it is safe to assume the 'new format' of log entries in slots | 
|  | * (0, 1). | 
|  | */ | 
|  | static int log_set_indices(struct arena_info *arena) | 
|  | { | 
|  | bool idx_set = false, initial_state = true; | 
|  | int ret, log_index[2] = {-1, -1}; | 
|  | u32 i, j, next_idx = 0; | 
|  | struct log_group log; | 
|  | u32 pad_count = 0; | 
|  |  | 
|  | for (i = 0; i < arena->nfree; i++) { | 
|  | ret = btt_log_group_read(arena, i, &log); | 
|  | if (ret < 0) | 
|  | return ret; | 
|  |  | 
|  | for (j = 0; j < 4; j++) { | 
|  | if (!idx_set) { | 
|  | if (ent_is_padding(&log.ent[j])) { | 
|  | pad_count++; | 
|  | continue; | 
|  | } else { | 
|  | /* Skip if index has been recorded */ | 
|  | if ((next_idx == 1) && | 
|  | (j == log_index[0])) | 
|  | continue; | 
|  | /* valid entry, record index */ | 
|  | log_index[next_idx] = j; | 
|  | next_idx++; | 
|  | } | 
|  | if (next_idx == 2) { | 
|  | /* two valid entries found */ | 
|  | idx_set = true; | 
|  | } else if (next_idx > 2) { | 
|  | /* too many valid indices */ | 
|  | return -ENXIO; | 
|  | } | 
|  | } else { | 
|  | /* | 
|  | * once the indices have been set, just verify | 
|  | * that all subsequent log groups are either in | 
|  | * their initial state or follow the same | 
|  | * indices. | 
|  | */ | 
|  | if (j == log_index[0]) { | 
|  | /* entry must be 'valid' */ | 
|  | if (ent_is_padding(&log.ent[j])) | 
|  | return -ENXIO; | 
|  | } else if (j == log_index[1]) { | 
|  | ; | 
|  | /* | 
|  | * log_index[1] can be padding if the | 
|  | * lane never got used and it is still | 
|  | * in the initial state (three 'padding' | 
|  | * entries) | 
|  | */ | 
|  | } else { | 
|  | /* entry must be invalid (padding) */ | 
|  | if (!ent_is_padding(&log.ent[j])) | 
|  | return -ENXIO; | 
|  | } | 
|  | } | 
|  | } | 
|  | /* | 
|  | * If any of the log_groups have more than one valid, | 
|  | * non-padding entry, then the we are no longer in the | 
|  | * initial_state | 
|  | */ | 
|  | if (pad_count < 3) | 
|  | initial_state = false; | 
|  | pad_count = 0; | 
|  | } | 
|  |  | 
|  | if (!initial_state && !idx_set) | 
|  | return -ENXIO; | 
|  |  | 
|  | /* | 
|  | * If all the entries in the log were in the initial state, | 
|  | * assume new padding scheme | 
|  | */ | 
|  | if (initial_state) | 
|  | log_index[1] = 1; | 
|  |  | 
|  | /* | 
|  | * Only allow the known permutations of log/padding indices, | 
|  | * i.e. (0, 1), and (0, 2) | 
|  | */ | 
|  | if ((log_index[0] == 0) && ((log_index[1] == 1) || (log_index[1] == 2))) | 
|  | ; /* known index possibilities */ | 
|  | else { | 
|  | dev_err(to_dev(arena), "Found an unknown padding scheme\n"); | 
|  | return -ENXIO; | 
|  | } | 
|  |  | 
|  | arena->log_index[0] = log_index[0]; | 
|  | arena->log_index[1] = log_index[1]; | 
|  | dev_dbg(to_dev(arena), "log_index_0 = %d\n", log_index[0]); | 
|  | dev_dbg(to_dev(arena), "log_index_1 = %d\n", log_index[1]); | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int btt_rtt_init(struct arena_info *arena) | 
|  | { | 
|  | arena->rtt = kcalloc(arena->nfree, sizeof(u32), GFP_KERNEL); | 
|  | if (arena->rtt == NULL) | 
|  | return -ENOMEM; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int btt_maplocks_init(struct arena_info *arena) | 
|  | { | 
|  | u32 i; | 
|  |  | 
|  | arena->map_locks = kcalloc(arena->nfree, sizeof(struct aligned_lock), | 
|  | GFP_KERNEL); | 
|  | if (!arena->map_locks) | 
|  | return -ENOMEM; | 
|  |  | 
|  | for (i = 0; i < arena->nfree; i++) | 
|  | spin_lock_init(&arena->map_locks[i].lock); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static struct arena_info *alloc_arena(struct btt *btt, size_t size, | 
|  | size_t start, size_t arena_off) | 
|  | { | 
|  | struct arena_info *arena; | 
|  | u64 logsize, mapsize, datasize; | 
|  | u64 available = size; | 
|  |  | 
|  | arena = kzalloc(sizeof(*arena), GFP_KERNEL); | 
|  | if (!arena) | 
|  | return NULL; | 
|  | arena->nd_btt = btt->nd_btt; | 
|  | arena->sector_size = btt->sector_size; | 
|  | mutex_init(&arena->err_lock); | 
|  |  | 
|  | if (!size) | 
|  | return arena; | 
|  |  | 
|  | arena->size = size; | 
|  | arena->external_lba_start = start; | 
|  | arena->external_lbasize = btt->lbasize; | 
|  | arena->internal_lbasize = roundup(arena->external_lbasize, | 
|  | INT_LBASIZE_ALIGNMENT); | 
|  | arena->nfree = BTT_DEFAULT_NFREE; | 
|  | arena->version_major = btt->nd_btt->version_major; | 
|  | arena->version_minor = btt->nd_btt->version_minor; | 
|  |  | 
|  | if (available % BTT_PG_SIZE) | 
|  | available -= (available % BTT_PG_SIZE); | 
|  |  | 
|  | /* Two pages are reserved for the super block and its copy */ | 
|  | available -= 2 * BTT_PG_SIZE; | 
|  |  | 
|  | /* The log takes a fixed amount of space based on nfree */ | 
|  | logsize = roundup(arena->nfree * LOG_GRP_SIZE, BTT_PG_SIZE); | 
|  | available -= logsize; | 
|  |  | 
|  | /* Calculate optimal split between map and data area */ | 
|  | arena->internal_nlba = div_u64(available - BTT_PG_SIZE, | 
|  | arena->internal_lbasize + MAP_ENT_SIZE); | 
|  | arena->external_nlba = arena->internal_nlba - arena->nfree; | 
|  |  | 
|  | mapsize = roundup((arena->external_nlba * MAP_ENT_SIZE), BTT_PG_SIZE); | 
|  | datasize = available - mapsize; | 
|  |  | 
|  | /* 'Absolute' values, relative to start of storage space */ | 
|  | arena->infooff = arena_off; | 
|  | arena->dataoff = arena->infooff + BTT_PG_SIZE; | 
|  | arena->mapoff = arena->dataoff + datasize; | 
|  | arena->logoff = arena->mapoff + mapsize; | 
|  | arena->info2off = arena->logoff + logsize; | 
|  |  | 
|  | /* Default log indices are (0,1) */ | 
|  | arena->log_index[0] = 0; | 
|  | arena->log_index[1] = 1; | 
|  | return arena; | 
|  | } | 
|  |  | 
|  | static void free_arenas(struct btt *btt) | 
|  | { | 
|  | struct arena_info *arena, *next; | 
|  |  | 
|  | list_for_each_entry_safe(arena, next, &btt->arena_list, list) { | 
|  | list_del(&arena->list); | 
|  | kfree(arena->rtt); | 
|  | kfree(arena->map_locks); | 
|  | kfree(arena->freelist); | 
|  | debugfs_remove_recursive(arena->debugfs_dir); | 
|  | kfree(arena); | 
|  | } | 
|  | } | 
|  |  | 
|  | /* | 
|  | * This function reads an existing valid btt superblock and | 
|  | * populates the corresponding arena_info struct | 
|  | */ | 
|  | static void parse_arena_meta(struct arena_info *arena, struct btt_sb *super, | 
|  | u64 arena_off) | 
|  | { | 
|  | arena->internal_nlba = le32_to_cpu(super->internal_nlba); | 
|  | arena->internal_lbasize = le32_to_cpu(super->internal_lbasize); | 
|  | arena->external_nlba = le32_to_cpu(super->external_nlba); | 
|  | arena->external_lbasize = le32_to_cpu(super->external_lbasize); | 
|  | arena->nfree = le32_to_cpu(super->nfree); | 
|  | arena->version_major = le16_to_cpu(super->version_major); | 
|  | arena->version_minor = le16_to_cpu(super->version_minor); | 
|  |  | 
|  | arena->nextoff = (super->nextoff == 0) ? 0 : (arena_off + | 
|  | le64_to_cpu(super->nextoff)); | 
|  | arena->infooff = arena_off; | 
|  | arena->dataoff = arena_off + le64_to_cpu(super->dataoff); | 
|  | arena->mapoff = arena_off + le64_to_cpu(super->mapoff); | 
|  | arena->logoff = arena_off + le64_to_cpu(super->logoff); | 
|  | arena->info2off = arena_off + le64_to_cpu(super->info2off); | 
|  |  | 
|  | arena->size = (le64_to_cpu(super->nextoff) > 0) | 
|  | ? (le64_to_cpu(super->nextoff)) | 
|  | : (arena->info2off - arena->infooff + BTT_PG_SIZE); | 
|  |  | 
|  | arena->flags = le32_to_cpu(super->flags); | 
|  | } | 
|  |  | 
|  | static int discover_arenas(struct btt *btt) | 
|  | { | 
|  | int ret = 0; | 
|  | struct arena_info *arena; | 
|  | size_t remaining = btt->rawsize; | 
|  | u64 cur_nlba = 0; | 
|  | size_t cur_off = 0; | 
|  | int num_arenas = 0; | 
|  |  | 
|  | struct btt_sb *super __free(kfree) = kzalloc(sizeof(*super), GFP_KERNEL); | 
|  | if (!super) | 
|  | return -ENOMEM; | 
|  |  | 
|  | while (remaining) { | 
|  | /* Alloc memory for arena */ | 
|  | arena = alloc_arena(btt, 0, 0, 0); | 
|  | if (!arena) | 
|  | return -ENOMEM; | 
|  |  | 
|  | arena->infooff = cur_off; | 
|  | ret = btt_info_read(arena, super); | 
|  | if (ret) | 
|  | goto out; | 
|  |  | 
|  | if (!nd_btt_arena_is_valid(btt->nd_btt, super)) { | 
|  | if (remaining == btt->rawsize) { | 
|  | btt->init_state = INIT_NOTFOUND; | 
|  | dev_info(to_dev(arena), "No existing arenas\n"); | 
|  | goto out; | 
|  | } else { | 
|  | dev_err(to_dev(arena), | 
|  | "Found corrupted metadata!\n"); | 
|  | ret = -ENODEV; | 
|  | goto out; | 
|  | } | 
|  | } | 
|  |  | 
|  | arena->external_lba_start = cur_nlba; | 
|  | parse_arena_meta(arena, super, cur_off); | 
|  |  | 
|  | ret = log_set_indices(arena); | 
|  | if (ret) { | 
|  | dev_err(to_dev(arena), | 
|  | "Unable to deduce log/padding indices\n"); | 
|  | goto out; | 
|  | } | 
|  |  | 
|  | ret = btt_freelist_init(arena); | 
|  | if (ret) | 
|  | goto out; | 
|  |  | 
|  | ret = btt_rtt_init(arena); | 
|  | if (ret) | 
|  | goto out; | 
|  |  | 
|  | ret = btt_maplocks_init(arena); | 
|  | if (ret) | 
|  | goto out; | 
|  |  | 
|  | list_add_tail(&arena->list, &btt->arena_list); | 
|  |  | 
|  | remaining -= arena->size; | 
|  | cur_off += arena->size; | 
|  | cur_nlba += arena->external_nlba; | 
|  | num_arenas++; | 
|  |  | 
|  | if (arena->nextoff == 0) | 
|  | break; | 
|  | } | 
|  | btt->num_arenas = num_arenas; | 
|  | btt->nlba = cur_nlba; | 
|  | btt->init_state = INIT_READY; | 
|  |  | 
|  | return ret; | 
|  |  | 
|  | out: | 
|  | kfree(arena); | 
|  | free_arenas(btt); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static int create_arenas(struct btt *btt) | 
|  | { | 
|  | size_t remaining = btt->rawsize; | 
|  | size_t cur_off = 0; | 
|  |  | 
|  | while (remaining) { | 
|  | struct arena_info *arena; | 
|  | size_t arena_size = min_t(u64, ARENA_MAX_SIZE, remaining); | 
|  |  | 
|  | remaining -= arena_size; | 
|  | if (arena_size < ARENA_MIN_SIZE) | 
|  | break; | 
|  |  | 
|  | arena = alloc_arena(btt, arena_size, btt->nlba, cur_off); | 
|  | if (!arena) { | 
|  | free_arenas(btt); | 
|  | return -ENOMEM; | 
|  | } | 
|  | btt->nlba += arena->external_nlba; | 
|  | if (remaining >= ARENA_MIN_SIZE) | 
|  | arena->nextoff = arena->size; | 
|  | else | 
|  | arena->nextoff = 0; | 
|  | cur_off += arena_size; | 
|  | list_add_tail(&arena->list, &btt->arena_list); | 
|  | } | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * This function completes arena initialization by writing | 
|  | * all the metadata. | 
|  | * It is only called for an uninitialized arena when a write | 
|  | * to that arena occurs for the first time. | 
|  | */ | 
|  | static int btt_arena_write_layout(struct arena_info *arena) | 
|  | { | 
|  | int ret; | 
|  | u64 sum; | 
|  | struct btt_sb *super; | 
|  | struct nd_btt *nd_btt = arena->nd_btt; | 
|  | const uuid_t *parent_uuid = nd_dev_to_uuid(&nd_btt->ndns->dev); | 
|  |  | 
|  | ret = btt_map_init(arena); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | ret = btt_log_init(arena); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | super = kzalloc(sizeof(*super), GFP_NOIO); | 
|  | if (!super) | 
|  | return -ENOMEM; | 
|  |  | 
|  | strscpy(super->signature, BTT_SIG, sizeof(super->signature)); | 
|  | export_uuid(super->uuid, nd_btt->uuid); | 
|  | export_uuid(super->parent_uuid, parent_uuid); | 
|  | super->flags = cpu_to_le32(arena->flags); | 
|  | super->version_major = cpu_to_le16(arena->version_major); | 
|  | super->version_minor = cpu_to_le16(arena->version_minor); | 
|  | super->external_lbasize = cpu_to_le32(arena->external_lbasize); | 
|  | super->external_nlba = cpu_to_le32(arena->external_nlba); | 
|  | super->internal_lbasize = cpu_to_le32(arena->internal_lbasize); | 
|  | super->internal_nlba = cpu_to_le32(arena->internal_nlba); | 
|  | super->nfree = cpu_to_le32(arena->nfree); | 
|  | super->infosize = cpu_to_le32(sizeof(struct btt_sb)); | 
|  | super->nextoff = cpu_to_le64(arena->nextoff); | 
|  | /* | 
|  | * Subtract arena->infooff (arena start) so numbers are relative | 
|  | * to 'this' arena | 
|  | */ | 
|  | super->dataoff = cpu_to_le64(arena->dataoff - arena->infooff); | 
|  | super->mapoff = cpu_to_le64(arena->mapoff - arena->infooff); | 
|  | super->logoff = cpu_to_le64(arena->logoff - arena->infooff); | 
|  | super->info2off = cpu_to_le64(arena->info2off - arena->infooff); | 
|  |  | 
|  | super->flags = 0; | 
|  | sum = nd_sb_checksum((struct nd_gen_sb *) super); | 
|  | super->checksum = cpu_to_le64(sum); | 
|  |  | 
|  | ret = btt_info_write(arena, super); | 
|  |  | 
|  | kfree(super); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * This function completes the initialization for the BTT namespace | 
|  | * such that it is ready to accept IOs | 
|  | */ | 
|  | static int btt_meta_init(struct btt *btt) | 
|  | { | 
|  | int ret = 0; | 
|  | struct arena_info *arena; | 
|  |  | 
|  | mutex_lock(&btt->init_lock); | 
|  | list_for_each_entry(arena, &btt->arena_list, list) { | 
|  | ret = btt_arena_write_layout(arena); | 
|  | if (ret) | 
|  | goto unlock; | 
|  |  | 
|  | ret = btt_freelist_init(arena); | 
|  | if (ret) | 
|  | goto unlock; | 
|  |  | 
|  | ret = btt_rtt_init(arena); | 
|  | if (ret) | 
|  | goto unlock; | 
|  |  | 
|  | ret = btt_maplocks_init(arena); | 
|  | if (ret) | 
|  | goto unlock; | 
|  | } | 
|  |  | 
|  | btt->init_state = INIT_READY; | 
|  |  | 
|  | unlock: | 
|  | mutex_unlock(&btt->init_lock); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static u32 btt_meta_size(struct btt *btt) | 
|  | { | 
|  | return btt->lbasize - btt->sector_size; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * This function calculates the arena in which the given LBA lies | 
|  | * by doing a linear walk. This is acceptable since we expect only | 
|  | * a few arenas. If we have backing devices that get much larger, | 
|  | * we can construct a balanced binary tree of arenas at init time | 
|  | * so that this range search becomes faster. | 
|  | */ | 
|  | static int lba_to_arena(struct btt *btt, sector_t sector, __u32 *premap, | 
|  | struct arena_info **arena) | 
|  | { | 
|  | struct arena_info *arena_list; | 
|  | __u64 lba = div_u64(sector << SECTOR_SHIFT, btt->sector_size); | 
|  |  | 
|  | list_for_each_entry(arena_list, &btt->arena_list, list) { | 
|  | if (lba < arena_list->external_nlba) { | 
|  | *arena = arena_list; | 
|  | *premap = lba; | 
|  | return 0; | 
|  | } | 
|  | lba -= arena_list->external_nlba; | 
|  | } | 
|  |  | 
|  | return -EIO; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * The following (lock_map, unlock_map) are mostly just to improve | 
|  | * readability, since they index into an array of locks | 
|  | */ | 
|  | static void lock_map(struct arena_info *arena, u32 premap) | 
|  | __acquires(&arena->map_locks[idx].lock) | 
|  | { | 
|  | u32 idx = (premap * MAP_ENT_SIZE / L1_CACHE_BYTES) % arena->nfree; | 
|  |  | 
|  | spin_lock(&arena->map_locks[idx].lock); | 
|  | } | 
|  |  | 
|  | static void unlock_map(struct arena_info *arena, u32 premap) | 
|  | __releases(&arena->map_locks[idx].lock) | 
|  | { | 
|  | u32 idx = (premap * MAP_ENT_SIZE / L1_CACHE_BYTES) % arena->nfree; | 
|  |  | 
|  | spin_unlock(&arena->map_locks[idx].lock); | 
|  | } | 
|  |  | 
|  | static int btt_data_read(struct arena_info *arena, struct page *page, | 
|  | unsigned int off, u32 lba, u32 len) | 
|  | { | 
|  | int ret; | 
|  | u64 nsoff = to_namespace_offset(arena, lba); | 
|  | void *mem = kmap_atomic(page); | 
|  |  | 
|  | ret = arena_read_bytes(arena, nsoff, mem + off, len, NVDIMM_IO_ATOMIC); | 
|  | kunmap_atomic(mem); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static int btt_data_write(struct arena_info *arena, u32 lba, | 
|  | struct page *page, unsigned int off, u32 len) | 
|  | { | 
|  | int ret; | 
|  | u64 nsoff = to_namespace_offset(arena, lba); | 
|  | void *mem = kmap_atomic(page); | 
|  |  | 
|  | ret = arena_write_bytes(arena, nsoff, mem + off, len, NVDIMM_IO_ATOMIC); | 
|  | kunmap_atomic(mem); | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static void zero_fill_data(struct page *page, unsigned int off, u32 len) | 
|  | { | 
|  | void *mem = kmap_atomic(page); | 
|  |  | 
|  | memset(mem + off, 0, len); | 
|  | kunmap_atomic(mem); | 
|  | } | 
|  |  | 
|  | #ifdef CONFIG_BLK_DEV_INTEGRITY | 
|  | static int btt_rw_integrity(struct btt *btt, struct bio_integrity_payload *bip, | 
|  | struct arena_info *arena, u32 postmap, int rw) | 
|  | { | 
|  | unsigned int len = btt_meta_size(btt); | 
|  | u64 meta_nsoff; | 
|  | int ret = 0; | 
|  |  | 
|  | if (bip == NULL) | 
|  | return 0; | 
|  |  | 
|  | meta_nsoff = to_namespace_offset(arena, postmap) + btt->sector_size; | 
|  |  | 
|  | while (len) { | 
|  | unsigned int cur_len; | 
|  | struct bio_vec bv; | 
|  | void *mem; | 
|  |  | 
|  | bv = bvec_iter_bvec(bip->bip_vec, bip->bip_iter); | 
|  | /* | 
|  | * The 'bv' obtained from bvec_iter_bvec has its .bv_len and | 
|  | * .bv_offset already adjusted for iter->bi_bvec_done, and we | 
|  | * can use those directly | 
|  | */ | 
|  |  | 
|  | cur_len = min(len, bv.bv_len); | 
|  | mem = bvec_kmap_local(&bv); | 
|  | if (rw) | 
|  | ret = arena_write_bytes(arena, meta_nsoff, mem, cur_len, | 
|  | NVDIMM_IO_ATOMIC); | 
|  | else | 
|  | ret = arena_read_bytes(arena, meta_nsoff, mem, cur_len, | 
|  | NVDIMM_IO_ATOMIC); | 
|  |  | 
|  | kunmap_local(mem); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | len -= cur_len; | 
|  | meta_nsoff += cur_len; | 
|  | if (!bvec_iter_advance(bip->bip_vec, &bip->bip_iter, cur_len)) | 
|  | return -EIO; | 
|  | } | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | #else /* CONFIG_BLK_DEV_INTEGRITY */ | 
|  | static int btt_rw_integrity(struct btt *btt, struct bio_integrity_payload *bip, | 
|  | struct arena_info *arena, u32 postmap, int rw) | 
|  | { | 
|  | return 0; | 
|  | } | 
|  | #endif | 
|  |  | 
|  | static int btt_read_pg(struct btt *btt, struct bio_integrity_payload *bip, | 
|  | struct page *page, unsigned int off, sector_t sector, | 
|  | unsigned int len) | 
|  | { | 
|  | int ret = 0; | 
|  | int t_flag, e_flag; | 
|  | struct arena_info *arena = NULL; | 
|  | u32 lane = 0, premap, postmap; | 
|  |  | 
|  | while (len) { | 
|  | u32 cur_len; | 
|  |  | 
|  | lane = nd_region_acquire_lane(btt->nd_region); | 
|  |  | 
|  | ret = lba_to_arena(btt, sector, &premap, &arena); | 
|  | if (ret) | 
|  | goto out_lane; | 
|  |  | 
|  | cur_len = min(btt->sector_size, len); | 
|  |  | 
|  | ret = btt_map_read(arena, premap, &postmap, &t_flag, &e_flag, | 
|  | NVDIMM_IO_ATOMIC); | 
|  | if (ret) | 
|  | goto out_lane; | 
|  |  | 
|  | /* | 
|  | * We loop to make sure that the post map LBA didn't change | 
|  | * from under us between writing the RTT and doing the actual | 
|  | * read. | 
|  | */ | 
|  | while (1) { | 
|  | u32 new_map; | 
|  | int new_t, new_e; | 
|  |  | 
|  | if (t_flag) { | 
|  | zero_fill_data(page, off, cur_len); | 
|  | goto out_lane; | 
|  | } | 
|  |  | 
|  | if (e_flag) { | 
|  | ret = -EIO; | 
|  | goto out_lane; | 
|  | } | 
|  |  | 
|  | arena->rtt[lane] = RTT_VALID | postmap; | 
|  | /* | 
|  | * Barrier to make sure this write is not reordered | 
|  | * to do the verification map_read before the RTT store | 
|  | */ | 
|  | barrier(); | 
|  |  | 
|  | ret = btt_map_read(arena, premap, &new_map, &new_t, | 
|  | &new_e, NVDIMM_IO_ATOMIC); | 
|  | if (ret) | 
|  | goto out_rtt; | 
|  |  | 
|  | if ((postmap == new_map) && (t_flag == new_t) && | 
|  | (e_flag == new_e)) | 
|  | break; | 
|  |  | 
|  | postmap = new_map; | 
|  | t_flag = new_t; | 
|  | e_flag = new_e; | 
|  | } | 
|  |  | 
|  | ret = btt_data_read(arena, page, off, postmap, cur_len); | 
|  | if (ret) { | 
|  | /* Media error - set the e_flag */ | 
|  | if (btt_map_write(arena, premap, postmap, 0, 1, NVDIMM_IO_ATOMIC)) | 
|  | dev_warn_ratelimited(to_dev(arena), | 
|  | "Error persistently tracking bad blocks at %#x\n", | 
|  | premap); | 
|  | goto out_rtt; | 
|  | } | 
|  |  | 
|  | if (bip) { | 
|  | ret = btt_rw_integrity(btt, bip, arena, postmap, READ); | 
|  | if (ret) | 
|  | goto out_rtt; | 
|  | } | 
|  |  | 
|  | arena->rtt[lane] = RTT_INVALID; | 
|  | nd_region_release_lane(btt->nd_region, lane); | 
|  |  | 
|  | len -= cur_len; | 
|  | off += cur_len; | 
|  | sector += btt->sector_size >> SECTOR_SHIFT; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  |  | 
|  | out_rtt: | 
|  | arena->rtt[lane] = RTT_INVALID; | 
|  | out_lane: | 
|  | nd_region_release_lane(btt->nd_region, lane); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | /* | 
|  | * Normally, arena_{read,write}_bytes will take care of the initial offset | 
|  | * adjustment, but in the case of btt_is_badblock, where we query is_bad_pmem, | 
|  | * we need the final, raw namespace offset here | 
|  | */ | 
|  | static bool btt_is_badblock(struct btt *btt, struct arena_info *arena, | 
|  | u32 postmap) | 
|  | { | 
|  | u64 nsoff = adjust_initial_offset(arena->nd_btt, | 
|  | to_namespace_offset(arena, postmap)); | 
|  | sector_t phys_sector = nsoff >> 9; | 
|  |  | 
|  | return is_bad_pmem(btt->phys_bb, phys_sector, arena->internal_lbasize); | 
|  | } | 
|  |  | 
|  | static int btt_write_pg(struct btt *btt, struct bio_integrity_payload *bip, | 
|  | sector_t sector, struct page *page, unsigned int off, | 
|  | unsigned int len) | 
|  | { | 
|  | int ret = 0; | 
|  | struct arena_info *arena = NULL; | 
|  | u32 premap = 0, old_postmap, new_postmap, lane = 0, i; | 
|  | struct log_entry log; | 
|  | int sub; | 
|  |  | 
|  | while (len) { | 
|  | u32 cur_len; | 
|  | int e_flag; | 
|  |  | 
|  | retry: | 
|  | lane = nd_region_acquire_lane(btt->nd_region); | 
|  |  | 
|  | ret = lba_to_arena(btt, sector, &premap, &arena); | 
|  | if (ret) | 
|  | goto out_lane; | 
|  | cur_len = min(btt->sector_size, len); | 
|  |  | 
|  | if ((arena->flags & IB_FLAG_ERROR_MASK) != 0) { | 
|  | ret = -EIO; | 
|  | goto out_lane; | 
|  | } | 
|  |  | 
|  | if (btt_is_badblock(btt, arena, arena->freelist[lane].block)) | 
|  | arena->freelist[lane].has_err = 1; | 
|  |  | 
|  | if (mutex_is_locked(&arena->err_lock) | 
|  | || arena->freelist[lane].has_err) { | 
|  | nd_region_release_lane(btt->nd_region, lane); | 
|  |  | 
|  | ret = arena_clear_freelist_error(arena, lane); | 
|  | if (ret) | 
|  | return ret; | 
|  |  | 
|  | /* OK to acquire a different lane/free block */ | 
|  | goto retry; | 
|  | } | 
|  |  | 
|  | new_postmap = arena->freelist[lane].block; | 
|  |  | 
|  | /* Wait if the new block is being read from */ | 
|  | for (i = 0; i < arena->nfree; i++) | 
|  | while (arena->rtt[i] == (RTT_VALID | new_postmap)) | 
|  | cpu_relax(); | 
|  |  | 
|  |  | 
|  | if (new_postmap >= arena->internal_nlba) { | 
|  | ret = -EIO; | 
|  | goto out_lane; | 
|  | } | 
|  |  | 
|  | ret = btt_data_write(arena, new_postmap, page, off, cur_len); | 
|  | if (ret) | 
|  | goto out_lane; | 
|  |  | 
|  | if (bip) { | 
|  | ret = btt_rw_integrity(btt, bip, arena, new_postmap, | 
|  | WRITE); | 
|  | if (ret) | 
|  | goto out_lane; | 
|  | } | 
|  |  | 
|  | lock_map(arena, premap); | 
|  | ret = btt_map_read(arena, premap, &old_postmap, NULL, &e_flag, | 
|  | NVDIMM_IO_ATOMIC); | 
|  | if (ret) | 
|  | goto out_map; | 
|  | if (old_postmap >= arena->internal_nlba) { | 
|  | ret = -EIO; | 
|  | goto out_map; | 
|  | } | 
|  | if (e_flag) | 
|  | set_e_flag(old_postmap); | 
|  |  | 
|  | log.lba = cpu_to_le32(premap); | 
|  | log.old_map = cpu_to_le32(old_postmap); | 
|  | log.new_map = cpu_to_le32(new_postmap); | 
|  | log.seq = cpu_to_le32(arena->freelist[lane].seq); | 
|  | sub = arena->freelist[lane].sub; | 
|  | ret = btt_flog_write(arena, lane, sub, &log); | 
|  | if (ret) | 
|  | goto out_map; | 
|  |  | 
|  | ret = btt_map_write(arena, premap, new_postmap, 0, 0, | 
|  | NVDIMM_IO_ATOMIC); | 
|  | if (ret) | 
|  | goto out_map; | 
|  |  | 
|  | unlock_map(arena, premap); | 
|  | nd_region_release_lane(btt->nd_region, lane); | 
|  |  | 
|  | if (e_flag) { | 
|  | ret = arena_clear_freelist_error(arena, lane); | 
|  | if (ret) | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | len -= cur_len; | 
|  | off += cur_len; | 
|  | sector += btt->sector_size >> SECTOR_SHIFT; | 
|  | } | 
|  |  | 
|  | return 0; | 
|  |  | 
|  | out_map: | 
|  | unlock_map(arena, premap); | 
|  | out_lane: | 
|  | nd_region_release_lane(btt->nd_region, lane); | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static int btt_do_bvec(struct btt *btt, struct bio_integrity_payload *bip, | 
|  | struct page *page, unsigned int len, unsigned int off, | 
|  | enum req_op op, sector_t sector) | 
|  | { | 
|  | int ret; | 
|  |  | 
|  | if (!op_is_write(op)) { | 
|  | ret = btt_read_pg(btt, bip, page, off, sector, len); | 
|  | flush_dcache_page(page); | 
|  | } else { | 
|  | flush_dcache_page(page); | 
|  | ret = btt_write_pg(btt, bip, sector, page, off, len); | 
|  | } | 
|  |  | 
|  | return ret; | 
|  | } | 
|  |  | 
|  | static void btt_submit_bio(struct bio *bio) | 
|  | { | 
|  | struct bio_integrity_payload *bip = bio_integrity(bio); | 
|  | struct btt *btt = bio->bi_bdev->bd_disk->private_data; | 
|  | struct bvec_iter iter; | 
|  | unsigned long start; | 
|  | struct bio_vec bvec; | 
|  | int err = 0; | 
|  | bool do_acct; | 
|  |  | 
|  | if (!bio_integrity_prep(bio)) | 
|  | return; | 
|  |  | 
|  | do_acct = blk_queue_io_stat(bio->bi_bdev->bd_disk->queue); | 
|  | if (do_acct) | 
|  | start = bio_start_io_acct(bio); | 
|  | bio_for_each_segment(bvec, bio, iter) { | 
|  | unsigned int len = bvec.bv_len; | 
|  |  | 
|  | if (len > PAGE_SIZE || len < btt->sector_size || | 
|  | len % btt->sector_size) { | 
|  | dev_err_ratelimited(&btt->nd_btt->dev, | 
|  | "unaligned bio segment (len: %d)\n", len); | 
|  | bio->bi_status = BLK_STS_IOERR; | 
|  | break; | 
|  | } | 
|  |  | 
|  | err = btt_do_bvec(btt, bip, bvec.bv_page, len, bvec.bv_offset, | 
|  | bio_op(bio), iter.bi_sector); | 
|  | if (err) { | 
|  | dev_err(&btt->nd_btt->dev, | 
|  | "io error in %s sector %lld, len %d,\n", | 
|  | (op_is_write(bio_op(bio))) ? "WRITE" : | 
|  | "READ", | 
|  | (unsigned long long) iter.bi_sector, len); | 
|  | bio->bi_status = errno_to_blk_status(err); | 
|  | break; | 
|  | } | 
|  | } | 
|  | if (do_acct) | 
|  | bio_end_io_acct(bio, start); | 
|  |  | 
|  | bio_endio(bio); | 
|  | } | 
|  |  | 
|  | static int btt_getgeo(struct gendisk *disk, struct hd_geometry *geo) | 
|  | { | 
|  | /* some standard values */ | 
|  | geo->heads = 1 << 6; | 
|  | geo->sectors = 1 << 5; | 
|  | geo->cylinders = get_capacity(disk) >> 11; | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static const struct block_device_operations btt_fops = { | 
|  | .owner =		THIS_MODULE, | 
|  | .submit_bio =		btt_submit_bio, | 
|  | .getgeo =		btt_getgeo, | 
|  | }; | 
|  |  | 
|  | static int btt_blk_init(struct btt *btt) | 
|  | { | 
|  | struct nd_btt *nd_btt = btt->nd_btt; | 
|  | struct nd_namespace_common *ndns = nd_btt->ndns; | 
|  | struct queue_limits lim = { | 
|  | .logical_block_size	= btt->sector_size, | 
|  | .max_hw_sectors		= UINT_MAX, | 
|  | .max_integrity_segments	= 1, | 
|  | .features		= BLK_FEAT_SYNCHRONOUS, | 
|  | }; | 
|  | int rc; | 
|  |  | 
|  | if (btt_meta_size(btt) && IS_ENABLED(CONFIG_BLK_DEV_INTEGRITY)) { | 
|  | lim.integrity.metadata_size = btt_meta_size(btt); | 
|  | lim.integrity.tag_size = btt_meta_size(btt); | 
|  | } | 
|  |  | 
|  | btt->btt_disk = blk_alloc_disk(&lim, NUMA_NO_NODE); | 
|  | if (IS_ERR(btt->btt_disk)) | 
|  | return PTR_ERR(btt->btt_disk); | 
|  |  | 
|  | nvdimm_namespace_disk_name(ndns, btt->btt_disk->disk_name); | 
|  | btt->btt_disk->first_minor = 0; | 
|  | btt->btt_disk->fops = &btt_fops; | 
|  | btt->btt_disk->private_data = btt; | 
|  |  | 
|  | set_capacity(btt->btt_disk, btt->nlba * btt->sector_size >> 9); | 
|  | rc = device_add_disk(&btt->nd_btt->dev, btt->btt_disk, NULL); | 
|  | if (rc) | 
|  | goto out_cleanup_disk; | 
|  |  | 
|  | btt->nd_btt->size = btt->nlba * (u64)btt->sector_size; | 
|  | nvdimm_check_and_set_ro(btt->btt_disk); | 
|  |  | 
|  | return 0; | 
|  |  | 
|  | out_cleanup_disk: | 
|  | put_disk(btt->btt_disk); | 
|  | return rc; | 
|  | } | 
|  |  | 
|  | static void btt_blk_cleanup(struct btt *btt) | 
|  | { | 
|  | del_gendisk(btt->btt_disk); | 
|  | put_disk(btt->btt_disk); | 
|  | } | 
|  |  | 
|  | /** | 
|  | * btt_init - initialize a block translation table for the given device | 
|  | * @nd_btt:	device with BTT geometry and backing device info | 
|  | * @rawsize:	raw size in bytes of the backing device | 
|  | * @lbasize:	lba size of the backing device | 
|  | * @uuid:	A uuid for the backing device - this is stored on media | 
|  | * @nd_region:	&struct nd_region for the REGION device | 
|  | * | 
|  | * Initialize a Block Translation Table on a backing device to provide | 
|  | * single sector power fail atomicity. | 
|  | * | 
|  | * Context: | 
|  | * Might sleep. | 
|  | * | 
|  | * Returns: | 
|  | * Pointer to a new struct btt on success, NULL on failure. | 
|  | */ | 
|  | static struct btt *btt_init(struct nd_btt *nd_btt, unsigned long long rawsize, | 
|  | u32 lbasize, uuid_t *uuid, | 
|  | struct nd_region *nd_region) | 
|  | { | 
|  | int ret; | 
|  | struct btt *btt; | 
|  | struct nd_namespace_io *nsio; | 
|  | struct device *dev = &nd_btt->dev; | 
|  |  | 
|  | btt = devm_kzalloc(dev, sizeof(struct btt), GFP_KERNEL); | 
|  | if (!btt) | 
|  | return NULL; | 
|  |  | 
|  | btt->nd_btt = nd_btt; | 
|  | btt->rawsize = rawsize; | 
|  | btt->lbasize = lbasize; | 
|  | btt->sector_size = ((lbasize >= 4096) ? 4096 : 512); | 
|  | INIT_LIST_HEAD(&btt->arena_list); | 
|  | mutex_init(&btt->init_lock); | 
|  | btt->nd_region = nd_region; | 
|  | nsio = to_nd_namespace_io(&nd_btt->ndns->dev); | 
|  | btt->phys_bb = &nsio->bb; | 
|  |  | 
|  | ret = discover_arenas(btt); | 
|  | if (ret) { | 
|  | dev_err(dev, "init: error in arena_discover: %d\n", ret); | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | if (btt->init_state != INIT_READY && nd_region->ro) { | 
|  | dev_warn(dev, "%s is read-only, unable to init btt metadata\n", | 
|  | dev_name(&nd_region->dev)); | 
|  | return NULL; | 
|  | } else if (btt->init_state != INIT_READY) { | 
|  | btt->num_arenas = (rawsize / ARENA_MAX_SIZE) + | 
|  | ((rawsize % ARENA_MAX_SIZE) ? 1 : 0); | 
|  | dev_dbg(dev, "init: %d arenas for %llu rawsize\n", | 
|  | btt->num_arenas, rawsize); | 
|  |  | 
|  | ret = create_arenas(btt); | 
|  | if (ret) { | 
|  | dev_info(dev, "init: create_arenas: %d\n", ret); | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | ret = btt_meta_init(btt); | 
|  | if (ret) { | 
|  | dev_err(dev, "init: error in meta_init: %d\n", ret); | 
|  | return NULL; | 
|  | } | 
|  | } | 
|  |  | 
|  | ret = btt_blk_init(btt); | 
|  | if (ret) { | 
|  | dev_err(dev, "init: error in blk_init: %d\n", ret); | 
|  | return NULL; | 
|  | } | 
|  |  | 
|  | btt_debugfs_init(btt); | 
|  |  | 
|  | return btt; | 
|  | } | 
|  |  | 
|  | /** | 
|  | * btt_fini - de-initialize a BTT | 
|  | * @btt:	the BTT handle that was generated by btt_init | 
|  | * | 
|  | * De-initialize a Block Translation Table on device removal | 
|  | * | 
|  | * Context: | 
|  | * Might sleep. | 
|  | */ | 
|  | static void btt_fini(struct btt *btt) | 
|  | { | 
|  | if (btt) { | 
|  | btt_blk_cleanup(btt); | 
|  | free_arenas(btt); | 
|  | debugfs_remove_recursive(btt->debugfs_dir); | 
|  | } | 
|  | } | 
|  |  | 
|  | int nvdimm_namespace_attach_btt(struct nd_namespace_common *ndns) | 
|  | { | 
|  | struct nd_btt *nd_btt = to_nd_btt(ndns->claim); | 
|  | struct nd_region *nd_region; | 
|  | struct btt_sb *btt_sb; | 
|  | struct btt *btt; | 
|  | size_t size, rawsize; | 
|  | int rc; | 
|  |  | 
|  | if (!nd_btt->uuid || !nd_btt->ndns || !nd_btt->lbasize) { | 
|  | dev_dbg(&nd_btt->dev, "incomplete btt configuration\n"); | 
|  | return -ENODEV; | 
|  | } | 
|  |  | 
|  | btt_sb = devm_kzalloc(&nd_btt->dev, sizeof(*btt_sb), GFP_KERNEL); | 
|  | if (!btt_sb) | 
|  | return -ENOMEM; | 
|  |  | 
|  | size = nvdimm_namespace_capacity(ndns); | 
|  | rc = devm_namespace_enable(&nd_btt->dev, ndns, size); | 
|  | if (rc) | 
|  | return rc; | 
|  |  | 
|  | /* | 
|  | * If this returns < 0, that is ok as it just means there wasn't | 
|  | * an existing BTT, and we're creating a new one. We still need to | 
|  | * call this as we need the version dependent fields in nd_btt to be | 
|  | * set correctly based on the holder class | 
|  | */ | 
|  | nd_btt_version(nd_btt, ndns, btt_sb); | 
|  |  | 
|  | rawsize = size - nd_btt->initial_offset; | 
|  | if (rawsize < ARENA_MIN_SIZE) { | 
|  | dev_dbg(&nd_btt->dev, "%s must be at least %ld bytes\n", | 
|  | dev_name(&ndns->dev), | 
|  | ARENA_MIN_SIZE + nd_btt->initial_offset); | 
|  | return -ENXIO; | 
|  | } | 
|  | nd_region = to_nd_region(nd_btt->dev.parent); | 
|  | btt = btt_init(nd_btt, rawsize, nd_btt->lbasize, nd_btt->uuid, | 
|  | nd_region); | 
|  | if (!btt) | 
|  | return -ENOMEM; | 
|  | nd_btt->btt = btt; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  | EXPORT_SYMBOL(nvdimm_namespace_attach_btt); | 
|  |  | 
|  | int nvdimm_namespace_detach_btt(struct nd_btt *nd_btt) | 
|  | { | 
|  | struct btt *btt = nd_btt->btt; | 
|  |  | 
|  | btt_fini(btt); | 
|  | nd_btt->btt = NULL; | 
|  |  | 
|  | return 0; | 
|  | } | 
|  | EXPORT_SYMBOL(nvdimm_namespace_detach_btt); | 
|  |  | 
|  | static int __init nd_btt_init(void) | 
|  | { | 
|  | int rc = 0; | 
|  |  | 
|  | debugfs_root = debugfs_create_dir("btt", NULL); | 
|  | if (IS_ERR_OR_NULL(debugfs_root)) | 
|  | rc = -ENXIO; | 
|  |  | 
|  | return rc; | 
|  | } | 
|  |  | 
|  | static void __exit nd_btt_exit(void) | 
|  | { | 
|  | debugfs_remove_recursive(debugfs_root); | 
|  | } | 
|  |  | 
|  | MODULE_ALIAS_ND_DEVICE(ND_DEVICE_BTT); | 
|  | MODULE_AUTHOR("Vishal Verma <vishal.l.verma@linux.intel.com>"); | 
|  | MODULE_DESCRIPTION("NVDIMM Block Translation Table"); | 
|  | MODULE_LICENSE("GPL v2"); | 
|  | module_init(nd_btt_init); | 
|  | module_exit(nd_btt_exit); |