// SPDX-License-Identifier: GPL-2.0
#include <linux/swap_cgroup.h>
#include <linux/vmalloc.h>
#include <linux/mm.h>

#include <linux/swapops.h> /* depends on mm.h include */

static DEFINE_MUTEX(swap_cgroup_mutex);

/* Pack two cgroup id (short) of two entries in one swap_cgroup (atomic_t) */
#define ID_PER_SC (sizeof(struct swap_cgroup) / sizeof(unsigned short))
#define ID_SHIFT (BITS_PER_TYPE(unsigned short))
#define ID_MASK (BIT(ID_SHIFT) - 1)
struct swap_cgroup {
        atomic_t ids;
};

struct swap_cgroup_ctrl {
        struct swap_cgroup *map;
};

static struct swap_cgroup_ctrl swap_cgroup_ctrl[MAX_SWAPFILES];

static unsigned short __swap_cgroup_id_lookup(struct swap_cgroup *map,
                                              pgoff_t offset)
{
        unsigned int shift = (offset % ID_PER_SC) * ID_SHIFT;
        unsigned int old_ids = atomic_read(&map[offset / ID_PER_SC].ids);

        BUILD_BUG_ON(!is_power_of_2(ID_PER_SC));
        BUILD_BUG_ON(sizeof(struct swap_cgroup) != sizeof(atomic_t));

        return (old_ids >> shift) & ID_MASK;
}

static unsigned short __swap_cgroup_id_xchg(struct swap_cgroup *map,
                                            pgoff_t offset,
                                            unsigned short new_id)
{
        unsigned short old_id;
        struct swap_cgroup *sc = &map[offset / ID_PER_SC];
        unsigned int shift = (offset % ID_PER_SC) * ID_SHIFT;
        unsigned int new_ids, old_ids = atomic_read(&sc->ids);

        do {
                old_id = (old_ids >> shift) & ID_MASK;
                new_ids = (old_ids & ~(ID_MASK << shift));
                new_ids |= ((unsigned int)new_id) << shift;
        } while (!atomic_try_cmpxchg(&sc->ids, &old_ids, new_ids));

        return old_id;
}

/**
 * swap_cgroup_record - record mem_cgroup for a set of swap entries.
 * These entries must belong to one single folio, and that folio
 * must be being charged for swap space (swap out), and these
 * entries must not have been charged
 *
 * @folio: the folio that the swap entry belongs to
 * @id: mem_cgroup ID to be recorded
 * @ent: the first swap entry to be recorded
 */
void swap_cgroup_record(struct folio *folio, unsigned short id,
                        swp_entry_t ent)
{
        unsigned int nr_ents = folio_nr_pages(folio);
        struct swap_cgroup *map;
        pgoff_t offset, end;
        unsigned short old;

        offset = swp_offset(ent);
        end = offset + nr_ents;
        map = swap_cgroup_ctrl[swp_type(ent)].map;

        do {
                old = __swap_cgroup_id_xchg(map, offset, id);
                VM_BUG_ON(old);
        } while (++offset != end);
}

/**
 * swap_cgroup_clear - clear mem_cgroup for a set of swap entries.
 * These entries must be being uncharged from swap. They either
 * belongs to one single folio in the swap cache (swap in for
 * cgroup v1), or no longer have any users (slot freeing).
 *
 * @ent: the first swap entry to be recorded into
 * @nr_ents: number of swap entries to be recorded
 *
 * Returns the existing old value.
 */
unsigned short swap_cgroup_clear(swp_entry_t ent, unsigned int nr_ents)
{
        pgoff_t offset, end;
        struct swap_cgroup *map;
        unsigned short old, iter = 0;

        offset = swp_offset(ent);
        end = offset + nr_ents;
        map = swap_cgroup_ctrl[swp_type(ent)].map;

        do {
                old = __swap_cgroup_id_xchg(map, offset, 0);
                if (!iter)
                        iter = old;
                VM_BUG_ON(iter != old);
        } while (++offset != end);

        return old;
}

/**
 * lookup_swap_cgroup_id - lookup mem_cgroup id tied to swap entry
 * @ent: swap entry to be looked up.
 *
 * Returns ID of mem_cgroup at success. 0 at failure. (0 is invalid ID)
 */
unsigned short lookup_swap_cgroup_id(swp_entry_t ent)
{
        struct swap_cgroup_ctrl *ctrl;

        if (mem_cgroup_disabled())
                return 0;

        ctrl = &swap_cgroup_ctrl[swp_type(ent)];
        return __swap_cgroup_id_lookup(ctrl->map, swp_offset(ent));
}

int swap_cgroup_swapon(int type, unsigned long max_pages)
{
        struct swap_cgroup *map;
        struct swap_cgroup_ctrl *ctrl;

        if (mem_cgroup_disabled())
                return 0;

        BUILD_BUG_ON(sizeof(unsigned short) * ID_PER_SC !=
                     sizeof(struct swap_cgroup));
        map = vzalloc(DIV_ROUND_UP(max_pages, ID_PER_SC) *
                      sizeof(struct swap_cgroup));
        if (!map)
                goto nomem;

        ctrl = &swap_cgroup_ctrl[type];
        mutex_lock(&swap_cgroup_mutex);
        ctrl->map = map;
        mutex_unlock(&swap_cgroup_mutex);

        return 0;
nomem:
        pr_info("couldn't allocate enough memory for swap_cgroup\n");
        pr_info("swap_cgroup can be disabled by swapaccount=0 boot option\n");
        return -ENOMEM;
}

void swap_cgroup_swapoff(int type)
{
        struct swap_cgroup *map;
        struct swap_cgroup_ctrl *ctrl;

        if (mem_cgroup_disabled())
                return;

        mutex_lock(&swap_cgroup_mutex);
        ctrl = &swap_cgroup_ctrl[type];
        map = ctrl->map;
        ctrl->map = NULL;
        mutex_unlock(&swap_cgroup_mutex);

        vfree(map);
}