/***************************************************************************
 * Copyright (C) 2016
 * by Dimok
 *
 * This software is provided 'as-is', without any express or implied
 * warranty. In no event will the authors be held liable for any
 * damages arising from the use of this software.
 *
 * Permission is granted to anyone to use this software for any
 * purpose, including commercial applications, and to alter it and
 * redistribute it freely, subject to the following restrictions:
 *
 * 1. The origin of this software must not be misrepresented; you
 * must not claim that you wrote the original software. If you use
 * this software in a product, an acknowledgment in the product
 * documentation would be appreciated but is not required.
 *
 * 2. Altered source versions must be plainly marked as such, and
 * must not be misrepresented as being the original software.
 *
 * 3. This notice may not be removed or altered from any source
 * distribution.
 ***************************************************************************/
#ifndef _UTILS_H
#define _UTILS_H

#define ALIGN4(x)            (((x) + 3) & ~3)

#define kernel_memcpy        ((void *(*) (void *, const void *, int) ) 0x08131D04)
#define kernel_memset        ((void *(*) (void *, int, unsigned int) ) 0x08131DA0)
#define kernel_strncpy       ((char *(*) (char *, const char *, unsigned int) ) 0x081329B8)
#define disable_interrupts   ((int (*)()) 0x0812E778)
#define enable_interrupts    ((int (*)(int)) 0x0812E78C)
#define kernel_bsp_command_5 ((int (*)(const char *, int offset, const char *, int size, void *buffer)) 0x0812EC40)

void reverse_memcpy(void *dest, const void *src, unsigned int size);

static inline unsigned int disable_mmu(void) {
    unsigned int control_register = 0;
    asm volatile("MRC p15, 0, %0, c1, c0, 0"
                 : "=r"(control_register));
    asm volatile("MCR p15, 0, %0, c1, c0, 0"
                 :
                 : "r"(control_register & 0xFFFFEFFA));
    return control_register;
}

static inline void restore_mmu(unsigned int control_register) {
    asm volatile("MCR p15, 0, %0, c1, c0, 0"
                 :
                 : "r"(control_register));
}

static inline void set_domain_register(unsigned int domain_register) {
    asm volatile("MCR p15, 0, %0, c3, c0, 0"
                 :
                 : "r"(domain_register));
}

#endif