soc/bman: Add self-test for BMan driver (97e0d385) · Commits · e / devices / android_kernel_oneplus_sm7250

drivers/soc/fsl/qbman/Kconfig

+16 −0

Original line number	Diff line number	Diff line
		@@ -25,4 +25,20 @@ config FSL_DPAA_CHECKING
		Compiles in additional checks, to sanity-check the drivers and
		any use of the exported API. Not recommended for performance.

		config FSL_BMAN_TEST
		tristate "BMan self-tests"
		help
		Compile the BMan self-test code. These tests will
		exercise the BMan APIs to confirm functionality
		of both the software drivers and hardware device.

		config FSL_BMAN_TEST_API
		bool "High-level API self-test"
		depends on FSL_BMAN_TEST
		default y
		help
		This requires the presence of cpu-affine portals, and performs
		high-level API testing with them (whichever portal(s) are affine
		to the cpu(s) the test executes on).

		endif # FSL_DPAA

drivers/soc/fsl/qbman/Makefile

+4 −0

Original line number	Diff line number	Diff line
		obj-$(CONFIG_FSL_DPAA) += bman_ccsr.o qman_ccsr.o \
		bman_portal.o qman_portal.o \
		bman.o qman.o

		obj-$(CONFIG_FSL_BMAN_TEST) += bman-test.o
		bman-test-y = bman_test.o
		bman-test-$(CONFIG_FSL_BMAN_TEST_API) += bman_test_api.o

drivers/soc/fsl/qbman/bman_test.c

0 → 100644

+53 −0

