/*-
 * SPDX-License-Identifier: BSD-2-Clause
 *
 * Copyright (c) 2010 Alexander Motin <mav@FreeBSD.org>
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHORS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 */

#include <sys/param.h>
#include <sys/bio.h>
#include <sys/endian.h>
#include <sys/kernel.h>
#include <sys/kobj.h>
#include <sys/lock.h>
#include <sys/malloc.h>
#include <sys/mutex.h>
#include <sys/systm.h>
#include <geom/geom.h>
#include <geom/geom_dbg.h>
#include "geom/raid/g_raid.h"
#include "g_raid_tr_if.h"

static MALLOC_DEFINE(M_TR_CONCAT, "tr_concat_data", "GEOM_RAID CONCAT data");

struct g_raid_tr_concat_object {
	struct g_raid_tr_object	 trso_base;
	int			 trso_starting;
	int			 trso_stopped;
};

static g_raid_tr_taste_t g_raid_tr_taste_concat;
static g_raid_tr_event_t g_raid_tr_event_concat;
static g_raid_tr_start_t g_raid_tr_start_concat;
static g_raid_tr_stop_t g_raid_tr_stop_concat;
static g_raid_tr_iostart_t g_raid_tr_iostart_concat;
static g_raid_tr_iodone_t g_raid_tr_iodone_concat;
static g_raid_tr_kerneldump_t g_raid_tr_kerneldump_concat;
static g_raid_tr_free_t g_raid_tr_free_concat;

static kobj_method_t g_raid_tr_concat_methods[] = {
	KOBJMETHOD(g_raid_tr_taste,	g_raid_tr_taste_concat),
	KOBJMETHOD(g_raid_tr_event,	g_raid_tr_event_concat),
	KOBJMETHOD(g_raid_tr_start,	g_raid_tr_start_concat),
	KOBJMETHOD(g_raid_tr_stop,	g_raid_tr_stop_concat),
	KOBJMETHOD(g_raid_tr_iostart,	g_raid_tr_iostart_concat),
	KOBJMETHOD(g_raid_tr_iodone,	g_raid_tr_iodone_concat),
	KOBJMETHOD(g_raid_tr_kerneldump,	g_raid_tr_kerneldump_concat),
	KOBJMETHOD(g_raid_tr_free,	g_raid_tr_free_concat),
	{ 0, 0 }
};

static struct g_raid_tr_class g_raid_tr_concat_class = {
	"CONCAT",
	g_raid_tr_concat_methods,
	sizeof(struct g_raid_tr_concat_object),
	.trc_enable = 1,
	.trc_priority = 50,
	.trc_accept_unmapped = 1
};

static int
g_raid_tr_taste_concat(struct g_raid_tr_object *tr, struct g_raid_volume *volume)
{
	struct g_raid_tr_concat_object *trs;

	trs = (struct g_raid_tr_concat_object *)tr;
	if (tr->tro_volume->v_raid_level != G_RAID_VOLUME_RL_SINGLE &&
	    tr->tro_volume->v_raid_level != G_RAID_VOLUME_RL_CONCAT &&
	    !(tr->tro_volume->v_disks_count == 1 &&
	      tr->tro_volume->v_raid_level != G_RAID_VOLUME_RL_UNKNOWN))
		return (G_RAID_TR_TASTE_FAIL);
	trs->trso_starting = 1;
	return (G_RAID_TR_TASTE_SUCCEED);
}

