gnssuser
/
GNSS_Nucleo
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Added user src folder with uart_it and printf files

Browse Source
master
gnssuser 4 weeks ago
parent 5fbda0a45c
commit e58426d8d3
8 changed files with 697 additions and 0 deletions
Show Stats Download Patch File Download Diff File

245
Core/user/printf.c
Unescape Escape View File

@ -0,0 +1,245 @@
/*
* Copyright (c) 2004,2012 Kustaa Nyholm / SpareTimeLabs
*
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without modification,
* are permitted provided that the following conditions are met:
*
* Redistributions of source code must retain the above copyright notice, this list
* of conditions and the following disclaimer.
*
* Redistributions in binary form must reproduce the above copyright notice, this
* list of conditions and the following disclaimer in the documentation and/or other
* materials provided with the distribution.
*
* Neither the name of the Kustaa Nyholm or SpareTimeLabs nor the names of its
* contributors may be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
* IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
* INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
* WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
* OF SUCH DAMAGE.
*/
#include "printf.h"
typedef void (*putcf) (void*,char);
static putcf stdout_putf;
static void* stdout_putp;
#ifdef PRINTF_LONG_SUPPORT
static void uli2a(unsigned long int num, unsigned int base, int uc,char * bf)
{
int n=0;
unsigned int d=1;
while (num/d >= base)
d*=base;
while (d!=0) {
int dgt = num / d;
num%=d;
d/=base;
if (n || dgt>0|| d==0) {
*bf++ = dgt+(dgt<10 ? '0' : (uc ? 'A' : 'a')-10);
++n;
}
}
*bf=0;
}
static void li2a (long num, char * bf)
{
if (num<0) {
num=-num;
*bf++ = '-';
}
uli2a(num,10,0,bf);
}
#endif
static void ui2a(unsigned int num, unsigned int base, int uc,char * bf)
{
int n=0;
unsigned int d=1;
while (num/d >= base)
d*=base;
while (d!=0) {
int dgt = num / d;
num%= d;
d/=base;
if (n || dgt>0 || d==0) {
*bf++ = dgt+(dgt<10 ? '0' : (uc ? 'A' : 'a')-10);
++n;
}
}
*bf=0;
}
static void i2a (int num, char * bf)
{
if (num<0) {
num=-num;
*bf++ = '-';
}
ui2a(num,10,0,bf);
}
static int a2d(char ch)
{
if (ch>='0' && ch<='9')
return ch-'0';
else if (ch>='a' && ch<='f')
return ch-'a'+10;
else if (ch>='A' && ch<='F')
return ch-'A'+10;
else return -1;
}
static char a2i(char ch, const char** src,int base,int* nump)
{
const char* p= *src;
int num=0;
int digit;
while ((digit=a2d(ch))>=0) {
if (digit>base) break;
num=num*base+digit;
ch=*p++;
}
*src=p;
*nump=num;
return ch;
}
static void putchw(void* putp,putcf putf,int n, char z, char* bf)
{
char fc=z? '0' : ' ';
char ch;
char* p=bf;
while (*p++ && n > 0)
n--;
while (n-- > 0)
putf(putp,fc);
while ((ch= *bf++))
putf(putp,ch);
}
void tfp_format(void* putp,putcf putf,const char *fmt, va_list va)
{
char bf[12];
char ch;
while ((ch=*(fmt++))) {
if (ch!='%')
putf(putp,ch);
else {
char lz=0;
#ifdef PRINTF_LONG_SUPPORT
char lng=0;
#endif
int w=0;
ch=*(fmt++);
if (ch=='0') {
ch=*(fmt++);
lz=1;
}
if (ch>='0' && ch<='9') {
ch=a2i(ch,&fmt,10,&w);
}
#ifdef PRINTF_LONG_SUPPORT
if (ch=='l') {
ch=*(fmt++);
lng=1;
}
#endif
switch (ch) {
case 0:
goto abort;
case 'u' : {
#ifdef PRINTF_LONG_SUPPORT
if (lng)
uli2a(va_arg(va, unsigned long int),10,0,bf);
else
#endif
ui2a(va_arg(va, unsigned int),10,0,bf);
putchw(putp,putf,w,lz,bf);
break;
}
case 'd' : {
#ifdef PRINTF_LONG_SUPPORT
if (lng)
li2a(va_arg(va, unsigned long int),bf);
else
#endif
i2a(va_arg(va, int),bf);
putchw(putp,putf,w,lz,bf);
break;
}
case 'x': case 'X' :
#ifdef PRINTF_LONG_SUPPORT
if (lng)
uli2a(va_arg(va, unsigned long int),16,(ch=='X'),bf);
else
#endif
ui2a(va_arg(va, unsigned int),16,(ch=='X'),bf);
putchw(putp,putf,w,lz,bf);
break;
case 'c' :
putf(putp,(char)(va_arg(va, int)));
break;
case 's' :
putchw(putp,putf,w,0,va_arg(va, char*));
break;
case '%' :
putf(putp,ch);
default:
break;
}
}
}
abort:;
}
void init_printf(void* putp,void (*putf) (void*,char))
{
stdout_putf=putf;
stdout_putp=putp;
}
void tfp_printf(const char *fmt, ...)
{
va_list va;
va_start(va,fmt);
tfp_format(stdout_putp,stdout_putf,fmt,va);
va_end(va);
}
static void putcp(void* p,char c)
{
*(*((char**)p))++ = c;
}
void tfp_sprintf(char* s,char *fmt, ...)
{
va_list va;
va_start(va,fmt);
tfp_format(&s,putcp,fmt,va);
putcp(&s,0);
va_end(va);
}

