rt-thread/bsp/raspberry-pi/raspi4-64/driver/mbox.c

/*
 * Copyright (c) 2006-2021, RT-Thread Development Team
 *
 * SPDX-License-Identifier: Apache-2.0
 *
 * Change Logs:
 * Date           Author         Notes
 * 2019-08-29     zdzn           first version
 * 2020-09-10     bigmagic       add other mbox option
 */

/* mailbox message buffer */
#include "mbox.h"
#include "mmu.h"

volatile unsigned int *mbox = (volatile unsigned int *) MBOX_ADDR;
#define BUS_ADDRESS(phys)   (((phys) & ~0xC0000000)  |  0xC0000000)

/**
 * Make a mailbox call. Returns 0 on failure, non-zero on success
 */
int mbox_call(unsigned char ch, int mmu_enable)
{
    unsigned int r = (((MBOX_ADDR) & ~0xF) | (ch & 0xF));
    if (mmu_enable)
    {
        r = BUS_ADDRESS(r);
    }
    /* wait until we can write to the mailbox */
    do
    {
        __asm__ volatile ("nop");
    }
    while (*MBOX_STATUS & MBOX_FULL);
    /* write the address of our message to the mailbox with channel identifier */
    *MBOX_WRITE = r;
    /* now wait for the response */
    while (1)
    {
        /* is there a response? */
        do
        {
            __asm__ volatile ("nop");
        }
        while (*MBOX_STATUS & MBOX_EMPTY);
        /* is it a response to our message? */
        if (r == *MBOX_READ)
        {
            /* is it a valid successful response? */
            return mbox[1] == MBOX_RESPONSE;
        }
    }
    return 0;
}

int bcm271x_mbox_poweroff_devices(int id)
{
    mbox[0] = 8 * 4;                /* length of the message */
    mbox[1] = MBOX_REQUEST;         /* this is a request message */

    mbox[2] = MBOX_TAG_SETPOWER;    /* set power state */
    mbox[3] = 8;                    /* buffer size */
    mbox[4] = 8;                    /* len */

    mbox[5] = (unsigned int)id;     /* device id */
    mbox[6] = 0;                    /* bit 0: off, bit 1: no wait */

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MBOX_CH_PROP);

    return 0;
}

int bcm271x_mbox_get_touch(void)
{
    mbox[0] = 8 * 4;                    // length of the message
    mbox[1] = MBOX_REQUEST;             // this is a request message

    mbox[2] = MBOX_TAG_GET_TOUCHBUF;
    mbox[3] = 4;                        // buffer size
    mbox[4] = 0;                        // len

    mbox[5] = 0;                       // id
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    return (int)(mbox[5] &  ~0xC0000000);
}

int bcm271x_notify_reboot(void)
{
    mbox[0] = 7 * 4;                        // length of the message
    mbox[1] = MBOX_REQUEST;                 // this is a request message
    mbox[2] = MBOX_TAG_NOTIFY_REBOOT;       // (the tag id)
    mbox[3] = 0x00000004;                   // length + 4
    mbox[4] = 0x00000000;                   // size of the data
    mbox[5] = 0x00000000;                   // request

    mbox[6] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);
    return 0;
}

int bcm271x_notify_xhci_reset(void)
{
    mbox[0] = 7 * 4;                        // length of the message
    mbox[1] = MBOX_REQUEST;                 // this is a request message
    mbox[2] = MBOX_TAG_NOTIFY_XHCI_RESET;   // (the tag id)
    mbox[3] = 0x00000004;                   // length + 4
    mbox[4] = 0x00000004;                   // size of the data
    mbox[5] = 0x00100000;                   // request
    mbox[6] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);
    return 0;
}

int bcm271x_gpu_enable(void)
{
    mbox[0] = 12 * 4;                        // length of the message
    mbox[1] = MBOX_REQUEST;                  // this is a request message

    mbox[2] = MBOX_TAG_CLOCK_SET_RATE;
    mbox[3] = 0x00000008;                   // (the tag id)
    mbox[4] = 0x00000008;                   // (the tag id)
    mbox[5] = 5;                            // V3D
    mbox[6] = 250 * 1000 * 1000;
    mbox[7] = MBOX_TAG_ENABLE_QPU;                   // (the tag id)
    mbox[8] = 0x00000004;                   // (size of the buffer)
    mbox[9] = 0x00000004;                   // (size of the data)
    mbox[10] = 0x00000001;
    mbox[11] = MBOX_TAG_LAST;               // end tag
    mbox_call(8, MMU_DISABLE);
    return mbox[1];
}

