18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * Copyright (C) 2016 CNEX Labs
48c2ecf20Sopenharmony_ci * Initial release: Javier Gonzalez <javier@cnexlabs.com>
58c2ecf20Sopenharmony_ci *                  Matias Bjorling <matias@cnexlabs.com>
68c2ecf20Sopenharmony_ci *
78c2ecf20Sopenharmony_ci * This program is free software; you can redistribute it and/or
88c2ecf20Sopenharmony_ci * modify it under the terms of the GNU General Public License version
98c2ecf20Sopenharmony_ci * 2 as published by the Free Software Foundation.
108c2ecf20Sopenharmony_ci *
118c2ecf20Sopenharmony_ci * This program is distributed in the hope that it will be useful, but
128c2ecf20Sopenharmony_ci * WITHOUT ANY WARRANTY; without even the implied warranty of
138c2ecf20Sopenharmony_ci * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
148c2ecf20Sopenharmony_ci * General Public License for more details.
158c2ecf20Sopenharmony_ci *
168c2ecf20Sopenharmony_ci * pblk-rl.c - pblk's rate limiter for user I/O
178c2ecf20Sopenharmony_ci *
188c2ecf20Sopenharmony_ci */
198c2ecf20Sopenharmony_ci
208c2ecf20Sopenharmony_ci#include "pblk.h"
218c2ecf20Sopenharmony_ci
228c2ecf20Sopenharmony_cistatic void pblk_rl_kick_u_timer(struct pblk_rl *rl)
238c2ecf20Sopenharmony_ci{
248c2ecf20Sopenharmony_ci	mod_timer(&rl->u_timer, jiffies + msecs_to_jiffies(5000));
258c2ecf20Sopenharmony_ci}
268c2ecf20Sopenharmony_ci
278c2ecf20Sopenharmony_ciint pblk_rl_is_limit(struct pblk_rl *rl)
288c2ecf20Sopenharmony_ci{
298c2ecf20Sopenharmony_ci	int rb_space;
308c2ecf20Sopenharmony_ci
318c2ecf20Sopenharmony_ci	rb_space = atomic_read(&rl->rb_space);
328c2ecf20Sopenharmony_ci
338c2ecf20Sopenharmony_ci	return (rb_space == 0);
348c2ecf20Sopenharmony_ci}
358c2ecf20Sopenharmony_ci
368c2ecf20Sopenharmony_ciint pblk_rl_user_may_insert(struct pblk_rl *rl, int nr_entries)
378c2ecf20Sopenharmony_ci{
388c2ecf20Sopenharmony_ci	int rb_user_cnt = atomic_read(&rl->rb_user_cnt);
398c2ecf20Sopenharmony_ci	int rb_space = atomic_read(&rl->rb_space);
408c2ecf20Sopenharmony_ci
418c2ecf20Sopenharmony_ci	if (unlikely(rb_space >= 0) && (rb_space - nr_entries < 0))
428c2ecf20Sopenharmony_ci		return NVM_IO_ERR;
438c2ecf20Sopenharmony_ci
448c2ecf20Sopenharmony_ci	if (rb_user_cnt >= rl->rb_user_max)
458c2ecf20Sopenharmony_ci		return NVM_IO_REQUEUE;
468c2ecf20Sopenharmony_ci
478c2ecf20Sopenharmony_ci	return NVM_IO_OK;
488c2ecf20Sopenharmony_ci}
498c2ecf20Sopenharmony_ci
508c2ecf20Sopenharmony_civoid pblk_rl_inserted(struct pblk_rl *rl, int nr_entries)
518c2ecf20Sopenharmony_ci{
528c2ecf20Sopenharmony_ci	int rb_space = atomic_read(&rl->rb_space);
538c2ecf20Sopenharmony_ci
548c2ecf20Sopenharmony_ci	if (unlikely(rb_space >= 0))
558c2ecf20Sopenharmony_ci		atomic_sub(nr_entries, &rl->rb_space);
568c2ecf20Sopenharmony_ci}
578c2ecf20Sopenharmony_ci
588c2ecf20Sopenharmony_ciint pblk_rl_gc_may_insert(struct pblk_rl *rl, int nr_entries)
598c2ecf20Sopenharmony_ci{
608c2ecf20Sopenharmony_ci	int rb_gc_cnt = atomic_read(&rl->rb_gc_cnt);
618c2ecf20Sopenharmony_ci	int rb_user_active;
628c2ecf20Sopenharmony_ci
638c2ecf20Sopenharmony_ci	/* If there is no user I/O let GC take over space on the write buffer */
648c2ecf20Sopenharmony_ci	rb_user_active = READ_ONCE(rl->rb_user_active);
658c2ecf20Sopenharmony_ci	return (!(rb_gc_cnt >= rl->rb_gc_max && rb_user_active));
668c2ecf20Sopenharmony_ci}
678c2ecf20Sopenharmony_ci
688c2ecf20Sopenharmony_civoid pblk_rl_user_in(struct pblk_rl *rl, int nr_entries)
698c2ecf20Sopenharmony_ci{
708c2ecf20Sopenharmony_ci	atomic_add(nr_entries, &rl->rb_user_cnt);
718c2ecf20Sopenharmony_ci
728c2ecf20Sopenharmony_ci	/* Release user I/O state. Protect from GC */
738c2ecf20Sopenharmony_ci	smp_store_release(&rl->rb_user_active, 1);
748c2ecf20Sopenharmony_ci	pblk_rl_kick_u_timer(rl);
758c2ecf20Sopenharmony_ci}
768c2ecf20Sopenharmony_ci
778c2ecf20Sopenharmony_civoid pblk_rl_werr_line_in(struct pblk_rl *rl)
788c2ecf20Sopenharmony_ci{
798c2ecf20Sopenharmony_ci	atomic_inc(&rl->werr_lines);
808c2ecf20Sopenharmony_ci}
818c2ecf20Sopenharmony_ci
828c2ecf20Sopenharmony_civoid pblk_rl_werr_line_out(struct pblk_rl *rl)
838c2ecf20Sopenharmony_ci{
848c2ecf20Sopenharmony_ci	atomic_dec(&rl->werr_lines);
858c2ecf20Sopenharmony_ci}
868c2ecf20Sopenharmony_ci
878c2ecf20Sopenharmony_civoid pblk_rl_gc_in(struct pblk_rl *rl, int nr_entries)
888c2ecf20Sopenharmony_ci{
898c2ecf20Sopenharmony_ci	atomic_add(nr_entries, &rl->rb_gc_cnt);
908c2ecf20Sopenharmony_ci}
918c2ecf20Sopenharmony_ci
928c2ecf20Sopenharmony_civoid pblk_rl_out(struct pblk_rl *rl, int nr_user, int nr_gc)
938c2ecf20Sopenharmony_ci{
948c2ecf20Sopenharmony_ci	atomic_sub(nr_user, &rl->rb_user_cnt);
958c2ecf20Sopenharmony_ci	atomic_sub(nr_gc, &rl->rb_gc_cnt);
968c2ecf20Sopenharmony_ci}
978c2ecf20Sopenharmony_ci
988c2ecf20Sopenharmony_ciunsigned long pblk_rl_nr_free_blks(struct pblk_rl *rl)
998c2ecf20Sopenharmony_ci{
1008c2ecf20Sopenharmony_ci	return atomic_read(&rl->free_blocks);
1018c2ecf20Sopenharmony_ci}
1028c2ecf20Sopenharmony_ci
1038c2ecf20Sopenharmony_ciunsigned long pblk_rl_nr_user_free_blks(struct pblk_rl *rl)
1048c2ecf20Sopenharmony_ci{
1058c2ecf20Sopenharmony_ci	return atomic_read(&rl->free_user_blocks);
1068c2ecf20Sopenharmony_ci}
1078c2ecf20Sopenharmony_ci
1088c2ecf20Sopenharmony_cistatic void __pblk_rl_update_rates(struct pblk_rl *rl,
1098c2ecf20Sopenharmony_ci				   unsigned long free_blocks)
1108c2ecf20Sopenharmony_ci{
1118c2ecf20Sopenharmony_ci	struct pblk *pblk = container_of(rl, struct pblk, rl);
1128c2ecf20Sopenharmony_ci	int max = rl->rb_budget;
1138c2ecf20Sopenharmony_ci	int werr_gc_needed = atomic_read(&rl->werr_lines);
1148c2ecf20Sopenharmony_ci
1158c2ecf20Sopenharmony_ci	if (free_blocks >= rl->high) {
1168c2ecf20Sopenharmony_ci		if (werr_gc_needed) {
1178c2ecf20Sopenharmony_ci			/* Allocate a small budget for recovering
1188c2ecf20Sopenharmony_ci			 * lines with write errors
1198c2ecf20Sopenharmony_ci			 */
1208c2ecf20Sopenharmony_ci			rl->rb_gc_max = 1 << rl->rb_windows_pw;
1218c2ecf20Sopenharmony_ci			rl->rb_user_max = max - rl->rb_gc_max;
1228c2ecf20Sopenharmony_ci			rl->rb_state = PBLK_RL_WERR;
1238c2ecf20Sopenharmony_ci		} else {
1248c2ecf20Sopenharmony_ci			rl->rb_user_max = max;
1258c2ecf20Sopenharmony_ci			rl->rb_gc_max = 0;
1268c2ecf20Sopenharmony_ci			rl->rb_state = PBLK_RL_OFF;
1278c2ecf20Sopenharmony_ci		}
1288c2ecf20Sopenharmony_ci	} else if (free_blocks < rl->high) {
1298c2ecf20Sopenharmony_ci		int shift = rl->high_pw - rl->rb_windows_pw;
1308c2ecf20Sopenharmony_ci		int user_windows = free_blocks >> shift;
1318c2ecf20Sopenharmony_ci		int user_max = user_windows << ilog2(NVM_MAX_VLBA);
1328c2ecf20Sopenharmony_ci
1338c2ecf20Sopenharmony_ci		rl->rb_user_max = user_max;
1348c2ecf20Sopenharmony_ci		rl->rb_gc_max = max - user_max;
1358c2ecf20Sopenharmony_ci
1368c2ecf20Sopenharmony_ci		if (free_blocks <= rl->rsv_blocks) {
1378c2ecf20Sopenharmony_ci			rl->rb_user_max = 0;
1388c2ecf20Sopenharmony_ci			rl->rb_gc_max = max;
1398c2ecf20Sopenharmony_ci		}
1408c2ecf20Sopenharmony_ci
1418c2ecf20Sopenharmony_ci		/* In the worst case, we will need to GC lines in the low list
1428c2ecf20Sopenharmony_ci		 * (high valid sector count). If there are lines to GC on high
1438c2ecf20Sopenharmony_ci		 * or mid lists, these will be prioritized
1448c2ecf20Sopenharmony_ci		 */
1458c2ecf20Sopenharmony_ci		rl->rb_state = PBLK_RL_LOW;
1468c2ecf20Sopenharmony_ci	}
1478c2ecf20Sopenharmony_ci
1488c2ecf20Sopenharmony_ci	if (rl->rb_state != PBLK_RL_OFF)
1498c2ecf20Sopenharmony_ci		pblk_gc_should_start(pblk);
1508c2ecf20Sopenharmony_ci	else
1518c2ecf20Sopenharmony_ci		pblk_gc_should_stop(pblk);
1528c2ecf20Sopenharmony_ci}
1538c2ecf20Sopenharmony_ci
1548c2ecf20Sopenharmony_civoid pblk_rl_update_rates(struct pblk_rl *rl)
1558c2ecf20Sopenharmony_ci{
1568c2ecf20Sopenharmony_ci	__pblk_rl_update_rates(rl, pblk_rl_nr_user_free_blks(rl));
1578c2ecf20Sopenharmony_ci}
1588c2ecf20Sopenharmony_ci
1598c2ecf20Sopenharmony_civoid pblk_rl_free_lines_inc(struct pblk_rl *rl, struct pblk_line *line)
1608c2ecf20Sopenharmony_ci{
1618c2ecf20Sopenharmony_ci	int blk_in_line = atomic_read(&line->blk_in_line);
1628c2ecf20Sopenharmony_ci	int free_blocks;
1638c2ecf20Sopenharmony_ci
1648c2ecf20Sopenharmony_ci	atomic_add(blk_in_line, &rl->free_blocks);
1658c2ecf20Sopenharmony_ci	free_blocks = atomic_add_return(blk_in_line, &rl->free_user_blocks);
1668c2ecf20Sopenharmony_ci
1678c2ecf20Sopenharmony_ci	__pblk_rl_update_rates(rl, free_blocks);
1688c2ecf20Sopenharmony_ci}
1698c2ecf20Sopenharmony_ci
1708c2ecf20Sopenharmony_civoid pblk_rl_free_lines_dec(struct pblk_rl *rl, struct pblk_line *line,
1718c2ecf20Sopenharmony_ci			    bool used)
1728c2ecf20Sopenharmony_ci{
1738c2ecf20Sopenharmony_ci	int blk_in_line = atomic_read(&line->blk_in_line);
1748c2ecf20Sopenharmony_ci	int free_blocks;
1758c2ecf20Sopenharmony_ci
1768c2ecf20Sopenharmony_ci	atomic_sub(blk_in_line, &rl->free_blocks);
1778c2ecf20Sopenharmony_ci
1788c2ecf20Sopenharmony_ci	if (used)
1798c2ecf20Sopenharmony_ci		free_blocks = atomic_sub_return(blk_in_line,
1808c2ecf20Sopenharmony_ci							&rl->free_user_blocks);
1818c2ecf20Sopenharmony_ci	else
1828c2ecf20Sopenharmony_ci		free_blocks = atomic_read(&rl->free_user_blocks);
1838c2ecf20Sopenharmony_ci
1848c2ecf20Sopenharmony_ci	__pblk_rl_update_rates(rl, free_blocks);
1858c2ecf20Sopenharmony_ci}
1868c2ecf20Sopenharmony_ci
1878c2ecf20Sopenharmony_ciint pblk_rl_high_thrs(struct pblk_rl *rl)
1888c2ecf20Sopenharmony_ci{
1898c2ecf20Sopenharmony_ci	return rl->high;
1908c2ecf20Sopenharmony_ci}
1918c2ecf20Sopenharmony_ci
1928c2ecf20Sopenharmony_ciint pblk_rl_max_io(struct pblk_rl *rl)
1938c2ecf20Sopenharmony_ci{
1948c2ecf20Sopenharmony_ci	return rl->rb_max_io;
1958c2ecf20Sopenharmony_ci}
1968c2ecf20Sopenharmony_ci
1978c2ecf20Sopenharmony_cistatic void pblk_rl_u_timer(struct timer_list *t)
1988c2ecf20Sopenharmony_ci{
1998c2ecf20Sopenharmony_ci	struct pblk_rl *rl = from_timer(rl, t, u_timer);
2008c2ecf20Sopenharmony_ci
2018c2ecf20Sopenharmony_ci	/* Release user I/O state. Protect from GC */
2028c2ecf20Sopenharmony_ci	smp_store_release(&rl->rb_user_active, 0);
2038c2ecf20Sopenharmony_ci}
2048c2ecf20Sopenharmony_ci
2058c2ecf20Sopenharmony_civoid pblk_rl_free(struct pblk_rl *rl)
2068c2ecf20Sopenharmony_ci{
2078c2ecf20Sopenharmony_ci	del_timer(&rl->u_timer);
2088c2ecf20Sopenharmony_ci}
2098c2ecf20Sopenharmony_ci
2108c2ecf20Sopenharmony_civoid pblk_rl_init(struct pblk_rl *rl, int budget, int threshold)
2118c2ecf20Sopenharmony_ci{
2128c2ecf20Sopenharmony_ci	struct pblk *pblk = container_of(rl, struct pblk, rl);
2138c2ecf20Sopenharmony_ci	struct nvm_tgt_dev *dev = pblk->dev;
2148c2ecf20Sopenharmony_ci	struct nvm_geo *geo = &dev->geo;
2158c2ecf20Sopenharmony_ci	struct pblk_line_mgmt *l_mg = &pblk->l_mg;
2168c2ecf20Sopenharmony_ci	struct pblk_line_meta *lm = &pblk->lm;
2178c2ecf20Sopenharmony_ci	int sec_meta, blk_meta;
2188c2ecf20Sopenharmony_ci	unsigned int rb_windows;
2198c2ecf20Sopenharmony_ci
2208c2ecf20Sopenharmony_ci	/* Consider sectors used for metadata */
2218c2ecf20Sopenharmony_ci	sec_meta = (lm->smeta_sec + lm->emeta_sec[0]) * l_mg->nr_free_lines;
2228c2ecf20Sopenharmony_ci	blk_meta = DIV_ROUND_UP(sec_meta, geo->clba);
2238c2ecf20Sopenharmony_ci
2248c2ecf20Sopenharmony_ci	rl->high = pblk->op_blks - blk_meta - lm->blk_per_line;
2258c2ecf20Sopenharmony_ci	rl->high_pw = get_count_order(rl->high);
2268c2ecf20Sopenharmony_ci
2278c2ecf20Sopenharmony_ci	rl->rsv_blocks = pblk_get_min_chks(pblk);
2288c2ecf20Sopenharmony_ci
2298c2ecf20Sopenharmony_ci	/* This will always be a power-of-2 */
2308c2ecf20Sopenharmony_ci	rb_windows = budget / NVM_MAX_VLBA;
2318c2ecf20Sopenharmony_ci	rl->rb_windows_pw = get_count_order(rb_windows);
2328c2ecf20Sopenharmony_ci
2338c2ecf20Sopenharmony_ci	/* To start with, all buffer is available to user I/O writers */
2348c2ecf20Sopenharmony_ci	rl->rb_budget = budget;
2358c2ecf20Sopenharmony_ci	rl->rb_user_max = budget;
2368c2ecf20Sopenharmony_ci	rl->rb_gc_max = 0;
2378c2ecf20Sopenharmony_ci	rl->rb_state = PBLK_RL_HIGH;
2388c2ecf20Sopenharmony_ci
2398c2ecf20Sopenharmony_ci	/* Maximize I/O size and ansure that back threshold is respected */
2408c2ecf20Sopenharmony_ci	if (threshold)
2418c2ecf20Sopenharmony_ci		rl->rb_max_io = budget - pblk->min_write_pgs_data - threshold;
2428c2ecf20Sopenharmony_ci	else
2438c2ecf20Sopenharmony_ci		rl->rb_max_io = budget - pblk->min_write_pgs_data - 1;
2448c2ecf20Sopenharmony_ci
2458c2ecf20Sopenharmony_ci	atomic_set(&rl->rb_user_cnt, 0);
2468c2ecf20Sopenharmony_ci	atomic_set(&rl->rb_gc_cnt, 0);
2478c2ecf20Sopenharmony_ci	atomic_set(&rl->rb_space, -1);
2488c2ecf20Sopenharmony_ci	atomic_set(&rl->werr_lines, 0);
2498c2ecf20Sopenharmony_ci
2508c2ecf20Sopenharmony_ci	timer_setup(&rl->u_timer, pblk_rl_u_timer, 0);
2518c2ecf20Sopenharmony_ci
2528c2ecf20Sopenharmony_ci	rl->rb_user_active = 0;
2538c2ecf20Sopenharmony_ci	rl->rb_gc_active = 0;
2548c2ecf20Sopenharmony_ci}
255