124
Core/user/printf.h
Unescape Escape View File

@ -0,0 +1,124 @@
/*
File: printf.h
Copyright (c) 2004,2012 Kustaa Nyholm / SpareTimeLabs
All rights reserved.
Redistribution and use in source and binary forms, with or without modification,
are permitted provided that the following conditions are met:
Redistributions of source code must retain the above copyright notice, this list
of conditions and the following disclaimer.
Redistributions in binary form must reproduce the above copyright notice, this
list of conditions and the following disclaimer in the documentation and/or other
materials provided with the distribution.
Neither the name of the Kustaa Nyholm or SpareTimeLabs nor the names of its
contributors may be used to endorse or promote products derived from this software
without specific prior written permission.
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY
OF SUCH DAMAGE.
----------------------------------------------------------------------
This library is realy just two files: 'printf.h' and 'printf.c'.
They provide a simple and small (+200 loc) printf functionality to
be used in embedded systems.
I've found them so usefull in debugging that I do not bother with a
debugger at all.
They are distributed in source form, so to use them, just compile them
into your project.
Two printf variants are provided: printf and sprintf.
The formats supported by this implementation are: 'd' 'u' 'c' 's' 'x' 'X'.
Zero padding and field width are also supported.
If the library is compiled with 'PRINTF_SUPPORT_LONG' defined then the
long specifier is also
supported. Note that this will pull in some long math routines (pun intended!)
and thus make your executable noticably longer.
The memory foot print of course depends on the target cpu, compiler and
compiler options, but a rough guestimate (based on a H8S target) is about
1.4 kB for code and some twenty 'int's and 'char's, say 60 bytes of stack space.
Not too bad. Your milage may vary. By hacking the source code you can
get rid of some hunred bytes, I'm sure, but personally I feel the balance of
functionality and flexibility versus code size is close to optimal for
many embedded systems.
To use the printf you need to supply your own character output function,
something like :
void putc ( void* p, char c)
{
while (!SERIAL_PORT_EMPTY) ;
SERIAL_PORT_TX_REGISTER = c;
}
Before you can call printf you need to initialize it to use your
character output function with something like:
init_printf(NULL,putc);
Notice the 'NULL' in 'init_printf' and the parameter 'void* p' in 'putc',
the NULL (or any pointer) you pass into the 'init_printf' will eventually be
passed to your 'putc' routine. This allows you to pass some storage space (or
anything realy) to the character output function, if necessary.
This is not often needed but it was implemented like that because it made
implementing the sprintf function so neat (look at the source code).
The code is re-entrant, except for the 'init_printf' function, so it
is safe to call it from interupts too, although this may result in mixed output.
If you rely on re-entrancy, take care that your 'putc' function is re-entrant!
The printf and sprintf functions are actually macros that translate to
'tfp_printf' and 'tfp_sprintf'. This makes it possible
to use them along with 'stdio.h' printf's in a single source file.
You just need to undef the names before you include the 'stdio.h'.
Note that these are not function like macros, so if you have variables
or struct members with these names, things will explode in your face.
Without variadic macros this is the best we can do to wrap these
fucnction. If it is a problem just give up the macros and use the
functions directly or rename them.
For further details see source code.
regs Kusti, 23.10.2004
*/
#ifndef __TFP_PRINTF__
#define __TFP_PRINTF__
#include <stdarg.h>
void init_printf(void* putp,void (*putf) (void*,char));
void tfp_printf(const char *fmt, ...);
void tfp_sprintf(char* s,char *fmt, ...);
void tfp_format(void* putp,void (*putf) (void*,char),const char *fmt, va_list va);
#define printf tfp_printf
#define sprintf tfp_sprintf
#endif

