213 lines
7.3 KiB
C
213 lines
7.3 KiB
C
|
/**
|
||
|
|
* \file
|
||
|
|
* <!--
|
||
|
|
* This file is part of BeRTOS.
|
||
|
|
*
|
||
|
|
* Bertos 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., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
||
|
|
*
|
||
|
|
* As a special exception, you may use this file as part of a free software
|
||
|
|
* library without restriction. Specifically, if other files instantiate
|
||
|
|
* templates or use macros or inline functions from this file, or you compile
|
||
|
|
* this file and link it with other files to produce an executable, this
|
||
|
|
* file does not by itself cause the resulting executable to be covered by
|
||
|
|
* the GNU General Public License. This exception does not however
|
||
|
|
* invalidate any other reasons why the executable file might be covered by
|
||
|
|
* the GNU General Public License.
|
||
|
|
*
|
||
|
|
* Copyright 2003, 2004, 2005, 2006, 2007 Develer S.r.l. (http://www.develer.com/)
|
||
|
|
* Copyright 2000, 2001, 2002 Bernie Innocenti <bernie@codewiz.org>
|
||
|
|
* Copyright 2011 Onno <developer@gorgoz.org>
|
||
|
|
*
|
||
|
|
* -->
|
||
|
|
*
|
||
|
|
* \brief AVR XMega debug support (implementation).
|
||
|
|
*
|
||
|
|
* This file is heavily inspired by the AVR implementation for BeRTOS,
|
||
|
|
* but uses a different approach for implementing the different debug
|
||
|
|
* ports, by using the USART_t structs.
|
||
|
|
*
|
||
|
|
* \author Onno <developer@gorgoz.org>
|
||
|
|
* notest:all
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <hw/hw_cpufreq.h> /* for CPU_FREQ */
|
||
|
|
#include "hw/hw_ser.h" /* Required for bus macros overrides */
|
||
|
|
|
||
|
|
#include "cfg/cfg_debug.h" /* for debugging configuration settings */
|
||
|
|
#include <cfg/macros.h> /* for BV(), DIV_ROUND */
|
||
|
|
|
||
|
|
#include <cpu/types.h>
|
||
|
|
#include <cpu/attr.h>
|
||
|
|
|
||
|
|
#include <avr/io.h>
|
||
|
|
|
||
|
|
/* Set KDBG_USART, KDBG_USART_PORT and KDBG_USART_TX_PIN_bm
|
||
|
|
* according to the CONFIG_KDEBUG_PORT setting
|
||
|
|
* The Xmega A and D families support at least 2 UARTS
|
||
|
|
*/
|
||
|
|
#if CONFIG_KDEBUG_PORT == 0
|
||
|
|
#define KDBG_USART USARTC0
|
||
|
|
#define KDBG_USART_PORT PORTC
|
||
|
|
#define KDBG_USART_TX_PIN_bm PIN3_bm
|
||
|
|
#elif CONFIG_KDEBUG_PORT == 1
|
||
|
|
#define KDBG_USART USARTD0
|
||
|
|
#define KDBG_USART_PORT PORTD
|
||
|
|
#define KDBG_USART_TX_PIN_bm PIN3_bm
|
||
|
|
#endif
|
||
|
|
/* Allow the configuration of the extra 3 UARTS for the
|
||
|
|
* Xmega A family
|
||
|
|
*/
|
||
|
|
#ifdef CPU_AVR_XMEGA_A
|
||
|
|
#if CONFIG_KDEBUG_PORT == 2
|
||
|
|
#define KDBG_USART USARTC1
|
||
|
|
#define KDBG_USART_PORT PORTC
|
||
|
|
#define KDBG_USART_TX_PIN_bm PIN7_bm
|
||
|
|
#elif CONFIG_KDEBUG_PORT == 3
|
||
|
|
#define KDBG_USART USARTD1
|
||
|
|
#define KDBG_USART_PORT PORTD
|
||
|
|
#define KDBG_USART_TX_PIN_bm PIN7_bm
|
||
|
|
#elif CONFIG_KDEBUG_PORT == 4
|
||
|
|
#define KDBG_USART USARTE0
|
||
|
|
#define KDBG_USART_PORT PORTE
|
||
|
|
#define KDBG_USART_TX_PIN_bm PIN3_bm
|
||
|
|
#endif
|
||
|
|
#endif
|
||
|
|
/* Check if all required KDBG_ macros are defined
|
||
|
|
*/
|
||
|
|
#ifndef KDBG_USART
|
||
|
|
#if CPU_AVR_XMEGA_D
|
||
|
|
#error CONFIG_KDEBUG_PORT should be either 0 or 1
|
||
|
|
#elif CPU_AVR_XMEGA_A
|
||
|
|
#error CONFIG_KDEBUG_PORT should be either 0, 1, 2, 3 or 4
|
||
|
|
#endif
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Scalefactor to use for computing the baudrate
|
||
|
|
* this scalefactor should be an integer value between -7
|
||
|
|
* and 7
|
||
|
|
*/
|
||
|
|
#ifndef KDBG_USART_SCALE_FACTOR
|
||
|
|
#define KDBG_USART_SCALE_FACTOR (-7)
|
||
|
|
#else
|
||
|
|
#if KDBG_USART_SCALE_FACTOR > 7 || KDBG_USART_SCALE_FACTOR < -7
|
||
|
|
#error KDBG_USART_SCALE_FACTOR should be an integer between -7 and 7
|
||
|
|
#endif
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/*
|
||
|
|
* \name KDBG macros
|
||
|
|
*
|
||
|
|
* Used to set or alter the KDB_USART operation,
|
||
|
|
* enable the usart or send a byte.
|
||
|
|
* Some of these methods are called/included from kdbg_hw_init()
|
||
|
|
* others are called/included from the cpu independ kdebug implementation
|
||
|
|
* These macros are heavily imspired by the examples provided by atmel
|
||
|
|
*
|
||
|
|
* \{
|
||
|
|
*/
|
||
|
|
#define KDBG_SET_FORMAT(_charSize, _parityMode, _twoStopBits) \
|
||
|
|
(KDBG_USART).CTRLC = (uint8_t) _charSize | _parityMode | \
|
||
|
|
(_twoStopBits ? USART_SBMODE_bm : 0)
|
||
|
|
|
||
|
|
#define KDBG_SET_BAUDRATE(_bselValue, _bScaleFactor) \
|
||
|
|
(KDBG_USART).BAUDCTRLA =(uint8_t)_bselValue; \
|
||
|
|
(KDBG_USART).BAUDCTRLB =(_bScaleFactor << USART_BSCALE0_bp)|(_bselValue >> 8)
|
||
|
|
|
||
|
|
#define KDBG_TX_ENABLE() ((KDBG_USART).CTRLB |= USART_TXEN_bm)
|
||
|
|
|
||
|
|
#define KDBG_SET_MODE(_usartMode) \
|
||
|
|
((KDBG_USART).CTRLC = ((KDBG_USART).CTRLC & (~USART_CMODE_gm)) | _usartMode)
|
||
|
|
|
||
|
|
#define KDBG_WAIT_READY() do{ loop_until_bit_is_set((KDBG_USART).STATUS, USART_DREIF_bp); } while(0)
|
||
|
|
#define KDBG_WAIT_TXDONE() do { loop_until_bit_is_set((KDBG_USART).STATUS, USART_TXCIF_bp); } while(0)
|
||
|
|
#define KDBG_WRITE_CHAR(c) do { (KDBG_USART).DATA = (c); } while(0)
|
||
|
|
|
||
|
|
#define KDBG_SET_TX_INTERRUPTLEVEL(_txdIntLevel) \
|
||
|
|
(KDBG_USART).CTRLA = ((KDBG_USART).CTRLA & ~USART_TXCINTLVL_gm) | _txdIntLevel
|
||
|
|
|
||
|
|
#define KDBG_SET_DRE_INTERRUPTLEVEL(_dreIntLevel) \
|
||
|
|
(KDBG_USART).CTRLA = ((KDBG_USART).CTRLA & ~USART_DREINTLVL_gm) | _dreIntLevel
|
||
|
|
|
||
|
|
/*\}*/
|
||
|
|
|
||
|
|
/*
|
||
|
|
* To restore the USART state, to registers need to be restored
|
||
|
|
* These registers (CTRLA and CTRLB) can be saved to the
|
||
|
|
* kdbg_avr_xmaga_irqsave structure
|
||
|
|
*/
|
||
|
|
struct kdbg_avr_xmega_irqsave
|
||
|
|
{
|
||
|
|
uint8_t ctrlb;
|
||
|
|
uint8_t ctrla;
|
||
|
|
};
|
||
|
|
typedef struct kdbg_avr_xmega_irqsave kdbg_irqsave_t;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* param is the kdbg_irqsave_t structure
|
||
|
|
*
|
||
|
|
* * Stores the current state of the USART.CTRLA and
|
||
|
|
* the USART.CTRLB registers
|
||
|
|
* * Disables Transmit Complete and Date Register Empty interrupts
|
||
|
|
* * Enabled the transmitter
|
||
|
|
*/
|
||
|
|
#define KDBG_MASK_IRQ(old) do { \
|
||
|
|
(old).ctrlb = KDBG_USART.CTRLB; \
|
||
|
|
(old).ctrla = KDBG_USART.CTRLA; \
|
||
|
|
KDBG_SET_TX_INTERRUPTLEVEL(USART_TXCINTLVL_OFF_gc); \
|
||
|
|
KDBG_SET_DRE_INTERRUPTLEVEL(USART_DREINTLVL_OFF_gc); \
|
||
|
|
KDBG_TX_ENABLE(); \
|
||
|
|
} while(0)
|
||
|
|
|
||
|
|
/*
|
||
|
|
* param is the kdbg_irqsave_t structure
|
||
|
|
*
|
||
|
|
* * waits until all data has been transmitted
|
||
|
|
* * restores the USART.CTRLA and USART.CTRLB registers
|
||
|
|
*/
|
||
|
|
#define KDBG_RESTORE_IRQ(old) do { \
|
||
|
|
KDBG_WAIT_TXDONE(); \
|
||
|
|
KDBG_USART.CTRLB = (old).ctrlb; \
|
||
|
|
KDBG_USART.CTRLA = (old).ctrla; \
|
||
|
|
} while(0)
|
||
|
|
|
||
|
|
|
||
|
|
/*
|
||
|
|
* method included from the cpu independent kdebug.c file.
|
||
|
|
* it initializes KDBG_USART by:
|
||
|
|
* * Setting the KDBG_USART_TX_PIN_bm as an outputpin
|
||
|
|
* * Setting KDBG_USART to use 8 bits, No parity, 1 stopbit
|
||
|
|
* * Setting the baudrate to 115200
|
||
|
|
* * Enabeling the transmitter
|
||
|
|
*/
|
||
|
|
INLINE void kdbg_hw_init(void)
|
||
|
|
{
|
||
|
|
//set transmit pin as output
|
||
|
|
KDBG_USART_PORT.OUT = KDBG_USART_PORT.OUT & ~KDBG_USART_TX_PIN_bm;
|
||
|
|
KDBG_USART_PORT.DIRSET = KDBG_USART_TX_PIN_bm;
|
||
|
|
//set 8 bits, no parity, 1 stop bit
|
||
|
|
KDBG_SET_FORMAT(USART_CHSIZE_8BIT_gc, USART_PMODE_DISABLED_gc, false);
|
||
|
|
//compute and set the baud rate
|
||
|
|
/* Compute baud-rate period, this requires a valid USART_SCALE_FACTOR */
|
||
|
|
#if KDBG_USART_SCALE_FACTOR < 0
|
||
|
|
uint16_t bsel = DIV_ROUND((1 << (-(KDBG_USART_SCALE_FACTOR))) * (CPU_FREQ - (16 * CONFIG_KDEBUG_BAUDRATE)), 16 * CONFIG_KDEBUG_BAUDRATE);
|
||
|
|
#else
|
||
|
|
uint16_t bsel = DIV_ROUND(CPU_FREQ, (1 << (KDBG_USART_SCALE_FACTOR)) * 16 * CONFIG_KDEBUG_BAUDRATE) - 1;
|
||
|
|
#endif
|
||
|
|
KDBG_SET_BAUDRATE(bsel, KDBG_USART_SCALE_FACTOR);
|
||
|
|
//enable the Transmitter
|
||
|
|
KDBG_TX_ENABLE();
|
||
|
|
}
|