1 /******************************************************************************

     2 *

     3 *           msr_io.c

     4 *

     5 *           Debugging über Serielle Schnittstelle

     6 *           

     7 *           Autoren: Wilhelm Hagemeister

     8 *

     9 *           $LastChangedDate: 2005-09-16 17:45:46 +0200 (Fri, 16 Sep 2005) $

    10 *           $Author: hm $

    11 *

    12 *           (C) Copyright IgH 2005

    13 *           Ingenieurgemeinschaft IgH

    14 *           Heinz-Bäcker Str. 34

    15 *           D-45356 Essen

    16 *           Tel.: +49 201/61 99 31

    17 *           Fax.: +49 201/61 98 36

    18 *           E-mail: sp@igh-essen.com

    19 *

    20 * /bin/setserial /dev/ttyS0 uart none

    21 * /bin/setserial /dev/ttyS1 uart none

    22 *

    23 *

    24 ******************************************************************************/

    25 

    26 /*--Includes-----------------------------------------------------------------*/

    27 

    28 #include <linux/module.h>

    29 #include <linux/tqueue.h>

    30 #include <linux/slab.h>

    31 #include <linux/delay.h>

    32 #include <linux/spinlock.h>

    33 

    34 #include "aip_com.h"

    35 #include "rs232dbg.h"

    36 #include <rtai.h>

    37 

    38 spinlock_t rs232wlock;

    39 

    40 

    41 void SDBG_print(const char *format, ...) 

    42 {

    43     va_list argptr;  

    44     static char buf[1024];                               

    45     int len;

    46     if(format != NULL) {

    47 	va_start(argptr,format); 

    48 	len = vsnprintf(buf, sizeof(buf), format, argptr);

    49         if (len > 0 && buf[len - 1] == '\n') len--; // fp

    50 	rt_com_write(0,buf,len);

    51 	rt_com_write(0,"\r\n",2);

    52 	va_end(argptr); 

    53     }

    54 }

    55 

    56 /*

    57 void SDBG_print(unsigned char *buf)

    58 {

    59     static int counter = 0;

    60     unsigned char cbuf[20];

    61     unsigned long flags;

    62 

    63 //    flags = rt_spin_lock_irqsave (&rs232wlock);

    64 

    65     sprintf(cbuf,"%0d -- ",counter);

    66     rt_com_write(0,cbuf,strlen(cbuf));

    67     rt_com_write(0,buf,strlen(buf));

    68     rt_com_write(0,"\r\n",2);

    69     counter++;

    70     counter %= 10; //did we miss frames ??

    71 //    rt_spin_unlock_irqrestore (&rs232wlock,flags);

    72 }

    73 */

    74 

    75 

    76 /*

    77 *******************************************************************************

    78 *

    79 * Function: msr_init

    80 *

    81 * Beschreibung: MSR initialisieren

    82 *

    83 * Parameter:

    84 *

    85 * Rückgabe: 

    86 *               

    87 * Status: exp

    88 *

    89 *******************************************************************************

    90 */

    91 

    92 int msr_init(void)

    93 {   

    94     spin_lock_init (&rs2323wlock);

    95 

    96     printk("starting RS232 Setup\n");

    97     if(init_aip_com())

    98     {

    99 	printk("RS232 Setup failed\n");

   100 	return -1;

   101     }

   102 

   103     SDBG_print("Hello Word, Serial Debugger started...");

   104     mdelay(10);

   105     return 0;

   106 }

   107 

   108 /*

   109 *******************************************************************************

   110 *

   111 * Function: msr_io_cleanup

   112 *

   113 * Beschreibung: Aufräumen

   114 *

   115 * Parameter:

   116 *

   117 * Rückgabe: 

   118 *               

   119 * Status: exp

   120 *

   121 *******************************************************************************

   122 */

   123 

   124 void msr_io_cleanup(void)

   125 {

   126   cleanup_aip_com();

   127 }

   128 

   129 /*---Treiber-Einsprungspunkte etc.-------------------------------------------*/

   130 

   131 MODULE_LICENSE("GPL");

   132 

   133 module_init(msr_init);

   134 module_exit(msr_io_cleanup);

   135 

   136 /*---Ende--------------------------------------------------------------------*/