/*
 * Copyright (c) 2016-2017, The Linux Foundation. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 and
 * only version 2 as published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 */

#include <linux/delay.h>
#include <linux/slab.h>

#include "dsi_display_test.h"

static void dsi_display_test_dump_modes(struct dsi_display_mode *mode, u32
					count)
{
}

static void dsi_display_test_work(struct work_struct *work)
{
	struct dsi_display_test *test;
	struct dsi_display *display;
	struct dsi_display_mode *modes;
	u32 count = 0;
	u32 size = 0;
	int rc = 0;

	test = container_of(work, struct dsi_display_test, test_work);

	display = test->display;
	rc = dsi_display_get_mode_count(display, &count);
	if (rc) {
		pr_err("failed to get modes count, rc=%d\n", rc);
		goto test_fail;
	}

	size = count * sizeof(*modes);
	modes = kzalloc(size, GFP_KERNEL);
	if (!modes) {
		rc = -ENOMEM;
		goto test_fail;
	}

	rc = dsi_display_get_modes(display, modes);
	if (rc) {
		pr_err("failed to get modes, rc=%d\n", rc);
		goto test_fail_free_modes;
	}

	dsi_display_test_dump_modes(modes, count);

	rc = dsi_display_set_mode(display, &modes[0], 0x0);
	if (rc) {
		pr_err("failed to set mode, rc=%d\n", rc);
		goto test_fail_free_modes;
	}

	rc = dsi_display_prepare(display);
	if (rc) {
		pr_err("failed to prepare display, rc=%d\n", rc);
		goto test_fail_free_modes;
	}

	rc = dsi_display_enable(display);
	if (rc) {
		pr_err("failed to enable display, rc=%d\n", rc);
		goto test_fail_unprep_disp;
	}
	return;

test_fail_unprep_disp:
	if (rc) {
		pr_err("failed to unprep display, rc=%d\n", rc);
		goto test_fail_free_modes;
	}

test_fail_free_modes:
	kfree(modes);
test_fail:
	return;
}

int dsi_display_test_init(struct dsi_display *display)
{
	static int done;
	int rc = 0;
	struct dsi_display_test *test;

	if (done)
		return rc;

	done = 1;
	if (!display) {
		pr_err("Invalid params\n");
		return -EINVAL;
	}

	test = kzalloc(sizeof(*test), GFP_KERNEL);
	if (!test)
		return -ENOMEM;

	test->display = display;
	INIT_WORK(&test->test_work, dsi_display_test_work);

	dsi_display_test_work(&test->test_work);
	return rc;
}