Subversion Repositories or1k_soc_on_altera_embedded_dev_kit

/*

 * PlanetCore configuration data support functions

 *

 * Author: Scott Wood <scottwood@freescale.com>

 *

 * Copyright (c) 2007 Freescale Semiconductor, Inc.

 *

 * This program is free software; you can redistribute it and/or modify it

 * under the terms of the GNU General Public License version 2 as published

 * by the Free Software Foundation.

 */

#include "stdio.h"

#include "stdlib.h"

#include "ops.h"

#include "planetcore.h"

#include "io.h"

/* PlanetCore passes information to the OS in the form of

 * a table of key=value strings, separated by newlines.

 *

 * The list is terminated by an empty string (i.e. two

 * consecutive newlines).

 *

 * To make it easier to parse, we first convert all the

 * newlines into null bytes.

 */

void planetcore_prepare_table(char *table)

{

        do {

                if (*table == '\n')

                        *table = 0;

                table++;

        } while (*(table - 1) || *table != '\n');

        *table = 0;

}

const char *planetcore_get_key(const char *table, const char *key)

{

        int keylen = strlen(key);

        do {

                if (!strncmp(table, key, keylen) && table[keylen] == '=')

                        return table + keylen + 1;

                table += strlen(table) + 1;

        } while (strlen(table) != 0);

        return NULL;

}

int planetcore_get_decimal(const char *table, const char *key, u64 *val)

{

        const char *str = planetcore_get_key(table, key);

        if (!str)

                return 0;

        *val = strtoull(str, NULL, 10);

        return 1;

}

int planetcore_get_hex(const char *table, const char *key, u64 *val)

{

        const char *str = planetcore_get_key(table, key);

        if (!str)

                return 0;

        *val = strtoull(str, NULL, 16);

        return 1;

}

static u64 mac_table[4] = {

        0x000000000000,

        0x000000800000,

        0x000000400000,

        0x000000c00000,

};

void planetcore_set_mac_addrs(const char *table)

{

        u8 addr[4][6];

        u64 int_addr;

        u32 i;

        int j;

        if (!planetcore_get_hex(table, PLANETCORE_KEY_MAC_ADDR, &int_addr))

                return;

        for (i = 0; i < 4; i++) {

                u64 this_dev_addr = (int_addr & ~0x000000c00000) |

                                    mac_table[i];

                for (j = 5; j >= 0; j--) {

                        addr[i][j] = this_dev_addr & 0xff;

                        this_dev_addr >>= 8;

                }

                dt_fixup_mac_address(i, addr[i]);

        }

}

static char prop_buf[MAX_PROP_LEN];

void planetcore_set_stdout_path(const char *table)

{

        char *path;

        const char *label;

        void *node, *chosen;

        label = planetcore_get_key(table, PLANETCORE_KEY_SERIAL_PORT);

        if (!label)

                return;

        node = find_node_by_prop_value_str(NULL, "linux,planetcore-label",

                                           label);

        if (!node)

                return;

        path = get_path(node, prop_buf, MAX_PROP_LEN);

        if (!path)

                return;

        chosen = finddevice("/chosen");

        if (!chosen)

                chosen = create_node(NULL, "chosen");

        if (!chosen)

                return;

        setprop_str(chosen, "linux,stdout-path", path);

}

void planetcore_set_serial_speed(const char *table)

{

        void *chosen, *stdout;

        u64 baud;

        u32 baud32;

        int len;

        chosen = finddevice("/chosen");

        if (!chosen)

                return;

        len = getprop(chosen, "linux,stdout-path", prop_buf, MAX_PROP_LEN);

        if (len <= 0)

                return;

        stdout = finddevice(prop_buf);

        if (!stdout) {

                printf("planetcore_set_serial_speed: "

                       "Bad /chosen/linux,stdout-path.\r\n");

                return;

        }

        if (!planetcore_get_decimal(table, PLANETCORE_KEY_SERIAL_BAUD,

                                    &baud)) {

                printf("planetcore_set_serial_speed: No SB tag.\r\n");

                return;

        }

        baud32 = baud;

        setprop(stdout, "current-speed", &baud32, 4);

}