/*
 *  Copyright(c) 2023 Qualcomm Innovation Center, Inc. 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 as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  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.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, see <http://www.gnu.org/licenses/>.
 */

#include <stdio.h>
#include <stdbool.h>
#include <stdint.h>

/*
 *  Test the scalar core instructions that are new in v68
 */

int err;

static int buffer32[] = { 1, 2, 3, 4 };
static long long buffer64[] = { 5, 6, 7, 8 };

static void __check32(int line, uint32_t result, uint32_t expect)
{
    if (result != expect) {
        printf("ERROR at line %d: 0x%08x != 0x%08x\n",
               line, result, expect);
        err++;
    }
}

#define check32(RES, EXP) __check32(__LINE__, RES, EXP)

static void __check64(int line, uint64_t result, uint64_t expect)
{
    if (result != expect) {
        printf("ERROR at line %d: 0x%016llx != 0x%016llx\n",
               line, result, expect);
        err++;
    }
}

#define check64(RES, EXP) __check64(__LINE__, RES, EXP)

static inline int loadw_aq(int *p)
{
    int res;
    asm volatile("%0 = memw_aq(%1)\n\t"
                 : "=r"(res) : "r"(p));
    return res;
}

static void test_loadw_aq(void)
{
    int res;

    res = loadw_aq(&buffer32[0]);
    check32(res, 1);
    res = loadw_aq(&buffer32[1]);
    check32(res, 2);
}

static inline long long loadd_aq(long long *p)
{
    long long res;
    asm volatile("%0 = memd_aq(%1)\n\t"
                 : "=r"(res) : "r"(p));
    return res;
}

static void test_loadd_aq(void)
{
    long long res;

    res = loadd_aq(&buffer64[2]);
    check64(res, 7);
    res = loadd_aq(&buffer64[3]);
    check64(res, 8);
}

static inline void release_at(int *p)
{
    asm volatile("release(%0):at\n\t"
                 : : "r"(p));
}

static void test_release_at(void)
{
    release_at(&buffer32[2]);
    check64(buffer32[2], 3);
    release_at(&buffer32[3]);
    check64(buffer32[3], 4);
}

static inline void release_st(int *p)
{
    asm volatile("release(%0):st\n\t"
                 : : "r"(p));
}

static void test_release_st(void)
{
    release_st(&buffer32[2]);
    check64(buffer32[2], 3);
    release_st(&buffer32[3]);
    check64(buffer32[3], 4);
}

static inline void storew_rl_at(int *p, int val)
{
    asm volatile("memw_rl(%0):at = %1\n\t"
                 : : "r"(p), "r"(val) : "memory");
}

static void test_storew_rl_at(void)
{
    storew_rl_at(&buffer32[2], 9);
    check64(buffer32[2], 9);
    storew_rl_at(&buffer32[3], 10);
    check64(buffer32[3], 10);
}

static inline void stored_rl_at(long long *p, long long val)
{
    asm volatile("memd_rl(%0):at = %1\n\t"
                 : : "r"(p), "r"(val) : "memory");
}

static void test_stored_rl_at(void)
{
    stored_rl_at(&buffer64[2], 11);
    check64(buffer64[2], 11);
    stored_rl_at(&buffer64[3], 12);
    check64(buffer64[3], 12);
}

static inline void storew_rl_st(int *p, int val)
{
    asm volatile("memw_rl(%0):st = %1\n\t"
                 : : "r"(p), "r"(val) : "memory");
}

static void test_storew_rl_st(void)
{
    storew_rl_st(&buffer32[0], 13);
    check64(buffer32[0], 13);
    storew_rl_st(&buffer32[1], 14);
    check64(buffer32[1], 14);
}

static inline void stored_rl_st(long long *p, long long val)
{
    asm volatile("memd_rl(%0):st = %1\n\t"
                 : : "r"(p), "r"(val) : "memory");
}

static void test_stored_rl_st(void)
{
    stored_rl_st(&buffer64[0], 15);
    check64(buffer64[0], 15);
    stored_rl_st(&buffer64[1], 15);
    check64(buffer64[1], 15);
}

int main()
{
    test_loadw_aq();
    test_loadd_aq();
    test_release_at();
    test_release_st();
    test_storew_rl_at();
    test_stored_rl_at();
    test_storew_rl_st();
    test_stored_rl_st();

    puts(err ? "FAIL" : "PASS");
    return err ? 1 : 0;
}