forked from pichenettes/avril
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathdebug_output.h
101 lines (86 loc) · 2.65 KB
/
debug_output.h
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
// Copyright 2011 Peter Kvitek
//
// Author: Peter Kvitek ([email protected])
//
// This program is free software: you can redistribute it and/or modify
// it under the terms of the GNU General Public License as published by
// the Free Software Foundation, either version 3 of the License, or
// (at your option) any later version.
// This program is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
// GNU General Public License for more details.
// You should have received a copy of the GNU General Public License
// along with this program. If not, see <http://www.gnu.org/licenses/>.
//
// -----------------------------------------------------------------------------
//
// Serial debug output. Supports USART and software serial, both vanilla and buffered.
//
// Overrides stdout so printf("Hello world"), putc() etc. all do the right thing.
//
// * USART output declaration:
//
// DebugOutput< Serial<SerialPort0, 57600, DISABLED, POLLED> > dbg;
//
// * Software serial declaration: (see software_serial.h)
//
// DebugOutput< SoftwareSerialOutput< Gpio<PortD, 1>, 57600> > dbg;
//
// * Buffered software serial declaration:
//
// typedef BufferedSoftwareSerialOutput< Gpio<PortD, 1>, 31250, 2400, 32> DbgOutput;
//
// DebugOutput<DbgOutput> dbg;
//
// void InitTimer2() {
// Timer<2>::set_prescaler(3);
// Timer<2>::set_mode(TIMER_CTC);
// TIMSK2|= (1 << OCIE2A);
// OCR2A = 19; // for prescaler 32 @ 20MHz
// Timer<2>::Start();
// }
//
// ISR(TIMER2_COMPA_vect)
// {
// DbgOutput::Tick(); // called at 31250 kHz
// }
#ifndef AVRLIB_DEBUG_OUTPUT_H_
#define AVRLIB_DEBUG_OUTPUT_H_
#include <stdio.h>
#include <avr/io.h>
#include "avrlib/serial.h"
namespace avrlib {
template<typename SerialT, bool ensureCRLF = false>
class DebugOutput {
public:
DebugOutput() { }
static void Init() {
SerialT::Init();
stdout = &dbg_stdout_;
}
static inline void Write(char c) {
if (ensureCRLF && c == '\n') {
SerialT::Write('\r');
}
SerialT::Write(c);
}
static inline void Write(char* s) {
while (*s) {
Write(*s++);
}
}
private:
static FILE dbg_stdout_;
static int dbg_putchar(char c, FILE* stream) {
Write(c);
return 0;
}
DISALLOW_COPY_AND_ASSIGN(DebugOutput);
};
// Static variables created for each instance
template<typename SerialT, bool ensureCRLF>
FILE DebugOutput<SerialT, ensureCRLF>::dbg_stdout_ =
{ 0, 0, _FDEV_SETUP_WRITE, 0, 0, DebugOutput<SerialT, ensureCRLF>::dbg_putchar, NULL, 0 };
} // namespace avrlib
#endif // AVRLIB_DEBUG_OUTPUT_H_