Project import generated by Copybara.
GitOrigin-RevId: 7a5ad44492fdaf91173ec14352acd6b4db053f0b
diff --git a/board/hardkernel/odroidc2/firmware/scp_task/pwr_ctrl.c b/board/hardkernel/odroidc2/firmware/scp_task/pwr_ctrl.c
new file mode 100644
index 0000000..4cec22f
--- /dev/null
+++ b/board/hardkernel/odroidc2/firmware/scp_task/pwr_ctrl.c
@@ -0,0 +1,327 @@
+/*
+* Copyright (C) 2017 Amlogic, 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, write to the Free Software Foundation, Inc.,
+* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
+* *
+Description:
+*/
+
+/*p200/201 GPIOAO_2 powr on :0, power_off :1*/
+
+#define __SUSPEND_FIRMWARE__
+#include <config.h>
+#undef __SUSPEND_FIRMWARE__
+
+#define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0]))
+
+#ifdef CONFIG_CEC_WAKEUP
+#include <cec_tx_reg.h>
+#endif
+
+#include <gpio-gxbb.h>
+
+extern int pwm_voltage_table[31][2];
+
+#define P_PIN_MUX_REG3 (*((volatile unsigned *)(0xda834400 + (0x2f << 2))))
+#define P_PIN_MUX_REG7 (*((volatile unsigned *)(0xda834400 + (0x33 << 2))))
+
+#define P_PWM_MISC_REG_AB (*((volatile unsigned *)(0xc1100000 + (0x2156 << 2))))
+#define P_PWM_PWM_B (*((volatile unsigned *)(0xc1100000 + (0x2155 << 2))))
+#define P_PWM_MISC_REG_CD (*((volatile unsigned *)(0xc1100000 + (0x2196 << 2))))
+#define P_PWM_PWM_D (*((volatile unsigned *)(0xc1100000 + (0x2195 << 2))))
+
+#define P_EE_TIMER_E (*((volatile unsigned *)(0xc1100000 + (0x2662 << 2))))
+
+enum pwm_id {
+ pwm_a = 0,
+ pwm_b,
+ pwm_c,
+ pwm_d,
+ pwm_e,
+ pwm_f,
+};
+
+void pwm_set_voltage(unsigned int id, unsigned int voltage)
+{
+ int to;
+
+ uart_puts("set vddee to 0x");
+ uart_put_hex(voltage, 16);
+ uart_puts("mv\n");
+ for (to = 0; to < ARRAY_SIZE(pwm_voltage_table); to++) {
+ if (pwm_voltage_table[to][1] >= voltage) {
+ break;
+ }
+ }
+ if (to >= ARRAY_SIZE(pwm_voltage_table)) {
+ to = ARRAY_SIZE(pwm_voltage_table) - 1;
+ }
+ switch (id) {
+ case pwm_b:
+ P_PWM_PWM_B = pwm_voltage_table[to][0];
+ break;
+
+ case pwm_d:
+ P_PWM_PWM_D = pwm_voltage_table[to][0];
+ break;
+ default:
+ break;
+ }
+ _udelay(200);
+}
+
+static void power_off_3v3(void)
+{
+ aml_update_bits(AO_GPIO_O_EN_N, 1<<2, 0);
+ aml_update_bits(AO_GPIO_O_EN_N, 1<<18, 1<<18);
+}
+static void power_on_3v3(void)
+{
+ aml_update_bits(AO_GPIO_O_EN_N, 1<<2, 0);
+ aml_update_bits(AO_GPIO_O_EN_N, 1<<18, 0);
+}
+
+/*p200/201 GPIOAO_4 powr on :1, power_off :0*/
+static void power_off_vcck(void)
+{
+ aml_update_bits(AO_GPIO_O_EN_N, 1<<4, 0);
+ aml_update_bits(AO_GPIO_O_EN_N, 1<<20, 0);
+}
+static void power_on_vcck(void)
+{
+ aml_update_bits(AO_GPIO_O_EN_N, 1<<4, 0);
+ aml_update_bits(AO_GPIO_O_EN_N, 1<<20, 1<<20);
+}
+
+static void power_off_at_clk81(void)
+{
+ power_off_3v3();
+ power_off_vcck();
+ pwm_set_voltage(pwm_d, CONFIG_VDDEE_SLEEP_VOLTAGE); // reduce power
+}
+static void power_on_at_clk81(void)
+{
+ pwm_set_voltage(pwm_d, CONFIG_VDDEE_INIT_VOLTAGE);
+ power_on_vcck();
+ power_on_3v3();
+}
+
+static void power_off_at_24M(void)
+{
+ //LED gpioao_13
+ aml_update_bits(AO_GPIO_O_EN_N, 1<<29, 0);
+}
+
+static void power_on_at_24M(void)
+{
+ aml_update_bits(AO_GPIO_O_EN_N, 1<<29, 1<<29);
+}
+
+static void power_off_at_32k(void)
+{
+}
+
+static void power_on_at_32k(void)
+{
+}
+
+void get_wakeup_source(void *response, unsigned int suspend_from)
+{
+ struct wakeup_info *p = (struct wakeup_info *)response;
+ unsigned val;
+ struct wakeup_gpio_info *gpio;
+ unsigned i = 0;
+
+ p->status = RESPONSE_OK;
+ val = (POWER_KEY_WAKEUP_SRC | AUTO_WAKEUP_SRC | REMOTE_WAKEUP_SRC);
+#ifdef CONFIG_BT_WAKEUP
+ val |= BT_WAKEUP_SRC;
+#endif
+
+#ifdef CONFIG_CEC_WAKEUP
+ if (suspend_from != SYS_POWEROFF)
+ val |= CEC_WAKEUP_SRC;
+#endif
+#ifdef CONFIG_WIFI_WAKEUP
+ if (suspend_from != SYS_POWEROFF)
+ val |= WIFI_WAKEUP_SRC;
+#endif
+
+ p->sources = val;
+
+ /* Power Key: AO_GPIO[3]*/
+ gpio = &(p->gpio_info[i]);
+ gpio->wakeup_id = POWER_KEY_WAKEUP_SRC;
+ gpio->gpio_in_idx = GPIOAO_3;
+ gpio->gpio_in_ao = 1;
+ gpio->gpio_out_idx = -1;
+ gpio->gpio_out_ao = -1;
+ gpio->irq = IRQ_AO_GPIO0_NUM;
+ gpio->trig_type = GPIO_IRQ_FALLING_EDGE;
+ p->gpio_info_count = ++i;
+
+ /* BT Wakeup: IN: GPIOX[21], OUT: GPIOX[20]*/
+ gpio = &(p->gpio_info[i]);
+ gpio->wakeup_id = BT_WAKEUP;
+ gpio->gpio_in_idx = GPIOX_21;
+ gpio->gpio_in_ao = 0;
+ gpio->gpio_out_idx = GPIOX_20;
+ gpio->gpio_out_ao = 0;
+ gpio->irq = IRQ_GPIO0_NUM;
+ gpio->trig_type = GPIO_IRQ_FALLING_EDGE;
+ p->gpio_info_count = ++i;
+
+#ifdef CONFIG_WIFI_WAKEUP
+ if (suspend_from != SYS_POWEROFF) {
+ /*WIFI Wakeup: IN: GPIOX[7], OUT: GPIOX[6]*/
+ gpio = &(p->gpio_info[i]);
+ gpio->wakeup_id = WIFI_WAKEUP;
+ gpio->gpio_in_idx = GPIOX_7;
+ gpio->gpio_in_ao = 0;
+ gpio->gpio_out_idx = GPIOX_6;
+ gpio->gpio_out_ao = 0;
+ gpio->irq = IRQ_GPIO1_NUM;
+ gpio->trig_type = GPIO_IRQ_FALLING_EDGE;
+ p->gpio_info_count = ++i;
+ }
+#endif
+}
+
+void wakeup_timer_setup(void)
+{
+ /* 1ms resolution*/
+ unsigned value;
+ value = readl(P_ISA_TIMER_MUX);
+ value |= ((0x3<<0) | (0x1<<12) | (0x1<<16));
+ writel(value, P_ISA_TIMER_MUX);
+ writel(10, P_ISA_TIMERA);
+}
+void wakeup_timer_clear(void)
+{
+ unsigned value;
+ value = readl(P_ISA_TIMER_MUX);
+ value &= ~((0x1<<12) | (0x1<<16));
+ writel(value, P_ISA_TIMER_MUX);
+}
+
+static unsigned int detect_key(unsigned int suspend_from)
+{
+ int exit_reason = 0;
+ unsigned int time_out = readl(AO_DEBUG_REG2);
+ unsigned time_out_ms = time_out*100;
+ unsigned *irq = (unsigned *)SECURE_TASK_SHARE_IRQ;
+ /* unsigned *wakeup_en = (unsigned *)SECURE_TASK_RESPONSE_WAKEUP_EN; */
+
+ /* setup wakeup resources*/
+ /*auto suspend: timerA 10ms resolution*/
+ if (time_out_ms != 0)
+ wakeup_timer_setup();
+
+ init_remote();
+#ifdef CONFIG_CEC_WAKEUP
+ if (hdmi_cec_func_config & 0x1) {
+ remote_cec_hw_reset();
+ cec_node_init();
+ }
+#endif
+
+ /* *wakeup_en = 1;*/
+ do {
+ switch (*irq) {
+#ifdef CONFIG_CEC_WAKEUP
+ case IRQ_AO_CEC_NUM:
+ if (suspend_from == SYS_POWEROFF)
+ break;
+ if (cec_msg.log_addr) {
+ if (hdmi_cec_func_config & 0x1) {
+ cec_handler();
+ if (cec_msg.cec_power == 0x1) {
+ /*cec power key*/
+ exit_reason = CEC_WAKEUP;
+ break;
+ }
+ }
+ } else if (hdmi_cec_func_config & 0x1)
+ cec_node_init();
+ break;
+#endif
+ case IRQ_TIMERA_NUM:
+ if (time_out_ms != 0)
+ time_out_ms--;
+ if (time_out_ms == 0) {
+ wakeup_timer_clear();
+ exit_reason = AUTO_WAKEUP;
+ }
+ break;
+
+ case IRQ_AO_IR_DEC_NUM:
+ if (remote_detect_key())
+ exit_reason = REMOTE_WAKEUP;
+ break;
+
+ case IRQ_AO_GPIO0_NUM:
+ if ((readl(AO_GPIO_I) & (1<<3)) == 0)
+ exit_reason = POWER_KEY_WAKEUP;
+ break;
+
+#ifdef CONFIG_BT_WAKEUP
+ case IRQ_GPIO0_NUM:
+ if (!(readl(PREG_PAD_GPIO4_EN_N)
+ &(0x01 << 20)) &&
+ (readl(PREG_PAD_GPIO4_O)
+ & (0x01 << 20)) &&
+ !(readl(PREG_PAD_GPIO4_I)
+ & (0x01 << 21)))
+ exit_reason = BT_WAKEUP;
+ break;
+#endif
+#ifdef CONFIG_WIFI_WAKEUP
+ case IRQ_GPIO1_NUM:
+ if (suspend_from) {
+ if (!(readl(PREG_PAD_GPIO4_EN_N)
+ & (0x01 << 6)) &&
+ (readl(PREG_PAD_GPIO4_O)
+ & (0x01 << 6)) &&
+ !(readl(PREG_PAD_GPIO4_I)
+ & (0x01 << 7)))
+ exit_reason = WIFI_WAKEUP;
+ }
+ break;
+#endif
+ default:
+ break;
+ }
+ *irq = 0xffffffff;
+ if (exit_reason)
+ break;
+ else
+ asm volatile("wfi");
+ } while (1);
+
+ return exit_reason;
+}
+
+static void pwr_op_init(struct pwr_op *pwr_op)
+{
+ pwr_op->power_off_at_clk81 = power_off_at_clk81;
+ pwr_op->power_on_at_clk81 = power_on_at_clk81;
+ pwr_op->power_off_at_24M = power_off_at_24M;
+ pwr_op->power_on_at_24M = power_on_at_24M;
+ pwr_op->power_off_at_32k = power_off_at_32k;
+ pwr_op->power_on_at_32k = power_on_at_32k;
+
+ pwr_op->detect_key = detect_key;
+ pwr_op->get_wakeup_source = get_wakeup_source;
+}
