Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 1 | /* |
Brian Swetland | ddf61a2 | 2009-01-29 20:46:14 -0800 | [diff] [blame] | 2 | * Copyright (c) 2009, Google Inc. |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 3 | * All rights reserved. |
lijuang | 84dedfe | 2019-11-05 19:00:37 +0800 | [diff] [blame] | 4 | * Copyright (c) 2009-2016, 2018-2019, The Linux Foundation. All rights reserved. |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 5 | * |
| 6 | * Redistribution and use in source and binary forms, with or without |
| 7 | * modification, are permitted provided that the following conditions |
| 8 | * are met: |
| 9 | * * Redistributions of source code must retain the above copyright |
| 10 | * notice, this list of conditions and the following disclaimer. |
| 11 | * * Redistributions in binary form must reproduce the above copyright |
| 12 | * notice, this list of conditions and the following disclaimer in |
| 13 | * the documentation and/or other materials provided with the |
| 14 | * distribution. |
| 15 | * * Neither the name of Google, Inc. nor the names of its contributors |
| 16 | * may be used to endorse or promote products derived from this |
| 17 | * software without specific prior written permission. |
| 18 | * |
| 19 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
| 20 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
| 21 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS |
| 22 | * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE |
| 23 | * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, |
| 24 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, |
| 25 | * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS |
| 26 | * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED |
| 27 | * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, |
| 28 | * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT |
| 29 | * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
| 30 | * SUCH DAMAGE. |
| 31 | */ |
| 32 | |
Pavel Nedev | 94eaaad | 2013-06-10 14:50:59 +0300 | [diff] [blame] | 33 | #include <stdlib.h> |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 34 | #include <debug.h> |
| 35 | #include <printf.h> |
| 36 | #include <arch/arm/dcc.h> |
Dima Zavin | 6e274c2 | 2009-01-28 17:28:41 -0800 | [diff] [blame] | 37 | #include <dev/fbcon.h> |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 38 | #include <dev/uart.h> |
Deepa Dinamani | 7212589 | 2013-05-06 16:50:38 -0700 | [diff] [blame] | 39 | #include <platform/timer.h> |
Pavel Nedev | 420ecf5 | 2013-05-14 14:04:22 +0300 | [diff] [blame] | 40 | #include <platform.h> |
Maria Yu | 43bd26e | 2018-05-11 13:51:36 +0800 | [diff] [blame] | 41 | #include <arch/ops.h> |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 42 | |
Matthew Qin | 50341de | 2014-02-25 17:19:19 +0800 | [diff] [blame] | 43 | #if PON_VIB_SUPPORT |
| 44 | #include <vibrator.h> |
| 45 | #endif |
| 46 | |
vijay kumar | cb5499d | 2015-05-04 14:55:21 +0530 | [diff] [blame] | 47 | |
Deepa Dinamani | 7212589 | 2013-05-06 16:50:38 -0700 | [diff] [blame] | 48 | static void write_dcc(char c) |
| 49 | { |
| 50 | uint32_t timeout = 10; |
| 51 | |
| 52 | /* Note: Smallest sampling rate for DCC is 50us. |
| 53 | * This can be changed by SNOOPer.Rate on T32 window. |
| 54 | */ |
| 55 | while (timeout) |
| 56 | { |
| 57 | if (dcc_putc(c) == 0) |
| 58 | break; |
| 59 | udelay(50); |
| 60 | timeout--; |
| 61 | } |
| 62 | } |
Pavel Nedev | 94eaaad | 2013-06-10 14:50:59 +0300 | [diff] [blame] | 63 | |
| 64 | #if WITH_DEBUG_LOG_BUF |
| 65 | |
| 66 | #ifndef LK_LOG_BUF_SIZE |
| 67 | #define LK_LOG_BUF_SIZE (4096) /* align on 4k */ |
| 68 | #endif |
| 69 | |
| 70 | #define LK_LOG_COOKIE 0x474f4c52 /* "RLOG" in ASCII */ |
| 71 | |
| 72 | struct lk_log { |
| 73 | struct lk_log_header { |
| 74 | unsigned cookie; |
| 75 | unsigned max_size; |
| 76 | unsigned size_written; |
| 77 | unsigned idx; |
| 78 | } header; |
| 79 | char data[LK_LOG_BUF_SIZE]; |
| 80 | }; |
| 81 | |
| 82 | static struct lk_log log = { |
| 83 | .header = { |
| 84 | .cookie = LK_LOG_COOKIE, |
| 85 | .max_size = sizeof(log.data), |
| 86 | .size_written = 0, |
| 87 | .idx = 0, |
| 88 | }, |
| 89 | .data = {0} |
| 90 | }; |
| 91 | |
| 92 | static void log_putc(char c) |
| 93 | { |
| 94 | log.data[log.header.idx++] = c; |
| 95 | log.header.size_written++; |
| 96 | if (unlikely(log.header.idx >= log.header.max_size)) |
| 97 | log.header.idx = 0; |
| 98 | } |
| 99 | #endif /* WITH_DEBUG_LOG_BUF */ |
| 100 | |
vijay kumar | cb5499d | 2015-05-04 14:55:21 +0530 | [diff] [blame] | 101 | void display_fbcon_message(char *str) |
| 102 | { |
| 103 | #if ENABLE_FBCON_LOGGING |
| 104 | while(*str != 0) { |
lijuang | 84dedfe | 2019-11-05 19:00:37 +0800 | [diff] [blame] | 105 | fbcon_putc(*str++, 0); |
vijay kumar | cb5499d | 2015-05-04 14:55:21 +0530 | [diff] [blame] | 106 | } |
| 107 | #endif |
| 108 | } |
| 109 | |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 110 | void _dputc(char c) |
| 111 | { |
Pavel Nedev | 94eaaad | 2013-06-10 14:50:59 +0300 | [diff] [blame] | 112 | #if WITH_DEBUG_LOG_BUF |
| 113 | log_putc(c); |
| 114 | #endif |
Brian Swetland | ddf61a2 | 2009-01-29 20:46:14 -0800 | [diff] [blame] | 115 | #if WITH_DEBUG_DCC |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 116 | if (c == '\n') { |
Deepa Dinamani | 7212589 | 2013-05-06 16:50:38 -0700 | [diff] [blame] | 117 | write_dcc('\r'); |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 118 | } |
Deepa Dinamani | 7212589 | 2013-05-06 16:50:38 -0700 | [diff] [blame] | 119 | write_dcc(c) ; |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 120 | #endif |
Brian Swetland | ddf61a2 | 2009-01-29 20:46:14 -0800 | [diff] [blame] | 121 | #if WITH_DEBUG_UART |
| 122 | uart_putc(0, c); |
| 123 | #endif |
| 124 | #if WITH_DEBUG_FBCON && WITH_DEV_FBCON |
lijuang | 84dedfe | 2019-11-05 19:00:37 +0800 | [diff] [blame] | 125 | fbcon_putc(c, 0); |
Dima Zavin | 6e274c2 | 2009-01-28 17:28:41 -0800 | [diff] [blame] | 126 | #endif |
Ajay Dudani | 168f6cb | 2009-12-07 19:04:02 -0800 | [diff] [blame] | 127 | #if WITH_DEBUG_JTAG |
| 128 | jtag_dputc(c); |
| 129 | #endif |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 130 | } |
| 131 | |
Travis Geiselbrecht | dbc2c68 | 2009-06-28 12:18:39 -0700 | [diff] [blame] | 132 | int dgetc(char *c, bool wait) |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 133 | { |
Brian Swetland | c82fda9 | 2009-01-02 01:53:42 -0800 | [diff] [blame] | 134 | int n; |
Brian Swetland | ddf61a2 | 2009-01-29 20:46:14 -0800 | [diff] [blame] | 135 | #if WITH_DEBUG_DCC |
Brian Swetland | c82fda9 | 2009-01-02 01:53:42 -0800 | [diff] [blame] | 136 | n = dcc_getc(); |
Brian Swetland | ddf61a2 | 2009-01-29 20:46:14 -0800 | [diff] [blame] | 137 | #elif WITH_DEBUG_UART |
| 138 | n = uart_getc(0, 0); |
Brian Swetland | c82fda9 | 2009-01-02 01:53:42 -0800 | [diff] [blame] | 139 | #else |
Brian Swetland | ddf61a2 | 2009-01-29 20:46:14 -0800 | [diff] [blame] | 140 | n = -1; |
Brian Swetland | c82fda9 | 2009-01-02 01:53:42 -0800 | [diff] [blame] | 141 | #endif |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 142 | if (n < 0) { |
| 143 | return -1; |
| 144 | } else { |
| 145 | *c = n; |
| 146 | return 0; |
| 147 | } |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 148 | } |
| 149 | |
| 150 | void platform_halt(void) |
| 151 | { |
Matthew Qin | 50341de | 2014-02-25 17:19:19 +0800 | [diff] [blame] | 152 | #if PON_VIB_SUPPORT |
| 153 | vib_turn_off(); |
| 154 | #endif |
lijuang | 395b5e6 | 2015-11-19 17:39:44 +0800 | [diff] [blame] | 155 | dprintf(CRITICAL, "HALT: reboot into dload mode...\n"); |
Maria Yu | 43bd26e | 2018-05-11 13:51:36 +0800 | [diff] [blame] | 156 | arch_clean_cache_range(MEMBASE, MEMSIZE); |
lijuang | 395b5e6 | 2015-11-19 17:39:44 +0800 | [diff] [blame] | 157 | reboot_device(NORMAL_DLOAD); |
| 158 | |
Pavel Nedev | 420ecf5 | 2013-05-14 14:04:22 +0300 | [diff] [blame] | 159 | dprintf(CRITICAL, "HALT: spinning forever...\n"); |
Ajay Dudani | b01e506 | 2011-12-03 23:23:42 -0800 | [diff] [blame] | 160 | for (;;) ; |
Brian Swetland | 2500aa1 | 2009-01-01 04:33:55 -0800 | [diff] [blame] | 161 | } |