int bcm271x_mbox_hardware_get_model(void)
{
    mbox[0] = 8 * 4;                        // length of the message
    mbox[1] = MBOX_REQUEST;                 // this is a request message

    mbox[2] = MBOX_TAG_HARDWARE_GET_MODEL;
    mbox[3] = 4;                            // buffer size
    mbox[4] = 0;                            // len

    mbox[5] = 0;
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    return mbox[5];
}

int bcm271x_mbox_hardware_get_revison(void)
{
    mbox[0] = 8 * 4;                        // length of the message
    mbox[1] = MBOX_REQUEST;                 // this is a request message

    mbox[2] = MBOX_TAG_HARDWARE_GET_REV;
    mbox[3] = 4;                            // buffer size
    mbox[4] = 0;                            // len

    mbox[5] = 0;
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    return mbox[5];
}

int bcm271x_mbox_hardware_get_mac_address(uint8_t *mac)
{
    mbox[0] = 8 * 4;                               // length of the message
    mbox[1] = MBOX_REQUEST;                        // this is a request message

    mbox[2] = MBOX_TAG_HARDWARE_GET_MAC_ADDRESS;
    mbox[3] = 6;                                   // buffer size
    mbox[4] = 0;                                   // len

    mbox[5] = 0;
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    char *mac_str = (char *)&mbox[5];
    mac[0] = mac_str[0];
    mac[1] = mac_str[1];
    mac[2] = mac_str[2];
    mac[3] = mac_str[3];
    mac[4] = mac_str[4];
    mac[5] = mac_str[5];
    return 0;
}


int bcm271x_mbox_hardware_get_serial(rt_uint64_t *sn)
{
    mbox[0] = 8 * 4;                            // length of the message
    mbox[1] = MBOX_REQUEST;                     // this is a request message

    mbox[2] = MBOX_TAG_HARDWARE_GET_SERIAL;
    mbox[3] = 8;                                // buffer size
    mbox[4] = 0;                                // len

    mbox[5] = 0;
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    sn = (rt_uint64_t *)&mbox[5];

    return 0;
}

int bcm271x_mbox_hardware_get_arm_memory(rt_uint32_t *base, rt_uint32_t *size)
{
    mbox[0] = 8 * 4;                                // length of the message
    mbox[1] = MBOX_REQUEST;                         // this is a request message

    mbox[2] = MBOX_TAG_HARDWARE_GET_ARM_MEMORY;
    mbox[3] = 8;                                    // buffer size
    mbox[4] = 0;                                    // len

    mbox[5] = 0;
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    *base = mbox[5];
    *size = mbox[6];

    return 0;

}

int bcm271x_mbox_hardware_get_vc_memory(rt_uint32_t *base, rt_uint32_t *size)
{
    mbox[0] = 8 * 4;                             // length of the message
    mbox[1] = MBOX_REQUEST;                      // this is a request message

    mbox[2] = MBOX_TAG_HARDWARE_GET_VC_MEMORY;
    mbox[3] = 8;                                 // buffer size
    mbox[4] = 0;                                 // len

    mbox[5] = 0;
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    *base = mbox[5];
    *size = mbox[6];

    return 0;
}

int bcm271x_mbox_clock_get_turbo(void)
{
    mbox[0] = 8 * 4;                    // length of the message
    mbox[1] = MBOX_REQUEST;             // this is a request message

    mbox[2] = MBOX_TAG_CLOCK_GET_TURBO;
    mbox[3] = 8;                        // buffer size
    mbox[4] = 4;                        // len

    mbox[5] = 0;                        // id
    mbox[6] = 0;                        // val

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    if (mbox[5] != 0)
    {
        return -1;
    }

    return mbox[6];
}

int bcm271x_mbox_clock_set_turbo(int level)
{
    mbox[0] = 8 * 4;                    // length of the message
    mbox[1] = MBOX_REQUEST;             // this is a request message

    mbox[2] = MBOX_TAG_CLOCK_SET_TURBO;
    mbox[3] = 8;                        // buffer size
    mbox[4] = 8;                        // len

    mbox[5] = 0;                        // id
    mbox[6] = level ? 1 : 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    if (mbox[5] != 0)
    {
        return -1;
    }

    return mbox[6];
}

int bcm271x_mbox_clock_get_state(int id)
{
    mbox[0] = 8 * 4;                     // length of the message
    mbox[1] = MBOX_REQUEST;              // this is a request message

    mbox[2] = MBOX_TAG_CLOCK_GET_STATE;
    mbox[3] = 8;                         // buffer size
    mbox[4] = 4;                         // len

    mbox[5] = id;                        // id
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    if (mbox[5] != id)
    {
        return -1;
    }

    return (mbox[6] & 0x3);
}

