params_setup.c 2.44 KB
Newer Older
1
2
3
/*
 * Copyright (c) 2016, ARM Limited and Contributors. All rights reserved.
 *
dp-arm's avatar
dp-arm committed
4
 * SPDX-License-Identifier: BSD-3-Clause
5
6
7
8
9
10
 */

#include <arm_gic.h>
#include <assert.h>
#include <bl_common.h>
#include <console.h>
11
#include <coreboot.h>
12
13
14
15
16
#include <debug.h>
#include <gpio.h>
#include <mmio.h>
#include <plat_params.h>
#include <plat_private.h>
17
#include <platform.h>
18
19
#include <string.h>

20
21
static struct gpio_info param_reset;
static struct gpio_info param_poweroff;
22
static struct bl31_apio_param param_apio;
23
24
static struct gpio_info *rst_gpio;
static struct gpio_info *poweroff_gpio;
25
26
static struct gpio_info suspend_gpio[10];
uint32_t suspend_gpio_cnt;
27
static struct apio_info *suspend_apio;
28

29
struct gpio_info *plat_get_rockchip_gpio_reset(void)
30
31
32
33
{
	return rst_gpio;
}

34
struct gpio_info *plat_get_rockchip_gpio_poweroff(void)
35
36
37
38
{
	return poweroff_gpio;
}

39
40
41
42
43
44
45
struct gpio_info *plat_get_rockchip_suspend_gpio(uint32_t *count)
{
	*count = suspend_gpio_cnt;

	return &suspend_gpio[0];
}

46
47
48
49
50
struct apio_info *plat_get_rockchip_suspend_apio(void)
{
	return suspend_apio;
}

51
52
53
54
55
56
57
58
59
60
void params_early_setup(void *plat_param_from_bl2)
{
	struct bl31_plat_param *bl2_param;
	struct bl31_gpio_param *gpio_param;

	/* keep plat parameters for later processing if need */
	bl2_param = (struct bl31_plat_param *)plat_param_from_bl2;
	while (bl2_param) {
		switch (bl2_param->type) {
		case PARAM_RESET:
61
62
63
64
			gpio_param = (struct bl31_gpio_param *)bl2_param;
			memcpy(&param_reset, &gpio_param->gpio,
			       sizeof(struct gpio_info));
			rst_gpio = &param_reset;
65
66
			break;
		case PARAM_POWEROFF:
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
			gpio_param = (struct bl31_gpio_param *)bl2_param;
			memcpy(&param_poweroff, &gpio_param->gpio,
				sizeof(struct gpio_info));
			poweroff_gpio = &param_poweroff;
			break;
		case PARAM_SUSPEND_GPIO:
			if (suspend_gpio_cnt >= ARRAY_SIZE(suspend_gpio)) {
				ERROR("exceed support suspend gpio number\n");
				break;
			}
			gpio_param = (struct bl31_gpio_param *)bl2_param;
			memcpy(&suspend_gpio[suspend_gpio_cnt],
			       &gpio_param->gpio,
			       sizeof(struct gpio_info));
			suspend_gpio_cnt++;
82
			break;
83
84
85
86
87
		case PARAM_SUSPEND_APIO:
			memcpy(&param_apio, bl2_param,
			       sizeof(struct bl31_apio_param));
			suspend_apio = &param_apio.apio;
			break;
88
89
90
91
92
93
#if COREBOOT
		case PARAM_COREBOOT_TABLE:
			coreboot_table_setup((void *)
				((struct bl31_u64_param *)bl2_param)->value);
			break;
#endif
94
		default:
95
96
97
			ERROR("not expected type found %ld\n",
			      bl2_param->type);
			break;
98
99
100
101
		}
		bl2_param = bl2_param->next;
	}
}