usart.c 4.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152
  1. /*----------------------------------------------------------------------------
  2. Copyright: Radig Ulrich mailto: mail@ulrichradig.de
  3. Author: Radig Ulrich
  4. Remarks:
  5. known Problems: none
  6. Version: 24.10.2007
  7. Description: RS232 Routinen
  8. Dieses Programm ist freie Software. Sie können es unter den Bedingungen der
  9. GNU General Public License, wie von der Free Software Foundation veröffentlicht,
  10. weitergeben und/oder modifizieren, entweder gemäß Version 2 der Lizenz oder
  11. (nach Ihrer Option) jeder späteren Version.
  12. Die Veröffentlichung dieses Programms erfolgt in der Hoffnung,
  13. daß es Ihnen von Nutzen sein wird, aber OHNE IRGENDEINE GARANTIE,
  14. sogar ohne die implizite Garantie der MARKTREIFE oder der VERWENDBARKEIT
  15. FÜR EINEN BESTIMMTEN ZWECK. Details finden Sie in der GNU General Public License.
  16. Sie sollten eine Kopie der GNU General Public License zusammen mit diesem
  17. Programm erhalten haben.
  18. Falls nicht, schreiben Sie an die Free Software Foundation,
  19. Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
  20. ------------------------------------------------------------------------------*/
  21. #include "usart.h"
  22. //----------------------------------------------------------------------------
  23. //Init serielle Schnittstelle
  24. void usart_init(unsigned long baudrate)
  25. {
  26. //Serielle Schnittstelle 1
  27. //Enable TXEN im Register UCR TX-Data Enable
  28. UCR =(1 << TXEN | 1 << RXEN | 1<< RXCIE);
  29. // 0 = Parity Mode Disabled
  30. // 1 = Parity Mode Enabled, Even Parity
  31. // 2 = Parity Mode Enabled, Odd Parity
  32. //UCSRC = 0x06 + ((parity+1)<<4);
  33. //UCSRC |= (1<<USBS);
  34. //Teiler wird gesetzt
  35. UBRR=(F_CPU / (baudrate * 16L) - 1);
  36. }
  37. //----------------------------------------------------------------------------
  38. //Routine für die Serielle Ausgabe eines Zeichens (Schnittstelle0)
  39. void usart_write_char(char c)
  40. {
  41. //Warten solange bis Zeichen gesendet wurde
  42. while(!(USR & (1<<UDRE)));
  43. //Ausgabe des Zeichens
  44. UDR = c;
  45. return;
  46. }
  47. //------------------------------------------------------------------------------
  48. void usart_write_P (const char *Buffer,...)
  49. {
  50. va_list ap;
  51. va_start (ap, Buffer);
  52. int format_flag;
  53. char str_buffer[10];
  54. char str_null_buffer[10];
  55. char move = 0;
  56. char Base = 0;
  57. int tmp = 0;
  58. char by;
  59. char *ptr;
  60. //Ausgabe der Zeichen
  61. for(;;)
  62. {
  63. by = pgm_read_byte(Buffer++);
  64. if(by==0) break; // end of format string
  65. if (by == '%')
  66. {
  67. by = pgm_read_byte(Buffer++);
  68. if (isdigit(by)>0)
  69. {
  70. str_null_buffer[0] = by;
  71. str_null_buffer[1] = '\0';
  72. move = atoi(str_null_buffer);
  73. by = pgm_read_byte(Buffer++);
  74. }
  75. switch (by)
  76. {
  77. case 's':
  78. ptr = va_arg(ap,char *);
  79. while(*ptr) { usart_write_char(*ptr++); }
  80. break;
  81. case 'b':
  82. Base = 2;
  83. goto ConversionLoop;
  84. case 'c':
  85. //Int to char
  86. format_flag = va_arg(ap,int);
  87. usart_write_char (format_flag++);
  88. break;
  89. case 'i':
  90. Base = 10;
  91. goto ConversionLoop;
  92. case 'o':
  93. Base = 8;
  94. goto ConversionLoop;
  95. case 'x':
  96. Base = 16;
  97. //****************************
  98. ConversionLoop:
  99. //****************************
  100. itoa(va_arg(ap,int),str_buffer,Base);
  101. int b=0;
  102. while (str_buffer[b++] != 0){};
  103. b--;
  104. if (b<move)
  105. {
  106. move -=b;
  107. for (tmp = 0;tmp<move;tmp++)
  108. {
  109. str_null_buffer[tmp] = '0';
  110. }
  111. //tmp ++;
  112. str_null_buffer[tmp] = '\0';
  113. strcat(str_null_buffer,str_buffer);
  114. strcpy(str_buffer,str_null_buffer);
  115. }
  116. usart_write_str (str_buffer);
  117. move =0;
  118. break;
  119. }
  120. }
  121. else
  122. {
  123. usart_write_char ( by );
  124. }
  125. }
  126. va_end(ap);
  127. }
  128. //----------------------------------------------------------------------------
  129. //Ausgabe eines Strings
  130. void usart_write_str(char *str)
  131. {
  132. while (*str)
  133. {
  134. usart_write_char(*str++);
  135. }
  136. }