int bcm271x_mbox_clock_set_state(int id, int state)
{
    mbox[0] = 8 * 4;                    // length of the message
    mbox[1] = MBOX_REQUEST;             // this is a request message

    mbox[2] = MBOX_TAG_CLOCK_SET_STATE;
    mbox[3] = 8;                        // buffer size
    mbox[4] = 8;                        // len

    mbox[5] = id;                       // id
    mbox[6] = state & 0x3;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    if (mbox[5] != id)
    {
        return -1;
    }

    return (mbox[6] & 0x3);
}

int bcm271x_mbox_clock_get_rate(int id)
{
    mbox[0] = 8 * 4;                    // length of the message
    mbox[1] = MBOX_REQUEST;             // this is a request message

    mbox[2] = MBOX_TAG_CLOCK_GET_RATE;
    mbox[3] = 8;                        // buffer size
    mbox[4] = 4;                        // len

    mbox[5] = id;                       // id
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    if (mbox[5] != id)
    {
        return -1;
    }

    return mbox[6];
}

int bcm271x_mbox_clock_set_rate(int id, int rate)
{
    mbox[0] = 8 * 4;                    // length of the message
    mbox[1] = MBOX_REQUEST;             // this is a request message

    mbox[2] = MBOX_TAG_CLOCK_SET_RATE;
    mbox[3] = 8;                        // buffer size
    mbox[4] = 8;                        // len

    mbox[5] = id;                       // id
    mbox[6] = rate;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    if (mbox[5] != id)
    {
        return -1;
    }

    return mbox[6];
}

int bcm271x_mbox_clock_get_max_rate(int id)
{
    mbox[0] = 8 * 4;                        // length of the message
    mbox[1] = MBOX_REQUEST;                 // this is a request message

    mbox[2] = MBOX_TAG_CLOCK_GET_MAX_RATE;
    mbox[3] = 8;                            // buffer size
    mbox[4] = 4;                            // len

    mbox[5] = id;                           // id
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    if (mbox[5] != id)
    {
        return -1;
    }

    return mbox[6];
}

int bcm271x_mbox_clock_get_min_rate(int id)
{
    mbox[0] = 8 * 4;                        // length of the message
    mbox[1] = MBOX_REQUEST;                 // this is a request message

    mbox[2] = MBOX_TAG_CLOCK_GET_MIN_RATE;
    mbox[3] = 8;                            // buffer size
    mbox[4] = 4;                            // len

    mbox[5] = id;                           // id
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    if (mbox[5] != id)
    {
        return -1;
    }

    return mbox[6];
}

int bcm271x_mbox_power_get_state(int id)
{
    mbox[0] = 8 * 4;                // length of the message
    mbox[1] = MBOX_REQUEST;         // this is a request message

    mbox[2] = MBOX_TAG_POWER_GET_STATE;
    mbox[3] = 8;                    // buffer size
    mbox[4] = 4;                    // len

    mbox[5] = id;                   // id
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    if (mbox[5] != id)
    {
        return -1;
    }

    return (mbox[6] & 0x3);
}

int bcm271x_mbox_power_set_state(int id, int state)
{
    mbox[0] = 8 * 4;                // length of the message
    mbox[1] = MBOX_REQUEST;         // this is a request message

    mbox[2] = MBOX_TAG_POWER_SET_STATE;
    mbox[3] = 8;                    // buffer size
    mbox[4] = 8;                    // len

    mbox[5] = id;                    // id
    mbox[6] = state & 0x3;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    if (mbox[5] != id)
    {
        return -1;
    }

    return (mbox[6] & 0x3);
}

int bcm271x_mbox_temp_get(void)
{
    mbox[0] = 8 * 4;                // length of the message
    mbox[1] = MBOX_REQUEST;         // this is a request message

    mbox[2] = MBOX_TAG_TEMP_GET;
    mbox[3] = 8;                    // buffer size
    mbox[4] = 4;                    // len

    mbox[5] = 0;                    //id
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    if (mbox[5] != 0)
    {
        return -1;
    }

    return mbox[6];
}

int bcm271x_mbox_temp_get_max(void)
{
    mbox[0] = 8 * 4;                // length of the message
    mbox[1] = MBOX_REQUEST;         // this is a request message

    mbox[2] = MBOX_TAG_TEMP_GET_MAX;
    mbox[3] = 8;                    // buffer size
    mbox[4] = 4;                    // len

    mbox[5] = 0;                    // id
    mbox[6] = 0;

    mbox[7] = MBOX_TAG_LAST;
    mbox_call(8, MMU_DISABLE);

    if (mbox[5] != 0)
    {
        return -1;
    }

    return mbox[6];
}