static int
g_raid_tr_update_state_concat(struct g_raid_volume *vol)
{
	struct g_raid_tr_concat_object *trs;
	struct g_raid_softc *sc;
	off_t size;
	u_int s;
	int i, n, f;

	sc = vol->v_softc;
	trs = (struct g_raid_tr_concat_object *)vol->v_tr;
	if (trs->trso_stopped)
		s = G_RAID_VOLUME_S_STOPPED;
	else if (trs->trso_starting)
		s = G_RAID_VOLUME_S_STARTING;
	else {
		n = g_raid_nsubdisks(vol, G_RAID_SUBDISK_S_ACTIVE);
		f = g_raid_nsubdisks(vol, G_RAID_SUBDISK_S_FAILED);
		if (n + f == vol->v_disks_count) {
			if (f == 0)
				s = G_RAID_VOLUME_S_OPTIMAL;
			else
				s = G_RAID_VOLUME_S_SUBOPTIMAL;
		} else
			s = G_RAID_VOLUME_S_BROKEN;
	}
	if (s != vol->v_state) {
		/*
		 * Some metadata modules may not know CONCAT volume
		 * mediasize until all disks connected. Recalculate.
		 */
		if (vol->v_raid_level == G_RAID_VOLUME_RL_CONCAT &&
		    G_RAID_VOLUME_S_ALIVE(s) &&
		    !G_RAID_VOLUME_S_ALIVE(vol->v_state)) {
			size = 0;
			for (i = 0; i < vol->v_disks_count; i++) {
				if (vol->v_subdisks[i].sd_state !=
				    G_RAID_SUBDISK_S_NONE)
					size += vol->v_subdisks[i].sd_size;
			}
			vol->v_mediasize = size;
		}

		g_raid_event_send(vol, G_RAID_VOLUME_S_ALIVE(s) ?
		    G_RAID_VOLUME_E_UP : G_RAID_VOLUME_E_DOWN,
		    G_RAID_EVENT_VOLUME);
		g_raid_change_volume_state(vol, s);
		if (!trs->trso_starting && !trs->trso_stopped)
			g_raid_write_metadata(sc, vol, NULL, NULL);
	}
	return (0);
}

static int
g_raid_tr_event_concat(struct g_raid_tr_object *tr,
    struct g_raid_subdisk *sd, u_int event)
{
	struct g_raid_tr_concat_object *trs;
	struct g_raid_softc *sc;
	struct g_raid_volume *vol;
	int state;

	trs = (struct g_raid_tr_concat_object *)tr;
	vol = tr->tro_volume;
	sc = vol->v_softc;

	state = sd->sd_state;
	if (state != G_RAID_SUBDISK_S_NONE &&
	    state != G_RAID_SUBDISK_S_FAILED &&
	    state != G_RAID_SUBDISK_S_ACTIVE) {
		G_RAID_DEBUG1(1, sc,
		    "Promote subdisk %s:%d from %s to ACTIVE.",
		    vol->v_name, sd->sd_pos,
		    g_raid_subdisk_state2str(sd->sd_state));
		g_raid_change_subdisk_state(sd, G_RAID_SUBDISK_S_ACTIVE);
	}
	if (state != sd->sd_state &&
	    !trs->trso_starting && !trs->trso_stopped)
		g_raid_write_metadata(sc, vol, sd, NULL);
	g_raid_tr_update_state_concat(vol);
	return (0);
}

static int
g_raid_tr_start_concat(struct g_raid_tr_object *tr)
{
	struct g_raid_tr_concat_object *trs;
	struct g_raid_volume *vol;

	trs = (struct g_raid_tr_concat_object *)tr;
	vol = tr->tro_volume;
	trs->trso_starting = 0;
	g_raid_tr_update_state_concat(vol);
	return (0);
}

static int
g_raid_tr_stop_concat(struct g_raid_tr_object *tr)
{
	struct g_raid_tr_concat_object *trs;
	struct g_raid_volume *vol;

	trs = (struct g_raid_tr_concat_object *)tr;
	vol = tr->tro_volume;
	trs->trso_starting = 0;
	trs->trso_stopped = 1;
	g_raid_tr_update_state_concat(vol);
	return (0);
}