Original line number	Diff line number	Diff line
		/* Copyright 2008 - 2016 Freescale Semiconductor, Inc.
		*
		* Redistribution and use in source and binary forms, with or without
		* modification, are permitted provided that the following conditions are met:
		* * Redistributions of source code must retain the above copyright
		* notice, this list of conditions and the following disclaimer.
		* * 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.
		* * Neither the name of Freescale Semiconductor nor the
		* names of its contributors may be used to endorse or promote products
		* derived from this software without specific prior written permission.
		*
		* ALTERNATIVELY, this software may be distributed under the terms of the
		* GNU General Public License ("GPL") as published by the Free Software
		* Foundation, either version 2 of that License or (at your option) any
		* later version.
		*
		* THIS SOFTWARE IS PROVIDED BY Freescale Semiconductor ``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 Freescale Semiconductor 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 "bman_test.h"

		MODULE_AUTHOR("Geoff Thorpe");
		MODULE_LICENSE("Dual BSD/GPL");
		MODULE_DESCRIPTION("BMan testing");

		static int test_init(void)
		{
		#ifdef CONFIG_FSL_BMAN_TEST_API
		int loop = 1;

		while (loop--)
		bman_test_api();
		#endif
		return 0;
		}

		static void test_exit(void)
		{
		}

		module_init(test_init);
		module_exit(test_exit);

drivers/soc/fsl/qbman/bman_test.h

0 → 100644

+35 −0

Original line number	Diff line number	Diff line
		/* Copyright 2008 - 2016 Freescale Semiconductor, Inc.
		*
		* Redistribution and use in source and binary forms, with or without
		* modification, are permitted provided that the following conditions are met:
		* * Redistributions of source code must retain the above copyright
		* notice, this list of conditions and the following disclaimer.
		* * 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.
		* * Neither the name of Freescale Semiconductor nor the
		* names of its contributors may be used to endorse or promote products
		* derived from this software without specific prior written permission.
		*
		* ALTERNATIVELY, this software may be distributed under the terms of the
		* GNU General Public License ("GPL") as published by the Free Software
		* Foundation, either version 2 of that License or (at your option) any
		* later version.
		*
		* THIS SOFTWARE IS PROVIDED BY Freescale Semiconductor ``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 Freescale Semiconductor 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 "bman_priv.h"

		#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

		void bman_test_api(void);

drivers/soc/fsl/qbman/bman_test_api.c

0 → 100644

+151 −0

Original line number	Diff line number	Diff line
		/* Copyright 2008 - 2016 Freescale Semiconductor, Inc.
		*
		* Redistribution and use in source and binary forms, with or without
		* modification, are permitted provided that the following conditions are met:
		* * Redistributions of source code must retain the above copyright
		* notice, this list of conditions and the following disclaimer.
		* * 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.
		* * Neither the name of Freescale Semiconductor nor the
		* names of its contributors may be used to endorse or promote products
		* derived from this software without specific prior written permission.
		*
		* ALTERNATIVELY, this software may be distributed under the terms of the
		* GNU General Public License ("GPL") as published by the Free Software
		* Foundation, either version 2 of that License or (at your option) any
		* later version.
		*
		* THIS SOFTWARE IS PROVIDED BY Freescale Semiconductor ``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 Freescale Semiconductor 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 "bman_test.h"

		#define NUM_BUFS 93
		#define LOOPS 3
		#define BMAN_TOKEN_MASK 0x00FFFFFFFFFFLLU

		static struct bman_pool *pool;
		static struct bm_buffer bufs_in[NUM_BUFS] ____cacheline_aligned;
		static struct bm_buffer bufs_out[NUM_BUFS] ____cacheline_aligned;
		static int bufs_received;

		static void bufs_init(void)
		{
		int i;

		for (i = 0; i < NUM_BUFS; i++)
		bm_buffer_set64(&bufs_in[i], 0xfedc01234567LLU * i);
		bufs_received = 0;
		}

		static inline int bufs_cmp(const struct bm_buffer a, const struct bm_buffer b)
		{
		if (bman_ip_rev == BMAN_REV20 \|\| bman_ip_rev == BMAN_REV21) {

		/*
		* On SoCs with BMan revison 2.0, BMan only respects the 40
		* LS-bits of buffer addresses, masking off the upper 8-bits on
		* release commands. The API provides for 48-bit addresses
		* because some SoCs support all 48-bits. When generating
		* garbage addresses for testing, we either need to zero the
		* upper 8-bits when releasing to BMan (otherwise we'll be
		* disappointed when the buffers we acquire back from BMan
		* don't match), or we need to mask the upper 8-bits off when
		* comparing. We do the latter.
		*/
		if ((bm_buffer_get64(a) & BMAN_TOKEN_MASK) <
		(bm_buffer_get64(b) & BMAN_TOKEN_MASK))
		return -1;
		if ((bm_buffer_get64(a) & BMAN_TOKEN_MASK) >
		(bm_buffer_get64(b) & BMAN_TOKEN_MASK))
		return 1;
		} else {
		if (bm_buffer_get64(a) < bm_buffer_get64(b))
		return -1;
		if (bm_buffer_get64(a) > bm_buffer_get64(b))
		return 1;
		}

		return 0;
		}

		static void bufs_confirm(void)
		{
		int i, j;

		for (i = 0; i < NUM_BUFS; i++) {
		int matches = 0;

		for (j = 0; j < NUM_BUFS; j++)
		if (!bufs_cmp(&bufs_in[i], &bufs_out[j]))
		matches++;
		WARN_ON(matches != 1);
		}
		}

		/* test */
		void bman_test_api(void)
		{
		int i, loops = LOOPS;

		bufs_init();

		pr_info("%s(): Starting\n", __func__);

		pool = bman_new_pool();
		if (!pool) {
		pr_crit("bman_new_pool() failed\n");
		goto failed;
		}

		/* Release buffers */
		do_loop:
		i = 0;
		while (i < NUM_BUFS) {
		int num = 8;

		if (i + num > NUM_BUFS)
		num = NUM_BUFS - i;
		if (bman_release(pool, bufs_in + i, num)) {
		pr_crit("bman_release() failed\n");
		goto failed;
		}
		i += num;
		}

		/* Acquire buffers */
		while (i > 0) {
		int tmp, num = 8;

		if (num > i)
		num = i;
		tmp = bman_acquire(pool, bufs_out + i - num, num);
		WARN_ON(tmp != num);
		i -= num;
		}
		i = bman_acquire(pool, NULL, 1);
		WARN_ON(i > 0);

		bufs_confirm();

		if (--loops)
		goto do_loop;

		/* Clean up */
		bman_free_pool(pool);
		pr_info("%s(): Finished\n", __func__);
		return;

		failed:
		WARN_ON(1);
		}