开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
ppc-stub.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：18k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

ppc-stub.c：源码内容
  1. /*
  2.  * BK Id: SCCS/s.ppc-stub.c 1.6 05/17/01 18:14:21 cort
  3.  */
  4. /*
  5.  * ppc-stub.c:  KGDB support for the Linux kernel.
  6.  *
  7.  * adapted from arch/sparc/kernel/sparc-stub.c for the PowerPC
  8.  * some stuff borrowed from Paul Mackerras' xmon
  9.  * Copyright (C) 1998 Michael AK Tesch (tesch@cs.wisc.edu)
  10.  *
  11.  * Modifications to run under Linux
  12.  * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
  13.  *
  14.  * This file originally came from the gdb sources, and the
  15.  * copyright notices have been retained below.
  16.  */
  18. /****************************************************************************
  20. THIS SOFTWARE IS NOT COPYRIGHTED
  22.    HP offers the following for use in the public domain.  HP makes no
  23.    warranty with regard to the software or its performance and the
  24.    user accepts the software "AS IS" with all faults.
  26.    HP DISCLAIMS ANY WARRANTIES, EXPRESS OR IMPLIED, WITH REGARD
  27.    TO THIS SOFTWARE INCLUDING BUT NOT LIMITED TO THE WARRANTIES
  28.    OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  30. ****************************************************************************/
  32. /****************************************************************************
  33.  *  Header: remcom.c,v 1.34 91/03/09 12:29:49 glenne Exp $
  34.  *
  35.  *  Module name: remcom.c $
  36.  *  Revision: 1.34 $
  37.  *  Date: 91/03/09 12:29:49 $
  38.  *  Contributor:     Lake Stevens Instrument Division$
  39.  *
  40.  *  Description:     low level support for gdb debugger. $
  41.  *
  42.  *  Considerations:  only works on target hardware $
  43.  *
  44.  *  Written by:      Glenn Engel $
  45.  *  ModuleState:     Experimental $
  46.  *
  47.  *  NOTES:           See Below $
  48.  *
  49.  *  Modified for SPARC by Stu Grossman, Cygnus Support.
  50.  *
  51.  *  This code has been extensively tested on the Fujitsu SPARClite demo board.
  52.  *
  53.  *  To enable debugger support, two things need to happen.  One, a
  54.  *  call to set_debug_traps() is necessary in order to allow any breakpoints
  55.  *  or error conditions to be properly intercepted and reported to gdb.
  56.  *  Two, a breakpoint needs to be generated to begin communication.  This
  57.  *  is most easily accomplished by a call to breakpoint().  Breakpoint()
  58.  *  simulates a breakpoint by executing a trap #1.
  59.  *
  60.  *************
  61.  *
  62.  *    The following gdb commands are supported:
  63.  *
  64.  * command          function                               Return value
  65.  *
  66.  *    g             return the value of the CPU registers  hex data or ENN
  67.  *    G             set the value of the CPU registers     OK or ENN
  68.  *    qOffsets      Get section offsets.  Reply is Text=xxx;Data=yyy;Bss=zzz
  69.  *
  70.  *    mAA..AA,LLLL  Read LLLL bytes at address AA..AA      hex data or ENN
  71.  *    MAA..AA,LLLL: Write LLLL bytes at address AA.AA      OK or ENN
  72.  *
  73.  *    c             Resume at current address              SNN   ( signal NN)
  74.  *    cAA..AA       Continue at address AA..AA             SNN
  75.  *
  76.  *    s             Step one instruction                   SNN
  77.  *    sAA..AA       Step one instruction from AA..AA       SNN
  78.  *
  79.  *    k             kill
  80.  *
  81.  *    ?             What was the last sigval ?             SNN   (signal NN)
  82.  *
  83.  *    bBB..BB     Set baud rate to BB..BB    OK or BNN, then sets
  84.  *    baud rate
  85.  *
  86.  * All commands and responses are sent with a packet which includes a
  87.  * checksum.  A packet consists of
  88.  *
  89.  * $<packet info>#<checksum>.
  90.  *
  91.  * where
  92.  * <packet info> :: <characters representing the command or response>
  93.  * <checksum>    :: <two hex digits computed as modulo 256 sum of <packetinfo>>
  94.  *
  95.  * When a packet is received, it is first acknowledged with either '+' or '-'.
  96.  * '+' indicates a successful transfer.  '-' indicates a failed transfer.
  97.  *
  98.  * Example:
  99.  *
  100.  * Host:                  Reply:
  101.  * $m0,10#2a               +$00010203040506070809101112131415#42
  102.  *
  103.  ****************************************************************************/
  105. #include <linux/config.h>
  106. #include <linux/kernel.h>
  107. #include <linux/string.h>
  108. #include <linux/mm.h>
  109. #include <linux/smp.h>
  110. #include <linux/smp_lock.h>
  112. #include <asm/system.h>
  113. #include <asm/signal.h>
  114. #include <asm/kgdb.h>
  115. #include <asm/pgtable.h>
  116. #include <asm/ptrace.h>
  118. void breakinst(void);
  120. /*
  121.  * BUFMAX defines the maximum number of characters in inbound/outbound buffers
  122.  * at least NUMREGBYTES*2 are needed for register packets
  123.  */
  124. #define BUFMAX 2048
  125. static char remcomInBuffer[BUFMAX];
  126. static char remcomOutBuffer[BUFMAX];
  128. static int initialized;
  129. static int kgdb_active;
  130. static int kgdb_started;
  131. static u_int fault_jmp_buf[100];
  132. static int kdebug;
  134. static const char hexchars[]="0123456789abcdef";
  136. /* Place where we save old trap entries for restoration - sparc*/
  137. /* struct tt_entry kgdb_savettable[256]; */
  138. /* typedef void (*trapfunc_t)(void); */
  140. #if 0
  141. /* Install an exception handler for kgdb */
  142. static void exceptionHandler(int tnum, unsigned int *tfunc)
  143. {
  144. /* We are dorking with a live trap table, all irqs off */
  145. }
  146. #endif
  148. int
  149. kgdb_setjmp(long *buf)
  150. {
  151. asm ("mflr 0; stw 0,0(%0);"
  152.      "stw 1,4(%0); stw 2,8(%0);"
  153.      "mfcr 0; stw 0,12(%0);"
  154.      "stmw 13,16(%0)"
  155.      : : "r" (buf));
  156. /* XXX should save fp regs as well */
  157. return 0;
  158. }
  159. void
  160. kgdb_longjmp(long *buf, int val)
  161. {
  162. if (val == 0)
  163. val = 1;
  164. asm ("lmw 13,16(%0);"
  165.      "lwz 0,12(%0); mtcrf 0x38,0;"
  166.      "lwz 0,0(%0); lwz 1,4(%0); lwz 2,8(%0);"
  167.      "mtlr 0; mr 3,%1"
  168.      : : "r" (buf), "r" (val));
  169. }
  170. /* Convert ch from a hex digit to an int */
  171. static int
  172. hex(unsigned char ch)
  173. {
  174. if (ch >= 'a' && ch <= 'f')
  175. return ch-'a'+10;
  176. if (ch >= '0' && ch <= '9')
  177. return ch-'0';
  178. if (ch >= 'A' && ch <= 'F')
  179. return ch-'A'+10;
  180. return -1;
  181. }
  183. /* Convert the memory pointed to by mem into hex, placing result in buf.
  184.  * Return a pointer to the last char put in buf (null), in case of mem fault,
  185.  * return 0.
  186.  */
  187. static unsigned char *
  188. mem2hex(char *mem, char *buf, int count)
  189. {
  190. unsigned char ch;
  192. if (kgdb_setjmp((long*)fault_jmp_buf) == 0) {
  193. debugger_fault_handler = kgdb_fault_handler;
  194. while (count-- > 0) {
  195. ch = *mem++;
  196. *buf++ = hexchars[ch >> 4];
  197. *buf++ = hexchars[ch & 0xf];
  198. }
  199. } else {
  200. /* error condition */
  201. }
  202. debugger_fault_handler = 0;
  203. *buf = 0;
  204. return buf;
  205. }
  207. /* convert the hex array pointed to by buf into binary to be placed in mem
  208.  * return a pointer to the character AFTER the last byte written.
  209. */
  210. static char *
  211. hex2mem(char *buf, char *mem, int count)
  212. {
  213. int i;
  214. unsigned char ch;
  216. if (kgdb_setjmp((long*)fault_jmp_buf) == 0) {
  217. debugger_fault_handler = kgdb_fault_handler;
  218. for (i=0; i<count; i++) {
  219. ch = hex(*buf++) << 4;
  220. ch |= hex(*buf++);
  221. *mem++ = ch;
  222. }
  223. flush_icache_range((int)mem, (int)mem+count);
  224. } else {
  225. /* error condition */
  226. }
  227. debugger_fault_handler = 0;
  228. return mem;
  229. }
  231. /*
  232.  * While we find nice hex chars, build an int.
  233.  * Return number of chars processed.
  234.  */
  235. static int
  236. hexToInt(char **ptr, int *intValue)
  237. {
  238. int numChars = 0;
  239. int hexValue;
  241. *intValue = 0;
  243. if (kgdb_setjmp((long*)fault_jmp_buf) == 0) {
  244. debugger_fault_handler = kgdb_fault_handler;
  245. while (**ptr) {
  246. hexValue = hex(**ptr);
  247. if (hexValue < 0)
  248. break;
  250. *intValue = (*intValue << 4) | hexValue;
  251. numChars ++;
  253. (*ptr)++;
  254. }
  255. } else {
  256.      /* error condition */
  257. }
  258. debugger_fault_handler = 0;
  260. return (numChars);
  261. }
  263. /* scan for the sequence $<data>#<checksum>     */
  264. static void
  265. getpacket(char *buffer)
  266. {
  267. unsigned char checksum;
  268. unsigned char xmitcsum;
  269. int i;
  270. int count;
  271. unsigned char ch;
  273. do {
  274. /* wait around for the start character, ignore all other
  275.  * characters */
  276. while ((ch = (getDebugChar() & 0x7f)) != '$') ;
  278. checksum = 0;
  279. xmitcsum = -1;
  281. count = 0;
  283. /* now, read until a # or end of buffer is found */
  284. while (count < BUFMAX) {
  285. ch = getDebugChar() & 0x7f;
  286. if (ch == '#')
  287. break;
  288. checksum = checksum + ch;
  289. buffer[count] = ch;
  290. count = count + 1;
  291. }
  293. if (count >= BUFMAX)
  294. continue;
  296. buffer[count] = 0;
  298. if (ch == '#') {
  299. xmitcsum = hex(getDebugChar() & 0x7f) << 4;
  300. xmitcsum |= hex(getDebugChar() & 0x7f);
  301. if (checksum != xmitcsum)
  302. putDebugChar('-'); /* failed checksum */
  303. else {
  304. putDebugChar('+'); /* successful transfer */
  305. /* if a sequence char is present, reply the ID */
  306. if (buffer[2] == ':') {
  307. putDebugChar(buffer[0]);
  308. putDebugChar(buffer[1]);
  309. /* remove sequence chars from buffer */
  310. count = strlen(buffer);
  311. for (i=3; i <= count; i++)
  312. buffer[i-3] = buffer[i];
  313. }
  314. }
  315. }
  316. } while (checksum != xmitcsum);
  317. }
  319. /* send the packet in buffer.  */
  320. static void putpacket(unsigned char *buffer)
  321. {
  322. unsigned char checksum;
  323. int count;
  324. unsigned char ch, recv;
  326. /*  $<packet info>#<checksum>. */
  327. do {
  328. putDebugChar('$');
  329. checksum = 0;
  330. count = 0;
  332. while ((ch = buffer[count])) {
  333. putDebugChar(ch);
  334. checksum += ch;
  335. count += 1;
  336. }
  338. putDebugChar('#');
  339. putDebugChar(hexchars[checksum >> 4]);
  340. putDebugChar(hexchars[checksum & 0xf]);
  341. recv = getDebugChar();
  342. } while ((recv & 0x7f) != '+');
  343. }
  345. static void kgdb_flush_cache_all(void)
  346. {
  347. flush_instruction_cache();
  348. }
  350. static inline int get_msr(void)
  351. {
  352. int msr;
  353. asm volatile("mfmsr %0" : "=r" (msr):);
  354. return msr;
  355. }
  357. static inline void set_msr(int msr)
  358. {
  359. asm volatile("mtmsr %0" : : "r" (msr));
  360. }
  362. /* Set up exception handlers for tracing and breakpoints
  363.  * [could be called kgdb_init()]
  364.  */
  365. void set_debug_traps(void)
  366. {
  367. #if 0
  368. unsigned char c;
  370. save_and_cli(flags);
  372. /* In case GDB is started before us, ack any packets (presumably
  373.  * "$?#xx") sitting there.
  374.  *
  375.  * I've found this code causes more problems than it solves,
  376.  * so that's why it's commented out.  GDB seems to work fine
  377.  * now starting either before or after the kernel   -bwb
  378.  */
  380. while((c = getDebugChar()) != '$');
  381. while((c = getDebugChar()) != '#');
  382. c = getDebugChar(); /* eat first csum byte */
  383. c = getDebugChar(); /* eat second csum byte */
  384. putDebugChar('+'); /* ack it */
  385. #endif
  386. debugger = kgdb;
  387. debugger_bpt = kgdb_bpt;
  388. debugger_sstep = kgdb_sstep;
  389. debugger_iabr_match = kgdb_iabr_match;
  390. debugger_dabr_match = kgdb_dabr_match;
  392. initialized = 1;
  393. }
  395. static void kgdb_fault_handler(struct pt_regs *regs)
  396. {
  397. kgdb_longjmp((long*)fault_jmp_buf, 1);
  398. }
  400. int kgdb_bpt(struct pt_regs *regs)
  401. {
  402. handle_exception(regs);
  403. return 1;
  404. }
  406. int kgdb_sstep(struct pt_regs *regs)
  407. {
  408. handle_exception(regs);
  409. return 1;
  410. }
  412. void kgdb(struct pt_regs *regs)
  413. {
  414. handle_exception(regs);
  415. }
  417. int kgdb_iabr_match(struct pt_regs *regs)
  418. {
  419. printk("kgdb doesn't support iabr, what?!?n");
  420. handle_exception(regs);
  421. return 1;
  422. }
  424. int kgdb_dabr_match(struct pt_regs *regs)
  425. {
  426. printk("kgdb doesn't support dabr, what?!?n");
  427. handle_exception(regs);
  428. return 1;
  429. }
  431. /* Convert the SPARC hardware trap type code to a unix signal number. */
  432. /*
  433.  * This table contains the mapping between PowerPC hardware trap types, and
  434.  * signals, which are primarily what GDB understands.
  435.  */
  436. static struct hard_trap_info
  437. {
  438. unsigned int tt; /* Trap type code for powerpc */
  439. unsigned char signo; /* Signal that we map this trap into */
  440. } hard_trap_info[] = {
  441. { 0x200, SIGSEGV }, /* machine check */
  442. { 0x300, SIGSEGV }, /* address error (store) */
  443. { 0x400, SIGBUS }, /* instruction bus error */
  444. { 0x500, SIGINT }, /* interrupt */
  445. { 0x600, SIGBUS }, /* alingment */
  446. { 0x700, SIGTRAP }, /* breakpoint trap */
  447. { 0x800, SIGFPE }, /* fpu unavail */
  448. { 0x900, SIGALRM }, /* decrementer */
  449. { 0xa00, SIGILL }, /* reserved */
  450. { 0xb00, SIGILL }, /* reserved */
  451. { 0xc00, SIGCHLD }, /* syscall */
  452. { 0xd00, SIGTRAP }, /* single-step/watch */
  453. { 0xe00, SIGFPE }, /* fp assist */
  454. { 0, 0} /* Must be last */
  455. };
  457. static int computeSignal(unsigned int tt)
  458. {
  459. struct hard_trap_info *ht;
  461. for (ht = hard_trap_info; ht->tt && ht->signo; ht++)
  462. if (ht->tt == tt)
  463. return ht->signo;
  465. return SIGHUP;         /* default for things we don't know about */
  466. }
  468. #define PC_REGNUM 64
  469. #define SP_REGNUM 1
  471. /*
  472.  * This function does all command processing for interfacing to gdb.
  473.  */
  474. static void
  475. handle_exception (struct pt_regs *regs)
  476. {
  477. int sigval;
  478. int addr;
  479. int length;
  480. char *ptr;
  481. unsigned int msr;
  483. if (debugger_fault_handler) {
  484. debugger_fault_handler(regs);
  485. panic("kgdb longjump failed!n");
  486. }
  487. if (kgdb_active) {
  488. printk("interrupt while in kgdb, returningn");
  489. return;
  490. }
  491. kgdb_active = 1;
  492. kgdb_started = 1;
  494. #ifdef KGDB_DEBUG
  495. printk("kgdb: entering handle_exception; trap [0x%x]n",
  496.        (unsigned int)regs->trap);
  497. #endif
  499. kgdb_interruptible(0);
  500. lock_kernel();
  501. msr = get_msr();
  502. set_msr(msr & ~MSR_EE); /* disable interrupts */
  504. if (regs->nip == (unsigned long)breakinst) {
  505. /* Skip over breakpoint trap insn */
  506. regs->nip += 4;
  507. }
  509. /* reply to host that an exception has occurred */
  510. sigval = computeSignal(regs->trap);
  511. ptr = remcomOutBuffer;
  513. #if 0
  514. *ptr++ = 'S';
  515. *ptr++ = hexchars[sigval >> 4];
  516. *ptr++ = hexchars[sigval & 0xf];
  517. #else
  518. *ptr++ = 'T';
  519. *ptr++ = hexchars[sigval >> 4];
  520. *ptr++ = hexchars[sigval & 0xf];
  521. *ptr++ = hexchars[PC_REGNUM >> 4];
  522. *ptr++ = hexchars[PC_REGNUM & 0xf];
  523. *ptr++ = ':';
  524. ptr = mem2hex((char *)&regs->nip, ptr, 4);
  525. *ptr++ = ';';
  526. *ptr++ = hexchars[SP_REGNUM >> 4];
  527. *ptr++ = hexchars[SP_REGNUM & 0xf];
  528. *ptr++ = ':';
  529. ptr = mem2hex(((char *)&regs) + SP_REGNUM*4, ptr, 4);
  530. *ptr++ = ';';
  531. #endif
  533. *ptr++ = 0;
  535. putpacket(remcomOutBuffer);
  537. /* XXX We may want to add some features dealing with poking the
  538.  * XXX page tables, ... (look at sparc-stub.c for more info)
  539.  * XXX also required hacking to the gdb sources directly...
  540.  */
  542. while (1) {
  543. remcomOutBuffer[0] = 0;
  545. getpacket(remcomInBuffer);
  546. switch (remcomInBuffer[0]) {
  547. case '?':               /* report most recent signal */
  548. remcomOutBuffer[0] = 'S';
  549. remcomOutBuffer[1] = hexchars[sigval >> 4];
  550. remcomOutBuffer[2] = hexchars[sigval & 0xf];
  551. remcomOutBuffer[3] = 0;
  552. break;
  553. #if 0
  554. case 'q': /* this screws up gdb for some reason...*/
  555. {
  556. extern long _start, sdata, __bss_start;
  558. ptr = &remcomInBuffer[1];
  559. if (strncmp(ptr, "Offsets", 7) != 0)
  560. break;
  562. ptr = remcomOutBuffer;
  563. sprintf(ptr, "Text=%8.8x;Data=%8.8x;Bss=%8.8x",
  564. &_start, &sdata, &__bss_start);
  565. break;
  566. }
  567. #endif
  568. case 'd':
  569. /* toggle debug flag */
  570. kdebug ^= 1;
  571. break;
  573. case 'g': /* return the value of the CPU registers.
  574.  * some of them are non-PowerPC names :(
  575.  * they are stored in gdb like:
  576.  * struct {
  577.  *     u32 gpr[32];
  578.  *     f64 fpr[32];
  579.  *     u32 pc, ps, cnd, lr; (ps=msr)
  580.  *     u32 cnt, xer, mq;
  581.  * }
  582.  */
  583. {
  584. int i;
  585. ptr = remcomOutBuffer;
  586. /* General Purpose Regs */
  587. ptr = mem2hex((char *)regs, ptr, 32 * 4);
  588. /* Floating Point Regs - FIXME */
  589. /*ptr = mem2hex((char *), ptr, 32 * 8);*/
  590. for(i=0; i<(32*8*2); i++) { /* 2chars/byte */
  591. ptr[i] = '0';
  592. }
  593. ptr += 32*8*2;
  594. /* pc, msr, cr, lr, ctr, xer, (mq is unused) */
  595. ptr = mem2hex((char *)&regs->nip, ptr, 4);
  596. ptr = mem2hex((char *)&regs->msr, ptr, 4);
  597. ptr = mem2hex((char *)&regs->ccr, ptr, 4);
  598. ptr = mem2hex((char *)&regs->link, ptr, 4);
  599. ptr = mem2hex((char *)&regs->ctr, ptr, 4);
  600. ptr = mem2hex((char *)&regs->xer, ptr, 4);
  601. }
  602. break;
  604. case 'G':   /* set the value of the CPU registers */
  605. {
  606. ptr = &remcomInBuffer[1];
  608. /*
  609.  * If the stack pointer has moved, you should pray.
  610.  * (cause only god can help you).
  611.  */
  613. /* General Purpose Regs */
  614. hex2mem(ptr, (char *)regs, 32 * 4);
  616. /* Floating Point Regs - FIXME?? */
  617. /*ptr = hex2mem(ptr, ??, 32 * 8);*/
  618. ptr += 32*8*2;
  620. /* pc, msr, cr, lr, ctr, xer, (mq is unused) */
  621. ptr = hex2mem(ptr, (char *)&regs->nip, 4);
  622. ptr = hex2mem(ptr, (char *)&regs->msr, 4);
  623. ptr = hex2mem(ptr, (char *)&regs->ccr, 4);
  624. ptr = hex2mem(ptr, (char *)&regs->link, 4);
  625. ptr = hex2mem(ptr, (char *)&regs->ctr, 4);
  626. ptr = hex2mem(ptr, (char *)&regs->xer, 4);
  628. strcpy(remcomOutBuffer,"OK");
  629. }
  630. break;
  631. case 'H':
  632. /* don't do anything, yet, just acknowledge */
  633. hexToInt(&ptr, &addr);
  634. strcpy(remcomOutBuffer,"OK");
  635. break;
  637. case 'm': /* mAA..AA,LLLL  Read LLLL bytes at address AA..AA */
  638. /* Try to read %x,%x.  */
  640. ptr = &remcomInBuffer[1];
  642. if (hexToInt(&ptr, &addr)
  643.     && *ptr++ == ','
  644.     && hexToInt(&ptr, &length)) {
  645. if (mem2hex((char *)addr, remcomOutBuffer,length))
  646. break;
  647. strcpy (remcomOutBuffer, "E03");
  648. } else {
  649. strcpy(remcomOutBuffer,"E01");
  650. }
  651. break;
  653. case 'M': /* MAA..AA,LLLL: Write LLLL bytes at address AA.AA return OK */
  654. /* Try to read '%x,%x:'.  */
  656. ptr = &remcomInBuffer[1];
  658. if (hexToInt(&ptr, &addr)
  659.     && *ptr++ == ','
  660.     && hexToInt(&ptr, &length)
  661.     && *ptr++ == ':') {
  662. if (hex2mem(ptr, (char *)addr, length)) {
  663. strcpy(remcomOutBuffer, "OK");
  664. } else {
  665. strcpy(remcomOutBuffer, "E03");
  666. }
  667. flush_icache_range(addr, addr+length);
  668. } else {
  669. strcpy(remcomOutBuffer, "E02");
  670. }
  671. break;
  674. case 'k':    /* kill the program, actually just continue */
  675. case 'c':    /* cAA..AA  Continue; address AA..AA optional */
  676. /* try to read optional parameter, pc unchanged if no parm */
  678. ptr = &remcomInBuffer[1];
  679. if (hexToInt(&ptr, &addr)) {
  680. regs->nip = addr;
  681. }
  683. /* Need to flush the instruction cache here, as we may have deposited a
  684.  * breakpoint, and the icache probably has no way of knowing that a data ref to
  685.  * some location may have changed something that is in the instruction cache.
  686.  */
  687. kgdb_flush_cache_all();
  688. set_msr(msr);
  689. kgdb_interruptible(1);
  690. unlock_kernel();
  691. kgdb_active = 0;
  692. return;
  694. case 's':
  695. kgdb_flush_cache_all();
  696. regs->msr |= MSR_SE;
  697. #if 0
  698. set_msr(msr | MSR_SE);
  699. #endif
  700. unlock_kernel();
  701. kgdb_active = 0;
  702. return;
  704. case 'r': /* Reset (if user process..exit ???)*/
  705. panic("kgdb reset.");
  706. break;
  707. } /* switch */
  708. if (remcomOutBuffer[0] && kdebug) {
  709. printk("remcomInBuffer: %sn", remcomInBuffer);
  710. printk("remcomOutBuffer: %sn", remcomOutBuffer);
  711. }
  712. /* reply to the request */
  713. putpacket(remcomOutBuffer);
  714. } /* while(1) */
  715. }
  717. /* This function will generate a breakpoint exception.  It is used at the
  718.    beginning of a program to sync up with a debugger and can be used
  719.    otherwise as a quick means to stop program execution and "break" into
  720.    the debugger. */
  722. void
  723. breakpoint(void)
  724. {
  725. if (!initialized) {
  726. printk("breakpoint() called b4 kgdb initn");
  727. return;
  728. }
  730. asm(" .globl breakinst
  731.      breakinst: .long 0x7d821008
  732.             ");
  733. }
  735. /* Output string in GDB O-packet format if GDB has connected. If nothing
  736.    output, returns 0 (caller must then handle output). */
  737. int
  738. kgdb_output_string (const char* s, unsigned int count)
  739. {
  740. char buffer[512];
  742.         if (!kgdb_started)
  743.             return 0;
  745. count = (count <= (sizeof(buffer) / 2 - 2)) 
  746. ? count : (sizeof(buffer) / 2 - 2);
  748. buffer[0] = 'O';
  749. mem2hex (s, &buffer[1], count);
  750. putpacket(buffer);
  752.         return 1;
  753.  }
  755. #ifndef CONFIG_8xx
  757. /* I don't know why other platforms don't need this.  The function for
  758.  * the 8xx is found in arch/ppc/8xx_io/uart.c.  -- Dan
  759.  */
  760. void
  761. kgdb_map_scc(void)
  762. {
  763. }
  764. #endif