static void
g_raid_tr_iostart_concat(struct g_raid_tr_object *tr, struct bio *bp)
{
	struct g_raid_volume *vol;
	struct g_raid_subdisk *sd;
	struct bio_queue_head queue;
	struct bio *cbp;
	char *addr;
	off_t offset, length, remain;
	u_int no;

	vol = tr->tro_volume;
	if (vol->v_state != G_RAID_VOLUME_S_OPTIMAL &&
	    vol->v_state != G_RAID_VOLUME_S_SUBOPTIMAL) {
		g_raid_iodone(bp, EIO);
		return;
	}
	if (bp->bio_cmd == BIO_FLUSH || bp->bio_cmd == BIO_SPEEDUP) {
		g_raid_tr_flush_common(tr, bp);
		return;
	}

	offset = bp->bio_offset;
	remain = bp->bio_length;
	if ((bp->bio_flags & BIO_UNMAPPED) != 0)
		addr = NULL;
	else
		addr = bp->bio_data;
	no = 0;
	while (no < vol->v_disks_count &&
	    offset >= vol->v_subdisks[no].sd_size) {
		offset -= vol->v_subdisks[no].sd_size;
		no++;
	}
	if (no >= vol->v_disks_count) {
		g_raid_iodone(bp, EIO);
		return;
	}
	bioq_init(&queue);
	do {
		sd = &vol->v_subdisks[no];
		length = MIN(sd->sd_size - offset, remain);
		cbp = g_clone_bio(bp);
		if (cbp == NULL)
			goto failure;
		cbp->bio_offset = offset;
		cbp->bio_length = length;
		if ((bp->bio_flags & BIO_UNMAPPED) != 0 &&
		    bp->bio_cmd != BIO_DELETE) {
			cbp->bio_ma_offset += (uintptr_t)addr;
			cbp->bio_ma += cbp->bio_ma_offset / PAGE_SIZE;
			cbp->bio_ma_offset %= PAGE_SIZE;
			cbp->bio_ma_n = round_page(cbp->bio_ma_offset +
			    cbp->bio_length) / PAGE_SIZE;
		} else
			cbp->bio_data = addr;
		cbp->bio_caller1 = sd;
		bioq_insert_tail(&queue, cbp);
		remain -= length;
		if (bp->bio_cmd != BIO_DELETE)
			addr += length;
		offset = 0;
		no++;
	} while (remain > 0 && no < vol->v_disks_count);
	bp->bio_completed = bp->bio_length - remain;
	while ((cbp = bioq_takefirst(&queue)) != NULL) {
		sd = cbp->bio_caller1;
		cbp->bio_caller1 = NULL;
		g_raid_subdisk_iostart(sd, cbp);
	}
	return;
failure:
	while ((cbp = bioq_takefirst(&queue)) != NULL)
		g_destroy_bio(cbp);
	if (bp->bio_error == 0)
		bp->bio_error = ENOMEM;
	g_raid_iodone(bp, bp->bio_error);
}

static int
g_raid_tr_kerneldump_concat(struct g_raid_tr_object *tr, void *virtual,
    off_t boffset, size_t blength)
{
	struct g_raid_volume *vol;
	struct g_raid_subdisk *sd;
	char *addr;
	off_t offset, length, remain;
	int error, no;

	vol = tr->tro_volume;
	if (vol->v_state != G_RAID_VOLUME_S_OPTIMAL)
		return (ENXIO);

	offset = boffset;
	remain = blength;
	addr = virtual;
	no = 0;
	while (no < vol->v_disks_count &&
	    offset >= vol->v_subdisks[no].sd_size) {
		offset -= vol->v_subdisks[no].sd_size;
		no++;
	}
	if (no >= vol->v_disks_count)
		return (EIO);
	do {
		sd = &vol->v_subdisks[no];
		length = MIN(sd->sd_size - offset, remain);
		error = g_raid_subdisk_kerneldump(&vol->v_subdisks[no],
		    addr, offset, length);
		if (error != 0)
			return (error);
		remain -= length;
		addr += length;
		offset = 0;
		no++;
	} while (remain > 0 && no < vol->v_disks_count);
	if (remain > 0)
		return (EIO);
	return (0);
}

static void
g_raid_tr_iodone_concat(struct g_raid_tr_object *tr,
    struct g_raid_subdisk *sd,struct bio *bp)
{
	struct bio *pbp;

	pbp = bp->bio_parent;
	if (pbp->bio_error == 0)
		pbp->bio_error = bp->bio_error;
	g_destroy_bio(bp);
	pbp->bio_inbed++;
	if (pbp->bio_children == pbp->bio_inbed) {
		g_raid_iodone(pbp, pbp->bio_error);
	}
}

static int
g_raid_tr_free_concat(struct g_raid_tr_object *tr)
{

	return (0);
}

G_RAID_TR_DECLARE(concat, "CONCAT");