gdb_hook.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:5k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * Carsten Langgaard, carstenl@mips.com
  3.  * Copyright (C) 2000 MIPS Technologies, Inc.  All rights reserved.
  4.  *
  5.  * ########################################################################
  6.  *
  7.  *  This program is free software; you can distribute it and/or modify it
  8.  *  under the terms of the GNU General Public License (Version 2) as
  9.  *  published by the Free Software Foundation.
  10.  *
  11.  *  This program is distributed in the hope it will be useful, but WITHOUT
  12.  *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13.  *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  14.  *  for more details.
  15.  *
  16.  *  You should have received a copy of the GNU General Public License along
  17.  *  with this program; if not, write to the Free Software Foundation, Inc.,
  18.  *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
  19.  *
  20.  * ########################################################################
  21.  *
  22.  * This is the interface to the remote debugger stub.
  23.  *
  24.  */
  25. #include <linux/serialP.h>
  26. #include <linux/serial_reg.h>
  27. #include <asm/serial.h>
  28. #include <asm/io.h>
  29. static struct serial_state rs_table[RS_TABLE_SIZE] = {
  30. SERIAL_PORT_DFNS /* Defined in serial.h */
  31. };
  32. static struct async_struct kdb_port_info = {0};
  33. static __inline__ unsigned int serial_in(struct async_struct *info, int offset)
  34. {
  35. return inb(info->port + offset);
  36. }
  37. static __inline__ void serial_out(struct async_struct *info, int offset,
  38. int value)
  39. {
  40. outb(value, info->port+offset);
  41. }
  42. void rs_kgdb_hook(int tty_no) {
  43. int t;
  44. struct serial_state *ser = &rs_table[tty_no];
  45. kdb_port_info.state = ser;
  46. kdb_port_info.magic = SERIAL_MAGIC;
  47. kdb_port_info.port = ser->port;
  48. kdb_port_info.flags = ser->flags;
  49. /*
  50.  * Clear all interrupts
  51.  */
  52. serial_in(&kdb_port_info, UART_LSR);
  53. serial_in(&kdb_port_info, UART_RX);
  54. serial_in(&kdb_port_info, UART_IIR);
  55. serial_in(&kdb_port_info, UART_MSR);
  56. /*
  57.  * Now, initialize the UART 
  58.  */
  59. serial_out(&kdb_port_info, UART_LCR, UART_LCR_WLEN8); /* reset DLAB */
  60. if (kdb_port_info.flags & ASYNC_FOURPORT) {
  61. kdb_port_info.MCR = UART_MCR_DTR | UART_MCR_RTS;
  62. t = UART_MCR_DTR | UART_MCR_OUT1;
  63. } else {
  64. kdb_port_info.MCR 
  65. = UART_MCR_DTR | UART_MCR_RTS | UART_MCR_OUT2;
  66. t = UART_MCR_DTR | UART_MCR_RTS;
  67. }
  68. kdb_port_info.MCR = t; /* no interrupts, please */
  69. serial_out(&kdb_port_info, UART_MCR, kdb_port_info.MCR);
  70. /*
  71.  * and set the speed of the serial port
  72.  * (currently hardwired to 9600 8N1
  73.  */
  74. /* baud rate is fixed to 9600 (is this sufficient?)*/
  75. t = kdb_port_info.state->baud_base / 9600;
  76. /* set DLAB */
  77. serial_out(&kdb_port_info, UART_LCR, UART_LCR_WLEN8 | UART_LCR_DLAB);
  78. serial_out(&kdb_port_info, UART_DLL, t & 0xff);/* LS of divisor */
  79. serial_out(&kdb_port_info, UART_DLM, t >> 8);  /* MS of divisor */
  80. /* reset DLAB */
  81. serial_out(&kdb_port_info, UART_LCR, UART_LCR_WLEN8);
  82. }
  83. int rs_putDebugChar(char c)
  84. {
  85. if (!kdb_port_info.state) {  /* need to init device first */
  86. return 0;
  87. }
  88. while ((serial_in(&kdb_port_info, UART_LSR) & UART_LSR_THRE) == 0)
  89. ;
  90. serial_out(&kdb_port_info, UART_TX, c);
  91. return 1;
  92. }
  93. char rs_getDebugChar(void)
  94. {
  95. if (!kdb_port_info.state) {  /* need to init device first */
  96. return 0;
  97. }
  98. while (!(serial_in(&kdb_port_info, UART_LSR) & 1))
  99. ;
  100. return(serial_in(&kdb_port_info, UART_RX));
  101. }
  102. #ifdef CONFIG_MIPS_ATLAS
  103. #include <asm/mips-boards/atlas.h>
  104. #include <asm/mips-boards/saa9730_uart.h>
  105. #define INB(a)     inb((unsigned long)a)
  106. #define OUTB(x,a)  outb(x,(unsigned long)a)
  107. /*
  108.  * This is the interface to the remote debugger stub
  109.  * if the Philips part is used for the debug port,
  110.  * called from the platform setup code.
  111.  *
  112.  * PCI init will not have been done yet, we make a
  113.  * universal assumption about the way the bootloader (YAMON)
  114.  * have located and set up the chip.
  115.  */
  116. static t_uart_saa9730_regmap *kgdb_uart = (void *)(ATLAS_SAA9730_REG + SAA9730_UART_REGS_ADDR);
  117. static int saa9730_kgdb_active = 0;
  118. void saa9730_kgdb_hook(void) 
  119. {
  120.         volatile unsigned char t;
  121.         /*
  122.          * Clear all interrupts
  123.          */
  124. t = INB(&kgdb_uart->Lsr);
  125. t += INB(&kgdb_uart->Msr);
  126. t += INB(&kgdb_uart->Thr_Rbr);
  127. t += INB(&kgdb_uart->Iir_Fcr);
  128.         /*
  129.          * Now, initialize the UART
  130.          */
  131. /* 8 data bits, one stop bit, no parity */
  132. OUTB(SAA9730_LCR_DATA8, &kgdb_uart->Lcr);
  133.         /* baud rate is fixed to 9600 (is this sufficient?)*/
  134. OUTB(0, &kgdb_uart->BaudDivMsb); /* HACK - Assumes standard crystal */
  135. OUTB(23, &kgdb_uart->BaudDivLsb); /* HACK - known for MIPS Atlas */
  136. /* Set RTS/DTR active */
  137. OUTB(SAA9730_MCR_DTR | SAA9730_MCR_RTS, &kgdb_uart->Mcr);
  138. saa9730_kgdb_active = 1;
  139. }
  140. int saa9730_putDebugChar(char c)
  141. {
  142.         if (!saa9730_kgdb_active) {     /* need to init device first */
  143.                 return 0;
  144.         }
  145.         while (!(INB(&kgdb_uart->Lsr) & SAA9730_LSR_THRE))
  146.                 ;
  147. OUTB(c, &kgdb_uart->Thr_Rbr);
  148.         return 1;
  149. }
  150. char saa9730_getDebugChar(void)
  151. {
  152. char c;
  153.         if (!saa9730_kgdb_active) {     /* need to init device first */
  154.                 return 0;
  155.         }
  156.         while (!(INB(&kgdb_uart->Lsr) & SAA9730_LSR_DR))
  157.                 ;
  158. c = INB(&kgdb_uart->Thr_Rbr);
  159.         return(c);
  160. }
  161. #endif