mirror of
https://bitbucket.org/librepilot/librepilot.git
synced 2024-12-05 13:24:11 +01:00
150 lines
4.6 KiB
C
150 lines
4.6 KiB
C
/***************************************************************************
|
|
* Copyright (C) 2008 by Dominic Rath *
|
|
* Dominic.Rath@gmx.de *
|
|
* Copyright (C) 2008 by Spencer Oliver *
|
|
* spen@spen-soft.co.uk *
|
|
* Copyright (C) 2008 by Frederik Kriewtz *
|
|
* frederik@kriewitz.eu *
|
|
* *
|
|
* 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 2 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, write to the *
|
|
* Free Software Foundation, Inc., *
|
|
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
|
|
***************************************************************************/
|
|
|
|
#include "inc/dcc_stdio.h"
|
|
|
|
#define TARGET_REQ_TRACEMSG 0x00
|
|
#define TARGET_REQ_DEBUGMSG_ASCII 0x01
|
|
#define TARGET_REQ_DEBUGMSG_HEXMSG(size) (0x01 | ((size & 0xff) << 8))
|
|
#define TARGET_REQ_DEBUGCHAR 0x02
|
|
|
|
/* we use the cortex_m3 DCRDR reg to simulate a arm7_9 dcc channel
|
|
* DCRDR[7:0] is used by target for status
|
|
* DCRDR[15:8] is used by target for write buffer
|
|
* DCRDR[23:16] is used for by host for status
|
|
* DCRDR[31:24] is used for by host for write buffer */
|
|
|
|
#define NVIC_DBG_DATA_R (*((volatile unsigned short *)0xE000EDF8))
|
|
|
|
#define BUSY 1
|
|
|
|
void dbg_write(unsigned long dcc_data)
|
|
{
|
|
int len = 4;
|
|
|
|
while (len--) {
|
|
/* wait for data ready */
|
|
while (NVIC_DBG_DATA_R & BUSY) {
|
|
;
|
|
}
|
|
|
|
/* write our data and set write flag - tell host there is data*/
|
|
NVIC_DBG_DATA_R = (unsigned short)(((dcc_data & 0xff) << 8) | BUSY);
|
|
dcc_data >>= 8;
|
|
}
|
|
}
|
|
|
|
void dbg_trace_point(unsigned long number)
|
|
{
|
|
dbg_write(TARGET_REQ_TRACEMSG | (number << 8));
|
|
}
|
|
|
|
void dbg_write_u32(const unsigned long *val, long len)
|
|
{
|
|
dbg_write(TARGET_REQ_DEBUGMSG_HEXMSG(4) | ((len & 0xffff) << 16));
|
|
|
|
while (len > 0) {
|
|
dbg_write(*val);
|
|
|
|
val++;
|
|
len--;
|
|
}
|
|
}
|
|
|
|
void dbg_write_u16(const unsigned short *val, long len)
|
|
{
|
|
unsigned long dcc_data;
|
|
|
|
dbg_write(TARGET_REQ_DEBUGMSG_HEXMSG(2) | ((len & 0xffff) << 16));
|
|
|
|
while (len > 0) {
|
|
dcc_data = val[0]
|
|
| ((len > 1) ? val[1] << 16 : 0x0000);
|
|
|
|
dbg_write(dcc_data);
|
|
|
|
val += 2;
|
|
len -= 2;
|
|
}
|
|
}
|
|
|
|
void dbg_write_u8(const unsigned char *val, long len)
|
|
{
|
|
unsigned long dcc_data;
|
|
|
|
dbg_write(TARGET_REQ_DEBUGMSG_HEXMSG(1) | ((len & 0xffff) << 16));
|
|
|
|
while (len > 0) {
|
|
dcc_data = val[0]
|
|
| ((len > 1) ? val[1] << 8 : 0x00)
|
|
| ((len > 2) ? val[2] << 16 : 0x00)
|
|
| ((len > 3) ? val[3] << 24 : 0x00);
|
|
|
|
dbg_write(dcc_data);
|
|
|
|
val += 4;
|
|
len -= 4;
|
|
}
|
|
}
|
|
|
|
void dbg_write_str(const char *msg)
|
|
{
|
|
long len;
|
|
unsigned long dcc_data;
|
|
|
|
for (len = 0; msg[len] && (len < 65536); len++) {
|
|
;
|
|
}
|
|
|
|
dbg_write(TARGET_REQ_DEBUGMSG_ASCII | ((len & 0xffff) << 16));
|
|
|
|
while (len > 0) {
|
|
dcc_data = msg[0]
|
|
| ((len > 1) ? msg[1] << 8 : 0x00)
|
|
| ((len > 2) ? msg[2] << 16 : 0x00)
|
|
| ((len > 3) ? msg[3] << 24 : 0x00);
|
|
dbg_write(dcc_data);
|
|
|
|
msg += 4;
|
|
len -= 4;
|
|
}
|
|
}
|
|
|
|
void dbg_write_char(char msg)
|
|
{
|
|
dbg_write(TARGET_REQ_DEBUGCHAR | ((msg & 0xff) << 16));
|
|
}
|
|
|
|
void dbg_write_hex32(const unsigned long val)
|
|
{
|
|
static const char hextab[] = {
|
|
'0', '1', '2', '3', '4', '5', '6', '7',
|
|
'8', '9', 'a', 'b', 'c', 'd', 'e', 'f'
|
|
};
|
|
|
|
for (int shift = 28; shift >= 0; shift -= 4) {
|
|
dbg_write_char(hextab[(val >> shift) & 0xf]);
|
|
}
|
|
}
|