141
Core/user/usart2_it.c
Unescape Escape View File

@ -0,0 +1,141 @@
/***************************************************************************//**
* @file usart2_it.c
* @brief UART with interrupt and ring buffer
*//****************************************************************************/
#include "stm32f4xx_hal.h"
//------------------------------C library---------------------------------------
#include <stdlib.h>
//----------------------------user includes-------------------------------------
#include "usart2_it.h"
#include "usart2_it_cfg.h"
//------------------------------------------------------------------------------
/* Private typedefs ----------------------------------------------------------*/
/* Private macros ------------------------------------------------------------*/
//====== UART buffer defines ===================================================
#define USART2_RXBUF_MASK (USART2_RXBUF_SIZE - 1)
#define USART2_TXBUF_MASK (USART2_TXBUF_SIZE - 1)
#if ( USART2_RXBUF_SIZE & USART2_RXBUF_MASK )
#error RX buffer size is not a power of 2!
#endif
#if ( USART2_TXBUF_SIZE & USART2_TXBUF_MASK )
#error TX buffer size is not a power of 2!
#endif
/* Private variables ---------------------------------------------------------*/
//====== Variables for transmitter =============================================
static uint8_t Usart2TxBuf[USART2_TXBUF_SIZE];
static uint16_t Usart2TxWrIdx = 0;
static volatile uint16_t Usart2TxRdIdx = 0;
//====== Variables for Receiver ================================================
static uint8_t Usart2RxBuf[USART2_RXBUF_SIZE];
static volatile uint16_t Usart2RxWrIdx = 0;
static volatile uint16_t Usart2RxRdIdx = 0;
/* Public variables ----------------------------------------------------------*/
/* Functions -----------------------------------------------------------------*/
/***************************************************************************//**
* @brief USART2 init
*//****************************************************************************/
void Usart2_Init(void) {
USART2->CR1 |= USART_CR1_RXNEIE; // Enable RX interrupt
}
/***************************************************************************//**
* @brief USART2 interrupt handler
*//****************************************************************************/
void USART2_IRQHandler(void) {
uint32_t statusreg = USART2->SR; // read interrupt flags
if ((statusreg & USART_SR_RXNE)) { // RX interrupt
uint8_t d = USART2->DR; // read received byte
uint_fast16_t wr = Usart2RxWrIdx;
wr = (wr + 1) & USART2_RXBUF_MASK; // new write index
Usart2RxBuf[wr] = d; // received data to buffer
Usart2RxWrIdx = wr; // Store new index
}
if ((statusreg & USART_SR_TXE)) { // TX interrupt
uint_fast16_t rd = Usart2TxRdIdx;
uint_fast16_t wr = Usart2TxWrIdx;
if (wr != rd) { // data in buffer
rd = (rd + 1) & USART2_TXBUF_MASK; // new read index
USART2->DR = Usart2TxBuf[rd]; // send data byte
Usart2TxRdIdx = rd; // Store new index
if (wr == rd) { // data buffer empty
USART2->CR1 &= ~USART_CR1_TXEIE; // INT disable
}
}
}
}
/***************************************************************************//**
* @brief Send byte to UART
* @param d: byte to send
*//****************************************************************************/
void Usart2_PutByte(uint8_t d) {
uint_fast16_t wr = Usart2TxWrIdx;
wr = (wr + 1) & USART2_TXBUF_MASK; // new write index
if (wr == Usart2TxRdIdx) { // No free space in buffer (overflow)
return; // drop remaining data (Attention! Buffer overflow not signaled! Use bigger buffer)
}
Usart2TxBuf[wr] = d; // Store data in buffer
Usart2TxWrIdx = wr; // Store new index
USART2->CR1 |= USART_CR1_TXEIE; // Interrupt enable (start send)
}
/***************************************************************************//**
* @brief Send more data to UART
* @param src: data to send
* @param n: count of data
*//****************************************************************************/
void Usart2_PutData (void* src, uint16_t n) {
uint8_t* p = src;
uint_fast16_t wr = Usart2TxWrIdx;
while (n) {
wr = (wr + 1) & USART2_TXBUF_MASK; // new write index
if (wr == Usart2TxRdIdx) { // No free space in buffer (overflow)
break; // drop remaining data (Attention! Buffer overflow not signaled! Use bigger buffer)
}
Usart2TxBuf[wr] = *p; // Store data in buffer
p++;
n--;
}
Usart2TxWrIdx = wr; // Store new index
USART2->CR1 |= USART_CR1_TXEIE; // Interrupt enable (start send)
}
/***************************************************************************//**
* @brief Read data from UART RX buffer
* @return received character, -1: no data in RX buffer
*//****************************************************************************/
int16_t Usart2_GetByte(void) {
uint_fast16_t rd = Usart2RxRdIdx;
if (rd != Usart2RxWrIdx) { // new data in buffer
rd = (rd + 1) & USART2_RXBUF_MASK; // new read index
Usart2RxRdIdx = rd; // store new index
return Usart2RxBuf[rd]; // return with data
}else {
return -1; // buffer empty
}
}

