1bae9a0aaSDmitry Fomichev // SPDX-License-Identifier: GPL-2.0-only
23b1a94c8SDamien Le Moal /*
33b1a94c8SDamien Le Moal  * Copyright (C) 2017 Western Digital Corporation or its affiliates.
43b1a94c8SDamien Le Moal  *
53b1a94c8SDamien Le Moal  * This file is released under the GPL.
63b1a94c8SDamien Le Moal  */
73b1a94c8SDamien Le Moal 
83b1a94c8SDamien Le Moal #include "dm-zoned.h"
93b1a94c8SDamien Le Moal 
103b1a94c8SDamien Le Moal #include <linux/module.h>
113b1a94c8SDamien Le Moal #include <linux/crc32.h>
12bd976e52SDamien Le Moal #include <linux/sched/mm.h>
133b1a94c8SDamien Le Moal 
143b1a94c8SDamien Le Moal #define	DM_MSG_PREFIX		"zoned metadata"
153b1a94c8SDamien Le Moal 
163b1a94c8SDamien Le Moal /*
173b1a94c8SDamien Le Moal  * Metadata version.
183b1a94c8SDamien Le Moal  */
19bd5c4031SHannes Reinecke #define DMZ_META_VER	2
203b1a94c8SDamien Le Moal 
213b1a94c8SDamien Le Moal /*
223b1a94c8SDamien Le Moal  * On-disk super block magic.
233b1a94c8SDamien Le Moal  */
243b1a94c8SDamien Le Moal #define DMZ_MAGIC	((((unsigned int)('D')) << 24) | \
253b1a94c8SDamien Le Moal 			 (((unsigned int)('Z')) << 16) | \
263b1a94c8SDamien Le Moal 			 (((unsigned int)('B')) <<  8) | \
273b1a94c8SDamien Le Moal 			 ((unsigned int)('D')))
283b1a94c8SDamien Le Moal 
293b1a94c8SDamien Le Moal /*
303b1a94c8SDamien Le Moal  * On disk super block.
313b1a94c8SDamien Le Moal  * This uses only 512 B but uses on disk a full 4KB block. This block is
323b1a94c8SDamien Le Moal  * followed on disk by the mapping table of chunks to zones and the bitmap
333b1a94c8SDamien Le Moal  * blocks indicating zone block validity.
343b1a94c8SDamien Le Moal  * The overall resulting metadata format is:
353b1a94c8SDamien Le Moal  *    (1) Super block (1 block)
363b1a94c8SDamien Le Moal  *    (2) Chunk mapping table (nr_map_blocks)
373b1a94c8SDamien Le Moal  *    (3) Bitmap blocks (nr_bitmap_blocks)
38ad1bd578SDmitry Fomichev  * All metadata blocks are stored in conventional zones, starting from
393b1a94c8SDamien Le Moal  * the first conventional zone found on disk.
403b1a94c8SDamien Le Moal  */
413b1a94c8SDamien Le Moal struct dmz_super {
423b1a94c8SDamien Le Moal 	/* Magic number */
433b1a94c8SDamien Le Moal 	__le32		magic;			/*   4 */
443b1a94c8SDamien Le Moal 
453b1a94c8SDamien Le Moal 	/* Metadata version number */
463b1a94c8SDamien Le Moal 	__le32		version;		/*   8 */
473b1a94c8SDamien Le Moal 
483b1a94c8SDamien Le Moal 	/* Generation number */
493b1a94c8SDamien Le Moal 	__le64		gen;			/*  16 */
503b1a94c8SDamien Le Moal 
513b1a94c8SDamien Le Moal 	/* This block number */
523b1a94c8SDamien Le Moal 	__le64		sb_block;		/*  24 */
533b1a94c8SDamien Le Moal 
543b1a94c8SDamien Le Moal 	/* The number of metadata blocks, including this super block */
553b1a94c8SDamien Le Moal 	__le32		nr_meta_blocks;		/*  28 */
563b1a94c8SDamien Le Moal 
573b1a94c8SDamien Le Moal 	/* The number of sequential zones reserved for reclaim */
583b1a94c8SDamien Le Moal 	__le32		nr_reserved_seq;	/*  32 */
593b1a94c8SDamien Le Moal 
603b1a94c8SDamien Le Moal 	/* The number of entries in the mapping table */
613b1a94c8SDamien Le Moal 	__le32		nr_chunks;		/*  36 */
623b1a94c8SDamien Le Moal 
633b1a94c8SDamien Le Moal 	/* The number of blocks used for the chunk mapping table */
643b1a94c8SDamien Le Moal 	__le32		nr_map_blocks;		/*  40 */
653b1a94c8SDamien Le Moal 
663b1a94c8SDamien Le Moal 	/* The number of blocks used for the block bitmaps */
673b1a94c8SDamien Le Moal 	__le32		nr_bitmap_blocks;	/*  44 */
683b1a94c8SDamien Le Moal 
693b1a94c8SDamien Le Moal 	/* Checksum */
703b1a94c8SDamien Le Moal 	__le32		crc;			/*  48 */
713b1a94c8SDamien Le Moal 
72bd5c4031SHannes Reinecke 	/* DM-Zoned label */
73bd5c4031SHannes Reinecke 	u8		dmz_label[32];		/*  80 */
74bd5c4031SHannes Reinecke 
75bd5c4031SHannes Reinecke 	/* DM-Zoned UUID */
76bd5c4031SHannes Reinecke 	u8		dmz_uuid[16];		/*  96 */
77bd5c4031SHannes Reinecke 
78bd5c4031SHannes Reinecke 	/* Device UUID */
79bd5c4031SHannes Reinecke 	u8		dev_uuid[16];		/* 112 */
80bd5c4031SHannes Reinecke 
813b1a94c8SDamien Le Moal 	/* Padding to full 512B sector */
82bd5c4031SHannes Reinecke 	u8		reserved[400];		/* 512 */
833b1a94c8SDamien Le Moal };
843b1a94c8SDamien Le Moal 
853b1a94c8SDamien Le Moal /*
863b1a94c8SDamien Le Moal  * Chunk mapping entry: entries are indexed by chunk number
873b1a94c8SDamien Le Moal  * and give the zone ID (dzone_id) mapping the chunk on disk.
883b1a94c8SDamien Le Moal  * This zone may be sequential or random. If it is a sequential
893b1a94c8SDamien Le Moal  * zone, a second zone (bzone_id) used as a write buffer may
903b1a94c8SDamien Le Moal  * also be specified. This second zone will always be a randomly
913b1a94c8SDamien Le Moal  * writeable zone.
923b1a94c8SDamien Le Moal  */
933b1a94c8SDamien Le Moal struct dmz_map {
943b1a94c8SDamien Le Moal 	__le32			dzone_id;
953b1a94c8SDamien Le Moal 	__le32			bzone_id;
963b1a94c8SDamien Le Moal };
973b1a94c8SDamien Le Moal 
983b1a94c8SDamien Le Moal /*
993b1a94c8SDamien Le Moal  * Chunk mapping table metadata: 512 8-bytes entries per 4KB block.
1003b1a94c8SDamien Le Moal  */
1013b1a94c8SDamien Le Moal #define DMZ_MAP_ENTRIES		(DMZ_BLOCK_SIZE / sizeof(struct dmz_map))
1023b1a94c8SDamien Le Moal #define DMZ_MAP_ENTRIES_SHIFT	(ilog2(DMZ_MAP_ENTRIES))
1033b1a94c8SDamien Le Moal #define DMZ_MAP_ENTRIES_MASK	(DMZ_MAP_ENTRIES - 1)
1043b1a94c8SDamien Le Moal #define DMZ_MAP_UNMAPPED	UINT_MAX
1053b1a94c8SDamien Le Moal 
1063b1a94c8SDamien Le Moal /*
1073b1a94c8SDamien Le Moal  * Meta data block descriptor (for cached metadata blocks).
1083b1a94c8SDamien Le Moal  */
1093b1a94c8SDamien Le Moal struct dmz_mblock {
1103b1a94c8SDamien Le Moal 	struct rb_node		node;
1113b1a94c8SDamien Le Moal 	struct list_head	link;
1123b1a94c8SDamien Le Moal 	sector_t		no;
11333c2865fSDamien Le Moal 	unsigned int		ref;
1143b1a94c8SDamien Le Moal 	unsigned long		state;
1153b1a94c8SDamien Le Moal 	struct page		*page;
1163b1a94c8SDamien Le Moal 	void			*data;
1173b1a94c8SDamien Le Moal };
1183b1a94c8SDamien Le Moal 
1193b1a94c8SDamien Le Moal /*
1203b1a94c8SDamien Le Moal  * Metadata block state flags.
1213b1a94c8SDamien Le Moal  */
1223b1a94c8SDamien Le Moal enum {
1233b1a94c8SDamien Le Moal 	DMZ_META_DIRTY,
1243b1a94c8SDamien Le Moal 	DMZ_META_READING,
1253b1a94c8SDamien Le Moal 	DMZ_META_WRITING,
1263b1a94c8SDamien Le Moal 	DMZ_META_ERROR,
1273b1a94c8SDamien Le Moal };
1283b1a94c8SDamien Le Moal 
1293b1a94c8SDamien Le Moal /*
1303b1a94c8SDamien Le Moal  * Super block information (one per metadata set).
1313b1a94c8SDamien Le Moal  */
1323b1a94c8SDamien Le Moal struct dmz_sb {
1333b1a94c8SDamien Le Moal 	sector_t		block;
134bf28a3baSHannes Reinecke 	struct dmz_dev		*dev;
1353b1a94c8SDamien Le Moal 	struct dmz_mblock	*mblk;
1363b1a94c8SDamien Le Moal 	struct dmz_super	*sb;
137735bd7e4SHannes Reinecke 	struct dm_zone		*zone;
1383b1a94c8SDamien Le Moal };
1393b1a94c8SDamien Le Moal 
1403b1a94c8SDamien Le Moal /*
1413b1a94c8SDamien Le Moal  * In-memory metadata.
1423b1a94c8SDamien Le Moal  */
1433b1a94c8SDamien Le Moal struct dmz_metadata {
1443b1a94c8SDamien Le Moal 	struct dmz_dev		*dev;
145bd5c4031SHannes Reinecke 	unsigned int		nr_devs;
1463b1a94c8SDamien Le Moal 
1472234e732SHannes Reinecke 	char			devname[BDEVNAME_SIZE];
148bd5c4031SHannes Reinecke 	char			label[BDEVNAME_SIZE];
149bd5c4031SHannes Reinecke 	uuid_t			uuid;
1502234e732SHannes Reinecke 
1513b1a94c8SDamien Le Moal 	sector_t		zone_bitmap_size;
1523b1a94c8SDamien Le Moal 	unsigned int		zone_nr_bitmap_blocks;
153b3996295SDmitry Fomichev 	unsigned int		zone_bits_per_mblk;
1543b1a94c8SDamien Le Moal 
15536820560SHannes Reinecke 	sector_t		zone_nr_blocks;
15636820560SHannes Reinecke 	sector_t		zone_nr_blocks_shift;
15736820560SHannes Reinecke 
15836820560SHannes Reinecke 	sector_t		zone_nr_sectors;
15936820560SHannes Reinecke 	sector_t		zone_nr_sectors_shift;
16036820560SHannes Reinecke 
1613b1a94c8SDamien Le Moal 	unsigned int		nr_bitmap_blocks;
1623b1a94c8SDamien Le Moal 	unsigned int		nr_map_blocks;
1633b1a94c8SDamien Le Moal 
16436820560SHannes Reinecke 	unsigned int		nr_zones;
1653b1a94c8SDamien Le Moal 	unsigned int		nr_useable_zones;
1663b1a94c8SDamien Le Moal 	unsigned int		nr_meta_blocks;
1673b1a94c8SDamien Le Moal 	unsigned int		nr_meta_zones;
1683b1a94c8SDamien Le Moal 	unsigned int		nr_data_zones;
16934f5affdSHannes Reinecke 	unsigned int		nr_cache_zones;
1703b1a94c8SDamien Le Moal 	unsigned int		nr_rnd_zones;
1713b1a94c8SDamien Le Moal 	unsigned int		nr_reserved_seq;
1723b1a94c8SDamien Le Moal 	unsigned int		nr_chunks;
1733b1a94c8SDamien Le Moal 
1743b1a94c8SDamien Le Moal 	/* Zone information array */
1753b1a94c8SDamien Le Moal 	struct dm_zone		*zones;
1763b1a94c8SDamien Le Moal 
177bd5c4031SHannes Reinecke 	struct dmz_sb		sb[3];
1783b1a94c8SDamien Le Moal 	unsigned int		mblk_primary;
179bd5c4031SHannes Reinecke 	unsigned int		sb_version;
1803b1a94c8SDamien Le Moal 	u64			sb_gen;
1813b1a94c8SDamien Le Moal 	unsigned int		min_nr_mblks;
1823b1a94c8SDamien Le Moal 	unsigned int		max_nr_mblks;
1833b1a94c8SDamien Le Moal 	atomic_t		nr_mblks;
1843b1a94c8SDamien Le Moal 	struct rw_semaphore	mblk_sem;
1853b1a94c8SDamien Le Moal 	struct mutex		mblk_flush_lock;
1863b1a94c8SDamien Le Moal 	spinlock_t		mblk_lock;
1873b1a94c8SDamien Le Moal 	struct rb_root		mblk_rbtree;
1883b1a94c8SDamien Le Moal 	struct list_head	mblk_lru_list;
1893b1a94c8SDamien Le Moal 	struct list_head	mblk_dirty_list;
1903b1a94c8SDamien Le Moal 	struct shrinker		mblk_shrinker;
1913b1a94c8SDamien Le Moal 
1923b1a94c8SDamien Le Moal 	/* Zone allocation management */
1933b1a94c8SDamien Le Moal 	struct mutex		map_lock;
1943b1a94c8SDamien Le Moal 	struct dmz_mblock	**map_mblk;
1953b1a94c8SDamien Le Moal 	unsigned int		nr_rnd;
1963b1a94c8SDamien Le Moal 	atomic_t		unmap_nr_rnd;
1973b1a94c8SDamien Le Moal 	struct list_head	unmap_rnd_list;
1983b1a94c8SDamien Le Moal 	struct list_head	map_rnd_list;
1993b1a94c8SDamien Le Moal 
20034f5affdSHannes Reinecke 	unsigned int		nr_cache;
20134f5affdSHannes Reinecke 	atomic_t		unmap_nr_cache;
20234f5affdSHannes Reinecke 	struct list_head	unmap_cache_list;
20334f5affdSHannes Reinecke 	struct list_head	map_cache_list;
20434f5affdSHannes Reinecke 
2053b1a94c8SDamien Le Moal 	unsigned int		nr_seq;
2063b1a94c8SDamien Le Moal 	atomic_t		unmap_nr_seq;
2073b1a94c8SDamien Le Moal 	struct list_head	unmap_seq_list;
2083b1a94c8SDamien Le Moal 	struct list_head	map_seq_list;
2093b1a94c8SDamien Le Moal 
2103b1a94c8SDamien Le Moal 	atomic_t		nr_reserved_seq_zones;
2113b1a94c8SDamien Le Moal 	struct list_head	reserved_seq_zones_list;
2123b1a94c8SDamien Le Moal 
2133b1a94c8SDamien Le Moal 	wait_queue_head_t	free_wq;
2143b1a94c8SDamien Le Moal };
2153b1a94c8SDamien Le Moal 
216ca1a7045SHannes Reinecke #define dmz_zmd_info(zmd, format, args...)	\
217bd5c4031SHannes Reinecke 	DMINFO("(%s): " format, (zmd)->label, ## args)
218ca1a7045SHannes Reinecke 
219ca1a7045SHannes Reinecke #define dmz_zmd_err(zmd, format, args...)	\
220bd5c4031SHannes Reinecke 	DMERR("(%s): " format, (zmd)->label, ## args)
221ca1a7045SHannes Reinecke 
222ca1a7045SHannes Reinecke #define dmz_zmd_warn(zmd, format, args...)	\
223bd5c4031SHannes Reinecke 	DMWARN("(%s): " format, (zmd)->label, ## args)
224ca1a7045SHannes Reinecke 
225ca1a7045SHannes Reinecke #define dmz_zmd_debug(zmd, format, args...)	\
226bd5c4031SHannes Reinecke 	DMDEBUG("(%s): " format, (zmd)->label, ## args)
2273b1a94c8SDamien Le Moal /*
2283b1a94c8SDamien Le Moal  * Various accessors
2293b1a94c8SDamien Le Moal  */
230bd5c4031SHannes Reinecke static unsigned int dmz_dev_zone_id(struct dmz_metadata *zmd, struct dm_zone *zone)
231bd5c4031SHannes Reinecke {
232bd5c4031SHannes Reinecke 	unsigned int zone_id;
233bd5c4031SHannes Reinecke 
234bd5c4031SHannes Reinecke 	if (WARN_ON(!zone))
235bd5c4031SHannes Reinecke 		return 0;
236bd5c4031SHannes Reinecke 
237bd5c4031SHannes Reinecke 	zone_id = zone->id;
238bd5c4031SHannes Reinecke 	if (zmd->nr_devs > 1 &&
239bd5c4031SHannes Reinecke 	    (zone_id >= zmd->dev[1].zone_offset))
240bd5c4031SHannes Reinecke 		zone_id -= zmd->dev[1].zone_offset;
241bd5c4031SHannes Reinecke 	return zone_id;
242bd5c4031SHannes Reinecke }
243bd5c4031SHannes Reinecke 
2443b1a94c8SDamien Le Moal sector_t dmz_start_sect(struct dmz_metadata *zmd, struct dm_zone *zone)
2453b1a94c8SDamien Le Moal {
246bd5c4031SHannes Reinecke 	unsigned int zone_id = dmz_dev_zone_id(zmd, zone);
247bd5c4031SHannes Reinecke 
248bd5c4031SHannes Reinecke 	return (sector_t)zone_id << zmd->zone_nr_sectors_shift;
2493b1a94c8SDamien Le Moal }
2503b1a94c8SDamien Le Moal 
2513b1a94c8SDamien Le Moal sector_t dmz_start_block(struct dmz_metadata *zmd, struct dm_zone *zone)
2523b1a94c8SDamien Le Moal {
253bd5c4031SHannes Reinecke 	unsigned int zone_id = dmz_dev_zone_id(zmd, zone);
254bd5c4031SHannes Reinecke 
255bd5c4031SHannes Reinecke 	return (sector_t)zone_id << zmd->zone_nr_blocks_shift;
2563b1a94c8SDamien Le Moal }
2573b1a94c8SDamien Le Moal 
258bf28a3baSHannes Reinecke struct dmz_dev *dmz_zone_to_dev(struct dmz_metadata *zmd, struct dm_zone *zone)
259bf28a3baSHannes Reinecke {
260bd5c4031SHannes Reinecke 	if (WARN_ON(!zone))
261bd5c4031SHannes Reinecke 		return &zmd->dev[0];
262bd5c4031SHannes Reinecke 
263bd5c4031SHannes Reinecke 	if (zmd->nr_devs > 1 &&
264bd5c4031SHannes Reinecke 	    zone->id >= zmd->dev[1].zone_offset)
265bd5c4031SHannes Reinecke 		return &zmd->dev[1];
266bd5c4031SHannes Reinecke 
267bf28a3baSHannes Reinecke 	return &zmd->dev[0];
268bf28a3baSHannes Reinecke }
269bf28a3baSHannes Reinecke 
27036820560SHannes Reinecke unsigned int dmz_zone_nr_blocks(struct dmz_metadata *zmd)
27136820560SHannes Reinecke {
27236820560SHannes Reinecke 	return zmd->zone_nr_blocks;
27336820560SHannes Reinecke }
27436820560SHannes Reinecke 
27536820560SHannes Reinecke unsigned int dmz_zone_nr_blocks_shift(struct dmz_metadata *zmd)
27636820560SHannes Reinecke {
27736820560SHannes Reinecke 	return zmd->zone_nr_blocks_shift;
27836820560SHannes Reinecke }
27936820560SHannes Reinecke 
28036820560SHannes Reinecke unsigned int dmz_zone_nr_sectors(struct dmz_metadata *zmd)
28136820560SHannes Reinecke {
28236820560SHannes Reinecke 	return zmd->zone_nr_sectors;
28336820560SHannes Reinecke }
28436820560SHannes Reinecke 
28536820560SHannes Reinecke unsigned int dmz_zone_nr_sectors_shift(struct dmz_metadata *zmd)
28636820560SHannes Reinecke {
28736820560SHannes Reinecke 	return zmd->zone_nr_sectors_shift;
28836820560SHannes Reinecke }
28936820560SHannes Reinecke 
290bc3d5717SHannes Reinecke unsigned int dmz_nr_zones(struct dmz_metadata *zmd)
291bc3d5717SHannes Reinecke {
29236820560SHannes Reinecke 	return zmd->nr_zones;
293bc3d5717SHannes Reinecke }
294bc3d5717SHannes Reinecke 
2953b1a94c8SDamien Le Moal unsigned int dmz_nr_chunks(struct dmz_metadata *zmd)
2963b1a94c8SDamien Le Moal {
2973b1a94c8SDamien Le Moal 	return zmd->nr_chunks;
2983b1a94c8SDamien Le Moal }
2993b1a94c8SDamien Le Moal 
3003b1a94c8SDamien Le Moal unsigned int dmz_nr_rnd_zones(struct dmz_metadata *zmd)
3013b1a94c8SDamien Le Moal {
3023b1a94c8SDamien Le Moal 	return zmd->nr_rnd;
3033b1a94c8SDamien Le Moal }
3043b1a94c8SDamien Le Moal 
3053b1a94c8SDamien Le Moal unsigned int dmz_nr_unmap_rnd_zones(struct dmz_metadata *zmd)
3063b1a94c8SDamien Le Moal {
3073b1a94c8SDamien Le Moal 	return atomic_read(&zmd->unmap_nr_rnd);
3083b1a94c8SDamien Le Moal }
3093b1a94c8SDamien Le Moal 
31034f5affdSHannes Reinecke unsigned int dmz_nr_cache_zones(struct dmz_metadata *zmd)
31134f5affdSHannes Reinecke {
31234f5affdSHannes Reinecke 	return zmd->nr_cache;
31334f5affdSHannes Reinecke }
31434f5affdSHannes Reinecke 
31534f5affdSHannes Reinecke unsigned int dmz_nr_unmap_cache_zones(struct dmz_metadata *zmd)
31634f5affdSHannes Reinecke {
31734f5affdSHannes Reinecke 	return atomic_read(&zmd->unmap_nr_cache);
31834f5affdSHannes Reinecke }
31934f5affdSHannes Reinecke 
320bc3d5717SHannes Reinecke unsigned int dmz_nr_seq_zones(struct dmz_metadata *zmd)
321bc3d5717SHannes Reinecke {
322bc3d5717SHannes Reinecke 	return zmd->nr_seq;
323bc3d5717SHannes Reinecke }
324bc3d5717SHannes Reinecke 
325bc3d5717SHannes Reinecke unsigned int dmz_nr_unmap_seq_zones(struct dmz_metadata *zmd)
326bc3d5717SHannes Reinecke {
327bc3d5717SHannes Reinecke 	return atomic_read(&zmd->unmap_nr_seq);
328bc3d5717SHannes Reinecke }
329bc3d5717SHannes Reinecke 
3302234e732SHannes Reinecke const char *dmz_metadata_label(struct dmz_metadata *zmd)
3312234e732SHannes Reinecke {
332bd5c4031SHannes Reinecke 	return (const char *)zmd->label;
3332234e732SHannes Reinecke }
3342234e732SHannes Reinecke 
335d0e21ce4SHannes Reinecke bool dmz_check_dev(struct dmz_metadata *zmd)
336d0e21ce4SHannes Reinecke {
337bd5c4031SHannes Reinecke 	unsigned int i;
338bd5c4031SHannes Reinecke 
339bd5c4031SHannes Reinecke 	for (i = 0; i < zmd->nr_devs; i++) {
340bd5c4031SHannes Reinecke 		if (!dmz_check_bdev(&zmd->dev[i]))
341bd5c4031SHannes Reinecke 			return false;
342bd5c4031SHannes Reinecke 	}
343bd5c4031SHannes Reinecke 	return true;
344d0e21ce4SHannes Reinecke }
345d0e21ce4SHannes Reinecke 
346d0e21ce4SHannes Reinecke bool dmz_dev_is_dying(struct dmz_metadata *zmd)
347d0e21ce4SHannes Reinecke {
348bd5c4031SHannes Reinecke 	unsigned int i;
349bd5c4031SHannes Reinecke 
350bd5c4031SHannes Reinecke 	for (i = 0; i < zmd->nr_devs; i++) {
351bd5c4031SHannes Reinecke 		if (dmz_bdev_is_dying(&zmd->dev[i]))
352bd5c4031SHannes Reinecke 			return true;
353bd5c4031SHannes Reinecke 	}
354bd5c4031SHannes Reinecke 	return false;
355d0e21ce4SHannes Reinecke }
356d0e21ce4SHannes Reinecke 
3573b1a94c8SDamien Le Moal /*
3583b1a94c8SDamien Le Moal  * Lock/unlock mapping table.
3593b1a94c8SDamien Le Moal  * The map lock also protects all the zone lists.
3603b1a94c8SDamien Le Moal  */
3613b1a94c8SDamien Le Moal void dmz_lock_map(struct dmz_metadata *zmd)
3623b1a94c8SDamien Le Moal {
3633b1a94c8SDamien Le Moal 	mutex_lock(&zmd->map_lock);
3643b1a94c8SDamien Le Moal }
3653b1a94c8SDamien Le Moal 
3663b1a94c8SDamien Le Moal void dmz_unlock_map(struct dmz_metadata *zmd)
3673b1a94c8SDamien Le Moal {
3683b1a94c8SDamien Le Moal 	mutex_unlock(&zmd->map_lock);
3693b1a94c8SDamien Le Moal }
3703b1a94c8SDamien Le Moal 
3713b1a94c8SDamien Le Moal /*
3723b1a94c8SDamien Le Moal  * Lock/unlock metadata access. This is a "read" lock on a semaphore
3733b1a94c8SDamien Le Moal  * that prevents metadata flush from running while metadata are being
3743b1a94c8SDamien Le Moal  * modified. The actual metadata write mutual exclusion is achieved with
375ad1bd578SDmitry Fomichev  * the map lock and zone state management (active and reclaim state are
3763b1a94c8SDamien Le Moal  * mutually exclusive).
3773b1a94c8SDamien Le Moal  */
3783b1a94c8SDamien Le Moal void dmz_lock_metadata(struct dmz_metadata *zmd)
3793b1a94c8SDamien Le Moal {
3803b1a94c8SDamien Le Moal 	down_read(&zmd->mblk_sem);
3813b1a94c8SDamien Le Moal }
3823b1a94c8SDamien Le Moal 
3833b1a94c8SDamien Le Moal void dmz_unlock_metadata(struct dmz_metadata *zmd)
3843b1a94c8SDamien Le Moal {
3853b1a94c8SDamien Le Moal 	up_read(&zmd->mblk_sem);
3863b1a94c8SDamien Le Moal }
3873b1a94c8SDamien Le Moal 
3883b1a94c8SDamien Le Moal /*
3893b1a94c8SDamien Le Moal  * Lock/unlock flush: prevent concurrent executions
3903b1a94c8SDamien Le Moal  * of dmz_flush_metadata as well as metadata modification in reclaim
3913b1a94c8SDamien Le Moal  * while flush is being executed.
3923b1a94c8SDamien Le Moal  */
3933b1a94c8SDamien Le Moal void dmz_lock_flush(struct dmz_metadata *zmd)
3943b1a94c8SDamien Le Moal {
3953b1a94c8SDamien Le Moal 	mutex_lock(&zmd->mblk_flush_lock);
3963b1a94c8SDamien Le Moal }
3973b1a94c8SDamien Le Moal 
3983b1a94c8SDamien Le Moal void dmz_unlock_flush(struct dmz_metadata *zmd)
3993b1a94c8SDamien Le Moal {
4003b1a94c8SDamien Le Moal 	mutex_unlock(&zmd->mblk_flush_lock);
4013b1a94c8SDamien Le Moal }
4023b1a94c8SDamien Le Moal 
4033b1a94c8SDamien Le Moal /*
4043b1a94c8SDamien Le Moal  * Allocate a metadata block.
4053b1a94c8SDamien Le Moal  */
4063b1a94c8SDamien Le Moal static struct dmz_mblock *dmz_alloc_mblock(struct dmz_metadata *zmd,
4073b1a94c8SDamien Le Moal 					   sector_t mblk_no)
4083b1a94c8SDamien Le Moal {
4093b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk = NULL;
4103b1a94c8SDamien Le Moal 
4113b1a94c8SDamien Le Moal 	/* See if we can reuse cached blocks */
4123b1a94c8SDamien Le Moal 	if (zmd->max_nr_mblks && atomic_read(&zmd->nr_mblks) > zmd->max_nr_mblks) {
4133b1a94c8SDamien Le Moal 		spin_lock(&zmd->mblk_lock);
4143b1a94c8SDamien Le Moal 		mblk = list_first_entry_or_null(&zmd->mblk_lru_list,
4153b1a94c8SDamien Le Moal 						struct dmz_mblock, link);
4163b1a94c8SDamien Le Moal 		if (mblk) {
4173b1a94c8SDamien Le Moal 			list_del_init(&mblk->link);
4183b1a94c8SDamien Le Moal 			rb_erase(&mblk->node, &zmd->mblk_rbtree);
4193b1a94c8SDamien Le Moal 			mblk->no = mblk_no;
4203b1a94c8SDamien Le Moal 		}
4213b1a94c8SDamien Le Moal 		spin_unlock(&zmd->mblk_lock);
4223b1a94c8SDamien Le Moal 		if (mblk)
4233b1a94c8SDamien Le Moal 			return mblk;
4243b1a94c8SDamien Le Moal 	}
4253b1a94c8SDamien Le Moal 
4263b1a94c8SDamien Le Moal 	/* Allocate a new block */
4273b1a94c8SDamien Le Moal 	mblk = kmalloc(sizeof(struct dmz_mblock), GFP_NOIO);
4283b1a94c8SDamien Le Moal 	if (!mblk)
4293b1a94c8SDamien Le Moal 		return NULL;
4303b1a94c8SDamien Le Moal 
4313b1a94c8SDamien Le Moal 	mblk->page = alloc_page(GFP_NOIO);
4323b1a94c8SDamien Le Moal 	if (!mblk->page) {
4333b1a94c8SDamien Le Moal 		kfree(mblk);
4343b1a94c8SDamien Le Moal 		return NULL;
4353b1a94c8SDamien Le Moal 	}
4363b1a94c8SDamien Le Moal 
4373b1a94c8SDamien Le Moal 	RB_CLEAR_NODE(&mblk->node);
4383b1a94c8SDamien Le Moal 	INIT_LIST_HEAD(&mblk->link);
43933c2865fSDamien Le Moal 	mblk->ref = 0;
4403b1a94c8SDamien Le Moal 	mblk->state = 0;
4413b1a94c8SDamien Le Moal 	mblk->no = mblk_no;
4423b1a94c8SDamien Le Moal 	mblk->data = page_address(mblk->page);
4433b1a94c8SDamien Le Moal 
4443b1a94c8SDamien Le Moal 	atomic_inc(&zmd->nr_mblks);
4453b1a94c8SDamien Le Moal 
4463b1a94c8SDamien Le Moal 	return mblk;
4473b1a94c8SDamien Le Moal }
4483b1a94c8SDamien Le Moal 
4493b1a94c8SDamien Le Moal /*
4503b1a94c8SDamien Le Moal  * Free a metadata block.
4513b1a94c8SDamien Le Moal  */
4523b1a94c8SDamien Le Moal static void dmz_free_mblock(struct dmz_metadata *zmd, struct dmz_mblock *mblk)
4533b1a94c8SDamien Le Moal {
4543b1a94c8SDamien Le Moal 	__free_pages(mblk->page, 0);
4553b1a94c8SDamien Le Moal 	kfree(mblk);
4563b1a94c8SDamien Le Moal 
4573b1a94c8SDamien Le Moal 	atomic_dec(&zmd->nr_mblks);
4583b1a94c8SDamien Le Moal }
4593b1a94c8SDamien Le Moal 
4603b1a94c8SDamien Le Moal /*
4613b1a94c8SDamien Le Moal  * Insert a metadata block in the rbtree.
4623b1a94c8SDamien Le Moal  */
4633b1a94c8SDamien Le Moal static void dmz_insert_mblock(struct dmz_metadata *zmd, struct dmz_mblock *mblk)
4643b1a94c8SDamien Le Moal {
4653b1a94c8SDamien Le Moal 	struct rb_root *root = &zmd->mblk_rbtree;
4663b1a94c8SDamien Le Moal 	struct rb_node **new = &(root->rb_node), *parent = NULL;
4673b1a94c8SDamien Le Moal 	struct dmz_mblock *b;
4683b1a94c8SDamien Le Moal 
4693b1a94c8SDamien Le Moal 	/* Figure out where to put the new node */
4703b1a94c8SDamien Le Moal 	while (*new) {
4713b1a94c8SDamien Le Moal 		b = container_of(*new, struct dmz_mblock, node);
4723b1a94c8SDamien Le Moal 		parent = *new;
4733b1a94c8SDamien Le Moal 		new = (b->no < mblk->no) ? &((*new)->rb_left) : &((*new)->rb_right);
4743b1a94c8SDamien Le Moal 	}
4753b1a94c8SDamien Le Moal 
4763b1a94c8SDamien Le Moal 	/* Add new node and rebalance tree */
4773b1a94c8SDamien Le Moal 	rb_link_node(&mblk->node, parent, new);
4783b1a94c8SDamien Le Moal 	rb_insert_color(&mblk->node, root);
4793b1a94c8SDamien Le Moal }
4803b1a94c8SDamien Le Moal 
4813b1a94c8SDamien Le Moal /*
4823d4e7383SDamien Le Moal  * Lookup a metadata block in the rbtree. If the block is found, increment
4833d4e7383SDamien Le Moal  * its reference count.
4843b1a94c8SDamien Le Moal  */
4853d4e7383SDamien Le Moal static struct dmz_mblock *dmz_get_mblock_fast(struct dmz_metadata *zmd,
4863b1a94c8SDamien Le Moal 					      sector_t mblk_no)
4873b1a94c8SDamien Le Moal {
4883b1a94c8SDamien Le Moal 	struct rb_root *root = &zmd->mblk_rbtree;
4893b1a94c8SDamien Le Moal 	struct rb_node *node = root->rb_node;
4903b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk;
4913b1a94c8SDamien Le Moal 
4923b1a94c8SDamien Le Moal 	while (node) {
4933b1a94c8SDamien Le Moal 		mblk = container_of(node, struct dmz_mblock, node);
4943d4e7383SDamien Le Moal 		if (mblk->no == mblk_no) {
4953d4e7383SDamien Le Moal 			/*
4963d4e7383SDamien Le Moal 			 * If this is the first reference to the block,
4973d4e7383SDamien Le Moal 			 * remove it from the LRU list.
4983d4e7383SDamien Le Moal 			 */
4993d4e7383SDamien Le Moal 			mblk->ref++;
5003d4e7383SDamien Le Moal 			if (mblk->ref == 1 &&
5013d4e7383SDamien Le Moal 			    !test_bit(DMZ_META_DIRTY, &mblk->state))
5023d4e7383SDamien Le Moal 				list_del_init(&mblk->link);
5033b1a94c8SDamien Le Moal 			return mblk;
5043d4e7383SDamien Le Moal 		}
5053b1a94c8SDamien Le Moal 		node = (mblk->no < mblk_no) ? node->rb_left : node->rb_right;
5063b1a94c8SDamien Le Moal 	}
5073b1a94c8SDamien Le Moal 
5083b1a94c8SDamien Le Moal 	return NULL;
5093b1a94c8SDamien Le Moal }
5103b1a94c8SDamien Le Moal 
5113b1a94c8SDamien Le Moal /*
5123b1a94c8SDamien Le Moal  * Metadata block BIO end callback.
5133b1a94c8SDamien Le Moal  */
5143b1a94c8SDamien Le Moal static void dmz_mblock_bio_end_io(struct bio *bio)
5153b1a94c8SDamien Le Moal {
5163b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk = bio->bi_private;
5173b1a94c8SDamien Le Moal 	int flag;
5183b1a94c8SDamien Le Moal 
5193b1a94c8SDamien Le Moal 	if (bio->bi_status)
5203b1a94c8SDamien Le Moal 		set_bit(DMZ_META_ERROR, &mblk->state);
5213b1a94c8SDamien Le Moal 
5223b1a94c8SDamien Le Moal 	if (bio_op(bio) == REQ_OP_WRITE)
5233b1a94c8SDamien Le Moal 		flag = DMZ_META_WRITING;
5243b1a94c8SDamien Le Moal 	else
5253b1a94c8SDamien Le Moal 		flag = DMZ_META_READING;
5263b1a94c8SDamien Le Moal 
5273b1a94c8SDamien Le Moal 	clear_bit_unlock(flag, &mblk->state);
5283b1a94c8SDamien Le Moal 	smp_mb__after_atomic();
5293b1a94c8SDamien Le Moal 	wake_up_bit(&mblk->state, flag);
5303b1a94c8SDamien Le Moal 
5313b1a94c8SDamien Le Moal 	bio_put(bio);
5323b1a94c8SDamien Le Moal }
5333b1a94c8SDamien Le Moal 
5343b1a94c8SDamien Le Moal /*
5353d4e7383SDamien Le Moal  * Read an uncached metadata block from disk and add it to the cache.
5363b1a94c8SDamien Le Moal  */
5373d4e7383SDamien Le Moal static struct dmz_mblock *dmz_get_mblock_slow(struct dmz_metadata *zmd,
5383b1a94c8SDamien Le Moal 					      sector_t mblk_no)
5393b1a94c8SDamien Le Moal {
5403d4e7383SDamien Le Moal 	struct dmz_mblock *mblk, *m;
5413b1a94c8SDamien Le Moal 	sector_t block = zmd->sb[zmd->mblk_primary].block + mblk_no;
542bf28a3baSHannes Reinecke 	struct dmz_dev *dev = zmd->sb[zmd->mblk_primary].dev;
5433b1a94c8SDamien Le Moal 	struct bio *bio;
5443b1a94c8SDamien Le Moal 
545bf28a3baSHannes Reinecke 	if (dmz_bdev_is_dying(dev))
54675d66ffbSDmitry Fomichev 		return ERR_PTR(-EIO);
54775d66ffbSDmitry Fomichev 
5483d4e7383SDamien Le Moal 	/* Get a new block and a BIO to read it */
5493b1a94c8SDamien Le Moal 	mblk = dmz_alloc_mblock(zmd, mblk_no);
5503b1a94c8SDamien Le Moal 	if (!mblk)
55175d66ffbSDmitry Fomichev 		return ERR_PTR(-ENOMEM);
5523b1a94c8SDamien Le Moal 
5533b1a94c8SDamien Le Moal 	bio = bio_alloc(GFP_NOIO, 1);
5543b1a94c8SDamien Le Moal 	if (!bio) {
5553b1a94c8SDamien Le Moal 		dmz_free_mblock(zmd, mblk);
55675d66ffbSDmitry Fomichev 		return ERR_PTR(-ENOMEM);
5573b1a94c8SDamien Le Moal 	}
5583b1a94c8SDamien Le Moal 
5593d4e7383SDamien Le Moal 	spin_lock(&zmd->mblk_lock);
5603d4e7383SDamien Le Moal 
5613d4e7383SDamien Le Moal 	/*
5623d4e7383SDamien Le Moal 	 * Make sure that another context did not start reading
5633d4e7383SDamien Le Moal 	 * the block already.
5643d4e7383SDamien Le Moal 	 */
5653d4e7383SDamien Le Moal 	m = dmz_get_mblock_fast(zmd, mblk_no);
5663d4e7383SDamien Le Moal 	if (m) {
5673d4e7383SDamien Le Moal 		spin_unlock(&zmd->mblk_lock);
5683d4e7383SDamien Le Moal 		dmz_free_mblock(zmd, mblk);
5693d4e7383SDamien Le Moal 		bio_put(bio);
5703d4e7383SDamien Le Moal 		return m;
5713d4e7383SDamien Le Moal 	}
5723d4e7383SDamien Le Moal 
5733d4e7383SDamien Le Moal 	mblk->ref++;
5743d4e7383SDamien Le Moal 	set_bit(DMZ_META_READING, &mblk->state);
5753d4e7383SDamien Le Moal 	dmz_insert_mblock(zmd, mblk);
5763d4e7383SDamien Le Moal 
5773d4e7383SDamien Le Moal 	spin_unlock(&zmd->mblk_lock);
5783d4e7383SDamien Le Moal 
5793d4e7383SDamien Le Moal 	/* Submit read BIO */
5803b1a94c8SDamien Le Moal 	bio->bi_iter.bi_sector = dmz_blk2sect(block);
581bf28a3baSHannes Reinecke 	bio_set_dev(bio, dev->bdev);
5823b1a94c8SDamien Le Moal 	bio->bi_private = mblk;
5833b1a94c8SDamien Le Moal 	bio->bi_end_io = dmz_mblock_bio_end_io;
5843b1a94c8SDamien Le Moal 	bio_set_op_attrs(bio, REQ_OP_READ, REQ_META | REQ_PRIO);
5853b1a94c8SDamien Le Moal 	bio_add_page(bio, mblk->page, DMZ_BLOCK_SIZE, 0);
5863b1a94c8SDamien Le Moal 	submit_bio(bio);
5873b1a94c8SDamien Le Moal 
5883b1a94c8SDamien Le Moal 	return mblk;
5893b1a94c8SDamien Le Moal }
5903b1a94c8SDamien Le Moal 
5913b1a94c8SDamien Le Moal /*
5923b1a94c8SDamien Le Moal  * Free metadata blocks.
5933b1a94c8SDamien Le Moal  */
5943b1a94c8SDamien Le Moal static unsigned long dmz_shrink_mblock_cache(struct dmz_metadata *zmd,
5953b1a94c8SDamien Le Moal 					     unsigned long limit)
5963b1a94c8SDamien Le Moal {
5973b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk;
5983b1a94c8SDamien Le Moal 	unsigned long count = 0;
5993b1a94c8SDamien Le Moal 
6003b1a94c8SDamien Le Moal 	if (!zmd->max_nr_mblks)
6013b1a94c8SDamien Le Moal 		return 0;
6023b1a94c8SDamien Le Moal 
6033b1a94c8SDamien Le Moal 	while (!list_empty(&zmd->mblk_lru_list) &&
6043b1a94c8SDamien Le Moal 	       atomic_read(&zmd->nr_mblks) > zmd->min_nr_mblks &&
6053b1a94c8SDamien Le Moal 	       count < limit) {
6063b1a94c8SDamien Le Moal 		mblk = list_first_entry(&zmd->mblk_lru_list,
6073b1a94c8SDamien Le Moal 					struct dmz_mblock, link);
6083b1a94c8SDamien Le Moal 		list_del_init(&mblk->link);
6093b1a94c8SDamien Le Moal 		rb_erase(&mblk->node, &zmd->mblk_rbtree);
6103b1a94c8SDamien Le Moal 		dmz_free_mblock(zmd, mblk);
6113b1a94c8SDamien Le Moal 		count++;
6123b1a94c8SDamien Le Moal 	}
6133b1a94c8SDamien Le Moal 
6143b1a94c8SDamien Le Moal 	return count;
6153b1a94c8SDamien Le Moal }
6163b1a94c8SDamien Le Moal 
6173b1a94c8SDamien Le Moal /*
6183b1a94c8SDamien Le Moal  * For mblock shrinker: get the number of unused metadata blocks in the cache.
6193b1a94c8SDamien Le Moal  */
6203b1a94c8SDamien Le Moal static unsigned long dmz_mblock_shrinker_count(struct shrinker *shrink,
6213b1a94c8SDamien Le Moal 					       struct shrink_control *sc)
6223b1a94c8SDamien Le Moal {
6233b1a94c8SDamien Le Moal 	struct dmz_metadata *zmd = container_of(shrink, struct dmz_metadata, mblk_shrinker);
6243b1a94c8SDamien Le Moal 
6253b1a94c8SDamien Le Moal 	return atomic_read(&zmd->nr_mblks);
6263b1a94c8SDamien Le Moal }
6273b1a94c8SDamien Le Moal 
6283b1a94c8SDamien Le Moal /*
6293b1a94c8SDamien Le Moal  * For mblock shrinker: scan unused metadata blocks and shrink the cache.
6303b1a94c8SDamien Le Moal  */
6313b1a94c8SDamien Le Moal static unsigned long dmz_mblock_shrinker_scan(struct shrinker *shrink,
6323b1a94c8SDamien Le Moal 					      struct shrink_control *sc)
6333b1a94c8SDamien Le Moal {
6343b1a94c8SDamien Le Moal 	struct dmz_metadata *zmd = container_of(shrink, struct dmz_metadata, mblk_shrinker);
6353b1a94c8SDamien Le Moal 	unsigned long count;
6363b1a94c8SDamien Le Moal 
6373b1a94c8SDamien Le Moal 	spin_lock(&zmd->mblk_lock);
6383b1a94c8SDamien Le Moal 	count = dmz_shrink_mblock_cache(zmd, sc->nr_to_scan);
6393b1a94c8SDamien Le Moal 	spin_unlock(&zmd->mblk_lock);
6403b1a94c8SDamien Le Moal 
6413b1a94c8SDamien Le Moal 	return count ? count : SHRINK_STOP;
6423b1a94c8SDamien Le Moal }
6433b1a94c8SDamien Le Moal 
6443b1a94c8SDamien Le Moal /*
6453b1a94c8SDamien Le Moal  * Release a metadata block.
6463b1a94c8SDamien Le Moal  */
6473b1a94c8SDamien Le Moal static void dmz_release_mblock(struct dmz_metadata *zmd,
6483b1a94c8SDamien Le Moal 			       struct dmz_mblock *mblk)
6493b1a94c8SDamien Le Moal {
6503b1a94c8SDamien Le Moal 
6513b1a94c8SDamien Le Moal 	if (!mblk)
6523b1a94c8SDamien Le Moal 		return;
6533b1a94c8SDamien Le Moal 
6543b1a94c8SDamien Le Moal 	spin_lock(&zmd->mblk_lock);
6553b1a94c8SDamien Le Moal 
65633c2865fSDamien Le Moal 	mblk->ref--;
65733c2865fSDamien Le Moal 	if (mblk->ref == 0) {
6583b1a94c8SDamien Le Moal 		if (test_bit(DMZ_META_ERROR, &mblk->state)) {
6593b1a94c8SDamien Le Moal 			rb_erase(&mblk->node, &zmd->mblk_rbtree);
6603b1a94c8SDamien Le Moal 			dmz_free_mblock(zmd, mblk);
6613b1a94c8SDamien Le Moal 		} else if (!test_bit(DMZ_META_DIRTY, &mblk->state)) {
6623b1a94c8SDamien Le Moal 			list_add_tail(&mblk->link, &zmd->mblk_lru_list);
6633b1a94c8SDamien Le Moal 			dmz_shrink_mblock_cache(zmd, 1);
6643b1a94c8SDamien Le Moal 		}
6653b1a94c8SDamien Le Moal 	}
6663b1a94c8SDamien Le Moal 
6673b1a94c8SDamien Le Moal 	spin_unlock(&zmd->mblk_lock);
6683b1a94c8SDamien Le Moal }
6693b1a94c8SDamien Le Moal 
6703b1a94c8SDamien Le Moal /*
6713b1a94c8SDamien Le Moal  * Get a metadata block from the rbtree. If the block
6723b1a94c8SDamien Le Moal  * is not present, read it from disk.
6733b1a94c8SDamien Le Moal  */
6743b1a94c8SDamien Le Moal static struct dmz_mblock *dmz_get_mblock(struct dmz_metadata *zmd,
6753b1a94c8SDamien Le Moal 					 sector_t mblk_no)
6763b1a94c8SDamien Le Moal {
6773b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk;
678bf28a3baSHannes Reinecke 	struct dmz_dev *dev = zmd->sb[zmd->mblk_primary].dev;
6793b1a94c8SDamien Le Moal 
6803b1a94c8SDamien Le Moal 	/* Check rbtree */
6813b1a94c8SDamien Le Moal 	spin_lock(&zmd->mblk_lock);
6823d4e7383SDamien Le Moal 	mblk = dmz_get_mblock_fast(zmd, mblk_no);
6833b1a94c8SDamien Le Moal 	spin_unlock(&zmd->mblk_lock);
6843b1a94c8SDamien Le Moal 
6853b1a94c8SDamien Le Moal 	if (!mblk) {
6863b1a94c8SDamien Le Moal 		/* Cache miss: read the block from disk */
6873d4e7383SDamien Le Moal 		mblk = dmz_get_mblock_slow(zmd, mblk_no);
68875d66ffbSDmitry Fomichev 		if (IS_ERR(mblk))
68975d66ffbSDmitry Fomichev 			return mblk;
6903b1a94c8SDamien Le Moal 	}
6913b1a94c8SDamien Le Moal 
6923b1a94c8SDamien Le Moal 	/* Wait for on-going read I/O and check for error */
6933b1a94c8SDamien Le Moal 	wait_on_bit_io(&mblk->state, DMZ_META_READING,
6943b1a94c8SDamien Le Moal 		       TASK_UNINTERRUPTIBLE);
6953b1a94c8SDamien Le Moal 	if (test_bit(DMZ_META_ERROR, &mblk->state)) {
6963b1a94c8SDamien Le Moal 		dmz_release_mblock(zmd, mblk);
697bf28a3baSHannes Reinecke 		dmz_check_bdev(dev);
6983b1a94c8SDamien Le Moal 		return ERR_PTR(-EIO);
6993b1a94c8SDamien Le Moal 	}
7003b1a94c8SDamien Le Moal 
7013b1a94c8SDamien Le Moal 	return mblk;
7023b1a94c8SDamien Le Moal }
7033b1a94c8SDamien Le Moal 
7043b1a94c8SDamien Le Moal /*
7053b1a94c8SDamien Le Moal  * Mark a metadata block dirty.
7063b1a94c8SDamien Le Moal  */
7073b1a94c8SDamien Le Moal static void dmz_dirty_mblock(struct dmz_metadata *zmd, struct dmz_mblock *mblk)
7083b1a94c8SDamien Le Moal {
7093b1a94c8SDamien Le Moal 	spin_lock(&zmd->mblk_lock);
7103b1a94c8SDamien Le Moal 	if (!test_and_set_bit(DMZ_META_DIRTY, &mblk->state))
7113b1a94c8SDamien Le Moal 		list_add_tail(&mblk->link, &zmd->mblk_dirty_list);
7123b1a94c8SDamien Le Moal 	spin_unlock(&zmd->mblk_lock);
7133b1a94c8SDamien Le Moal }
7143b1a94c8SDamien Le Moal 
7153b1a94c8SDamien Le Moal /*
7163b1a94c8SDamien Le Moal  * Issue a metadata block write BIO.
7173b1a94c8SDamien Le Moal  */
71875d66ffbSDmitry Fomichev static int dmz_write_mblock(struct dmz_metadata *zmd, struct dmz_mblock *mblk,
7193b1a94c8SDamien Le Moal 			    unsigned int set)
7203b1a94c8SDamien Le Moal {
721bf28a3baSHannes Reinecke 	struct dmz_dev *dev = zmd->sb[set].dev;
7223b1a94c8SDamien Le Moal 	sector_t block = zmd->sb[set].block + mblk->no;
7233b1a94c8SDamien Le Moal 	struct bio *bio;
7243b1a94c8SDamien Le Moal 
725bf28a3baSHannes Reinecke 	if (dmz_bdev_is_dying(dev))
72675d66ffbSDmitry Fomichev 		return -EIO;
72775d66ffbSDmitry Fomichev 
7283b1a94c8SDamien Le Moal 	bio = bio_alloc(GFP_NOIO, 1);
7293b1a94c8SDamien Le Moal 	if (!bio) {
7303b1a94c8SDamien Le Moal 		set_bit(DMZ_META_ERROR, &mblk->state);
73175d66ffbSDmitry Fomichev 		return -ENOMEM;
7323b1a94c8SDamien Le Moal 	}
7333b1a94c8SDamien Le Moal 
7343b1a94c8SDamien Le Moal 	set_bit(DMZ_META_WRITING, &mblk->state);
7353b1a94c8SDamien Le Moal 
7363b1a94c8SDamien Le Moal 	bio->bi_iter.bi_sector = dmz_blk2sect(block);
737bf28a3baSHannes Reinecke 	bio_set_dev(bio, dev->bdev);
7383b1a94c8SDamien Le Moal 	bio->bi_private = mblk;
7393b1a94c8SDamien Le Moal 	bio->bi_end_io = dmz_mblock_bio_end_io;
7403b1a94c8SDamien Le Moal 	bio_set_op_attrs(bio, REQ_OP_WRITE, REQ_META | REQ_PRIO);
7413b1a94c8SDamien Le Moal 	bio_add_page(bio, mblk->page, DMZ_BLOCK_SIZE, 0);
7423b1a94c8SDamien Le Moal 	submit_bio(bio);
74375d66ffbSDmitry Fomichev 
74475d66ffbSDmitry Fomichev 	return 0;
7453b1a94c8SDamien Le Moal }
7463b1a94c8SDamien Le Moal 
7473b1a94c8SDamien Le Moal /*
7483b1a94c8SDamien Le Moal  * Read/write a metadata block.
7493b1a94c8SDamien Le Moal  */
750bf28a3baSHannes Reinecke static int dmz_rdwr_block(struct dmz_dev *dev, int op,
751bf28a3baSHannes Reinecke 			  sector_t block, struct page *page)
7523b1a94c8SDamien Le Moal {
7533b1a94c8SDamien Le Moal 	struct bio *bio;
7543b1a94c8SDamien Le Moal 	int ret;
7553b1a94c8SDamien Le Moal 
756bd5c4031SHannes Reinecke 	if (WARN_ON(!dev))
757bd5c4031SHannes Reinecke 		return -EIO;
758bd5c4031SHannes Reinecke 
759bf28a3baSHannes Reinecke 	if (dmz_bdev_is_dying(dev))
76075d66ffbSDmitry Fomichev 		return -EIO;
76175d66ffbSDmitry Fomichev 
7623b1a94c8SDamien Le Moal 	bio = bio_alloc(GFP_NOIO, 1);
7633b1a94c8SDamien Le Moal 	if (!bio)
7643b1a94c8SDamien Le Moal 		return -ENOMEM;
7653b1a94c8SDamien Le Moal 
7663b1a94c8SDamien Le Moal 	bio->bi_iter.bi_sector = dmz_blk2sect(block);
767bf28a3baSHannes Reinecke 	bio_set_dev(bio, dev->bdev);
7683b1a94c8SDamien Le Moal 	bio_set_op_attrs(bio, op, REQ_SYNC | REQ_META | REQ_PRIO);
7693b1a94c8SDamien Le Moal 	bio_add_page(bio, page, DMZ_BLOCK_SIZE, 0);
7703b1a94c8SDamien Le Moal 	ret = submit_bio_wait(bio);
7713b1a94c8SDamien Le Moal 	bio_put(bio);
7723b1a94c8SDamien Le Moal 
773e7fad909SDmitry Fomichev 	if (ret)
774bf28a3baSHannes Reinecke 		dmz_check_bdev(dev);
7753b1a94c8SDamien Le Moal 	return ret;
7763b1a94c8SDamien Le Moal }
7773b1a94c8SDamien Le Moal 
7783b1a94c8SDamien Le Moal /*
7793b1a94c8SDamien Le Moal  * Write super block of the specified metadata set.
7803b1a94c8SDamien Le Moal  */
7813b1a94c8SDamien Le Moal static int dmz_write_sb(struct dmz_metadata *zmd, unsigned int set)
7823b1a94c8SDamien Le Moal {
7833b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk = zmd->sb[set].mblk;
7843b1a94c8SDamien Le Moal 	struct dmz_super *sb = zmd->sb[set].sb;
785bf28a3baSHannes Reinecke 	struct dmz_dev *dev = zmd->sb[set].dev;
786bd5c4031SHannes Reinecke 	sector_t sb_block;
7873b1a94c8SDamien Le Moal 	u64 sb_gen = zmd->sb_gen + 1;
7883b1a94c8SDamien Le Moal 	int ret;
7893b1a94c8SDamien Le Moal 
7903b1a94c8SDamien Le Moal 	sb->magic = cpu_to_le32(DMZ_MAGIC);
791bd5c4031SHannes Reinecke 
792bd5c4031SHannes Reinecke 	sb->version = cpu_to_le32(zmd->sb_version);
793bd5c4031SHannes Reinecke 	if (zmd->sb_version > 1) {
794bd5c4031SHannes Reinecke 		BUILD_BUG_ON(UUID_SIZE != 16);
795bd5c4031SHannes Reinecke 		export_uuid(sb->dmz_uuid, &zmd->uuid);
796bd5c4031SHannes Reinecke 		memcpy(sb->dmz_label, zmd->label, BDEVNAME_SIZE);
797bd5c4031SHannes Reinecke 		export_uuid(sb->dev_uuid, &dev->uuid);
798bd5c4031SHannes Reinecke 	}
7993b1a94c8SDamien Le Moal 
8003b1a94c8SDamien Le Moal 	sb->gen = cpu_to_le64(sb_gen);
8013b1a94c8SDamien Le Moal 
802bd5c4031SHannes Reinecke 	/*
803bd5c4031SHannes Reinecke 	 * The metadata always references the absolute block address,
804bd5c4031SHannes Reinecke 	 * ie relative to the entire block range, not the per-device
805bd5c4031SHannes Reinecke 	 * block address.
806bd5c4031SHannes Reinecke 	 */
807bd5c4031SHannes Reinecke 	sb_block = zmd->sb[set].zone->id << zmd->zone_nr_blocks_shift;
808bd5c4031SHannes Reinecke 	sb->sb_block = cpu_to_le64(sb_block);
8093b1a94c8SDamien Le Moal 	sb->nr_meta_blocks = cpu_to_le32(zmd->nr_meta_blocks);
8103b1a94c8SDamien Le Moal 	sb->nr_reserved_seq = cpu_to_le32(zmd->nr_reserved_seq);
8113b1a94c8SDamien Le Moal 	sb->nr_chunks = cpu_to_le32(zmd->nr_chunks);
8123b1a94c8SDamien Le Moal 
8133b1a94c8SDamien Le Moal 	sb->nr_map_blocks = cpu_to_le32(zmd->nr_map_blocks);
8143b1a94c8SDamien Le Moal 	sb->nr_bitmap_blocks = cpu_to_le32(zmd->nr_bitmap_blocks);
8153b1a94c8SDamien Le Moal 
8163b1a94c8SDamien Le Moal 	sb->crc = 0;
8173b1a94c8SDamien Le Moal 	sb->crc = cpu_to_le32(crc32_le(sb_gen, (unsigned char *)sb, DMZ_BLOCK_SIZE));
8183b1a94c8SDamien Le Moal 
819bd5c4031SHannes Reinecke 	ret = dmz_rdwr_block(dev, REQ_OP_WRITE, zmd->sb[set].block,
820bd5c4031SHannes Reinecke 			     mblk->page);
8213b1a94c8SDamien Le Moal 	if (ret == 0)
822bf28a3baSHannes Reinecke 		ret = blkdev_issue_flush(dev->bdev, GFP_NOIO, NULL);
8233b1a94c8SDamien Le Moal 
8243b1a94c8SDamien Le Moal 	return ret;
8253b1a94c8SDamien Le Moal }
8263b1a94c8SDamien Le Moal 
8273b1a94c8SDamien Le Moal /*
8283b1a94c8SDamien Le Moal  * Write dirty metadata blocks to the specified set.
8293b1a94c8SDamien Le Moal  */
8303b1a94c8SDamien Le Moal static int dmz_write_dirty_mblocks(struct dmz_metadata *zmd,
8313b1a94c8SDamien Le Moal 				   struct list_head *write_list,
8323b1a94c8SDamien Le Moal 				   unsigned int set)
8333b1a94c8SDamien Le Moal {
8343b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk;
835bf28a3baSHannes Reinecke 	struct dmz_dev *dev = zmd->sb[set].dev;
8363b1a94c8SDamien Le Moal 	struct blk_plug plug;
83775d66ffbSDmitry Fomichev 	int ret = 0, nr_mblks_submitted = 0;
8383b1a94c8SDamien Le Moal 
8393b1a94c8SDamien Le Moal 	/* Issue writes */
8403b1a94c8SDamien Le Moal 	blk_start_plug(&plug);
84175d66ffbSDmitry Fomichev 	list_for_each_entry(mblk, write_list, link) {
84275d66ffbSDmitry Fomichev 		ret = dmz_write_mblock(zmd, mblk, set);
84375d66ffbSDmitry Fomichev 		if (ret)
84475d66ffbSDmitry Fomichev 			break;
84575d66ffbSDmitry Fomichev 		nr_mblks_submitted++;
84675d66ffbSDmitry Fomichev 	}
8473b1a94c8SDamien Le Moal 	blk_finish_plug(&plug);
8483b1a94c8SDamien Le Moal 
8493b1a94c8SDamien Le Moal 	/* Wait for completion */
8503b1a94c8SDamien Le Moal 	list_for_each_entry(mblk, write_list, link) {
85175d66ffbSDmitry Fomichev 		if (!nr_mblks_submitted)
85275d66ffbSDmitry Fomichev 			break;
8533b1a94c8SDamien Le Moal 		wait_on_bit_io(&mblk->state, DMZ_META_WRITING,
8543b1a94c8SDamien Le Moal 			       TASK_UNINTERRUPTIBLE);
8553b1a94c8SDamien Le Moal 		if (test_bit(DMZ_META_ERROR, &mblk->state)) {
8563b1a94c8SDamien Le Moal 			clear_bit(DMZ_META_ERROR, &mblk->state);
857bf28a3baSHannes Reinecke 			dmz_check_bdev(dev);
8583b1a94c8SDamien Le Moal 			ret = -EIO;
8593b1a94c8SDamien Le Moal 		}
86075d66ffbSDmitry Fomichev 		nr_mblks_submitted--;
8613b1a94c8SDamien Le Moal 	}
8623b1a94c8SDamien Le Moal 
8633b1a94c8SDamien Le Moal 	/* Flush drive cache (this will also sync data) */
8643b1a94c8SDamien Le Moal 	if (ret == 0)
865bf28a3baSHannes Reinecke 		ret = blkdev_issue_flush(dev->bdev, GFP_NOIO, NULL);
8663b1a94c8SDamien Le Moal 
8673b1a94c8SDamien Le Moal 	return ret;
8683b1a94c8SDamien Le Moal }
8693b1a94c8SDamien Le Moal 
8703b1a94c8SDamien Le Moal /*
8713b1a94c8SDamien Le Moal  * Log dirty metadata blocks.
8723b1a94c8SDamien Le Moal  */
8733b1a94c8SDamien Le Moal static int dmz_log_dirty_mblocks(struct dmz_metadata *zmd,
8743b1a94c8SDamien Le Moal 				 struct list_head *write_list)
8753b1a94c8SDamien Le Moal {
8763b1a94c8SDamien Le Moal 	unsigned int log_set = zmd->mblk_primary ^ 0x1;
8773b1a94c8SDamien Le Moal 	int ret;
8783b1a94c8SDamien Le Moal 
8793b1a94c8SDamien Le Moal 	/* Write dirty blocks to the log */
8803b1a94c8SDamien Le Moal 	ret = dmz_write_dirty_mblocks(zmd, write_list, log_set);
8813b1a94c8SDamien Le Moal 	if (ret)
8823b1a94c8SDamien Le Moal 		return ret;
8833b1a94c8SDamien Le Moal 
8843b1a94c8SDamien Le Moal 	/*
8853b1a94c8SDamien Le Moal 	 * No error so far: now validate the log by updating the
8863b1a94c8SDamien Le Moal 	 * log index super block generation.
8873b1a94c8SDamien Le Moal 	 */
8883b1a94c8SDamien Le Moal 	ret = dmz_write_sb(zmd, log_set);
8893b1a94c8SDamien Le Moal 	if (ret)
8903b1a94c8SDamien Le Moal 		return ret;
8913b1a94c8SDamien Le Moal 
8923b1a94c8SDamien Le Moal 	return 0;
8933b1a94c8SDamien Le Moal }
8943b1a94c8SDamien Le Moal 
8953b1a94c8SDamien Le Moal /*
8963b1a94c8SDamien Le Moal  * Flush dirty metadata blocks.
8973b1a94c8SDamien Le Moal  */
8983b1a94c8SDamien Le Moal int dmz_flush_metadata(struct dmz_metadata *zmd)
8993b1a94c8SDamien Le Moal {
9003b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk;
9013b1a94c8SDamien Le Moal 	struct list_head write_list;
902bf28a3baSHannes Reinecke 	struct dmz_dev *dev;
9033b1a94c8SDamien Le Moal 	int ret;
9043b1a94c8SDamien Le Moal 
9053b1a94c8SDamien Le Moal 	if (WARN_ON(!zmd))
9063b1a94c8SDamien Le Moal 		return 0;
9073b1a94c8SDamien Le Moal 
9083b1a94c8SDamien Le Moal 	INIT_LIST_HEAD(&write_list);
9093b1a94c8SDamien Le Moal 
9103b1a94c8SDamien Le Moal 	/*
9113b1a94c8SDamien Le Moal 	 * Make sure that metadata blocks are stable before logging: take
9123b1a94c8SDamien Le Moal 	 * the write lock on the metadata semaphore to prevent target BIOs
9133b1a94c8SDamien Le Moal 	 * from modifying metadata.
9143b1a94c8SDamien Le Moal 	 */
9153b1a94c8SDamien Le Moal 	down_write(&zmd->mblk_sem);
916bf28a3baSHannes Reinecke 	dev = zmd->sb[zmd->mblk_primary].dev;
9173b1a94c8SDamien Le Moal 
9183b1a94c8SDamien Le Moal 	/*
9193b1a94c8SDamien Le Moal 	 * This is called from the target flush work and reclaim work.
9203b1a94c8SDamien Le Moal 	 * Concurrent execution is not allowed.
9213b1a94c8SDamien Le Moal 	 */
9223b1a94c8SDamien Le Moal 	dmz_lock_flush(zmd);
9233b1a94c8SDamien Le Moal 
924bf28a3baSHannes Reinecke 	if (dmz_bdev_is_dying(dev)) {
92575d66ffbSDmitry Fomichev 		ret = -EIO;
92675d66ffbSDmitry Fomichev 		goto out;
92775d66ffbSDmitry Fomichev 	}
92875d66ffbSDmitry Fomichev 
9293b1a94c8SDamien Le Moal 	/* Get dirty blocks */
9303b1a94c8SDamien Le Moal 	spin_lock(&zmd->mblk_lock);
9313b1a94c8SDamien Le Moal 	list_splice_init(&zmd->mblk_dirty_list, &write_list);
9323b1a94c8SDamien Le Moal 	spin_unlock(&zmd->mblk_lock);
9333b1a94c8SDamien Le Moal 
9343b1a94c8SDamien Le Moal 	/* If there are no dirty metadata blocks, just flush the device cache */
9353b1a94c8SDamien Le Moal 	if (list_empty(&write_list)) {
936bf28a3baSHannes Reinecke 		ret = blkdev_issue_flush(dev->bdev, GFP_NOIO, NULL);
937e7fad909SDmitry Fomichev 		goto err;
9383b1a94c8SDamien Le Moal 	}
9393b1a94c8SDamien Le Moal 
9403b1a94c8SDamien Le Moal 	/*
9413b1a94c8SDamien Le Moal 	 * The primary metadata set is still clean. Keep it this way until
9423b1a94c8SDamien Le Moal 	 * all updates are successful in the secondary set. That is, use
9433b1a94c8SDamien Le Moal 	 * the secondary set as a log.
9443b1a94c8SDamien Le Moal 	 */
9453b1a94c8SDamien Le Moal 	ret = dmz_log_dirty_mblocks(zmd, &write_list);
9463b1a94c8SDamien Le Moal 	if (ret)
947e7fad909SDmitry Fomichev 		goto err;
9483b1a94c8SDamien Le Moal 
9493b1a94c8SDamien Le Moal 	/*
9503b1a94c8SDamien Le Moal 	 * The log is on disk. It is now safe to update in place
9513b1a94c8SDamien Le Moal 	 * in the primary metadata set.
9523b1a94c8SDamien Le Moal 	 */
9533b1a94c8SDamien Le Moal 	ret = dmz_write_dirty_mblocks(zmd, &write_list, zmd->mblk_primary);
9543b1a94c8SDamien Le Moal 	if (ret)
955e7fad909SDmitry Fomichev 		goto err;
9563b1a94c8SDamien Le Moal 
9573b1a94c8SDamien Le Moal 	ret = dmz_write_sb(zmd, zmd->mblk_primary);
9583b1a94c8SDamien Le Moal 	if (ret)
959e7fad909SDmitry Fomichev 		goto err;
9603b1a94c8SDamien Le Moal 
9613b1a94c8SDamien Le Moal 	while (!list_empty(&write_list)) {
9623b1a94c8SDamien Le Moal 		mblk = list_first_entry(&write_list, struct dmz_mblock, link);
9633b1a94c8SDamien Le Moal 		list_del_init(&mblk->link);
9643b1a94c8SDamien Le Moal 
9653b1a94c8SDamien Le Moal 		spin_lock(&zmd->mblk_lock);
9663b1a94c8SDamien Le Moal 		clear_bit(DMZ_META_DIRTY, &mblk->state);
96733c2865fSDamien Le Moal 		if (mblk->ref == 0)
9683b1a94c8SDamien Le Moal 			list_add_tail(&mblk->link, &zmd->mblk_lru_list);
9693b1a94c8SDamien Le Moal 		spin_unlock(&zmd->mblk_lock);
9703b1a94c8SDamien Le Moal 	}
9713b1a94c8SDamien Le Moal 
9723b1a94c8SDamien Le Moal 	zmd->sb_gen++;
9733b1a94c8SDamien Le Moal out:
9743b1a94c8SDamien Le Moal 	dmz_unlock_flush(zmd);
9753b1a94c8SDamien Le Moal 	up_write(&zmd->mblk_sem);
9763b1a94c8SDamien Le Moal 
9773b1a94c8SDamien Le Moal 	return ret;
978e7fad909SDmitry Fomichev 
979e7fad909SDmitry Fomichev err:
980e7fad909SDmitry Fomichev 	if (!list_empty(&write_list)) {
981e7fad909SDmitry Fomichev 		spin_lock(&zmd->mblk_lock);
982e7fad909SDmitry Fomichev 		list_splice(&write_list, &zmd->mblk_dirty_list);
983e7fad909SDmitry Fomichev 		spin_unlock(&zmd->mblk_lock);
984e7fad909SDmitry Fomichev 	}
985bf28a3baSHannes Reinecke 	if (!dmz_check_bdev(dev))
986e7fad909SDmitry Fomichev 		ret = -EIO;
987e7fad909SDmitry Fomichev 	goto out;
9883b1a94c8SDamien Le Moal }
9893b1a94c8SDamien Le Moal 
9903b1a94c8SDamien Le Moal /*
9913b1a94c8SDamien Le Moal  * Check super block.
9923b1a94c8SDamien Le Moal  */
993735bd7e4SHannes Reinecke static int dmz_check_sb(struct dmz_metadata *zmd, unsigned int set)
9943b1a94c8SDamien Le Moal {
995735bd7e4SHannes Reinecke 	struct dmz_super *sb = zmd->sb[set].sb;
996bf28a3baSHannes Reinecke 	struct dmz_dev *dev = zmd->sb[set].dev;
9973b1a94c8SDamien Le Moal 	unsigned int nr_meta_zones, nr_data_zones;
9983b1a94c8SDamien Le Moal 	u32 crc, stored_crc;
9993b1a94c8SDamien Le Moal 	u64 gen;
10003b1a94c8SDamien Le Moal 
1001bd5c4031SHannes Reinecke 	if (le32_to_cpu(sb->magic) != DMZ_MAGIC) {
1002bd5c4031SHannes Reinecke 		dmz_dev_err(dev, "Invalid meta magic (needed 0x%08x, got 0x%08x)",
1003bd5c4031SHannes Reinecke 			    DMZ_MAGIC, le32_to_cpu(sb->magic));
1004bd5c4031SHannes Reinecke 		return -ENXIO;
1005bd5c4031SHannes Reinecke 	}
1006bd5c4031SHannes Reinecke 
1007bd5c4031SHannes Reinecke 	zmd->sb_version = le32_to_cpu(sb->version);
1008bd5c4031SHannes Reinecke 	if (zmd->sb_version > DMZ_META_VER) {
1009bd5c4031SHannes Reinecke 		dmz_dev_err(dev, "Invalid meta version (needed %d, got %d)",
1010bd5c4031SHannes Reinecke 			    DMZ_META_VER, zmd->sb_version);
1011bd5c4031SHannes Reinecke 		return -EINVAL;
1012bd5c4031SHannes Reinecke 	}
1013bd5c4031SHannes Reinecke 	if ((zmd->sb_version < 1) && (set == 2)) {
1014bd5c4031SHannes Reinecke 		dmz_dev_err(dev, "Tertiary superblocks are not supported");
1015bd5c4031SHannes Reinecke 		return -EINVAL;
1016bd5c4031SHannes Reinecke 	}
1017bd5c4031SHannes Reinecke 
10183b1a94c8SDamien Le Moal 	gen = le64_to_cpu(sb->gen);
10193b1a94c8SDamien Le Moal 	stored_crc = le32_to_cpu(sb->crc);
10203b1a94c8SDamien Le Moal 	sb->crc = 0;
10213b1a94c8SDamien Le Moal 	crc = crc32_le(gen, (unsigned char *)sb, DMZ_BLOCK_SIZE);
10223b1a94c8SDamien Le Moal 	if (crc != stored_crc) {
10233b1a94c8SDamien Le Moal 		dmz_dev_err(dev, "Invalid checksum (needed 0x%08x, got 0x%08x)",
10243b1a94c8SDamien Le Moal 			    crc, stored_crc);
10253b1a94c8SDamien Le Moal 		return -ENXIO;
10263b1a94c8SDamien Le Moal 	}
10273b1a94c8SDamien Le Moal 
1028bd5c4031SHannes Reinecke 	if (zmd->sb_version > 1) {
1029bd5c4031SHannes Reinecke 		uuid_t sb_uuid;
1030bd5c4031SHannes Reinecke 
1031bd5c4031SHannes Reinecke 		import_uuid(&sb_uuid, sb->dmz_uuid);
1032bd5c4031SHannes Reinecke 		if (uuid_is_null(&sb_uuid)) {
1033bd5c4031SHannes Reinecke 			dmz_dev_err(dev, "NULL DM-Zoned uuid");
1034bd5c4031SHannes Reinecke 			return -ENXIO;
1035bd5c4031SHannes Reinecke 		} else if (uuid_is_null(&zmd->uuid)) {
1036bd5c4031SHannes Reinecke 			uuid_copy(&zmd->uuid, &sb_uuid);
1037bd5c4031SHannes Reinecke 		} else if (!uuid_equal(&zmd->uuid, &sb_uuid)) {
1038bd5c4031SHannes Reinecke 			dmz_dev_err(dev, "mismatching DM-Zoned uuid, "
1039bd5c4031SHannes Reinecke 				    "is %pUl expected %pUl",
1040bd5c4031SHannes Reinecke 				    &sb_uuid, &zmd->uuid);
1041bd5c4031SHannes Reinecke 			return -ENXIO;
1042bd5c4031SHannes Reinecke 		}
1043bd5c4031SHannes Reinecke 		if (!strlen(zmd->label))
1044bd5c4031SHannes Reinecke 			memcpy(zmd->label, sb->dmz_label, BDEVNAME_SIZE);
1045bd5c4031SHannes Reinecke 		else if (memcmp(zmd->label, sb->dmz_label, BDEVNAME_SIZE)) {
1046bd5c4031SHannes Reinecke 			dmz_dev_err(dev, "mismatching DM-Zoned label, "
1047bd5c4031SHannes Reinecke 				    "is %s expected %s",
1048bd5c4031SHannes Reinecke 				    sb->dmz_label, zmd->label);
1049bd5c4031SHannes Reinecke 			return -ENXIO;
1050bd5c4031SHannes Reinecke 		}
1051bd5c4031SHannes Reinecke 		import_uuid(&dev->uuid, sb->dev_uuid);
1052bd5c4031SHannes Reinecke 		if (uuid_is_null(&dev->uuid)) {
1053bd5c4031SHannes Reinecke 			dmz_dev_err(dev, "NULL device uuid");
10543b1a94c8SDamien Le Moal 			return -ENXIO;
10553b1a94c8SDamien Le Moal 		}
10563b1a94c8SDamien Le Moal 
1057bd5c4031SHannes Reinecke 		if (set == 2) {
1058bd5c4031SHannes Reinecke 			/*
1059bd5c4031SHannes Reinecke 			 * Generation number should be 0, but it doesn't
1060bd5c4031SHannes Reinecke 			 * really matter if it isn't.
1061bd5c4031SHannes Reinecke 			 */
1062bd5c4031SHannes Reinecke 			if (gen != 0)
1063bd5c4031SHannes Reinecke 				dmz_dev_warn(dev, "Invalid generation %llu",
1064bd5c4031SHannes Reinecke 					    gen);
1065bd5c4031SHannes Reinecke 			return 0;
1066bd5c4031SHannes Reinecke 		}
10673b1a94c8SDamien Le Moal 	}
10683b1a94c8SDamien Le Moal 
106936820560SHannes Reinecke 	nr_meta_zones = (le32_to_cpu(sb->nr_meta_blocks) + zmd->zone_nr_blocks - 1)
107036820560SHannes Reinecke 		>> zmd->zone_nr_blocks_shift;
10713b1a94c8SDamien Le Moal 	if (!nr_meta_zones ||
10723b1a94c8SDamien Le Moal 	    nr_meta_zones >= zmd->nr_rnd_zones) {
10733b1a94c8SDamien Le Moal 		dmz_dev_err(dev, "Invalid number of metadata blocks");
10743b1a94c8SDamien Le Moal 		return -ENXIO;
10753b1a94c8SDamien Le Moal 	}
10763b1a94c8SDamien Le Moal 
10773b1a94c8SDamien Le Moal 	if (!le32_to_cpu(sb->nr_reserved_seq) ||
10783b1a94c8SDamien Le Moal 	    le32_to_cpu(sb->nr_reserved_seq) >= (zmd->nr_useable_zones - nr_meta_zones)) {
10793b1a94c8SDamien Le Moal 		dmz_dev_err(dev, "Invalid number of reserved sequential zones");
10803b1a94c8SDamien Le Moal 		return -ENXIO;
10813b1a94c8SDamien Le Moal 	}
10823b1a94c8SDamien Le Moal 
10833b1a94c8SDamien Le Moal 	nr_data_zones = zmd->nr_useable_zones -
10843b1a94c8SDamien Le Moal 		(nr_meta_zones * 2 + le32_to_cpu(sb->nr_reserved_seq));
10853b1a94c8SDamien Le Moal 	if (le32_to_cpu(sb->nr_chunks) > nr_data_zones) {
10863b1a94c8SDamien Le Moal 		dmz_dev_err(dev, "Invalid number of chunks %u / %u",
10873b1a94c8SDamien Le Moal 			    le32_to_cpu(sb->nr_chunks), nr_data_zones);
10883b1a94c8SDamien Le Moal 		return -ENXIO;
10893b1a94c8SDamien Le Moal 	}
10903b1a94c8SDamien Le Moal 
10913b1a94c8SDamien Le Moal 	/* OK */
10923b1a94c8SDamien Le Moal 	zmd->nr_meta_blocks = le32_to_cpu(sb->nr_meta_blocks);
10933b1a94c8SDamien Le Moal 	zmd->nr_reserved_seq = le32_to_cpu(sb->nr_reserved_seq);
10943b1a94c8SDamien Le Moal 	zmd->nr_chunks = le32_to_cpu(sb->nr_chunks);
10953b1a94c8SDamien Le Moal 	zmd->nr_map_blocks = le32_to_cpu(sb->nr_map_blocks);
10963b1a94c8SDamien Le Moal 	zmd->nr_bitmap_blocks = le32_to_cpu(sb->nr_bitmap_blocks);
10973b1a94c8SDamien Le Moal 	zmd->nr_meta_zones = nr_meta_zones;
10983b1a94c8SDamien Le Moal 	zmd->nr_data_zones = nr_data_zones;
10993b1a94c8SDamien Le Moal 
11003b1a94c8SDamien Le Moal 	return 0;
11013b1a94c8SDamien Le Moal }
11023b1a94c8SDamien Le Moal 
11033b1a94c8SDamien Le Moal /*
11043b1a94c8SDamien Le Moal  * Read the first or second super block from disk.
11053b1a94c8SDamien Le Moal  */
11063b1a94c8SDamien Le Moal static int dmz_read_sb(struct dmz_metadata *zmd, unsigned int set)
11073b1a94c8SDamien Le Moal {
110835d0c96eSHannes Reinecke 	dmz_zmd_debug(zmd, "read superblock set %d dev %s block %llu",
110935d0c96eSHannes Reinecke 		      set, zmd->sb[set].dev->name,
111035d0c96eSHannes Reinecke 		      zmd->sb[set].block);
111135d0c96eSHannes Reinecke 
1112bf28a3baSHannes Reinecke 	return dmz_rdwr_block(zmd->sb[set].dev, REQ_OP_READ,
1113bf28a3baSHannes Reinecke 			      zmd->sb[set].block, zmd->sb[set].mblk->page);
11143b1a94c8SDamien Le Moal }
11153b1a94c8SDamien Le Moal 
11163b1a94c8SDamien Le Moal /*
11173b1a94c8SDamien Le Moal  * Determine the position of the secondary super blocks on disk.
11183b1a94c8SDamien Le Moal  * This is used only if a corruption of the primary super block
11193b1a94c8SDamien Le Moal  * is detected.
11203b1a94c8SDamien Le Moal  */
11213b1a94c8SDamien Le Moal static int dmz_lookup_secondary_sb(struct dmz_metadata *zmd)
11223b1a94c8SDamien Le Moal {
112336820560SHannes Reinecke 	unsigned int zone_nr_blocks = zmd->zone_nr_blocks;
11243b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk;
11253b1a94c8SDamien Le Moal 	int i;
11263b1a94c8SDamien Le Moal 
11273b1a94c8SDamien Le Moal 	/* Allocate a block */
11283b1a94c8SDamien Le Moal 	mblk = dmz_alloc_mblock(zmd, 0);
11293b1a94c8SDamien Le Moal 	if (!mblk)
11303b1a94c8SDamien Le Moal 		return -ENOMEM;
11313b1a94c8SDamien Le Moal 
11323b1a94c8SDamien Le Moal 	zmd->sb[1].mblk = mblk;
11333b1a94c8SDamien Le Moal 	zmd->sb[1].sb = mblk->data;
11343b1a94c8SDamien Le Moal 
11353b1a94c8SDamien Le Moal 	/* Bad first super block: search for the second one */
11363b1a94c8SDamien Le Moal 	zmd->sb[1].block = zmd->sb[0].block + zone_nr_blocks;
1137735bd7e4SHannes Reinecke 	zmd->sb[1].zone = zmd->sb[0].zone + 1;
1138bf28a3baSHannes Reinecke 	zmd->sb[1].dev = dmz_zone_to_dev(zmd, zmd->sb[1].zone);
11393b1a94c8SDamien Le Moal 	for (i = 0; i < zmd->nr_rnd_zones - 1; i++) {
11403b1a94c8SDamien Le Moal 		if (dmz_read_sb(zmd, 1) != 0)
11413b1a94c8SDamien Le Moal 			break;
1142735bd7e4SHannes Reinecke 		if (le32_to_cpu(zmd->sb[1].sb->magic) == DMZ_MAGIC) {
1143735bd7e4SHannes Reinecke 			zmd->sb[1].zone += i;
11443b1a94c8SDamien Le Moal 			return 0;
1145735bd7e4SHannes Reinecke 		}
11463b1a94c8SDamien Le Moal 		zmd->sb[1].block += zone_nr_blocks;
1147bf28a3baSHannes Reinecke 		zmd->sb[1].dev = dmz_zone_to_dev(zmd, zmd->sb[1].zone + i);
11483b1a94c8SDamien Le Moal 	}
11493b1a94c8SDamien Le Moal 
11503b1a94c8SDamien Le Moal 	dmz_free_mblock(zmd, mblk);
11513b1a94c8SDamien Le Moal 	zmd->sb[1].mblk = NULL;
1152735bd7e4SHannes Reinecke 	zmd->sb[1].zone = NULL;
1153bf28a3baSHannes Reinecke 	zmd->sb[1].dev = NULL;
11543b1a94c8SDamien Le Moal 
11553b1a94c8SDamien Le Moal 	return -EIO;
11563b1a94c8SDamien Le Moal }
11573b1a94c8SDamien Le Moal 
11583b1a94c8SDamien Le Moal /*
11593b1a94c8SDamien Le Moal  * Read the first or second super block from disk.
11603b1a94c8SDamien Le Moal  */
11613b1a94c8SDamien Le Moal static int dmz_get_sb(struct dmz_metadata *zmd, unsigned int set)
11623b1a94c8SDamien Le Moal {
11633b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk;
11643b1a94c8SDamien Le Moal 	int ret;
11653b1a94c8SDamien Le Moal 
11663b1a94c8SDamien Le Moal 	/* Allocate a block */
11673b1a94c8SDamien Le Moal 	mblk = dmz_alloc_mblock(zmd, 0);
11683b1a94c8SDamien Le Moal 	if (!mblk)
11693b1a94c8SDamien Le Moal 		return -ENOMEM;
11703b1a94c8SDamien Le Moal 
11713b1a94c8SDamien Le Moal 	zmd->sb[set].mblk = mblk;
11723b1a94c8SDamien Le Moal 	zmd->sb[set].sb = mblk->data;
11733b1a94c8SDamien Le Moal 
11743b1a94c8SDamien Le Moal 	/* Read super block */
11753b1a94c8SDamien Le Moal 	ret = dmz_read_sb(zmd, set);
11763b1a94c8SDamien Le Moal 	if (ret) {
11773b1a94c8SDamien Le Moal 		dmz_free_mblock(zmd, mblk);
11783b1a94c8SDamien Le Moal 		zmd->sb[set].mblk = NULL;
11793b1a94c8SDamien Le Moal 		return ret;
11803b1a94c8SDamien Le Moal 	}
11813b1a94c8SDamien Le Moal 
11823b1a94c8SDamien Le Moal 	return 0;
11833b1a94c8SDamien Le Moal }
11843b1a94c8SDamien Le Moal 
11853b1a94c8SDamien Le Moal /*
11863b1a94c8SDamien Le Moal  * Recover a metadata set.
11873b1a94c8SDamien Le Moal  */
11883b1a94c8SDamien Le Moal static int dmz_recover_mblocks(struct dmz_metadata *zmd, unsigned int dst_set)
11893b1a94c8SDamien Le Moal {
11903b1a94c8SDamien Le Moal 	unsigned int src_set = dst_set ^ 0x1;
11913b1a94c8SDamien Le Moal 	struct page *page;
11923b1a94c8SDamien Le Moal 	int i, ret;
11933b1a94c8SDamien Le Moal 
1194bf28a3baSHannes Reinecke 	dmz_dev_warn(zmd->sb[dst_set].dev,
1195bf28a3baSHannes Reinecke 		     "Metadata set %u invalid: recovering", dst_set);
11963b1a94c8SDamien Le Moal 
11973b1a94c8SDamien Le Moal 	if (dst_set == 0)
1198735bd7e4SHannes Reinecke 		zmd->sb[0].block = dmz_start_block(zmd, zmd->sb[0].zone);
1199735bd7e4SHannes Reinecke 	else
1200735bd7e4SHannes Reinecke 		zmd->sb[1].block = dmz_start_block(zmd, zmd->sb[1].zone);
12013b1a94c8SDamien Le Moal 
12024218a955SDamien Le Moal 	page = alloc_page(GFP_NOIO);
12033b1a94c8SDamien Le Moal 	if (!page)
12043b1a94c8SDamien Le Moal 		return -ENOMEM;
12053b1a94c8SDamien Le Moal 
12063b1a94c8SDamien Le Moal 	/* Copy metadata blocks */
12073b1a94c8SDamien Le Moal 	for (i = 1; i < zmd->nr_meta_blocks; i++) {
1208bf28a3baSHannes Reinecke 		ret = dmz_rdwr_block(zmd->sb[src_set].dev, REQ_OP_READ,
12093b1a94c8SDamien Le Moal 				     zmd->sb[src_set].block + i, page);
12103b1a94c8SDamien Le Moal 		if (ret)
12113b1a94c8SDamien Le Moal 			goto out;
1212bf28a3baSHannes Reinecke 		ret = dmz_rdwr_block(zmd->sb[dst_set].dev, REQ_OP_WRITE,
12133b1a94c8SDamien Le Moal 				     zmd->sb[dst_set].block + i, page);
12143b1a94c8SDamien Le Moal 		if (ret)
12153b1a94c8SDamien Le Moal 			goto out;
12163b1a94c8SDamien Le Moal 	}
12173b1a94c8SDamien Le Moal 
12183b1a94c8SDamien Le Moal 	/* Finalize with the super block */
12193b1a94c8SDamien Le Moal 	if (!zmd->sb[dst_set].mblk) {
12203b1a94c8SDamien Le Moal 		zmd->sb[dst_set].mblk = dmz_alloc_mblock(zmd, 0);
12213b1a94c8SDamien Le Moal 		if (!zmd->sb[dst_set].mblk) {
12223b1a94c8SDamien Le Moal 			ret = -ENOMEM;
12233b1a94c8SDamien Le Moal 			goto out;
12243b1a94c8SDamien Le Moal 		}
12253b1a94c8SDamien Le Moal 		zmd->sb[dst_set].sb = zmd->sb[dst_set].mblk->data;
12263b1a94c8SDamien Le Moal 	}
12273b1a94c8SDamien Le Moal 
12283b1a94c8SDamien Le Moal 	ret = dmz_write_sb(zmd, dst_set);
12293b1a94c8SDamien Le Moal out:
12303b1a94c8SDamien Le Moal 	__free_pages(page, 0);
12313b1a94c8SDamien Le Moal 
12323b1a94c8SDamien Le Moal 	return ret;
12333b1a94c8SDamien Le Moal }
12343b1a94c8SDamien Le Moal 
12353b1a94c8SDamien Le Moal /*
12363b1a94c8SDamien Le Moal  * Get super block from disk.
12373b1a94c8SDamien Le Moal  */
12383b1a94c8SDamien Le Moal static int dmz_load_sb(struct dmz_metadata *zmd)
12393b1a94c8SDamien Le Moal {
12403b1a94c8SDamien Le Moal 	bool sb_good[2] = {false, false};
12413b1a94c8SDamien Le Moal 	u64 sb_gen[2] = {0, 0};
12423b1a94c8SDamien Le Moal 	int ret;
12433b1a94c8SDamien Le Moal 
1244735bd7e4SHannes Reinecke 	if (!zmd->sb[0].zone) {
1245ca1a7045SHannes Reinecke 		dmz_zmd_err(zmd, "Primary super block zone not set");
1246735bd7e4SHannes Reinecke 		return -ENXIO;
1247735bd7e4SHannes Reinecke 	}
1248735bd7e4SHannes Reinecke 
12493b1a94c8SDamien Le Moal 	/* Read and check the primary super block */
1250735bd7e4SHannes Reinecke 	zmd->sb[0].block = dmz_start_block(zmd, zmd->sb[0].zone);
1251bf28a3baSHannes Reinecke 	zmd->sb[0].dev = dmz_zone_to_dev(zmd, zmd->sb[0].zone);
12523b1a94c8SDamien Le Moal 	ret = dmz_get_sb(zmd, 0);
12533b1a94c8SDamien Le Moal 	if (ret) {
1254bf28a3baSHannes Reinecke 		dmz_dev_err(zmd->sb[0].dev, "Read primary super block failed");
12553b1a94c8SDamien Le Moal 		return ret;
12563b1a94c8SDamien Le Moal 	}
12573b1a94c8SDamien Le Moal 
1258735bd7e4SHannes Reinecke 	ret = dmz_check_sb(zmd, 0);
12593b1a94c8SDamien Le Moal 
12603b1a94c8SDamien Le Moal 	/* Read and check secondary super block */
12613b1a94c8SDamien Le Moal 	if (ret == 0) {
12623b1a94c8SDamien Le Moal 		sb_good[0] = true;
1263735bd7e4SHannes Reinecke 		if (!zmd->sb[1].zone)
1264735bd7e4SHannes Reinecke 			zmd->sb[1].zone = zmd->sb[0].zone + zmd->nr_meta_zones;
1265735bd7e4SHannes Reinecke 		zmd->sb[1].block = dmz_start_block(zmd, zmd->sb[1].zone);
1266bf28a3baSHannes Reinecke 		zmd->sb[1].dev = dmz_zone_to_dev(zmd, zmd->sb[1].zone);
12673b1a94c8SDamien Le Moal 		ret = dmz_get_sb(zmd, 1);
12683b1a94c8SDamien Le Moal 	} else
12693b1a94c8SDamien Le Moal 		ret = dmz_lookup_secondary_sb(zmd);
12703b1a94c8SDamien Le Moal 
12713b1a94c8SDamien Le Moal 	if (ret) {
1272bf28a3baSHannes Reinecke 		dmz_dev_err(zmd->sb[1].dev, "Read secondary super block failed");
12733b1a94c8SDamien Le Moal 		return ret;
12743b1a94c8SDamien Le Moal 	}
12753b1a94c8SDamien Le Moal 
1276735bd7e4SHannes Reinecke 	ret = dmz_check_sb(zmd, 1);
12773b1a94c8SDamien Le Moal 	if (ret == 0)
12783b1a94c8SDamien Le Moal 		sb_good[1] = true;
12793b1a94c8SDamien Le Moal 
12803b1a94c8SDamien Le Moal 	/* Use highest generation sb first */
12813b1a94c8SDamien Le Moal 	if (!sb_good[0] && !sb_good[1]) {
1282ca1a7045SHannes Reinecke 		dmz_zmd_err(zmd, "No valid super block found");
12833b1a94c8SDamien Le Moal 		return -EIO;
12843b1a94c8SDamien Le Moal 	}
12853b1a94c8SDamien Le Moal 
12863b1a94c8SDamien Le Moal 	if (sb_good[0])
12873b1a94c8SDamien Le Moal 		sb_gen[0] = le64_to_cpu(zmd->sb[0].sb->gen);
1288bf28a3baSHannes Reinecke 	else {
12893b1a94c8SDamien Le Moal 		ret = dmz_recover_mblocks(zmd, 0);
1290bf28a3baSHannes Reinecke 		if (ret) {
1291bf28a3baSHannes Reinecke 			dmz_dev_err(zmd->sb[0].dev,
1292bf28a3baSHannes Reinecke 				    "Recovery of superblock 0 failed");
1293bf28a3baSHannes Reinecke 			return -EIO;
1294bf28a3baSHannes Reinecke 		}
1295bf28a3baSHannes Reinecke 	}
12963b1a94c8SDamien Le Moal 
12973b1a94c8SDamien Le Moal 	if (sb_good[1])
12983b1a94c8SDamien Le Moal 		sb_gen[1] = le64_to_cpu(zmd->sb[1].sb->gen);
1299bf28a3baSHannes Reinecke 	else {
13003b1a94c8SDamien Le Moal 		ret = dmz_recover_mblocks(zmd, 1);
13013b1a94c8SDamien Le Moal 
13023b1a94c8SDamien Le Moal 		if (ret) {
1303bf28a3baSHannes Reinecke 			dmz_dev_err(zmd->sb[1].dev,
1304bf28a3baSHannes Reinecke 				    "Recovery of superblock 1 failed");
13053b1a94c8SDamien Le Moal 			return -EIO;
13063b1a94c8SDamien Le Moal 		}
1307bf28a3baSHannes Reinecke 	}
13083b1a94c8SDamien Le Moal 
13093b1a94c8SDamien Le Moal 	if (sb_gen[0] >= sb_gen[1]) {
13103b1a94c8SDamien Le Moal 		zmd->sb_gen = sb_gen[0];
13113b1a94c8SDamien Le Moal 		zmd->mblk_primary = 0;
13123b1a94c8SDamien Le Moal 	} else {
13133b1a94c8SDamien Le Moal 		zmd->sb_gen = sb_gen[1];
13143b1a94c8SDamien Le Moal 		zmd->mblk_primary = 1;
13153b1a94c8SDamien Le Moal 	}
13163b1a94c8SDamien Le Moal 
1317bf28a3baSHannes Reinecke 	dmz_dev_debug(zmd->sb[zmd->mblk_primary].dev,
1318bf28a3baSHannes Reinecke 		      "Using super block %u (gen %llu)",
13193b1a94c8SDamien Le Moal 		      zmd->mblk_primary, zmd->sb_gen);
13203b1a94c8SDamien Le Moal 
1321bd5c4031SHannes Reinecke 	if ((zmd->sb_version > 1) && zmd->sb[2].zone) {
1322bd5c4031SHannes Reinecke 		zmd->sb[2].block = dmz_start_block(zmd, zmd->sb[2].zone);
1323bd5c4031SHannes Reinecke 		zmd->sb[2].dev = dmz_zone_to_dev(zmd, zmd->sb[2].zone);
1324bd5c4031SHannes Reinecke 		ret = dmz_get_sb(zmd, 2);
1325bd5c4031SHannes Reinecke 		if (ret) {
1326bd5c4031SHannes Reinecke 			dmz_dev_err(zmd->sb[2].dev,
1327bd5c4031SHannes Reinecke 				    "Read tertiary super block failed");
1328bd5c4031SHannes Reinecke 			return ret;
1329bd5c4031SHannes Reinecke 		}
1330bd5c4031SHannes Reinecke 		ret = dmz_check_sb(zmd, 2);
1331bd5c4031SHannes Reinecke 		if (ret == -EINVAL)
1332bd5c4031SHannes Reinecke 			return ret;
1333bd5c4031SHannes Reinecke 	}
13343b1a94c8SDamien Le Moal 	return 0;
13353b1a94c8SDamien Le Moal }
13363b1a94c8SDamien Le Moal 
13373b1a94c8SDamien Le Moal /*
13383b1a94c8SDamien Le Moal  * Initialize a zone descriptor.
13393b1a94c8SDamien Le Moal  */
1340bd5c4031SHannes Reinecke static int dmz_init_zone(struct blk_zone *blkz, unsigned int num, void *data)
13413b1a94c8SDamien Le Moal {
1342d4100351SChristoph Hellwig 	struct dmz_metadata *zmd = data;
1343bd5c4031SHannes Reinecke 	struct dmz_dev *dev = zmd->nr_devs > 1 ? &zmd->dev[1] : &zmd->dev[0];
1344bd5c4031SHannes Reinecke 	int idx = num + dev->zone_offset;
1345d4100351SChristoph Hellwig 	struct dm_zone *zone = &zmd->zones[idx];
13463b1a94c8SDamien Le Moal 
134736820560SHannes Reinecke 	if (blkz->len != zmd->zone_nr_sectors) {
1348bd5c4031SHannes Reinecke 		if (zmd->sb_version > 1) {
1349bd5c4031SHannes Reinecke 			/* Ignore the eventual runt (smaller) zone */
1350bd5c4031SHannes Reinecke 			set_bit(DMZ_OFFLINE, &zone->flags);
1351bd5c4031SHannes Reinecke 			return 0;
1352bd5c4031SHannes Reinecke 		} else if (blkz->start + blkz->len == dev->capacity)
13533b1a94c8SDamien Le Moal 			return 0;
13543b1a94c8SDamien Le Moal 		return -ENXIO;
13553b1a94c8SDamien Le Moal 	}
13563b1a94c8SDamien Le Moal 
13573b1a94c8SDamien Le Moal 	INIT_LIST_HEAD(&zone->link);
13583b1a94c8SDamien Le Moal 	atomic_set(&zone->refcount, 0);
1359b7122873SHannes Reinecke 	zone->id = idx;
13603b1a94c8SDamien Le Moal 	zone->chunk = DMZ_MAP_UNMAPPED;
13613b1a94c8SDamien Le Moal 
1362d4100351SChristoph Hellwig 	switch (blkz->type) {
1363d4100351SChristoph Hellwig 	case BLK_ZONE_TYPE_CONVENTIONAL:
13643b1a94c8SDamien Le Moal 		set_bit(DMZ_RND, &zone->flags);
1365d4100351SChristoph Hellwig 		break;
1366d4100351SChristoph Hellwig 	case BLK_ZONE_TYPE_SEQWRITE_REQ:
1367d4100351SChristoph Hellwig 	case BLK_ZONE_TYPE_SEQWRITE_PREF:
13683b1a94c8SDamien Le Moal 		set_bit(DMZ_SEQ, &zone->flags);
1369d4100351SChristoph Hellwig 		break;
1370d4100351SChristoph Hellwig 	default:
13713b1a94c8SDamien Le Moal 		return -ENXIO;
1372d4100351SChristoph Hellwig 	}
13733b1a94c8SDamien Le Moal 
13743b1a94c8SDamien Le Moal 	if (dmz_is_rnd(zone))
13753b1a94c8SDamien Le Moal 		zone->wp_block = 0;
13763b1a94c8SDamien Le Moal 	else
13773b1a94c8SDamien Le Moal 		zone->wp_block = dmz_sect2blk(blkz->wp - blkz->start);
13783b1a94c8SDamien Le Moal 
1379d4100351SChristoph Hellwig 	if (blkz->cond == BLK_ZONE_COND_OFFLINE)
1380d4100351SChristoph Hellwig 		set_bit(DMZ_OFFLINE, &zone->flags);
1381d4100351SChristoph Hellwig 	else if (blkz->cond == BLK_ZONE_COND_READONLY)
1382d4100351SChristoph Hellwig 		set_bit(DMZ_READ_ONLY, &zone->flags);
1383d4100351SChristoph Hellwig 	else {
13843b1a94c8SDamien Le Moal 		zmd->nr_useable_zones++;
13853b1a94c8SDamien Le Moal 		if (dmz_is_rnd(zone)) {
13863b1a94c8SDamien Le Moal 			zmd->nr_rnd_zones++;
1387bd5c4031SHannes Reinecke 			if (zmd->nr_devs == 1 && !zmd->sb[0].zone) {
1388bd5c4031SHannes Reinecke 				/* Primary super block zone */
1389735bd7e4SHannes Reinecke 				zmd->sb[0].zone = zone;
13903b1a94c8SDamien Le Moal 			}
13913b1a94c8SDamien Le Moal 		}
1392bd5c4031SHannes Reinecke 		if (zmd->nr_devs > 1 && !zmd->sb[2].zone) {
1393bd5c4031SHannes Reinecke 			/* Tertiary superblock zone */
1394bd5c4031SHannes Reinecke 			zmd->sb[2].zone = zone;
1395bd5c4031SHannes Reinecke 		}
13963b1a94c8SDamien Le Moal 	}
13973b1a94c8SDamien Le Moal 
13983b1a94c8SDamien Le Moal 	return 0;
13993b1a94c8SDamien Le Moal }
14003b1a94c8SDamien Le Moal 
1401bd5c4031SHannes Reinecke static void dmz_emulate_zones(struct dmz_metadata *zmd, struct dmz_dev *dev)
1402bd5c4031SHannes Reinecke {
1403bd5c4031SHannes Reinecke 	int idx;
1404bd5c4031SHannes Reinecke 	sector_t zone_offset = 0;
1405bd5c4031SHannes Reinecke 
1406bd5c4031SHannes Reinecke 	for(idx = 0; idx < dev->nr_zones; idx++) {
1407bd5c4031SHannes Reinecke 		struct dm_zone *zone = &zmd->zones[idx];
1408bd5c4031SHannes Reinecke 
1409bd5c4031SHannes Reinecke 		INIT_LIST_HEAD(&zone->link);
1410bd5c4031SHannes Reinecke 		atomic_set(&zone->refcount, 0);
1411bd5c4031SHannes Reinecke 		zone->id = idx;
1412bd5c4031SHannes Reinecke 		zone->chunk = DMZ_MAP_UNMAPPED;
141334f5affdSHannes Reinecke 		set_bit(DMZ_CACHE, &zone->flags);
1414bd5c4031SHannes Reinecke 		zone->wp_block = 0;
141534f5affdSHannes Reinecke 		zmd->nr_cache_zones++;
1416bd5c4031SHannes Reinecke 		zmd->nr_useable_zones++;
1417bd5c4031SHannes Reinecke 		if (dev->capacity - zone_offset < zmd->zone_nr_sectors) {
1418bd5c4031SHannes Reinecke 			/* Disable runt zone */
1419bd5c4031SHannes Reinecke 			set_bit(DMZ_OFFLINE, &zone->flags);
1420bd5c4031SHannes Reinecke 			break;
1421bd5c4031SHannes Reinecke 		}
1422bd5c4031SHannes Reinecke 		zone_offset += zmd->zone_nr_sectors;
1423bd5c4031SHannes Reinecke 	}
1424bd5c4031SHannes Reinecke }
1425bd5c4031SHannes Reinecke 
14263b1a94c8SDamien Le Moal /*
14273b1a94c8SDamien Le Moal  * Free zones descriptors.
14283b1a94c8SDamien Le Moal  */
14293b1a94c8SDamien Le Moal static void dmz_drop_zones(struct dmz_metadata *zmd)
14303b1a94c8SDamien Le Moal {
14313b1a94c8SDamien Le Moal 	kfree(zmd->zones);
14323b1a94c8SDamien Le Moal 	zmd->zones = NULL;
14333b1a94c8SDamien Le Moal }
14343b1a94c8SDamien Le Moal 
14353b1a94c8SDamien Le Moal /*
14363b1a94c8SDamien Le Moal  * Allocate and initialize zone descriptors using the zone
14373b1a94c8SDamien Le Moal  * information from disk.
14383b1a94c8SDamien Le Moal  */
14393b1a94c8SDamien Le Moal static int dmz_init_zones(struct dmz_metadata *zmd)
14403b1a94c8SDamien Le Moal {
1441bd5c4031SHannes Reinecke 	int i, ret;
1442bd5c4031SHannes Reinecke 	struct dmz_dev *zoned_dev = &zmd->dev[0];
14433b1a94c8SDamien Le Moal 
14443b1a94c8SDamien Le Moal 	/* Init */
1445bd5c4031SHannes Reinecke 	zmd->zone_nr_sectors = zmd->dev[0].zone_nr_sectors;
144636820560SHannes Reinecke 	zmd->zone_nr_sectors_shift = ilog2(zmd->zone_nr_sectors);
144736820560SHannes Reinecke 	zmd->zone_nr_blocks = dmz_sect2blk(zmd->zone_nr_sectors);
144836820560SHannes Reinecke 	zmd->zone_nr_blocks_shift = ilog2(zmd->zone_nr_blocks);
144936820560SHannes Reinecke 	zmd->zone_bitmap_size = zmd->zone_nr_blocks >> 3;
1450b3996295SDmitry Fomichev 	zmd->zone_nr_bitmap_blocks =
1451b3996295SDmitry Fomichev 		max_t(sector_t, 1, zmd->zone_bitmap_size >> DMZ_BLOCK_SHIFT);
145236820560SHannes Reinecke 	zmd->zone_bits_per_mblk = min_t(sector_t, zmd->zone_nr_blocks,
1453b3996295SDmitry Fomichev 					DMZ_BLOCK_SIZE_BITS);
14543b1a94c8SDamien Le Moal 
14553b1a94c8SDamien Le Moal 	/* Allocate zone array */
1456bd5c4031SHannes Reinecke 	zmd->nr_zones = 0;
1457bd5c4031SHannes Reinecke 	for (i = 0; i < zmd->nr_devs; i++)
1458bd5c4031SHannes Reinecke 		zmd->nr_zones += zmd->dev[i].nr_zones;
1459bd5c4031SHannes Reinecke 
1460bd5c4031SHannes Reinecke 	if (!zmd->nr_zones) {
1461bd5c4031SHannes Reinecke 		DMERR("(%s): No zones found", zmd->devname);
1462bd5c4031SHannes Reinecke 		return -ENXIO;
1463bd5c4031SHannes Reinecke 	}
146436820560SHannes Reinecke 	zmd->zones = kcalloc(zmd->nr_zones, sizeof(struct dm_zone), GFP_KERNEL);
14653b1a94c8SDamien Le Moal 	if (!zmd->zones)
14663b1a94c8SDamien Le Moal 		return -ENOMEM;
14673b1a94c8SDamien Le Moal 
1468ae3c1f11SHannes Reinecke 	DMDEBUG("(%s): Using %zu B for zone information",
1469ca1a7045SHannes Reinecke 		zmd->devname, sizeof(struct dm_zone) * zmd->nr_zones);
14703b1a94c8SDamien Le Moal 
1471bd5c4031SHannes Reinecke 	if (zmd->nr_devs > 1) {
1472bd5c4031SHannes Reinecke 		dmz_emulate_zones(zmd, &zmd->dev[0]);
1473bd5c4031SHannes Reinecke 		/*
1474bd5c4031SHannes Reinecke 		 * Primary superblock zone is always at zone 0 when multiple
1475bd5c4031SHannes Reinecke 		 * drives are present.
1476bd5c4031SHannes Reinecke 		 */
1477bd5c4031SHannes Reinecke 		zmd->sb[0].zone = &zmd->zones[0];
1478bd5c4031SHannes Reinecke 
1479bd5c4031SHannes Reinecke 		zoned_dev = &zmd->dev[1];
1480bd5c4031SHannes Reinecke 	}
1481bd5c4031SHannes Reinecke 
14823b1a94c8SDamien Le Moal 	/*
1483d4100351SChristoph Hellwig 	 * Get zone information and initialize zone descriptors.  At the same
1484d4100351SChristoph Hellwig 	 * time, determine where the super block should be: first block of the
1485d4100351SChristoph Hellwig 	 * first randomly writable zone.
14863b1a94c8SDamien Le Moal 	 */
1487bd5c4031SHannes Reinecke 	ret = blkdev_report_zones(zoned_dev->bdev, 0, BLK_ALL_ZONES,
1488bd5c4031SHannes Reinecke 				  dmz_init_zone, zmd);
1489d4100351SChristoph Hellwig 	if (ret < 0) {
1490bd5c4031SHannes Reinecke 		DMDEBUG("(%s): Failed to report zones, error %d",
1491bd5c4031SHannes Reinecke 			zmd->devname, ret);
14923b1a94c8SDamien Le Moal 		dmz_drop_zones(zmd);
14933b1a94c8SDamien Le Moal 		return ret;
14943b1a94c8SDamien Le Moal 	}
14953b1a94c8SDamien Le Moal 
1496d4100351SChristoph Hellwig 	return 0;
1497d4100351SChristoph Hellwig }
1498d4100351SChristoph Hellwig 
1499d4100351SChristoph Hellwig static int dmz_update_zone_cb(struct blk_zone *blkz, unsigned int idx,
1500d4100351SChristoph Hellwig 			      void *data)
1501d4100351SChristoph Hellwig {
1502d4100351SChristoph Hellwig 	struct dm_zone *zone = data;
1503d4100351SChristoph Hellwig 
1504d4100351SChristoph Hellwig 	clear_bit(DMZ_OFFLINE, &zone->flags);
1505d4100351SChristoph Hellwig 	clear_bit(DMZ_READ_ONLY, &zone->flags);
1506d4100351SChristoph Hellwig 	if (blkz->cond == BLK_ZONE_COND_OFFLINE)
1507d4100351SChristoph Hellwig 		set_bit(DMZ_OFFLINE, &zone->flags);
1508d4100351SChristoph Hellwig 	else if (blkz->cond == BLK_ZONE_COND_READONLY)
1509d4100351SChristoph Hellwig 		set_bit(DMZ_READ_ONLY, &zone->flags);
1510d4100351SChristoph Hellwig 
1511d4100351SChristoph Hellwig 	if (dmz_is_seq(zone))
1512d4100351SChristoph Hellwig 		zone->wp_block = dmz_sect2blk(blkz->wp - blkz->start);
1513d4100351SChristoph Hellwig 	else
1514d4100351SChristoph Hellwig 		zone->wp_block = 0;
1515d4100351SChristoph Hellwig 	return 0;
1516d4100351SChristoph Hellwig }
1517d4100351SChristoph Hellwig 
15183b1a94c8SDamien Le Moal /*
15193b1a94c8SDamien Le Moal  * Update a zone information.
15203b1a94c8SDamien Le Moal  */
15213b1a94c8SDamien Le Moal static int dmz_update_zone(struct dmz_metadata *zmd, struct dm_zone *zone)
15223b1a94c8SDamien Le Moal {
1523aa821c8dSHannes Reinecke 	struct dmz_dev *dev = dmz_zone_to_dev(zmd, zone);
1524bd976e52SDamien Le Moal 	unsigned int noio_flag;
15253b1a94c8SDamien Le Moal 	int ret;
15263b1a94c8SDamien Le Moal 
1527bd5c4031SHannes Reinecke 	if (dev->flags & DMZ_BDEV_REGULAR)
1528bd5c4031SHannes Reinecke 		return 0;
1529bd5c4031SHannes Reinecke 
1530bd976e52SDamien Le Moal 	/*
1531bd976e52SDamien Le Moal 	 * Get zone information from disk. Since blkdev_report_zones() uses
1532bd976e52SDamien Le Moal 	 * GFP_KERNEL by default for memory allocations, set the per-task
1533bd976e52SDamien Le Moal 	 * PF_MEMALLOC_NOIO flag so that all allocations are done as if
1534bd976e52SDamien Le Moal 	 * GFP_NOIO was specified.
1535bd976e52SDamien Le Moal 	 */
1536bd976e52SDamien Le Moal 	noio_flag = memalloc_noio_save();
1537aa821c8dSHannes Reinecke 	ret = blkdev_report_zones(dev->bdev, dmz_start_sect(zmd, zone), 1,
1538d4100351SChristoph Hellwig 				  dmz_update_zone_cb, zone);
1539bd976e52SDamien Le Moal 	memalloc_noio_restore(noio_flag);
1540d4100351SChristoph Hellwig 
1541d4100351SChristoph Hellwig 	if (ret == 0)
15427aedf75fSDamien Le Moal 		ret = -EIO;
1543d4100351SChristoph Hellwig 	if (ret < 0) {
1544aa821c8dSHannes Reinecke 		dmz_dev_err(dev, "Get zone %u report failed",
1545b7122873SHannes Reinecke 			    zone->id);
1546aa821c8dSHannes Reinecke 		dmz_check_bdev(dev);
15473b1a94c8SDamien Le Moal 		return ret;
15483b1a94c8SDamien Le Moal 	}
15493b1a94c8SDamien Le Moal 
15503b1a94c8SDamien Le Moal 	return 0;
15513b1a94c8SDamien Le Moal }
15523b1a94c8SDamien Le Moal 
15533b1a94c8SDamien Le Moal /*
15543b1a94c8SDamien Le Moal  * Check a zone write pointer position when the zone is marked
15553b1a94c8SDamien Le Moal  * with the sequential write error flag.
15563b1a94c8SDamien Le Moal  */
15573b1a94c8SDamien Le Moal static int dmz_handle_seq_write_err(struct dmz_metadata *zmd,
15583b1a94c8SDamien Le Moal 				    struct dm_zone *zone)
15593b1a94c8SDamien Le Moal {
1560aa821c8dSHannes Reinecke 	struct dmz_dev *dev = dmz_zone_to_dev(zmd, zone);
15613b1a94c8SDamien Le Moal 	unsigned int wp = 0;
15623b1a94c8SDamien Le Moal 	int ret;
15633b1a94c8SDamien Le Moal 
15643b1a94c8SDamien Le Moal 	wp = zone->wp_block;
15653b1a94c8SDamien Le Moal 	ret = dmz_update_zone(zmd, zone);
15663b1a94c8SDamien Le Moal 	if (ret)
15673b1a94c8SDamien Le Moal 		return ret;
15683b1a94c8SDamien Le Moal 
1569aa821c8dSHannes Reinecke 	dmz_dev_warn(dev, "Processing zone %u write error (zone wp %u/%u)",
1570b7122873SHannes Reinecke 		     zone->id, zone->wp_block, wp);
15713b1a94c8SDamien Le Moal 
15723b1a94c8SDamien Le Moal 	if (zone->wp_block < wp) {
15733b1a94c8SDamien Le Moal 		dmz_invalidate_blocks(zmd, zone, zone->wp_block,
15743b1a94c8SDamien Le Moal 				      wp - zone->wp_block);
15753b1a94c8SDamien Le Moal 	}
15763b1a94c8SDamien Le Moal 
15773b1a94c8SDamien Le Moal 	return 0;
15783b1a94c8SDamien Le Moal }
15793b1a94c8SDamien Le Moal 
15803b1a94c8SDamien Le Moal static struct dm_zone *dmz_get(struct dmz_metadata *zmd, unsigned int zone_id)
15813b1a94c8SDamien Le Moal {
15823b1a94c8SDamien Le Moal 	return &zmd->zones[zone_id];
15833b1a94c8SDamien Le Moal }
15843b1a94c8SDamien Le Moal 
15853b1a94c8SDamien Le Moal /*
15863b1a94c8SDamien Le Moal  * Reset a zone write pointer.
15873b1a94c8SDamien Le Moal  */
15883b1a94c8SDamien Le Moal static int dmz_reset_zone(struct dmz_metadata *zmd, struct dm_zone *zone)
15893b1a94c8SDamien Le Moal {
15903b1a94c8SDamien Le Moal 	int ret;
15913b1a94c8SDamien Le Moal 
15923b1a94c8SDamien Le Moal 	/*
15933b1a94c8SDamien Le Moal 	 * Ignore offline zones, read only zones,
15943b1a94c8SDamien Le Moal 	 * and conventional zones.
15953b1a94c8SDamien Le Moal 	 */
15963b1a94c8SDamien Le Moal 	if (dmz_is_offline(zone) ||
15973b1a94c8SDamien Le Moal 	    dmz_is_readonly(zone) ||
15983b1a94c8SDamien Le Moal 	    dmz_is_rnd(zone))
15993b1a94c8SDamien Le Moal 		return 0;
16003b1a94c8SDamien Le Moal 
16013b1a94c8SDamien Le Moal 	if (!dmz_is_empty(zone) || dmz_seq_write_err(zone)) {
1602aa821c8dSHannes Reinecke 		struct dmz_dev *dev = dmz_zone_to_dev(zmd, zone);
16033b1a94c8SDamien Le Moal 
16046c1b1da5SAjay Joshi 		ret = blkdev_zone_mgmt(dev->bdev, REQ_OP_ZONE_RESET,
16053b1a94c8SDamien Le Moal 				       dmz_start_sect(zmd, zone),
160636820560SHannes Reinecke 				       zmd->zone_nr_sectors, GFP_NOIO);
16073b1a94c8SDamien Le Moal 		if (ret) {
16083b1a94c8SDamien Le Moal 			dmz_dev_err(dev, "Reset zone %u failed %d",
1609b7122873SHannes Reinecke 				    zone->id, ret);
16103b1a94c8SDamien Le Moal 			return ret;
16113b1a94c8SDamien Le Moal 		}
16123b1a94c8SDamien Le Moal 	}
16133b1a94c8SDamien Le Moal 
16143b1a94c8SDamien Le Moal 	/* Clear write error bit and rewind write pointer position */
16153b1a94c8SDamien Le Moal 	clear_bit(DMZ_SEQ_WRITE_ERR, &zone->flags);
16163b1a94c8SDamien Le Moal 	zone->wp_block = 0;
16173b1a94c8SDamien Le Moal 
16183b1a94c8SDamien Le Moal 	return 0;
16193b1a94c8SDamien Le Moal }
16203b1a94c8SDamien Le Moal 
16213b1a94c8SDamien Le Moal static void dmz_get_zone_weight(struct dmz_metadata *zmd, struct dm_zone *zone);
16223b1a94c8SDamien Le Moal 
16233b1a94c8SDamien Le Moal /*
16243b1a94c8SDamien Le Moal  * Initialize chunk mapping.
16253b1a94c8SDamien Le Moal  */
16263b1a94c8SDamien Le Moal static int dmz_load_mapping(struct dmz_metadata *zmd)
16273b1a94c8SDamien Le Moal {
16283b1a94c8SDamien Le Moal 	struct dm_zone *dzone, *bzone;
16293b1a94c8SDamien Le Moal 	struct dmz_mblock *dmap_mblk = NULL;
16303b1a94c8SDamien Le Moal 	struct dmz_map *dmap;
16313b1a94c8SDamien Le Moal 	unsigned int i = 0, e = 0, chunk = 0;
16323b1a94c8SDamien Le Moal 	unsigned int dzone_id;
16333b1a94c8SDamien Le Moal 	unsigned int bzone_id;
16343b1a94c8SDamien Le Moal 
16353b1a94c8SDamien Le Moal 	/* Metadata block array for the chunk mapping table */
16363b1a94c8SDamien Le Moal 	zmd->map_mblk = kcalloc(zmd->nr_map_blocks,
16373b1a94c8SDamien Le Moal 				sizeof(struct dmz_mblk *), GFP_KERNEL);
16383b1a94c8SDamien Le Moal 	if (!zmd->map_mblk)
16393b1a94c8SDamien Le Moal 		return -ENOMEM;
16403b1a94c8SDamien Le Moal 
16413b1a94c8SDamien Le Moal 	/* Get chunk mapping table blocks and initialize zone mapping */
16423b1a94c8SDamien Le Moal 	while (chunk < zmd->nr_chunks) {
16433b1a94c8SDamien Le Moal 		if (!dmap_mblk) {
16443b1a94c8SDamien Le Moal 			/* Get mapping block */
16453b1a94c8SDamien Le Moal 			dmap_mblk = dmz_get_mblock(zmd, i + 1);
16463b1a94c8SDamien Le Moal 			if (IS_ERR(dmap_mblk))
16473b1a94c8SDamien Le Moal 				return PTR_ERR(dmap_mblk);
16483b1a94c8SDamien Le Moal 			zmd->map_mblk[i] = dmap_mblk;
16493b1a94c8SDamien Le Moal 			dmap = (struct dmz_map *) dmap_mblk->data;
16503b1a94c8SDamien Le Moal 			i++;
16513b1a94c8SDamien Le Moal 			e = 0;
16523b1a94c8SDamien Le Moal 		}
16533b1a94c8SDamien Le Moal 
16543b1a94c8SDamien Le Moal 		/* Check data zone */
16553b1a94c8SDamien Le Moal 		dzone_id = le32_to_cpu(dmap[e].dzone_id);
16563b1a94c8SDamien Le Moal 		if (dzone_id == DMZ_MAP_UNMAPPED)
16573b1a94c8SDamien Le Moal 			goto next;
16583b1a94c8SDamien Le Moal 
165936820560SHannes Reinecke 		if (dzone_id >= zmd->nr_zones) {
1660ca1a7045SHannes Reinecke 			dmz_zmd_err(zmd, "Chunk %u mapping: invalid data zone ID %u",
16613b1a94c8SDamien Le Moal 				    chunk, dzone_id);
16623b1a94c8SDamien Le Moal 			return -EIO;
16633b1a94c8SDamien Le Moal 		}
16643b1a94c8SDamien Le Moal 
16653b1a94c8SDamien Le Moal 		dzone = dmz_get(zmd, dzone_id);
16663b1a94c8SDamien Le Moal 		set_bit(DMZ_DATA, &dzone->flags);
16673b1a94c8SDamien Le Moal 		dzone->chunk = chunk;
16683b1a94c8SDamien Le Moal 		dmz_get_zone_weight(zmd, dzone);
16693b1a94c8SDamien Le Moal 
167034f5affdSHannes Reinecke 		if (dmz_is_cache(dzone))
167134f5affdSHannes Reinecke 			list_add_tail(&dzone->link, &zmd->map_cache_list);
167234f5affdSHannes Reinecke 		else if (dmz_is_rnd(dzone))
16733b1a94c8SDamien Le Moal 			list_add_tail(&dzone->link, &zmd->map_rnd_list);
16743b1a94c8SDamien Le Moal 		else
16753b1a94c8SDamien Le Moal 			list_add_tail(&dzone->link, &zmd->map_seq_list);
16763b1a94c8SDamien Le Moal 
16773b1a94c8SDamien Le Moal 		/* Check buffer zone */
16783b1a94c8SDamien Le Moal 		bzone_id = le32_to_cpu(dmap[e].bzone_id);
16793b1a94c8SDamien Le Moal 		if (bzone_id == DMZ_MAP_UNMAPPED)
16803b1a94c8SDamien Le Moal 			goto next;
16813b1a94c8SDamien Le Moal 
168236820560SHannes Reinecke 		if (bzone_id >= zmd->nr_zones) {
1683ca1a7045SHannes Reinecke 			dmz_zmd_err(zmd, "Chunk %u mapping: invalid buffer zone ID %u",
16843b1a94c8SDamien Le Moal 				    chunk, bzone_id);
16853b1a94c8SDamien Le Moal 			return -EIO;
16863b1a94c8SDamien Le Moal 		}
16873b1a94c8SDamien Le Moal 
16883b1a94c8SDamien Le Moal 		bzone = dmz_get(zmd, bzone_id);
168934f5affdSHannes Reinecke 		if (!dmz_is_rnd(bzone) && !dmz_is_cache(bzone)) {
1690ca1a7045SHannes Reinecke 			dmz_zmd_err(zmd, "Chunk %u mapping: invalid buffer zone %u",
16913b1a94c8SDamien Le Moal 				    chunk, bzone_id);
16923b1a94c8SDamien Le Moal 			return -EIO;
16933b1a94c8SDamien Le Moal 		}
16943b1a94c8SDamien Le Moal 
16953b1a94c8SDamien Le Moal 		set_bit(DMZ_DATA, &bzone->flags);
16963b1a94c8SDamien Le Moal 		set_bit(DMZ_BUF, &bzone->flags);
16973b1a94c8SDamien Le Moal 		bzone->chunk = chunk;
16983b1a94c8SDamien Le Moal 		bzone->bzone = dzone;
16993b1a94c8SDamien Le Moal 		dzone->bzone = bzone;
17003b1a94c8SDamien Le Moal 		dmz_get_zone_weight(zmd, bzone);
170134f5affdSHannes Reinecke 		if (dmz_is_cache(bzone))
170234f5affdSHannes Reinecke 			list_add_tail(&bzone->link, &zmd->map_cache_list);
170334f5affdSHannes Reinecke 		else
17043b1a94c8SDamien Le Moal 			list_add_tail(&bzone->link, &zmd->map_rnd_list);
17053b1a94c8SDamien Le Moal next:
17063b1a94c8SDamien Le Moal 		chunk++;
17073b1a94c8SDamien Le Moal 		e++;
17083b1a94c8SDamien Le Moal 		if (e >= DMZ_MAP_ENTRIES)
17093b1a94c8SDamien Le Moal 			dmap_mblk = NULL;
17103b1a94c8SDamien Le Moal 	}
17113b1a94c8SDamien Le Moal 
17123b1a94c8SDamien Le Moal 	/*
17133b1a94c8SDamien Le Moal 	 * At this point, only meta zones and mapped data zones were
17143b1a94c8SDamien Le Moal 	 * fully initialized. All remaining zones are unmapped data
17153b1a94c8SDamien Le Moal 	 * zones. Finish initializing those here.
17163b1a94c8SDamien Le Moal 	 */
171736820560SHannes Reinecke 	for (i = 0; i < zmd->nr_zones; i++) {
17183b1a94c8SDamien Le Moal 		dzone = dmz_get(zmd, i);
17193b1a94c8SDamien Le Moal 		if (dmz_is_meta(dzone))
17203b1a94c8SDamien Le Moal 			continue;
172134f5affdSHannes Reinecke 		if (dmz_is_offline(dzone))
172234f5affdSHannes Reinecke 			continue;
17233b1a94c8SDamien Le Moal 
172434f5affdSHannes Reinecke 		if (dmz_is_cache(dzone))
172534f5affdSHannes Reinecke 			zmd->nr_cache++;
172634f5affdSHannes Reinecke 		else if (dmz_is_rnd(dzone))
17273b1a94c8SDamien Le Moal 			zmd->nr_rnd++;
17283b1a94c8SDamien Le Moal 		else
17293b1a94c8SDamien Le Moal 			zmd->nr_seq++;
17303b1a94c8SDamien Le Moal 
17313b1a94c8SDamien Le Moal 		if (dmz_is_data(dzone)) {
17323b1a94c8SDamien Le Moal 			/* Already initialized */
17333b1a94c8SDamien Le Moal 			continue;
17343b1a94c8SDamien Le Moal 		}
17353b1a94c8SDamien Le Moal 
17363b1a94c8SDamien Le Moal 		/* Unmapped data zone */
17373b1a94c8SDamien Le Moal 		set_bit(DMZ_DATA, &dzone->flags);
17383b1a94c8SDamien Le Moal 		dzone->chunk = DMZ_MAP_UNMAPPED;
173934f5affdSHannes Reinecke 		if (dmz_is_cache(dzone)) {
174034f5affdSHannes Reinecke 			list_add_tail(&dzone->link, &zmd->unmap_cache_list);
174134f5affdSHannes Reinecke 			atomic_inc(&zmd->unmap_nr_cache);
174234f5affdSHannes Reinecke 		} else if (dmz_is_rnd(dzone)) {
17433b1a94c8SDamien Le Moal 			list_add_tail(&dzone->link, &zmd->unmap_rnd_list);
17443b1a94c8SDamien Le Moal 			atomic_inc(&zmd->unmap_nr_rnd);
17453b1a94c8SDamien Le Moal 		} else if (atomic_read(&zmd->nr_reserved_seq_zones) < zmd->nr_reserved_seq) {
17463b1a94c8SDamien Le Moal 			list_add_tail(&dzone->link, &zmd->reserved_seq_zones_list);
17473b1a94c8SDamien Le Moal 			atomic_inc(&zmd->nr_reserved_seq_zones);
17483b1a94c8SDamien Le Moal 			zmd->nr_seq--;
17493b1a94c8SDamien Le Moal 		} else {
17503b1a94c8SDamien Le Moal 			list_add_tail(&dzone->link, &zmd->unmap_seq_list);
17513b1a94c8SDamien Le Moal 			atomic_inc(&zmd->unmap_nr_seq);
17523b1a94c8SDamien Le Moal 		}
17533b1a94c8SDamien Le Moal 	}
17543b1a94c8SDamien Le Moal 
17553b1a94c8SDamien Le Moal 	return 0;
17563b1a94c8SDamien Le Moal }
17573b1a94c8SDamien Le Moal 
17583b1a94c8SDamien Le Moal /*
17593b1a94c8SDamien Le Moal  * Set a data chunk mapping.
17603b1a94c8SDamien Le Moal  */
17613b1a94c8SDamien Le Moal static void dmz_set_chunk_mapping(struct dmz_metadata *zmd, unsigned int chunk,
17623b1a94c8SDamien Le Moal 				  unsigned int dzone_id, unsigned int bzone_id)
17633b1a94c8SDamien Le Moal {
17643b1a94c8SDamien Le Moal 	struct dmz_mblock *dmap_mblk = zmd->map_mblk[chunk >> DMZ_MAP_ENTRIES_SHIFT];
17653b1a94c8SDamien Le Moal 	struct dmz_map *dmap = (struct dmz_map *) dmap_mblk->data;
17663b1a94c8SDamien Le Moal 	int map_idx = chunk & DMZ_MAP_ENTRIES_MASK;
17673b1a94c8SDamien Le Moal 
17683b1a94c8SDamien Le Moal 	dmap[map_idx].dzone_id = cpu_to_le32(dzone_id);
17693b1a94c8SDamien Le Moal 	dmap[map_idx].bzone_id = cpu_to_le32(bzone_id);
17703b1a94c8SDamien Le Moal 	dmz_dirty_mblock(zmd, dmap_mblk);
17713b1a94c8SDamien Le Moal }
17723b1a94c8SDamien Le Moal 
17733b1a94c8SDamien Le Moal /*
17743b1a94c8SDamien Le Moal  * The list of mapped zones is maintained in LRU order.
17753b1a94c8SDamien Le Moal  * This rotates a zone at the end of its map list.
17763b1a94c8SDamien Le Moal  */
17773b1a94c8SDamien Le Moal static void __dmz_lru_zone(struct dmz_metadata *zmd, struct dm_zone *zone)
17783b1a94c8SDamien Le Moal {
17793b1a94c8SDamien Le Moal 	if (list_empty(&zone->link))
17803b1a94c8SDamien Le Moal 		return;
17813b1a94c8SDamien Le Moal 
17823b1a94c8SDamien Le Moal 	list_del_init(&zone->link);
17833b1a94c8SDamien Le Moal 	if (dmz_is_seq(zone)) {
17843b1a94c8SDamien Le Moal 		/* LRU rotate sequential zone */
17853b1a94c8SDamien Le Moal 		list_add_tail(&zone->link, &zmd->map_seq_list);
178634f5affdSHannes Reinecke 	} else if (dmz_is_cache(zone)) {
178734f5affdSHannes Reinecke 		/* LRU rotate cache zone */
178834f5affdSHannes Reinecke 		list_add_tail(&zone->link, &zmd->map_cache_list);
17893b1a94c8SDamien Le Moal 	} else {
17903b1a94c8SDamien Le Moal 		/* LRU rotate random zone */
17913b1a94c8SDamien Le Moal 		list_add_tail(&zone->link, &zmd->map_rnd_list);
17923b1a94c8SDamien Le Moal 	}
17933b1a94c8SDamien Le Moal }
17943b1a94c8SDamien Le Moal 
17953b1a94c8SDamien Le Moal /*
17963b1a94c8SDamien Le Moal  * The list of mapped random zones is maintained
17973b1a94c8SDamien Le Moal  * in LRU order. This rotates a zone at the end of the list.
17983b1a94c8SDamien Le Moal  */
17993b1a94c8SDamien Le Moal static void dmz_lru_zone(struct dmz_metadata *zmd, struct dm_zone *zone)
18003b1a94c8SDamien Le Moal {
18013b1a94c8SDamien Le Moal 	__dmz_lru_zone(zmd, zone);
18023b1a94c8SDamien Le Moal 	if (zone->bzone)
18033b1a94c8SDamien Le Moal 		__dmz_lru_zone(zmd, zone->bzone);
18043b1a94c8SDamien Le Moal }
18053b1a94c8SDamien Le Moal 
18063b1a94c8SDamien Le Moal /*
18073b1a94c8SDamien Le Moal  * Wait for any zone to be freed.
18083b1a94c8SDamien Le Moal  */
18093b1a94c8SDamien Le Moal static void dmz_wait_for_free_zones(struct dmz_metadata *zmd)
18103b1a94c8SDamien Le Moal {
18113b1a94c8SDamien Le Moal 	DEFINE_WAIT(wait);
18123b1a94c8SDamien Le Moal 
18133b1a94c8SDamien Le Moal 	prepare_to_wait(&zmd->free_wq, &wait, TASK_UNINTERRUPTIBLE);
18143b1a94c8SDamien Le Moal 	dmz_unlock_map(zmd);
18153b1a94c8SDamien Le Moal 	dmz_unlock_metadata(zmd);
18163b1a94c8SDamien Le Moal 
18173b1a94c8SDamien Le Moal 	io_schedule_timeout(HZ);
18183b1a94c8SDamien Le Moal 
18193b1a94c8SDamien Le Moal 	dmz_lock_metadata(zmd);
18203b1a94c8SDamien Le Moal 	dmz_lock_map(zmd);
18213b1a94c8SDamien Le Moal 	finish_wait(&zmd->free_wq, &wait);
18223b1a94c8SDamien Le Moal }
18233b1a94c8SDamien Le Moal 
18243b1a94c8SDamien Le Moal /*
18253b1a94c8SDamien Le Moal  * Lock a zone for reclaim (set the zone RECLAIM bit).
18263b1a94c8SDamien Le Moal  * Returns false if the zone cannot be locked or if it is already locked
18273b1a94c8SDamien Le Moal  * and 1 otherwise.
18283b1a94c8SDamien Le Moal  */
18293b1a94c8SDamien Le Moal int dmz_lock_zone_reclaim(struct dm_zone *zone)
18303b1a94c8SDamien Le Moal {
18313b1a94c8SDamien Le Moal 	/* Active zones cannot be reclaimed */
18323b1a94c8SDamien Le Moal 	if (dmz_is_active(zone))
18333b1a94c8SDamien Le Moal 		return 0;
18343b1a94c8SDamien Le Moal 
18353b1a94c8SDamien Le Moal 	return !test_and_set_bit(DMZ_RECLAIM, &zone->flags);
18363b1a94c8SDamien Le Moal }
18373b1a94c8SDamien Le Moal 
18383b1a94c8SDamien Le Moal /*
18393b1a94c8SDamien Le Moal  * Clear a zone reclaim flag.
18403b1a94c8SDamien Le Moal  */
18413b1a94c8SDamien Le Moal void dmz_unlock_zone_reclaim(struct dm_zone *zone)
18423b1a94c8SDamien Le Moal {
18433b1a94c8SDamien Le Moal 	WARN_ON(dmz_is_active(zone));
18443b1a94c8SDamien Le Moal 	WARN_ON(!dmz_in_reclaim(zone));
18453b1a94c8SDamien Le Moal 
18463b1a94c8SDamien Le Moal 	clear_bit_unlock(DMZ_RECLAIM, &zone->flags);
18473b1a94c8SDamien Le Moal 	smp_mb__after_atomic();
18483b1a94c8SDamien Le Moal 	wake_up_bit(&zone->flags, DMZ_RECLAIM);
18493b1a94c8SDamien Le Moal }
18503b1a94c8SDamien Le Moal 
18513b1a94c8SDamien Le Moal /*
18523b1a94c8SDamien Le Moal  * Wait for a zone reclaim to complete.
18533b1a94c8SDamien Le Moal  */
18543b1a94c8SDamien Le Moal static void dmz_wait_for_reclaim(struct dmz_metadata *zmd, struct dm_zone *zone)
18553b1a94c8SDamien Le Moal {
18563b1a94c8SDamien Le Moal 	dmz_unlock_map(zmd);
18573b1a94c8SDamien Le Moal 	dmz_unlock_metadata(zmd);
1858a16b7deeSHannes Reinecke 	set_bit(DMZ_RECLAIM_TERMINATE, &zone->flags);
18593b1a94c8SDamien Le Moal 	wait_on_bit_timeout(&zone->flags, DMZ_RECLAIM, TASK_UNINTERRUPTIBLE, HZ);
1860a16b7deeSHannes Reinecke 	clear_bit(DMZ_RECLAIM_TERMINATE, &zone->flags);
18613b1a94c8SDamien Le Moal 	dmz_lock_metadata(zmd);
18623b1a94c8SDamien Le Moal 	dmz_lock_map(zmd);
18633b1a94c8SDamien Le Moal }
18643b1a94c8SDamien Le Moal 
18653b1a94c8SDamien Le Moal /*
186634f5affdSHannes Reinecke  * Select a cache or random write zone for reclaim.
18673b1a94c8SDamien Le Moal  */
186890a9b869SHannes Reinecke static struct dm_zone *dmz_get_rnd_zone_for_reclaim(struct dmz_metadata *zmd,
186990a9b869SHannes Reinecke 						    bool idle)
18703b1a94c8SDamien Le Moal {
18713b1a94c8SDamien Le Moal 	struct dm_zone *dzone = NULL;
18723b1a94c8SDamien Le Moal 	struct dm_zone *zone;
187334f5affdSHannes Reinecke 	struct list_head *zone_list = &zmd->map_rnd_list;
18743b1a94c8SDamien Le Moal 
187534f5affdSHannes Reinecke 	/* If we have cache zones select from the cache zone list */
187690a9b869SHannes Reinecke 	if (zmd->nr_cache) {
187734f5affdSHannes Reinecke 		zone_list = &zmd->map_cache_list;
187890a9b869SHannes Reinecke 		/* Try to relaim random zones, too, when idle */
187990a9b869SHannes Reinecke 		if (idle && list_empty(zone_list))
188090a9b869SHannes Reinecke 			zone_list = &zmd->map_rnd_list;
188190a9b869SHannes Reinecke 	}
18823b1a94c8SDamien Le Moal 
188334f5affdSHannes Reinecke 	list_for_each_entry(zone, zone_list, link) {
18843b1a94c8SDamien Le Moal 		if (dmz_is_buf(zone))
18853b1a94c8SDamien Le Moal 			dzone = zone->bzone;
18863b1a94c8SDamien Le Moal 		else
18873b1a94c8SDamien Le Moal 			dzone = zone;
18883b1a94c8SDamien Le Moal 		if (dmz_lock_zone_reclaim(dzone))
18893b1a94c8SDamien Le Moal 			return dzone;
18903b1a94c8SDamien Le Moal 	}
18913b1a94c8SDamien Le Moal 
1892489dc0f0SHannes Reinecke 	return NULL;
18933b1a94c8SDamien Le Moal }
18943b1a94c8SDamien Le Moal 
18953b1a94c8SDamien Le Moal /*
18963b1a94c8SDamien Le Moal  * Select a buffered sequential zone for reclaim.
18973b1a94c8SDamien Le Moal  */
18983b1a94c8SDamien Le Moal static struct dm_zone *dmz_get_seq_zone_for_reclaim(struct dmz_metadata *zmd)
18993b1a94c8SDamien Le Moal {
19003b1a94c8SDamien Le Moal 	struct dm_zone *zone;
19013b1a94c8SDamien Le Moal 
19023b1a94c8SDamien Le Moal 	list_for_each_entry(zone, &zmd->map_seq_list, link) {
19033b1a94c8SDamien Le Moal 		if (!zone->bzone)
19043b1a94c8SDamien Le Moal 			continue;
19053b1a94c8SDamien Le Moal 		if (dmz_lock_zone_reclaim(zone))
19063b1a94c8SDamien Le Moal 			return zone;
19073b1a94c8SDamien Le Moal 	}
19083b1a94c8SDamien Le Moal 
1909489dc0f0SHannes Reinecke 	return NULL;
19103b1a94c8SDamien Le Moal }
19113b1a94c8SDamien Le Moal 
19123b1a94c8SDamien Le Moal /*
19133b1a94c8SDamien Le Moal  * Select a zone for reclaim.
19143b1a94c8SDamien Le Moal  */
191590a9b869SHannes Reinecke struct dm_zone *dmz_get_zone_for_reclaim(struct dmz_metadata *zmd, bool idle)
19163b1a94c8SDamien Le Moal {
19173b1a94c8SDamien Le Moal 	struct dm_zone *zone;
19183b1a94c8SDamien Le Moal 
19193b1a94c8SDamien Le Moal 	/*
19203b1a94c8SDamien Le Moal 	 * Search for a zone candidate to reclaim: 2 cases are possible.
19213b1a94c8SDamien Le Moal 	 * (1) There is no free sequential zones. Then a random data zone
19223b1a94c8SDamien Le Moal 	 *     cannot be reclaimed. So choose a sequential zone to reclaim so
19233b1a94c8SDamien Le Moal 	 *     that afterward a random zone can be reclaimed.
19243b1a94c8SDamien Le Moal 	 * (2) At least one free sequential zone is available, then choose
19253b1a94c8SDamien Le Moal 	 *     the oldest random zone (data or buffer) that can be locked.
19263b1a94c8SDamien Le Moal 	 */
19273b1a94c8SDamien Le Moal 	dmz_lock_map(zmd);
19283b1a94c8SDamien Le Moal 	if (list_empty(&zmd->reserved_seq_zones_list))
19293b1a94c8SDamien Le Moal 		zone = dmz_get_seq_zone_for_reclaim(zmd);
19303b1a94c8SDamien Le Moal 	else
193190a9b869SHannes Reinecke 		zone = dmz_get_rnd_zone_for_reclaim(zmd, idle);
19323b1a94c8SDamien Le Moal 	dmz_unlock_map(zmd);
19333b1a94c8SDamien Le Moal 
19343b1a94c8SDamien Le Moal 	return zone;
19353b1a94c8SDamien Le Moal }
19363b1a94c8SDamien Le Moal 
19373b1a94c8SDamien Le Moal /*
19383b1a94c8SDamien Le Moal  * Get the zone mapping a chunk, if the chunk is mapped already.
19393b1a94c8SDamien Le Moal  * If no mapping exist and the operation is WRITE, a zone is
19403b1a94c8SDamien Le Moal  * allocated and used to map the chunk.
19413b1a94c8SDamien Le Moal  * The zone returned will be set to the active state.
19423b1a94c8SDamien Le Moal  */
19433b1a94c8SDamien Le Moal struct dm_zone *dmz_get_chunk_mapping(struct dmz_metadata *zmd, unsigned int chunk, int op)
19443b1a94c8SDamien Le Moal {
19453b1a94c8SDamien Le Moal 	struct dmz_mblock *dmap_mblk = zmd->map_mblk[chunk >> DMZ_MAP_ENTRIES_SHIFT];
19463b1a94c8SDamien Le Moal 	struct dmz_map *dmap = (struct dmz_map *) dmap_mblk->data;
19473b1a94c8SDamien Le Moal 	int dmap_idx = chunk & DMZ_MAP_ENTRIES_MASK;
19483b1a94c8SDamien Le Moal 	unsigned int dzone_id;
19493b1a94c8SDamien Le Moal 	struct dm_zone *dzone = NULL;
19503b1a94c8SDamien Le Moal 	int ret = 0;
195134f5affdSHannes Reinecke 	int alloc_flags = zmd->nr_cache ? DMZ_ALLOC_CACHE : DMZ_ALLOC_RND;
19523b1a94c8SDamien Le Moal 
19533b1a94c8SDamien Le Moal 	dmz_lock_map(zmd);
19543b1a94c8SDamien Le Moal again:
19553b1a94c8SDamien Le Moal 	/* Get the chunk mapping */
19563b1a94c8SDamien Le Moal 	dzone_id = le32_to_cpu(dmap[dmap_idx].dzone_id);
19573b1a94c8SDamien Le Moal 	if (dzone_id == DMZ_MAP_UNMAPPED) {
19583b1a94c8SDamien Le Moal 		/*
19593b1a94c8SDamien Le Moal 		 * Read or discard in unmapped chunks are fine. But for
19603b1a94c8SDamien Le Moal 		 * writes, we need a mapping, so get one.
19613b1a94c8SDamien Le Moal 		 */
19623b1a94c8SDamien Le Moal 		if (op != REQ_OP_WRITE)
19633b1a94c8SDamien Le Moal 			goto out;
19643b1a94c8SDamien Le Moal 
1965ad1bd578SDmitry Fomichev 		/* Allocate a random zone */
196634f5affdSHannes Reinecke 		dzone = dmz_alloc_zone(zmd, alloc_flags);
19673b1a94c8SDamien Le Moal 		if (!dzone) {
1968d0e21ce4SHannes Reinecke 			if (dmz_dev_is_dying(zmd)) {
196975d66ffbSDmitry Fomichev 				dzone = ERR_PTR(-EIO);
197075d66ffbSDmitry Fomichev 				goto out;
197175d66ffbSDmitry Fomichev 			}
19723b1a94c8SDamien Le Moal 			dmz_wait_for_free_zones(zmd);
19733b1a94c8SDamien Le Moal 			goto again;
19743b1a94c8SDamien Le Moal 		}
19753b1a94c8SDamien Le Moal 
19763b1a94c8SDamien Le Moal 		dmz_map_zone(zmd, dzone, chunk);
19773b1a94c8SDamien Le Moal 
19783b1a94c8SDamien Le Moal 	} else {
19793b1a94c8SDamien Le Moal 		/* The chunk is already mapped: get the mapping zone */
19803b1a94c8SDamien Le Moal 		dzone = dmz_get(zmd, dzone_id);
19813b1a94c8SDamien Le Moal 		if (dzone->chunk != chunk) {
19823b1a94c8SDamien Le Moal 			dzone = ERR_PTR(-EIO);
19833b1a94c8SDamien Le Moal 			goto out;
19843b1a94c8SDamien Le Moal 		}
19853b1a94c8SDamien Le Moal 
19863b1a94c8SDamien Le Moal 		/* Repair write pointer if the sequential dzone has error */
19873b1a94c8SDamien Le Moal 		if (dmz_seq_write_err(dzone)) {
19883b1a94c8SDamien Le Moal 			ret = dmz_handle_seq_write_err(zmd, dzone);
19893b1a94c8SDamien Le Moal 			if (ret) {
19903b1a94c8SDamien Le Moal 				dzone = ERR_PTR(-EIO);
19913b1a94c8SDamien Le Moal 				goto out;
19923b1a94c8SDamien Le Moal 			}
19933b1a94c8SDamien Le Moal 			clear_bit(DMZ_SEQ_WRITE_ERR, &dzone->flags);
19943b1a94c8SDamien Le Moal 		}
19953b1a94c8SDamien Le Moal 	}
19963b1a94c8SDamien Le Moal 
19973b1a94c8SDamien Le Moal 	/*
19983b1a94c8SDamien Le Moal 	 * If the zone is being reclaimed, the chunk mapping may change
19993b1a94c8SDamien Le Moal 	 * to a different zone. So wait for reclaim and retry. Otherwise,
20003b1a94c8SDamien Le Moal 	 * activate the zone (this will prevent reclaim from touching it).
20013b1a94c8SDamien Le Moal 	 */
20023b1a94c8SDamien Le Moal 	if (dmz_in_reclaim(dzone)) {
20033b1a94c8SDamien Le Moal 		dmz_wait_for_reclaim(zmd, dzone);
20043b1a94c8SDamien Le Moal 		goto again;
20053b1a94c8SDamien Le Moal 	}
20063b1a94c8SDamien Le Moal 	dmz_activate_zone(dzone);
20073b1a94c8SDamien Le Moal 	dmz_lru_zone(zmd, dzone);
20083b1a94c8SDamien Le Moal out:
20093b1a94c8SDamien Le Moal 	dmz_unlock_map(zmd);
20103b1a94c8SDamien Le Moal 
20113b1a94c8SDamien Le Moal 	return dzone;
20123b1a94c8SDamien Le Moal }
20133b1a94c8SDamien Le Moal 
20143b1a94c8SDamien Le Moal /*
20153b1a94c8SDamien Le Moal  * Write and discard change the block validity of data zones and their buffer
20163b1a94c8SDamien Le Moal  * zones. Check here that valid blocks are still present. If all blocks are
20173b1a94c8SDamien Le Moal  * invalid, the zones can be unmapped on the fly without waiting for reclaim
20183b1a94c8SDamien Le Moal  * to do it.
20193b1a94c8SDamien Le Moal  */
20203b1a94c8SDamien Le Moal void dmz_put_chunk_mapping(struct dmz_metadata *zmd, struct dm_zone *dzone)
20213b1a94c8SDamien Le Moal {
20223b1a94c8SDamien Le Moal 	struct dm_zone *bzone;
20233b1a94c8SDamien Le Moal 
20243b1a94c8SDamien Le Moal 	dmz_lock_map(zmd);
20253b1a94c8SDamien Le Moal 
20263b1a94c8SDamien Le Moal 	bzone = dzone->bzone;
20273b1a94c8SDamien Le Moal 	if (bzone) {
20283b1a94c8SDamien Le Moal 		if (dmz_weight(bzone))
20293b1a94c8SDamien Le Moal 			dmz_lru_zone(zmd, bzone);
20303b1a94c8SDamien Le Moal 		else {
20313b1a94c8SDamien Le Moal 			/* Empty buffer zone: reclaim it */
20323b1a94c8SDamien Le Moal 			dmz_unmap_zone(zmd, bzone);
20333b1a94c8SDamien Le Moal 			dmz_free_zone(zmd, bzone);
20343b1a94c8SDamien Le Moal 			bzone = NULL;
20353b1a94c8SDamien Le Moal 		}
20363b1a94c8SDamien Le Moal 	}
20373b1a94c8SDamien Le Moal 
20383b1a94c8SDamien Le Moal 	/* Deactivate the data zone */
20393b1a94c8SDamien Le Moal 	dmz_deactivate_zone(dzone);
20403b1a94c8SDamien Le Moal 	if (dmz_is_active(dzone) || bzone || dmz_weight(dzone))
20413b1a94c8SDamien Le Moal 		dmz_lru_zone(zmd, dzone);
20423b1a94c8SDamien Le Moal 	else {
20433b1a94c8SDamien Le Moal 		/* Unbuffered inactive empty data zone: reclaim it */
20443b1a94c8SDamien Le Moal 		dmz_unmap_zone(zmd, dzone);
20453b1a94c8SDamien Le Moal 		dmz_free_zone(zmd, dzone);
20463b1a94c8SDamien Le Moal 	}
20473b1a94c8SDamien Le Moal 
20483b1a94c8SDamien Le Moal 	dmz_unlock_map(zmd);
20493b1a94c8SDamien Le Moal }
20503b1a94c8SDamien Le Moal 
20513b1a94c8SDamien Le Moal /*
20523b1a94c8SDamien Le Moal  * Allocate and map a random zone to buffer a chunk
20533b1a94c8SDamien Le Moal  * already mapped to a sequential zone.
20543b1a94c8SDamien Le Moal  */
20553b1a94c8SDamien Le Moal struct dm_zone *dmz_get_chunk_buffer(struct dmz_metadata *zmd,
20563b1a94c8SDamien Le Moal 				     struct dm_zone *dzone)
20573b1a94c8SDamien Le Moal {
20583b1a94c8SDamien Le Moal 	struct dm_zone *bzone;
205934f5affdSHannes Reinecke 	int alloc_flags = zmd->nr_cache ? DMZ_ALLOC_CACHE : DMZ_ALLOC_RND;
20603b1a94c8SDamien Le Moal 
20613b1a94c8SDamien Le Moal 	dmz_lock_map(zmd);
20623b1a94c8SDamien Le Moal again:
20633b1a94c8SDamien Le Moal 	bzone = dzone->bzone;
20643b1a94c8SDamien Le Moal 	if (bzone)
20653b1a94c8SDamien Le Moal 		goto out;
20663b1a94c8SDamien Le Moal 
2067ad1bd578SDmitry Fomichev 	/* Allocate a random zone */
206834f5affdSHannes Reinecke 	bzone = dmz_alloc_zone(zmd, alloc_flags);
20693b1a94c8SDamien Le Moal 	if (!bzone) {
2070d0e21ce4SHannes Reinecke 		if (dmz_dev_is_dying(zmd)) {
207175d66ffbSDmitry Fomichev 			bzone = ERR_PTR(-EIO);
207275d66ffbSDmitry Fomichev 			goto out;
207375d66ffbSDmitry Fomichev 		}
20743b1a94c8SDamien Le Moal 		dmz_wait_for_free_zones(zmd);
20753b1a94c8SDamien Le Moal 		goto again;
20763b1a94c8SDamien Le Moal 	}
20773b1a94c8SDamien Le Moal 
20783b1a94c8SDamien Le Moal 	/* Update the chunk mapping */
2079b7122873SHannes Reinecke 	dmz_set_chunk_mapping(zmd, dzone->chunk, dzone->id, bzone->id);
20803b1a94c8SDamien Le Moal 
20813b1a94c8SDamien Le Moal 	set_bit(DMZ_BUF, &bzone->flags);
20823b1a94c8SDamien Le Moal 	bzone->chunk = dzone->chunk;
20833b1a94c8SDamien Le Moal 	bzone->bzone = dzone;
20843b1a94c8SDamien Le Moal 	dzone->bzone = bzone;
208534f5affdSHannes Reinecke 	if (dmz_is_cache(bzone))
208634f5affdSHannes Reinecke 		list_add_tail(&bzone->link, &zmd->map_cache_list);
208734f5affdSHannes Reinecke 	else
20883b1a94c8SDamien Le Moal 		list_add_tail(&bzone->link, &zmd->map_rnd_list);
20893b1a94c8SDamien Le Moal out:
20903b1a94c8SDamien Le Moal 	dmz_unlock_map(zmd);
20913b1a94c8SDamien Le Moal 
20923b1a94c8SDamien Le Moal 	return bzone;
20933b1a94c8SDamien Le Moal }
20943b1a94c8SDamien Le Moal 
20953b1a94c8SDamien Le Moal /*
20963b1a94c8SDamien Le Moal  * Get an unmapped (free) zone.
20973b1a94c8SDamien Le Moal  * This must be called with the mapping lock held.
20983b1a94c8SDamien Le Moal  */
20993b1a94c8SDamien Le Moal struct dm_zone *dmz_alloc_zone(struct dmz_metadata *zmd, unsigned long flags)
21003b1a94c8SDamien Le Moal {
21013b1a94c8SDamien Le Moal 	struct list_head *list;
21023b1a94c8SDamien Le Moal 	struct dm_zone *zone;
21033b1a94c8SDamien Le Moal 
210434f5affdSHannes Reinecke 	if (flags & DMZ_ALLOC_CACHE)
210534f5affdSHannes Reinecke 		list = &zmd->unmap_cache_list;
210634f5affdSHannes Reinecke 	else if (flags & DMZ_ALLOC_RND)
21073b1a94c8SDamien Le Moal 		list = &zmd->unmap_rnd_list;
21083b1a94c8SDamien Le Moal 	else
21093b1a94c8SDamien Le Moal 		list = &zmd->unmap_seq_list;
211034f5affdSHannes Reinecke 
21113b1a94c8SDamien Le Moal again:
21123b1a94c8SDamien Le Moal 	if (list_empty(list)) {
21133b1a94c8SDamien Le Moal 		/*
211434f5affdSHannes Reinecke 		 * No free zone: return NULL if this is for not reclaim.
21153b1a94c8SDamien Le Moal 		 */
211634f5affdSHannes Reinecke 		if (!(flags & DMZ_ALLOC_RECLAIM))
21173b1a94c8SDamien Le Moal 			return NULL;
211834f5affdSHannes Reinecke 		/*
211934f5affdSHannes Reinecke 		 * Fallback to the reserved sequential zones
212034f5affdSHannes Reinecke 		 */
212134f5affdSHannes Reinecke 		zone = list_first_entry_or_null(&zmd->reserved_seq_zones_list,
21223b1a94c8SDamien Le Moal 						struct dm_zone, link);
212334f5affdSHannes Reinecke 		if (zone) {
21243b1a94c8SDamien Le Moal 			list_del_init(&zone->link);
21253b1a94c8SDamien Le Moal 			atomic_dec(&zmd->nr_reserved_seq_zones);
212634f5affdSHannes Reinecke 		}
21273b1a94c8SDamien Le Moal 		return zone;
21283b1a94c8SDamien Le Moal 	}
21293b1a94c8SDamien Le Moal 
21303b1a94c8SDamien Le Moal 	zone = list_first_entry(list, struct dm_zone, link);
21313b1a94c8SDamien Le Moal 	list_del_init(&zone->link);
21323b1a94c8SDamien Le Moal 
213334f5affdSHannes Reinecke 	if (dmz_is_cache(zone))
213434f5affdSHannes Reinecke 		atomic_dec(&zmd->unmap_nr_cache);
213534f5affdSHannes Reinecke 	else if (dmz_is_rnd(zone))
21363b1a94c8SDamien Le Moal 		atomic_dec(&zmd->unmap_nr_rnd);
21373b1a94c8SDamien Le Moal 	else
21383b1a94c8SDamien Le Moal 		atomic_dec(&zmd->unmap_nr_seq);
21393b1a94c8SDamien Le Moal 
21403b1a94c8SDamien Le Moal 	if (dmz_is_offline(zone)) {
2141ca1a7045SHannes Reinecke 		dmz_zmd_warn(zmd, "Zone %u is offline", zone->id);
21423b1a94c8SDamien Le Moal 		zone = NULL;
21433b1a94c8SDamien Le Moal 		goto again;
21443b1a94c8SDamien Le Moal 	}
2145dc076c83SHannes Reinecke 	if (dmz_is_meta(zone)) {
2146dc076c83SHannes Reinecke 		struct dmz_dev *dev = dmz_zone_to_dev(zmd, zone);
21473b1a94c8SDamien Le Moal 
2148dc076c83SHannes Reinecke 		dmz_dev_warn(dev, "Zone %u has metadata", zone->id);
2149dc076c83SHannes Reinecke 		zone = NULL;
2150dc076c83SHannes Reinecke 		goto again;
2151dc076c83SHannes Reinecke 	}
21523b1a94c8SDamien Le Moal 	return zone;
21533b1a94c8SDamien Le Moal }
21543b1a94c8SDamien Le Moal 
21553b1a94c8SDamien Le Moal /*
21563b1a94c8SDamien Le Moal  * Free a zone.
21573b1a94c8SDamien Le Moal  * This must be called with the mapping lock held.
21583b1a94c8SDamien Le Moal  */
21593b1a94c8SDamien Le Moal void dmz_free_zone(struct dmz_metadata *zmd, struct dm_zone *zone)
21603b1a94c8SDamien Le Moal {
21613b1a94c8SDamien Le Moal 	/* If this is a sequential zone, reset it */
21623b1a94c8SDamien Le Moal 	if (dmz_is_seq(zone))
21633b1a94c8SDamien Le Moal 		dmz_reset_zone(zmd, zone);
21643b1a94c8SDamien Le Moal 
21653b1a94c8SDamien Le Moal 	/* Return the zone to its type unmap list */
216634f5affdSHannes Reinecke 	if (dmz_is_cache(zone)) {
216734f5affdSHannes Reinecke 		list_add_tail(&zone->link, &zmd->unmap_cache_list);
216834f5affdSHannes Reinecke 		atomic_inc(&zmd->unmap_nr_cache);
216934f5affdSHannes Reinecke 	} else if (dmz_is_rnd(zone)) {
21703b1a94c8SDamien Le Moal 		list_add_tail(&zone->link, &zmd->unmap_rnd_list);
21713b1a94c8SDamien Le Moal 		atomic_inc(&zmd->unmap_nr_rnd);
21723b1a94c8SDamien Le Moal 	} else if (atomic_read(&zmd->nr_reserved_seq_zones) <
21733b1a94c8SDamien Le Moal 		   zmd->nr_reserved_seq) {
21743b1a94c8SDamien Le Moal 		list_add_tail(&zone->link, &zmd->reserved_seq_zones_list);
21753b1a94c8SDamien Le Moal 		atomic_inc(&zmd->nr_reserved_seq_zones);
21763b1a94c8SDamien Le Moal 	} else {
21773b1a94c8SDamien Le Moal 		list_add_tail(&zone->link, &zmd->unmap_seq_list);
21783b1a94c8SDamien Le Moal 		atomic_inc(&zmd->unmap_nr_seq);
21793b1a94c8SDamien Le Moal 	}
21803b1a94c8SDamien Le Moal 
21813b1a94c8SDamien Le Moal 	wake_up_all(&zmd->free_wq);
21823b1a94c8SDamien Le Moal }
21833b1a94c8SDamien Le Moal 
21843b1a94c8SDamien Le Moal /*
21853b1a94c8SDamien Le Moal  * Map a chunk to a zone.
21863b1a94c8SDamien Le Moal  * This must be called with the mapping lock held.
21873b1a94c8SDamien Le Moal  */
21883b1a94c8SDamien Le Moal void dmz_map_zone(struct dmz_metadata *zmd, struct dm_zone *dzone,
21893b1a94c8SDamien Le Moal 		  unsigned int chunk)
21903b1a94c8SDamien Le Moal {
21913b1a94c8SDamien Le Moal 	/* Set the chunk mapping */
2192b7122873SHannes Reinecke 	dmz_set_chunk_mapping(zmd, chunk, dzone->id,
21933b1a94c8SDamien Le Moal 			      DMZ_MAP_UNMAPPED);
21943b1a94c8SDamien Le Moal 	dzone->chunk = chunk;
219534f5affdSHannes Reinecke 	if (dmz_is_cache(dzone))
219634f5affdSHannes Reinecke 		list_add_tail(&dzone->link, &zmd->map_cache_list);
219734f5affdSHannes Reinecke 	else if (dmz_is_rnd(dzone))
21983b1a94c8SDamien Le Moal 		list_add_tail(&dzone->link, &zmd->map_rnd_list);
21993b1a94c8SDamien Le Moal 	else
22003b1a94c8SDamien Le Moal 		list_add_tail(&dzone->link, &zmd->map_seq_list);
22013b1a94c8SDamien Le Moal }
22023b1a94c8SDamien Le Moal 
22033b1a94c8SDamien Le Moal /*
22043b1a94c8SDamien Le Moal  * Unmap a zone.
22053b1a94c8SDamien Le Moal  * This must be called with the mapping lock held.
22063b1a94c8SDamien Le Moal  */
22073b1a94c8SDamien Le Moal void dmz_unmap_zone(struct dmz_metadata *zmd, struct dm_zone *zone)
22083b1a94c8SDamien Le Moal {
22093b1a94c8SDamien Le Moal 	unsigned int chunk = zone->chunk;
22103b1a94c8SDamien Le Moal 	unsigned int dzone_id;
22113b1a94c8SDamien Le Moal 
22123b1a94c8SDamien Le Moal 	if (chunk == DMZ_MAP_UNMAPPED) {
22133b1a94c8SDamien Le Moal 		/* Already unmapped */
22143b1a94c8SDamien Le Moal 		return;
22153b1a94c8SDamien Le Moal 	}
22163b1a94c8SDamien Le Moal 
22173b1a94c8SDamien Le Moal 	if (test_and_clear_bit(DMZ_BUF, &zone->flags)) {
22183b1a94c8SDamien Le Moal 		/*
22193b1a94c8SDamien Le Moal 		 * Unmapping the chunk buffer zone: clear only
22203b1a94c8SDamien Le Moal 		 * the chunk buffer mapping
22213b1a94c8SDamien Le Moal 		 */
2222b7122873SHannes Reinecke 		dzone_id = zone->bzone->id;
22233b1a94c8SDamien Le Moal 		zone->bzone->bzone = NULL;
22243b1a94c8SDamien Le Moal 		zone->bzone = NULL;
22253b1a94c8SDamien Le Moal 
22263b1a94c8SDamien Le Moal 	} else {
22273b1a94c8SDamien Le Moal 		/*
22283b1a94c8SDamien Le Moal 		 * Unmapping the chunk data zone: the zone must
22293b1a94c8SDamien Le Moal 		 * not be buffered.
22303b1a94c8SDamien Le Moal 		 */
22313b1a94c8SDamien Le Moal 		if (WARN_ON(zone->bzone)) {
22323b1a94c8SDamien Le Moal 			zone->bzone->bzone = NULL;
22333b1a94c8SDamien Le Moal 			zone->bzone = NULL;
22343b1a94c8SDamien Le Moal 		}
22353b1a94c8SDamien Le Moal 		dzone_id = DMZ_MAP_UNMAPPED;
22363b1a94c8SDamien Le Moal 	}
22373b1a94c8SDamien Le Moal 
22383b1a94c8SDamien Le Moal 	dmz_set_chunk_mapping(zmd, chunk, dzone_id, DMZ_MAP_UNMAPPED);
22393b1a94c8SDamien Le Moal 
22403b1a94c8SDamien Le Moal 	zone->chunk = DMZ_MAP_UNMAPPED;
22413b1a94c8SDamien Le Moal 	list_del_init(&zone->link);
22423b1a94c8SDamien Le Moal }
22433b1a94c8SDamien Le Moal 
22443b1a94c8SDamien Le Moal /*
22453b1a94c8SDamien Le Moal  * Set @nr_bits bits in @bitmap starting from @bit.
22463b1a94c8SDamien Le Moal  * Return the number of bits changed from 0 to 1.
22473b1a94c8SDamien Le Moal  */
22483b1a94c8SDamien Le Moal static unsigned int dmz_set_bits(unsigned long *bitmap,
22493b1a94c8SDamien Le Moal 				 unsigned int bit, unsigned int nr_bits)
22503b1a94c8SDamien Le Moal {
22513b1a94c8SDamien Le Moal 	unsigned long *addr;
22523b1a94c8SDamien Le Moal 	unsigned int end = bit + nr_bits;
22533b1a94c8SDamien Le Moal 	unsigned int n = 0;
22543b1a94c8SDamien Le Moal 
22553b1a94c8SDamien Le Moal 	while (bit < end) {
22563b1a94c8SDamien Le Moal 		if (((bit & (BITS_PER_LONG - 1)) == 0) &&
22573b1a94c8SDamien Le Moal 		    ((end - bit) >= BITS_PER_LONG)) {
22583b1a94c8SDamien Le Moal 			/* Try to set the whole word at once */
22593b1a94c8SDamien Le Moal 			addr = bitmap + BIT_WORD(bit);
22603b1a94c8SDamien Le Moal 			if (*addr == 0) {
22613b1a94c8SDamien Le Moal 				*addr = ULONG_MAX;
22623b1a94c8SDamien Le Moal 				n += BITS_PER_LONG;
22633b1a94c8SDamien Le Moal 				bit += BITS_PER_LONG;
22643b1a94c8SDamien Le Moal 				continue;
22653b1a94c8SDamien Le Moal 			}
22663b1a94c8SDamien Le Moal 		}
22673b1a94c8SDamien Le Moal 
22683b1a94c8SDamien Le Moal 		if (!test_and_set_bit(bit, bitmap))
22693b1a94c8SDamien Le Moal 			n++;
22703b1a94c8SDamien Le Moal 		bit++;
22713b1a94c8SDamien Le Moal 	}
22723b1a94c8SDamien Le Moal 
22733b1a94c8SDamien Le Moal 	return n;
22743b1a94c8SDamien Le Moal }
22753b1a94c8SDamien Le Moal 
22763b1a94c8SDamien Le Moal /*
22773b1a94c8SDamien Le Moal  * Get the bitmap block storing the bit for chunk_block in zone.
22783b1a94c8SDamien Le Moal  */
22793b1a94c8SDamien Le Moal static struct dmz_mblock *dmz_get_bitmap(struct dmz_metadata *zmd,
22803b1a94c8SDamien Le Moal 					 struct dm_zone *zone,
22813b1a94c8SDamien Le Moal 					 sector_t chunk_block)
22823b1a94c8SDamien Le Moal {
22833b1a94c8SDamien Le Moal 	sector_t bitmap_block = 1 + zmd->nr_map_blocks +
2284b7122873SHannes Reinecke 		(sector_t)(zone->id * zmd->zone_nr_bitmap_blocks) +
22853b1a94c8SDamien Le Moal 		(chunk_block >> DMZ_BLOCK_SHIFT_BITS);
22863b1a94c8SDamien Le Moal 
22873b1a94c8SDamien Le Moal 	return dmz_get_mblock(zmd, bitmap_block);
22883b1a94c8SDamien Le Moal }
22893b1a94c8SDamien Le Moal 
22903b1a94c8SDamien Le Moal /*
22913b1a94c8SDamien Le Moal  * Copy the valid blocks bitmap of from_zone to the bitmap of to_zone.
22923b1a94c8SDamien Le Moal  */
22933b1a94c8SDamien Le Moal int dmz_copy_valid_blocks(struct dmz_metadata *zmd, struct dm_zone *from_zone,
22943b1a94c8SDamien Le Moal 			  struct dm_zone *to_zone)
22953b1a94c8SDamien Le Moal {
22963b1a94c8SDamien Le Moal 	struct dmz_mblock *from_mblk, *to_mblk;
22973b1a94c8SDamien Le Moal 	sector_t chunk_block = 0;
22983b1a94c8SDamien Le Moal 
22993b1a94c8SDamien Le Moal 	/* Get the zones bitmap blocks */
230036820560SHannes Reinecke 	while (chunk_block < zmd->zone_nr_blocks) {
23013b1a94c8SDamien Le Moal 		from_mblk = dmz_get_bitmap(zmd, from_zone, chunk_block);
23023b1a94c8SDamien Le Moal 		if (IS_ERR(from_mblk))
23033b1a94c8SDamien Le Moal 			return PTR_ERR(from_mblk);
23043b1a94c8SDamien Le Moal 		to_mblk = dmz_get_bitmap(zmd, to_zone, chunk_block);
23053b1a94c8SDamien Le Moal 		if (IS_ERR(to_mblk)) {
23063b1a94c8SDamien Le Moal 			dmz_release_mblock(zmd, from_mblk);
23073b1a94c8SDamien Le Moal 			return PTR_ERR(to_mblk);
23083b1a94c8SDamien Le Moal 		}
23093b1a94c8SDamien Le Moal 
23103b1a94c8SDamien Le Moal 		memcpy(to_mblk->data, from_mblk->data, DMZ_BLOCK_SIZE);
23113b1a94c8SDamien Le Moal 		dmz_dirty_mblock(zmd, to_mblk);
23123b1a94c8SDamien Le Moal 
23133b1a94c8SDamien Le Moal 		dmz_release_mblock(zmd, to_mblk);
23143b1a94c8SDamien Le Moal 		dmz_release_mblock(zmd, from_mblk);
23153b1a94c8SDamien Le Moal 
2316b3996295SDmitry Fomichev 		chunk_block += zmd->zone_bits_per_mblk;
23173b1a94c8SDamien Le Moal 	}
23183b1a94c8SDamien Le Moal 
23193b1a94c8SDamien Le Moal 	to_zone->weight = from_zone->weight;
23203b1a94c8SDamien Le Moal 
23213b1a94c8SDamien Le Moal 	return 0;
23223b1a94c8SDamien Le Moal }
23233b1a94c8SDamien Le Moal 
23243b1a94c8SDamien Le Moal /*
23253b1a94c8SDamien Le Moal  * Merge the valid blocks bitmap of from_zone into the bitmap of to_zone,
23263b1a94c8SDamien Le Moal  * starting from chunk_block.
23273b1a94c8SDamien Le Moal  */
23283b1a94c8SDamien Le Moal int dmz_merge_valid_blocks(struct dmz_metadata *zmd, struct dm_zone *from_zone,
23293b1a94c8SDamien Le Moal 			   struct dm_zone *to_zone, sector_t chunk_block)
23303b1a94c8SDamien Le Moal {
23313b1a94c8SDamien Le Moal 	unsigned int nr_blocks;
23323b1a94c8SDamien Le Moal 	int ret;
23333b1a94c8SDamien Le Moal 
23343b1a94c8SDamien Le Moal 	/* Get the zones bitmap blocks */
233536820560SHannes Reinecke 	while (chunk_block < zmd->zone_nr_blocks) {
23363b1a94c8SDamien Le Moal 		/* Get a valid region from the source zone */
23373b1a94c8SDamien Le Moal 		ret = dmz_first_valid_block(zmd, from_zone, &chunk_block);
23383b1a94c8SDamien Le Moal 		if (ret <= 0)
23393b1a94c8SDamien Le Moal 			return ret;
23403b1a94c8SDamien Le Moal 
23413b1a94c8SDamien Le Moal 		nr_blocks = ret;
23423b1a94c8SDamien Le Moal 		ret = dmz_validate_blocks(zmd, to_zone, chunk_block, nr_blocks);
23433b1a94c8SDamien Le Moal 		if (ret)
23443b1a94c8SDamien Le Moal 			return ret;
23453b1a94c8SDamien Le Moal 
23463b1a94c8SDamien Le Moal 		chunk_block += nr_blocks;
23473b1a94c8SDamien Le Moal 	}
23483b1a94c8SDamien Le Moal 
23493b1a94c8SDamien Le Moal 	return 0;
23503b1a94c8SDamien Le Moal }
23513b1a94c8SDamien Le Moal 
23523b1a94c8SDamien Le Moal /*
23533b1a94c8SDamien Le Moal  * Validate all the blocks in the range [block..block+nr_blocks-1].
23543b1a94c8SDamien Le Moal  */
23553b1a94c8SDamien Le Moal int dmz_validate_blocks(struct dmz_metadata *zmd, struct dm_zone *zone,
23563b1a94c8SDamien Le Moal 			sector_t chunk_block, unsigned int nr_blocks)
23573b1a94c8SDamien Le Moal {
23583b1a94c8SDamien Le Moal 	unsigned int count, bit, nr_bits;
235936820560SHannes Reinecke 	unsigned int zone_nr_blocks = zmd->zone_nr_blocks;
23603b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk;
23613b1a94c8SDamien Le Moal 	unsigned int n = 0;
23623b1a94c8SDamien Le Moal 
2363ca1a7045SHannes Reinecke 	dmz_zmd_debug(zmd, "=> VALIDATE zone %u, block %llu, %u blocks",
2364b7122873SHannes Reinecke 		      zone->id, (unsigned long long)chunk_block,
23653b1a94c8SDamien Le Moal 		      nr_blocks);
23663b1a94c8SDamien Le Moal 
23673b1a94c8SDamien Le Moal 	WARN_ON(chunk_block + nr_blocks > zone_nr_blocks);
23683b1a94c8SDamien Le Moal 
23693b1a94c8SDamien Le Moal 	while (nr_blocks) {
23703b1a94c8SDamien Le Moal 		/* Get bitmap block */
23713b1a94c8SDamien Le Moal 		mblk = dmz_get_bitmap(zmd, zone, chunk_block);
23723b1a94c8SDamien Le Moal 		if (IS_ERR(mblk))
23733b1a94c8SDamien Le Moal 			return PTR_ERR(mblk);
23743b1a94c8SDamien Le Moal 
23753b1a94c8SDamien Le Moal 		/* Set bits */
23763b1a94c8SDamien Le Moal 		bit = chunk_block & DMZ_BLOCK_MASK_BITS;
2377b3996295SDmitry Fomichev 		nr_bits = min(nr_blocks, zmd->zone_bits_per_mblk - bit);
23783b1a94c8SDamien Le Moal 
23793b1a94c8SDamien Le Moal 		count = dmz_set_bits((unsigned long *)mblk->data, bit, nr_bits);
23803b1a94c8SDamien Le Moal 		if (count) {
23813b1a94c8SDamien Le Moal 			dmz_dirty_mblock(zmd, mblk);
23823b1a94c8SDamien Le Moal 			n += count;
23833b1a94c8SDamien Le Moal 		}
23843b1a94c8SDamien Le Moal 		dmz_release_mblock(zmd, mblk);
23853b1a94c8SDamien Le Moal 
23863b1a94c8SDamien Le Moal 		nr_blocks -= nr_bits;
23873b1a94c8SDamien Le Moal 		chunk_block += nr_bits;
23883b1a94c8SDamien Le Moal 	}
23893b1a94c8SDamien Le Moal 
23903b1a94c8SDamien Le Moal 	if (likely(zone->weight + n <= zone_nr_blocks))
23913b1a94c8SDamien Le Moal 		zone->weight += n;
23923b1a94c8SDamien Le Moal 	else {
2393ca1a7045SHannes Reinecke 		dmz_zmd_warn(zmd, "Zone %u: weight %u should be <= %u",
2394b7122873SHannes Reinecke 			     zone->id, zone->weight,
23953b1a94c8SDamien Le Moal 			     zone_nr_blocks - n);
23963b1a94c8SDamien Le Moal 		zone->weight = zone_nr_blocks;
23973b1a94c8SDamien Le Moal 	}
23983b1a94c8SDamien Le Moal 
23993b1a94c8SDamien Le Moal 	return 0;
24003b1a94c8SDamien Le Moal }
24013b1a94c8SDamien Le Moal 
24023b1a94c8SDamien Le Moal /*
24033b1a94c8SDamien Le Moal  * Clear nr_bits bits in bitmap starting from bit.
24043b1a94c8SDamien Le Moal  * Return the number of bits cleared.
24053b1a94c8SDamien Le Moal  */
24063b1a94c8SDamien Le Moal static int dmz_clear_bits(unsigned long *bitmap, int bit, int nr_bits)
24073b1a94c8SDamien Le Moal {
24083b1a94c8SDamien Le Moal 	unsigned long *addr;
24093b1a94c8SDamien Le Moal 	int end = bit + nr_bits;
24103b1a94c8SDamien Le Moal 	int n = 0;
24113b1a94c8SDamien Le Moal 
24123b1a94c8SDamien Le Moal 	while (bit < end) {
24133b1a94c8SDamien Le Moal 		if (((bit & (BITS_PER_LONG - 1)) == 0) &&
24143b1a94c8SDamien Le Moal 		    ((end - bit) >= BITS_PER_LONG)) {
24153b1a94c8SDamien Le Moal 			/* Try to clear whole word at once */
24163b1a94c8SDamien Le Moal 			addr = bitmap + BIT_WORD(bit);
24173b1a94c8SDamien Le Moal 			if (*addr == ULONG_MAX) {
24183b1a94c8SDamien Le Moal 				*addr = 0;
24193b1a94c8SDamien Le Moal 				n += BITS_PER_LONG;
24203b1a94c8SDamien Le Moal 				bit += BITS_PER_LONG;
24213b1a94c8SDamien Le Moal 				continue;
24223b1a94c8SDamien Le Moal 			}
24233b1a94c8SDamien Le Moal 		}
24243b1a94c8SDamien Le Moal 
24253b1a94c8SDamien Le Moal 		if (test_and_clear_bit(bit, bitmap))
24263b1a94c8SDamien Le Moal 			n++;
24273b1a94c8SDamien Le Moal 		bit++;
24283b1a94c8SDamien Le Moal 	}
24293b1a94c8SDamien Le Moal 
24303b1a94c8SDamien Le Moal 	return n;
24313b1a94c8SDamien Le Moal }
24323b1a94c8SDamien Le Moal 
24333b1a94c8SDamien Le Moal /*
24343b1a94c8SDamien Le Moal  * Invalidate all the blocks in the range [block..block+nr_blocks-1].
24353b1a94c8SDamien Le Moal  */
24363b1a94c8SDamien Le Moal int dmz_invalidate_blocks(struct dmz_metadata *zmd, struct dm_zone *zone,
24373b1a94c8SDamien Le Moal 			  sector_t chunk_block, unsigned int nr_blocks)
24383b1a94c8SDamien Le Moal {
24393b1a94c8SDamien Le Moal 	unsigned int count, bit, nr_bits;
24403b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk;
24413b1a94c8SDamien Le Moal 	unsigned int n = 0;
24423b1a94c8SDamien Le Moal 
2443ca1a7045SHannes Reinecke 	dmz_zmd_debug(zmd, "=> INVALIDATE zone %u, block %llu, %u blocks",
2444b7122873SHannes Reinecke 		      zone->id, (u64)chunk_block, nr_blocks);
24453b1a94c8SDamien Le Moal 
244636820560SHannes Reinecke 	WARN_ON(chunk_block + nr_blocks > zmd->zone_nr_blocks);
24473b1a94c8SDamien Le Moal 
24483b1a94c8SDamien Le Moal 	while (nr_blocks) {
24493b1a94c8SDamien Le Moal 		/* Get bitmap block */
24503b1a94c8SDamien Le Moal 		mblk = dmz_get_bitmap(zmd, zone, chunk_block);
24513b1a94c8SDamien Le Moal 		if (IS_ERR(mblk))
24523b1a94c8SDamien Le Moal 			return PTR_ERR(mblk);
24533b1a94c8SDamien Le Moal 
24543b1a94c8SDamien Le Moal 		/* Clear bits */
24553b1a94c8SDamien Le Moal 		bit = chunk_block & DMZ_BLOCK_MASK_BITS;
2456b3996295SDmitry Fomichev 		nr_bits = min(nr_blocks, zmd->zone_bits_per_mblk - bit);
24573b1a94c8SDamien Le Moal 
24583b1a94c8SDamien Le Moal 		count = dmz_clear_bits((unsigned long *)mblk->data,
24593b1a94c8SDamien Le Moal 				       bit, nr_bits);
24603b1a94c8SDamien Le Moal 		if (count) {
24613b1a94c8SDamien Le Moal 			dmz_dirty_mblock(zmd, mblk);
24623b1a94c8SDamien Le Moal 			n += count;
24633b1a94c8SDamien Le Moal 		}
24643b1a94c8SDamien Le Moal 		dmz_release_mblock(zmd, mblk);
24653b1a94c8SDamien Le Moal 
24663b1a94c8SDamien Le Moal 		nr_blocks -= nr_bits;
24673b1a94c8SDamien Le Moal 		chunk_block += nr_bits;
24683b1a94c8SDamien Le Moal 	}
24693b1a94c8SDamien Le Moal 
24703b1a94c8SDamien Le Moal 	if (zone->weight >= n)
24713b1a94c8SDamien Le Moal 		zone->weight -= n;
24723b1a94c8SDamien Le Moal 	else {
2473ca1a7045SHannes Reinecke 		dmz_zmd_warn(zmd, "Zone %u: weight %u should be >= %u",
2474b7122873SHannes Reinecke 			     zone->id, zone->weight, n);
24753b1a94c8SDamien Le Moal 		zone->weight = 0;
24763b1a94c8SDamien Le Moal 	}
24773b1a94c8SDamien Le Moal 
24783b1a94c8SDamien Le Moal 	return 0;
24793b1a94c8SDamien Le Moal }
24803b1a94c8SDamien Le Moal 
24813b1a94c8SDamien Le Moal /*
24823b1a94c8SDamien Le Moal  * Get a block bit value.
24833b1a94c8SDamien Le Moal  */
24843b1a94c8SDamien Le Moal static int dmz_test_block(struct dmz_metadata *zmd, struct dm_zone *zone,
24853b1a94c8SDamien Le Moal 			  sector_t chunk_block)
24863b1a94c8SDamien Le Moal {
24873b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk;
24883b1a94c8SDamien Le Moal 	int ret;
24893b1a94c8SDamien Le Moal 
249036820560SHannes Reinecke 	WARN_ON(chunk_block >= zmd->zone_nr_blocks);
24913b1a94c8SDamien Le Moal 
24923b1a94c8SDamien Le Moal 	/* Get bitmap block */
24933b1a94c8SDamien Le Moal 	mblk = dmz_get_bitmap(zmd, zone, chunk_block);
24943b1a94c8SDamien Le Moal 	if (IS_ERR(mblk))
24953b1a94c8SDamien Le Moal 		return PTR_ERR(mblk);
24963b1a94c8SDamien Le Moal 
24973b1a94c8SDamien Le Moal 	/* Get offset */
24983b1a94c8SDamien Le Moal 	ret = test_bit(chunk_block & DMZ_BLOCK_MASK_BITS,
24993b1a94c8SDamien Le Moal 		       (unsigned long *) mblk->data) != 0;
25003b1a94c8SDamien Le Moal 
25013b1a94c8SDamien Le Moal 	dmz_release_mblock(zmd, mblk);
25023b1a94c8SDamien Le Moal 
25033b1a94c8SDamien Le Moal 	return ret;
25043b1a94c8SDamien Le Moal }
25053b1a94c8SDamien Le Moal 
25063b1a94c8SDamien Le Moal /*
25073b1a94c8SDamien Le Moal  * Return the number of blocks from chunk_block to the first block with a bit
25083b1a94c8SDamien Le Moal  * value specified by set. Search at most nr_blocks blocks from chunk_block.
25093b1a94c8SDamien Le Moal  */
25103b1a94c8SDamien Le Moal static int dmz_to_next_set_block(struct dmz_metadata *zmd, struct dm_zone *zone,
25113b1a94c8SDamien Le Moal 				 sector_t chunk_block, unsigned int nr_blocks,
25123b1a94c8SDamien Le Moal 				 int set)
25133b1a94c8SDamien Le Moal {
25143b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk;
25153b1a94c8SDamien Le Moal 	unsigned int bit, set_bit, nr_bits;
2516b3996295SDmitry Fomichev 	unsigned int zone_bits = zmd->zone_bits_per_mblk;
25173b1a94c8SDamien Le Moal 	unsigned long *bitmap;
25183b1a94c8SDamien Le Moal 	int n = 0;
25193b1a94c8SDamien Le Moal 
252036820560SHannes Reinecke 	WARN_ON(chunk_block + nr_blocks > zmd->zone_nr_blocks);
25213b1a94c8SDamien Le Moal 
25223b1a94c8SDamien Le Moal 	while (nr_blocks) {
25233b1a94c8SDamien Le Moal 		/* Get bitmap block */
25243b1a94c8SDamien Le Moal 		mblk = dmz_get_bitmap(zmd, zone, chunk_block);
25253b1a94c8SDamien Le Moal 		if (IS_ERR(mblk))
25263b1a94c8SDamien Le Moal 			return PTR_ERR(mblk);
25273b1a94c8SDamien Le Moal 
25283b1a94c8SDamien Le Moal 		/* Get offset */
25293b1a94c8SDamien Le Moal 		bitmap = (unsigned long *) mblk->data;
25303b1a94c8SDamien Le Moal 		bit = chunk_block & DMZ_BLOCK_MASK_BITS;
2531b3996295SDmitry Fomichev 		nr_bits = min(nr_blocks, zone_bits - bit);
25323b1a94c8SDamien Le Moal 		if (set)
2533b3996295SDmitry Fomichev 			set_bit = find_next_bit(bitmap, zone_bits, bit);
25343b1a94c8SDamien Le Moal 		else
2535b3996295SDmitry Fomichev 			set_bit = find_next_zero_bit(bitmap, zone_bits, bit);
25363b1a94c8SDamien Le Moal 		dmz_release_mblock(zmd, mblk);
25373b1a94c8SDamien Le Moal 
25383b1a94c8SDamien Le Moal 		n += set_bit - bit;
2539b3996295SDmitry Fomichev 		if (set_bit < zone_bits)
25403b1a94c8SDamien Le Moal 			break;
25413b1a94c8SDamien Le Moal 
25423b1a94c8SDamien Le Moal 		nr_blocks -= nr_bits;
25433b1a94c8SDamien Le Moal 		chunk_block += nr_bits;
25443b1a94c8SDamien Le Moal 	}
25453b1a94c8SDamien Le Moal 
25463b1a94c8SDamien Le Moal 	return n;
25473b1a94c8SDamien Le Moal }
25483b1a94c8SDamien Le Moal 
25493b1a94c8SDamien Le Moal /*
25503b1a94c8SDamien Le Moal  * Test if chunk_block is valid. If it is, the number of consecutive
25513b1a94c8SDamien Le Moal  * valid blocks from chunk_block will be returned.
25523b1a94c8SDamien Le Moal  */
25533b1a94c8SDamien Le Moal int dmz_block_valid(struct dmz_metadata *zmd, struct dm_zone *zone,
25543b1a94c8SDamien Le Moal 		    sector_t chunk_block)
25553b1a94c8SDamien Le Moal {
25563b1a94c8SDamien Le Moal 	int valid;
25573b1a94c8SDamien Le Moal 
25583b1a94c8SDamien Le Moal 	valid = dmz_test_block(zmd, zone, chunk_block);
25593b1a94c8SDamien Le Moal 	if (valid <= 0)
25603b1a94c8SDamien Le Moal 		return valid;
25613b1a94c8SDamien Le Moal 
25623b1a94c8SDamien Le Moal 	/* The block is valid: get the number of valid blocks from block */
25633b1a94c8SDamien Le Moal 	return dmz_to_next_set_block(zmd, zone, chunk_block,
256436820560SHannes Reinecke 				     zmd->zone_nr_blocks - chunk_block, 0);
25653b1a94c8SDamien Le Moal }
25663b1a94c8SDamien Le Moal 
25673b1a94c8SDamien Le Moal /*
25683b1a94c8SDamien Le Moal  * Find the first valid block from @chunk_block in @zone.
25693b1a94c8SDamien Le Moal  * If such a block is found, its number is returned using
25703b1a94c8SDamien Le Moal  * @chunk_block and the total number of valid blocks from @chunk_block
25713b1a94c8SDamien Le Moal  * is returned.
25723b1a94c8SDamien Le Moal  */
25733b1a94c8SDamien Le Moal int dmz_first_valid_block(struct dmz_metadata *zmd, struct dm_zone *zone,
25743b1a94c8SDamien Le Moal 			  sector_t *chunk_block)
25753b1a94c8SDamien Le Moal {
25763b1a94c8SDamien Le Moal 	sector_t start_block = *chunk_block;
25773b1a94c8SDamien Le Moal 	int ret;
25783b1a94c8SDamien Le Moal 
25793b1a94c8SDamien Le Moal 	ret = dmz_to_next_set_block(zmd, zone, start_block,
258036820560SHannes Reinecke 				    zmd->zone_nr_blocks - start_block, 1);
25813b1a94c8SDamien Le Moal 	if (ret < 0)
25823b1a94c8SDamien Le Moal 		return ret;
25833b1a94c8SDamien Le Moal 
25843b1a94c8SDamien Le Moal 	start_block += ret;
25853b1a94c8SDamien Le Moal 	*chunk_block = start_block;
25863b1a94c8SDamien Le Moal 
25873b1a94c8SDamien Le Moal 	return dmz_to_next_set_block(zmd, zone, start_block,
258836820560SHannes Reinecke 				     zmd->zone_nr_blocks - start_block, 0);
25893b1a94c8SDamien Le Moal }
25903b1a94c8SDamien Le Moal 
25913b1a94c8SDamien Le Moal /*
25923b1a94c8SDamien Le Moal  * Count the number of bits set starting from bit up to bit + nr_bits - 1.
25933b1a94c8SDamien Le Moal  */
25943b1a94c8SDamien Le Moal static int dmz_count_bits(void *bitmap, int bit, int nr_bits)
25953b1a94c8SDamien Le Moal {
25963b1a94c8SDamien Le Moal 	unsigned long *addr;
25973b1a94c8SDamien Le Moal 	int end = bit + nr_bits;
25983b1a94c8SDamien Le Moal 	int n = 0;
25993b1a94c8SDamien Le Moal 
26003b1a94c8SDamien Le Moal 	while (bit < end) {
26013b1a94c8SDamien Le Moal 		if (((bit & (BITS_PER_LONG - 1)) == 0) &&
26023b1a94c8SDamien Le Moal 		    ((end - bit) >= BITS_PER_LONG)) {
26033b1a94c8SDamien Le Moal 			addr = (unsigned long *)bitmap + BIT_WORD(bit);
26043b1a94c8SDamien Le Moal 			if (*addr == ULONG_MAX) {
26053b1a94c8SDamien Le Moal 				n += BITS_PER_LONG;
26063b1a94c8SDamien Le Moal 				bit += BITS_PER_LONG;
26073b1a94c8SDamien Le Moal 				continue;
26083b1a94c8SDamien Le Moal 			}
26093b1a94c8SDamien Le Moal 		}
26103b1a94c8SDamien Le Moal 
26113b1a94c8SDamien Le Moal 		if (test_bit(bit, bitmap))
26123b1a94c8SDamien Le Moal 			n++;
26133b1a94c8SDamien Le Moal 		bit++;
26143b1a94c8SDamien Le Moal 	}
26153b1a94c8SDamien Le Moal 
26163b1a94c8SDamien Le Moal 	return n;
26173b1a94c8SDamien Le Moal }
26183b1a94c8SDamien Le Moal 
26193b1a94c8SDamien Le Moal /*
26203b1a94c8SDamien Le Moal  * Get a zone weight.
26213b1a94c8SDamien Le Moal  */
26223b1a94c8SDamien Le Moal static void dmz_get_zone_weight(struct dmz_metadata *zmd, struct dm_zone *zone)
26233b1a94c8SDamien Le Moal {
26243b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk;
26253b1a94c8SDamien Le Moal 	sector_t chunk_block = 0;
26263b1a94c8SDamien Le Moal 	unsigned int bit, nr_bits;
262736820560SHannes Reinecke 	unsigned int nr_blocks = zmd->zone_nr_blocks;
26283b1a94c8SDamien Le Moal 	void *bitmap;
26293b1a94c8SDamien Le Moal 	int n = 0;
26303b1a94c8SDamien Le Moal 
26313b1a94c8SDamien Le Moal 	while (nr_blocks) {
26323b1a94c8SDamien Le Moal 		/* Get bitmap block */
26333b1a94c8SDamien Le Moal 		mblk = dmz_get_bitmap(zmd, zone, chunk_block);
26343b1a94c8SDamien Le Moal 		if (IS_ERR(mblk)) {
26353b1a94c8SDamien Le Moal 			n = 0;
26363b1a94c8SDamien Le Moal 			break;
26373b1a94c8SDamien Le Moal 		}
26383b1a94c8SDamien Le Moal 
26393b1a94c8SDamien Le Moal 		/* Count bits in this block */
26403b1a94c8SDamien Le Moal 		bitmap = mblk->data;
26413b1a94c8SDamien Le Moal 		bit = chunk_block & DMZ_BLOCK_MASK_BITS;
2642b3996295SDmitry Fomichev 		nr_bits = min(nr_blocks, zmd->zone_bits_per_mblk - bit);
26433b1a94c8SDamien Le Moal 		n += dmz_count_bits(bitmap, bit, nr_bits);
26443b1a94c8SDamien Le Moal 
26453b1a94c8SDamien Le Moal 		dmz_release_mblock(zmd, mblk);
26463b1a94c8SDamien Le Moal 
26473b1a94c8SDamien Le Moal 		nr_blocks -= nr_bits;
26483b1a94c8SDamien Le Moal 		chunk_block += nr_bits;
26493b1a94c8SDamien Le Moal 	}
26503b1a94c8SDamien Le Moal 
26513b1a94c8SDamien Le Moal 	zone->weight = n;
26523b1a94c8SDamien Le Moal }
26533b1a94c8SDamien Le Moal 
26543b1a94c8SDamien Le Moal /*
26553b1a94c8SDamien Le Moal  * Cleanup the zoned metadata resources.
26563b1a94c8SDamien Le Moal  */
26573b1a94c8SDamien Le Moal static void dmz_cleanup_metadata(struct dmz_metadata *zmd)
26583b1a94c8SDamien Le Moal {
26593b1a94c8SDamien Le Moal 	struct rb_root *root;
26603b1a94c8SDamien Le Moal 	struct dmz_mblock *mblk, *next;
26613b1a94c8SDamien Le Moal 	int i;
26623b1a94c8SDamien Le Moal 
26633b1a94c8SDamien Le Moal 	/* Release zone mapping resources */
26643b1a94c8SDamien Le Moal 	if (zmd->map_mblk) {
26653b1a94c8SDamien Le Moal 		for (i = 0; i < zmd->nr_map_blocks; i++)
26663b1a94c8SDamien Le Moal 			dmz_release_mblock(zmd, zmd->map_mblk[i]);
26673b1a94c8SDamien Le Moal 		kfree(zmd->map_mblk);
26683b1a94c8SDamien Le Moal 		zmd->map_mblk = NULL;
26693b1a94c8SDamien Le Moal 	}
26703b1a94c8SDamien Le Moal 
26713b1a94c8SDamien Le Moal 	/* Release super blocks */
26723b1a94c8SDamien Le Moal 	for (i = 0; i < 2; i++) {
26733b1a94c8SDamien Le Moal 		if (zmd->sb[i].mblk) {
26743b1a94c8SDamien Le Moal 			dmz_free_mblock(zmd, zmd->sb[i].mblk);
26753b1a94c8SDamien Le Moal 			zmd->sb[i].mblk = NULL;
26763b1a94c8SDamien Le Moal 		}
26773b1a94c8SDamien Le Moal 	}
26783b1a94c8SDamien Le Moal 
26793b1a94c8SDamien Le Moal 	/* Free cached blocks */
26803b1a94c8SDamien Le Moal 	while (!list_empty(&zmd->mblk_dirty_list)) {
26813b1a94c8SDamien Le Moal 		mblk = list_first_entry(&zmd->mblk_dirty_list,
26823b1a94c8SDamien Le Moal 					struct dmz_mblock, link);
2683ca1a7045SHannes Reinecke 		dmz_zmd_warn(zmd, "mblock %llu still in dirty list (ref %u)",
268433c2865fSDamien Le Moal 			     (u64)mblk->no, mblk->ref);
26853b1a94c8SDamien Le Moal 		list_del_init(&mblk->link);
26863b1a94c8SDamien Le Moal 		rb_erase(&mblk->node, &zmd->mblk_rbtree);
26873b1a94c8SDamien Le Moal 		dmz_free_mblock(zmd, mblk);
26883b1a94c8SDamien Le Moal 	}
26893b1a94c8SDamien Le Moal 
26903b1a94c8SDamien Le Moal 	while (!list_empty(&zmd->mblk_lru_list)) {
26913b1a94c8SDamien Le Moal 		mblk = list_first_entry(&zmd->mblk_lru_list,
26923b1a94c8SDamien Le Moal 					struct dmz_mblock, link);
26933b1a94c8SDamien Le Moal 		list_del_init(&mblk->link);
26943b1a94c8SDamien Le Moal 		rb_erase(&mblk->node, &zmd->mblk_rbtree);
26953b1a94c8SDamien Le Moal 		dmz_free_mblock(zmd, mblk);
26963b1a94c8SDamien Le Moal 	}
26973b1a94c8SDamien Le Moal 
26983b1a94c8SDamien Le Moal 	/* Sanity checks: the mblock rbtree should now be empty */
26993b1a94c8SDamien Le Moal 	root = &zmd->mblk_rbtree;
27003b1a94c8SDamien Le Moal 	rbtree_postorder_for_each_entry_safe(mblk, next, root, node) {
2701ca1a7045SHannes Reinecke 		dmz_zmd_warn(zmd, "mblock %llu ref %u still in rbtree",
270233c2865fSDamien Le Moal 			     (u64)mblk->no, mblk->ref);
270333c2865fSDamien Le Moal 		mblk->ref = 0;
27043b1a94c8SDamien Le Moal 		dmz_free_mblock(zmd, mblk);
27053b1a94c8SDamien Le Moal 	}
27063b1a94c8SDamien Le Moal 
27073b1a94c8SDamien Le Moal 	/* Free the zone descriptors */
27083b1a94c8SDamien Le Moal 	dmz_drop_zones(zmd);
2709d5ffebddSMike Snitzer 
2710d5ffebddSMike Snitzer 	mutex_destroy(&zmd->mblk_flush_lock);
2711d5ffebddSMike Snitzer 	mutex_destroy(&zmd->map_lock);
27123b1a94c8SDamien Le Moal }
27133b1a94c8SDamien Le Moal 
2714ca1a7045SHannes Reinecke static void dmz_print_dev(struct dmz_metadata *zmd, int num)
2715ca1a7045SHannes Reinecke {
2716ca1a7045SHannes Reinecke 	struct dmz_dev *dev = &zmd->dev[num];
2717ca1a7045SHannes Reinecke 
2718bd5c4031SHannes Reinecke 	if (bdev_zoned_model(dev->bdev) == BLK_ZONED_NONE)
2719bd5c4031SHannes Reinecke 		dmz_dev_info(dev, "Regular block device");
2720bd5c4031SHannes Reinecke 	else
2721ca1a7045SHannes Reinecke 		dmz_dev_info(dev, "Host-%s zoned block device",
2722ca1a7045SHannes Reinecke 			     bdev_zoned_model(dev->bdev) == BLK_ZONED_HA ?
2723ca1a7045SHannes Reinecke 			     "aware" : "managed");
2724bd5c4031SHannes Reinecke 	if (zmd->sb_version > 1) {
2725bd5c4031SHannes Reinecke 		sector_t sector_offset =
2726bd5c4031SHannes Reinecke 			dev->zone_offset << zmd->zone_nr_sectors_shift;
2727bd5c4031SHannes Reinecke 
2728bd5c4031SHannes Reinecke 		dmz_dev_info(dev, "  %llu 512-byte logical sectors (offset %llu)",
2729bd5c4031SHannes Reinecke 			     (u64)dev->capacity, (u64)sector_offset);
2730bd5c4031SHannes Reinecke 		dmz_dev_info(dev, "  %u zones of %llu 512-byte logical sectors (offset %llu)",
2731bd5c4031SHannes Reinecke 			     dev->nr_zones, (u64)zmd->zone_nr_sectors,
2732bd5c4031SHannes Reinecke 			     (u64)dev->zone_offset);
2733bd5c4031SHannes Reinecke 	} else {
2734ca1a7045SHannes Reinecke 		dmz_dev_info(dev, "  %llu 512-byte logical sectors",
2735ca1a7045SHannes Reinecke 			     (u64)dev->capacity);
2736ca1a7045SHannes Reinecke 		dmz_dev_info(dev, "  %u zones of %llu 512-byte logical sectors",
2737ca1a7045SHannes Reinecke 			     dev->nr_zones, (u64)zmd->zone_nr_sectors);
2738ca1a7045SHannes Reinecke 	}
2739bd5c4031SHannes Reinecke }
2740ca1a7045SHannes Reinecke 
27413b1a94c8SDamien Le Moal /*
27423b1a94c8SDamien Le Moal  * Initialize the zoned metadata.
27433b1a94c8SDamien Le Moal  */
2744bd5c4031SHannes Reinecke int dmz_ctr_metadata(struct dmz_dev *dev, int num_dev,
2745bd5c4031SHannes Reinecke 		     struct dmz_metadata **metadata,
27462234e732SHannes Reinecke 		     const char *devname)
27473b1a94c8SDamien Le Moal {
27483b1a94c8SDamien Le Moal 	struct dmz_metadata *zmd;
2749b7122873SHannes Reinecke 	unsigned int i;
27503b1a94c8SDamien Le Moal 	struct dm_zone *zone;
27513b1a94c8SDamien Le Moal 	int ret;
27523b1a94c8SDamien Le Moal 
27533b1a94c8SDamien Le Moal 	zmd = kzalloc(sizeof(struct dmz_metadata), GFP_KERNEL);
27543b1a94c8SDamien Le Moal 	if (!zmd)
27553b1a94c8SDamien Le Moal 		return -ENOMEM;
27563b1a94c8SDamien Le Moal 
27572234e732SHannes Reinecke 	strcpy(zmd->devname, devname);
27583b1a94c8SDamien Le Moal 	zmd->dev = dev;
2759bd5c4031SHannes Reinecke 	zmd->nr_devs = num_dev;
27603b1a94c8SDamien Le Moal 	zmd->mblk_rbtree = RB_ROOT;
27613b1a94c8SDamien Le Moal 	init_rwsem(&zmd->mblk_sem);
27623b1a94c8SDamien Le Moal 	mutex_init(&zmd->mblk_flush_lock);
27633b1a94c8SDamien Le Moal 	spin_lock_init(&zmd->mblk_lock);
27643b1a94c8SDamien Le Moal 	INIT_LIST_HEAD(&zmd->mblk_lru_list);
27653b1a94c8SDamien Le Moal 	INIT_LIST_HEAD(&zmd->mblk_dirty_list);
27663b1a94c8SDamien Le Moal 
27673b1a94c8SDamien Le Moal 	mutex_init(&zmd->map_lock);
27683b1a94c8SDamien Le Moal 	atomic_set(&zmd->unmap_nr_rnd, 0);
27693b1a94c8SDamien Le Moal 	INIT_LIST_HEAD(&zmd->unmap_rnd_list);
27703b1a94c8SDamien Le Moal 	INIT_LIST_HEAD(&zmd->map_rnd_list);
27713b1a94c8SDamien Le Moal 
277234f5affdSHannes Reinecke 	atomic_set(&zmd->unmap_nr_cache, 0);
277334f5affdSHannes Reinecke 	INIT_LIST_HEAD(&zmd->unmap_cache_list);
277434f5affdSHannes Reinecke 	INIT_LIST_HEAD(&zmd->map_cache_list);
277534f5affdSHannes Reinecke 
27763b1a94c8SDamien Le Moal 	atomic_set(&zmd->unmap_nr_seq, 0);
27773b1a94c8SDamien Le Moal 	INIT_LIST_HEAD(&zmd->unmap_seq_list);
27783b1a94c8SDamien Le Moal 	INIT_LIST_HEAD(&zmd->map_seq_list);
27793b1a94c8SDamien Le Moal 
27803b1a94c8SDamien Le Moal 	atomic_set(&zmd->nr_reserved_seq_zones, 0);
27813b1a94c8SDamien Le Moal 	INIT_LIST_HEAD(&zmd->reserved_seq_zones_list);
27823b1a94c8SDamien Le Moal 
27833b1a94c8SDamien Le Moal 	init_waitqueue_head(&zmd->free_wq);
27843b1a94c8SDamien Le Moal 
27853b1a94c8SDamien Le Moal 	/* Initialize zone descriptors */
27863b1a94c8SDamien Le Moal 	ret = dmz_init_zones(zmd);
27873b1a94c8SDamien Le Moal 	if (ret)
27883b1a94c8SDamien Le Moal 		goto err;
27893b1a94c8SDamien Le Moal 
27903b1a94c8SDamien Le Moal 	/* Get super block */
27913b1a94c8SDamien Le Moal 	ret = dmz_load_sb(zmd);
27923b1a94c8SDamien Le Moal 	if (ret)
27933b1a94c8SDamien Le Moal 		goto err;
27943b1a94c8SDamien Le Moal 
27953b1a94c8SDamien Le Moal 	/* Set metadata zones starting from sb_zone */
27963b1a94c8SDamien Le Moal 	for (i = 0; i < zmd->nr_meta_zones << 1; i++) {
2797735bd7e4SHannes Reinecke 		zone = dmz_get(zmd, zmd->sb[0].zone->id + i);
279834f5affdSHannes Reinecke 		if (!dmz_is_rnd(zone) && !dmz_is_cache(zone)) {
2799bd5c4031SHannes Reinecke 			dmz_zmd_err(zmd,
2800bd5c4031SHannes Reinecke 				    "metadata zone %d is not random", i);
2801bd5c4031SHannes Reinecke 			ret = -ENXIO;
28023b1a94c8SDamien Le Moal 			goto err;
2803bd5c4031SHannes Reinecke 		}
28043b1a94c8SDamien Le Moal 		set_bit(DMZ_META, &zone->flags);
28053b1a94c8SDamien Le Moal 	}
2806bd5c4031SHannes Reinecke 	if (zmd->sb[2].zone) {
2807bd5c4031SHannes Reinecke 		zone = dmz_get(zmd, zmd->sb[2].zone->id);
2808bd5c4031SHannes Reinecke 		if (!zone) {
2809bd5c4031SHannes Reinecke 			dmz_zmd_err(zmd,
2810bd5c4031SHannes Reinecke 				    "Tertiary metadata zone not present");
2811bd5c4031SHannes Reinecke 			ret = -ENXIO;
2812bd5c4031SHannes Reinecke 			goto err;
2813bd5c4031SHannes Reinecke 		}
2814bd5c4031SHannes Reinecke 		set_bit(DMZ_META, &zone->flags);
2815bd5c4031SHannes Reinecke 	}
28163b1a94c8SDamien Le Moal 	/* Load mapping table */
28173b1a94c8SDamien Le Moal 	ret = dmz_load_mapping(zmd);
28183b1a94c8SDamien Le Moal 	if (ret)
28193b1a94c8SDamien Le Moal 		goto err;
28203b1a94c8SDamien Le Moal 
28213b1a94c8SDamien Le Moal 	/*
28223b1a94c8SDamien Le Moal 	 * Cache size boundaries: allow at least 2 super blocks, the chunk map
28233b1a94c8SDamien Le Moal 	 * blocks and enough blocks to be able to cache the bitmap blocks of
28243b1a94c8SDamien Le Moal 	 * up to 16 zones when idle (min_nr_mblks). Otherwise, if busy, allow
28253b1a94c8SDamien Le Moal 	 * the cache to add 512 more metadata blocks.
28263b1a94c8SDamien Le Moal 	 */
28273b1a94c8SDamien Le Moal 	zmd->min_nr_mblks = 2 + zmd->nr_map_blocks + zmd->zone_nr_bitmap_blocks * 16;
28283b1a94c8SDamien Le Moal 	zmd->max_nr_mblks = zmd->min_nr_mblks + 512;
28293b1a94c8SDamien Le Moal 	zmd->mblk_shrinker.count_objects = dmz_mblock_shrinker_count;
28303b1a94c8SDamien Le Moal 	zmd->mblk_shrinker.scan_objects = dmz_mblock_shrinker_scan;
28313b1a94c8SDamien Le Moal 	zmd->mblk_shrinker.seeks = DEFAULT_SEEKS;
28323b1a94c8SDamien Le Moal 
28333b1a94c8SDamien Le Moal 	/* Metadata cache shrinker */
28343b1a94c8SDamien Le Moal 	ret = register_shrinker(&zmd->mblk_shrinker);
28353b1a94c8SDamien Le Moal 	if (ret) {
2836ca1a7045SHannes Reinecke 		dmz_zmd_err(zmd, "Register metadata cache shrinker failed");
28373b1a94c8SDamien Le Moal 		goto err;
28383b1a94c8SDamien Le Moal 	}
28393b1a94c8SDamien Le Moal 
2840bd5c4031SHannes Reinecke 	dmz_zmd_info(zmd, "DM-Zoned metadata version %d", zmd->sb_version);
2841bd5c4031SHannes Reinecke 	for (i = 0; i < zmd->nr_devs; i++)
2842bd5c4031SHannes Reinecke 		dmz_print_dev(zmd, i);
28433b1a94c8SDamien Le Moal 
2844ca1a7045SHannes Reinecke 	dmz_zmd_info(zmd, "  %u zones of %llu 512-byte logical sectors",
2845ca1a7045SHannes Reinecke 		     zmd->nr_zones, (u64)zmd->zone_nr_sectors);
2846ae3c1f11SHannes Reinecke 	dmz_zmd_debug(zmd, "  %u metadata zones",
2847ca1a7045SHannes Reinecke 		      zmd->nr_meta_zones * 2);
2848ae3c1f11SHannes Reinecke 	dmz_zmd_debug(zmd, "  %u data zones for %u chunks",
2849ca1a7045SHannes Reinecke 		      zmd->nr_data_zones, zmd->nr_chunks);
285034f5affdSHannes Reinecke 	dmz_zmd_debug(zmd, "    %u cache zones (%u unmapped)",
285134f5affdSHannes Reinecke 		      zmd->nr_cache, atomic_read(&zmd->unmap_nr_cache));
2852ae3c1f11SHannes Reinecke 	dmz_zmd_debug(zmd, "    %u random zones (%u unmapped)",
2853ca1a7045SHannes Reinecke 		      zmd->nr_rnd, atomic_read(&zmd->unmap_nr_rnd));
2854ae3c1f11SHannes Reinecke 	dmz_zmd_debug(zmd, "    %u sequential zones (%u unmapped)",
2855ca1a7045SHannes Reinecke 		      zmd->nr_seq, atomic_read(&zmd->unmap_nr_seq));
2856ae3c1f11SHannes Reinecke 	dmz_zmd_debug(zmd, "  %u reserved sequential data zones",
2857ca1a7045SHannes Reinecke 		      zmd->nr_reserved_seq);
2858ca1a7045SHannes Reinecke 	dmz_zmd_debug(zmd, "Format:");
2859ca1a7045SHannes Reinecke 	dmz_zmd_debug(zmd, "%u metadata blocks per set (%u max cache)",
28603b1a94c8SDamien Le Moal 		      zmd->nr_meta_blocks, zmd->max_nr_mblks);
2861ca1a7045SHannes Reinecke 	dmz_zmd_debug(zmd, "  %u data zone mapping blocks",
28623b1a94c8SDamien Le Moal 		      zmd->nr_map_blocks);
2863ca1a7045SHannes Reinecke 	dmz_zmd_debug(zmd, "  %u bitmap blocks",
28643b1a94c8SDamien Le Moal 		      zmd->nr_bitmap_blocks);
28653b1a94c8SDamien Le Moal 
28663b1a94c8SDamien Le Moal 	*metadata = zmd;
28673b1a94c8SDamien Le Moal 
28683b1a94c8SDamien Le Moal 	return 0;
28693b1a94c8SDamien Le Moal err:
28703b1a94c8SDamien Le Moal 	dmz_cleanup_metadata(zmd);
28713b1a94c8SDamien Le Moal 	kfree(zmd);
28723b1a94c8SDamien Le Moal 	*metadata = NULL;
28733b1a94c8SDamien Le Moal 
28743b1a94c8SDamien Le Moal 	return ret;
28753b1a94c8SDamien Le Moal }
28763b1a94c8SDamien Le Moal 
28773b1a94c8SDamien Le Moal /*
28783b1a94c8SDamien Le Moal  * Cleanup the zoned metadata resources.
28793b1a94c8SDamien Le Moal  */
28803b1a94c8SDamien Le Moal void dmz_dtr_metadata(struct dmz_metadata *zmd)
28813b1a94c8SDamien Le Moal {
28823b1a94c8SDamien Le Moal 	unregister_shrinker(&zmd->mblk_shrinker);
28833b1a94c8SDamien Le Moal 	dmz_cleanup_metadata(zmd);
28843b1a94c8SDamien Le Moal 	kfree(zmd);
28853b1a94c8SDamien Le Moal }
28863b1a94c8SDamien Le Moal 
28873b1a94c8SDamien Le Moal /*
28883b1a94c8SDamien Le Moal  * Check zone information on resume.
28893b1a94c8SDamien Le Moal  */
28903b1a94c8SDamien Le Moal int dmz_resume_metadata(struct dmz_metadata *zmd)
28913b1a94c8SDamien Le Moal {
28923b1a94c8SDamien Le Moal 	struct dm_zone *zone;
28933b1a94c8SDamien Le Moal 	sector_t wp_block;
28943b1a94c8SDamien Le Moal 	unsigned int i;
28953b1a94c8SDamien Le Moal 	int ret;
28963b1a94c8SDamien Le Moal 
28973b1a94c8SDamien Le Moal 	/* Check zones */
289836820560SHannes Reinecke 	for (i = 0; i < zmd->nr_zones; i++) {
28993b1a94c8SDamien Le Moal 		zone = dmz_get(zmd, i);
29003b1a94c8SDamien Le Moal 		if (!zone) {
2901ca1a7045SHannes Reinecke 			dmz_zmd_err(zmd, "Unable to get zone %u", i);
29023b1a94c8SDamien Le Moal 			return -EIO;
29033b1a94c8SDamien Le Moal 		}
29043b1a94c8SDamien Le Moal 		wp_block = zone->wp_block;
29053b1a94c8SDamien Le Moal 
29063b1a94c8SDamien Le Moal 		ret = dmz_update_zone(zmd, zone);
29073b1a94c8SDamien Le Moal 		if (ret) {
2908ca1a7045SHannes Reinecke 			dmz_zmd_err(zmd, "Broken zone %u", i);
29093b1a94c8SDamien Le Moal 			return ret;
29103b1a94c8SDamien Le Moal 		}
29113b1a94c8SDamien Le Moal 
29123b1a94c8SDamien Le Moal 		if (dmz_is_offline(zone)) {
2913ca1a7045SHannes Reinecke 			dmz_zmd_warn(zmd, "Zone %u is offline", i);
29143b1a94c8SDamien Le Moal 			continue;
29153b1a94c8SDamien Le Moal 		}
29163b1a94c8SDamien Le Moal 
29173b1a94c8SDamien Le Moal 		/* Check write pointer */
29183b1a94c8SDamien Le Moal 		if (!dmz_is_seq(zone))
29193b1a94c8SDamien Le Moal 			zone->wp_block = 0;
29203b1a94c8SDamien Le Moal 		else if (zone->wp_block != wp_block) {
2921ca1a7045SHannes Reinecke 			dmz_zmd_err(zmd, "Zone %u: Invalid wp (%llu / %llu)",
29223b1a94c8SDamien Le Moal 				    i, (u64)zone->wp_block, (u64)wp_block);
29233b1a94c8SDamien Le Moal 			zone->wp_block = wp_block;
29243b1a94c8SDamien Le Moal 			dmz_invalidate_blocks(zmd, zone, zone->wp_block,
292536820560SHannes Reinecke 					      zmd->zone_nr_blocks - zone->wp_block);
29263b1a94c8SDamien Le Moal 		}
29273b1a94c8SDamien Le Moal 	}
29283b1a94c8SDamien Le Moal 
29293b1a94c8SDamien Le Moal 	return 0;
29303b1a94c8SDamien Le Moal }
2931