13
Core/user/usart2_it.h
Unescape Escape View File

@ -0,0 +1,13 @@
#ifndef __USART2_IT_H__
#define __USART2_IT_H__
#include <stdint.h>
extern void Usart2_Init(void);
extern void Usart2_PutByte(uint8_t d);
extern void Usart2_PutData(void* src, uint16_t n);
extern int16_t Usart2_GetByte(void);
#endif

10
Core/user/usart2_it_cfg.h
Unescape Escape View File

@ -0,0 +1,10 @@
#ifndef __USART2_IT_CFG_H__
#define __USART2_IT_CFG_H__
#define USART2_RXBUF_SIZE 1024
#define USART2_TXBUF_SIZE 1024
#endif // __USART_CFG_H__

141
Core/user/usart6_it.c
Unescape Escape View File

@ -0,0 +1,141 @@
/***************************************************************************//**
* @file usart6_it.c
* @brief UART with interrupt and ring buffer
*//****************************************************************************/
#include "stm32f4xx_hal.h"
//------------------------------C library---------------------------------------
#include <stdlib.h>
//----------------------------user includes-------------------------------------
#include "usart6_it.h"
#include "usart6_it_cfg.h"
//------------------------------------------------------------------------------
/* Private typedefs ----------------------------------------------------------*/
/* Private macros ------------------------------------------------------------*/
//====== UART buffer defines ===================================================
#define USART6_RXBUF_MASK (USART6_RXBUF_SIZE - 1)
#define USART6_TXBUF_MASK (USART6_TXBUF_SIZE - 1)
#if ( USART6_RXBUF_SIZE & USART6_RXBUF_MASK )
#error RX buffer size is not a power of 2!
#endif
#if ( USART6_TXBUF_SIZE & USART6_TXBUF_MASK )
#error TX buffer size is not a power of 2!
#endif
/* Private variables ---------------------------------------------------------*/
//====== Variables for transmitter =============================================
static uint8_t Usart6TxBuf[USART6_TXBUF_SIZE];
static uint16_t Usart6TxWrIdx = 0;
static volatile uint16_t Usart6TxRdIdx = 0;
//====== Variables for Receiver ================================================
static uint8_t Usart6RxBuf[USART6_RXBUF_SIZE];
static volatile uint16_t Usart6RxWrIdx = 0;
static volatile uint16_t Usart6RxRdIdx = 0;
/* Public variables ----------------------------------------------------------*/
/* Functions -----------------------------------------------------------------*/
/***************************************************************************//**
* @brief USART6 init
*//****************************************************************************/
void Usart6_Init(void) {
USART6->CR1 |= USART_CR1_RXNEIE; // Enable RX interrupt
}
/***************************************************************************//**
* @brief USART6 interrupt handler
*//****************************************************************************/
void USART6_IRQHandler(void) {
uint32_t statusreg = USART6->SR; // read interrupt flags
if ((statusreg & USART_SR_RXNE)) { // RX interrupt
uint8_t d = USART6->DR; // read received byte
uint_fast16_t wr = Usart6RxWrIdx;
wr = (wr + 1) & USART6_RXBUF_MASK; // new write index
Usart6RxBuf[wr] = d; // received data to buffer
Usart6RxWrIdx = wr; // Store new index
}
if ((statusreg & USART_SR_TXE)) { // TX interrupt
uint_fast16_t rd = Usart6TxRdIdx;
uint_fast16_t wr = Usart6TxWrIdx;
if (wr != rd) { // data in buffer
rd = (rd + 1) & USART6_TXBUF_MASK; // new read index
USART6->DR = Usart6TxBuf[rd]; // send data byte
Usart6TxRdIdx = rd; // Store new index
if (wr == rd) { // data buffer empty
USART6->CR1 &= ~USART_CR1_TXEIE; // INT disable
}
}
}
}
/***************************************************************************//**
* @brief Send byte to UART
* @param d: byte to send
*//****************************************************************************/
void Usart6_PutByte(uint8_t d) {
uint_fast16_t wr = Usart6TxWrIdx;
wr = (wr + 1) & USART6_TXBUF_MASK; // new write index
if (wr == Usart6TxRdIdx) { // No free space in buffer (overflow)
return; // drop remaining data (Attention! Buffer overflow not signaled! Use bigger buffer)
}
Usart6TxBuf[wr] = d; // Store data in buffer
Usart6TxWrIdx = wr; // Store new index
USART6->CR1 |= USART_CR1_TXEIE; // Interrupt enable (start send)
}
/***************************************************************************//**
* @brief Send more data to UART
* @param src: data to send
* @param n: count of data
*//****************************************************************************/
void Usart6_PutData (void* src, uint16_t n) {
uint8_t* p = src;
uint_fast16_t wr = Usart6TxWrIdx;
while (n) {
wr = (wr + 1) & USART6_TXBUF_MASK; // new write index
if (wr == Usart6TxRdIdx) { // No free space in buffer (overflow)
break; // drop remaining data (Attention! Buffer overflow not signaled! Use bigger buffer)
}
Usart6TxBuf[wr] = *p; // Store data in buffer
p++;
n--;
}
Usart6TxWrIdx = wr; // Store new index
USART6->CR1 |= USART_CR1_TXEIE; // Interrupt enable (start send)
}
/***************************************************************************//**
* @brief Read data from UART RX buffer
* @return received character, -1: no data in RX buffer
*//****************************************************************************/
int16_t Usart6_GetByte(void) {
uint_fast16_t rd = Usart6RxRdIdx;
if (rd != Usart6RxWrIdx) { // new data in buffer
rd = (rd + 1) & USART6_RXBUF_MASK; // new read index
Usart6RxRdIdx = rd; // store new index
return Usart6RxBuf[rd]; // return with data
}else {
return -1; // buffer empty
}
}

13
Core/user/usart6_it.h
Unescape Escape View File

@ -0,0 +1,13 @@
#ifndef __USART6_IT_H__
#define __USART6_IT_H__
#include <stdint.h>
extern void Usart6_Init(void);
extern void Usart6_PutByte(uint8_t d);
extern void Usart6_PutData(void* src, uint16_t n);
extern int16_t Usart6_GetByte(void);
#endif

10
Core/user/usart6_it_cfg.h
Unescape Escape View File

@ -0,0 +1,10 @@
#ifndef __USART6_IT_CFG_H__
#define __USART6_IT_CFG_H__
#define USART6_RXBUF_SIZE 1024
#define USART6_TXBUF_SIZE 1024
#endif // __USART6_CFG_H__
Write Preview
Loading…
Cancel
Save