andrey
/
Marlin_FB4S
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
Browse Source

Pretty up Print.* within CMSIS

pull/1/head
Scott Lahteine 7 years ago
parent
c46de340b7
commit
dbd2189945
2 changed files with 155 additions and 284 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Unified View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 290
      frameworks/CMSIS/LPC1768/lib/Print.cpp
  2. 53
      frameworks/CMSIS/LPC1768/lib/Print.h

290
frameworks/CMSIS/LPC1768/lib/Print.cpp
View File

@ -1,23 +1,24 @@
/* /**
Print.cpp - Base class that provides print() and println() * Print.cpp - Base class that provides print() and println()
Copyright (c) 2008 David A. Mellis. All right reserved. * Copyright (c) 2008 David A. Mellis. All right reserved.
*
This library is free software; you can redistribute it and/or * This library is free software; you can redistribute it and/or
modify it under the terms of the GNU Lesser General Public * modify it under the terms of the GNU Lesser General Public
License as published by the Free Software Foundation; either * License as published by the Free Software Foundation; either
version 2.1 of the License, or (at your option) any later version. * version 2.1 of the License, or (at your option) any later version.
*
This library is distributed in the hope that it will be useful, * This library is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of * but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
Lesser General Public License for more details. * Lesser General Public License for more details.
*
You should have received a copy of the GNU Lesser General Public * You should have received a copy of the GNU Lesser General Public
License along with this library; if not, write to the Free Software * License along with this library; if not, write to the Free Software
Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
*
Modified 23 November 2006 by David A. Mellis * Modified 23 November 2006 by David A. Mellis
Modified 03 August 2015 by Chuck Todd * Modified 03 August 2015 by Chuck Todd
* Modified 03 February 2018 by Scott Lahteine
*/ */
#include <stdlib.h> #include <stdlib.h>
@ -28,16 +29,12 @@
#include "Print.h" #include "Print.h"
#include <stdarg.h> #include <stdarg.h>
#define PrintfEnable 1 #define ENABLE_PRINTF
typedef signed short sint16_t;
typedef signed long sint32_t;
// Public Methods ////////////////////////////////////////////////////////////// // Public Methods //////////////////////////////////////////////////////////////
/* default implementation: may be overridden */ /* default implementation: may be overridden */
size_t Print::write(const uint8_t *buffer, size_t size) size_t Print::write(const uint8_t *buffer, size_t size) {
{
size_t n = 0; size_t n = 0;
while (size--) { while (size--) {
if (write(*buffer++)) n++; if (write(*buffer++)) n++;
@ -46,133 +43,46 @@ size_t Print::write(const uint8_t *buffer, size_t size)
return n; return n;
} }
size_t Print::print(const char str[]) { return write(str); }
size_t Print::print(char c) { return write(c); }
size_t Print::print(unsigned char b, int base) { return print((unsigned long) b, base); }
size_t Print::print(int n, int base) { return print((long) n, base); }
size_t Print::print(unsigned int n, int base) { return print((unsigned long) n, base); }
size_t Print::print(double n, int digits) { return printFloat(n, digits); }
size_t Print::print(const Printable& x) { return x.printTo(*this); }
size_t Print::println(void) { return write("\r\n"); }
size_t Print::print(const char str[]) size_t Print::print(long n, int base) {
{ if (base == 0) return write(n);
if (base == 10) {
//while(1);
return write(str);
}
size_t Print::print(char c)
{
return write(c);
}
size_t Print::print(unsigned char b, int base)
{
return print((unsigned long) b, base);
}
size_t Print::print(int n, int base)
{
return print((long) n, base);
}
size_t Print::print(unsigned int n, int base)
{
return print((unsigned long) n, base);
}
size_t Print::print(long n, int base)
{
if (base == 0) {
return write(n);
} else if (base == 10) {
if (n < 0) { if (n < 0) {
int t = print('-'); const int t = print('-');
n = -n; return printNumber(-n, 10) + t;
return printNumber(n, 10) + t;
} }
return printNumber(n, 10);
} else {
return printNumber(n, base);
} }
return printNumber(n, base);
} }
size_t Print::print(unsigned long n, int base) size_t Print::print(unsigned long n, int base) {
{
if (base == 0) return write(n); if (base == 0) return write(n);
else return printNumber(n, base); return printNumber(n, base);
}
size_t Print::print(double n, int digits)
{
return printFloat(n, digits);
}
size_t Print::print(const Printable& x)
{
return x.printTo(*this);
}
size_t Print::println(void)
{
return write("\r\n");
}
size_t Print::println(const char c[])
{
size_t n = print(c);
n += println();
return n;
}
size_t Print::println(char c)
{
size_t n = print(c);
n += println();
return n;
}
size_t Print::println(unsigned char b, int base)
{
size_t n = print(b, base);
n += println();
return n;
}
size_t Print::println(int num, int base)
{
size_t n = print(num, base);
n += println();
return n;
}
size_t Print::println(unsigned int num, int base)
{
size_t n = print(num, base);
n += println();
return n;
}
size_t Print::println(long num, int base)
{
size_t n = print(num, base);
n += println();
return n;
}
size_t Print::println(unsigned long num, int base)
{
size_t n = print(num, base);
n += println();
return n;
} }
size_t Print::println(double num, int digits) #define PRINTLN(...) do{ \
{ size_t n = print(__VA_ARGS__); \
size_t n = print(num, digits); n += println(); \
n += println(); return n; \
return n; }while(0)
}
size_t Print::println(const Printable& x) size_t Print::println(const char c[]) { PRINTLN(c); }
{ size_t Print::println(char c) { PRINTLN(c); }
size_t n = print(x); size_t Print::println(unsigned char b, int base) { PRINTLN(b, base); }
n += println(); size_t Print::println(int num, int base) { PRINTLN(num, base); }
return n; size_t Print::println(unsigned int num, int base) { PRINTLN(num, base); }
} size_t Print::println(long num, int base) { PRINTLN(num, base); }
size_t Print::println(unsigned long num, int base) { PRINTLN(num, base); }
size_t Print::println(double num, int digits) { PRINTLN(num, digits); }
size_t Print::println(const Printable& x) { PRINTLN(x); }
// Private Methods ///////////////////////////////////////////////////////////// // Private Methods /////////////////////////////////////////////////////////////
@ -195,8 +105,7 @@ size_t Print::printNumber(unsigned long n, uint8_t base) {
return write(str); return write(str);
} }
size_t Print::printFloat(double number, uint8_t digits) size_t Print::printFloat(double number, uint8_t digits) {
{
size_t n = 0; size_t n = 0;
if (isnan(number)) return print("nan"); if (isnan(number)) return print("nan");
@ -205,34 +114,29 @@ size_t Print::printFloat(double number, uint8_t digits)
if (number <-4294967040.0) return print ("ovf"); // constant determined empirically if (number <-4294967040.0) return print ("ovf"); // constant determined empirically
// Handle negative numbers // Handle negative numbers
if (number < 0.0) if (number < 0.0) {
{
n += print('-'); n += print('-');
number = -number; number = -number;
} }
// Round correctly so that print(1.999, 2) prints as "2.00" // Round correctly so that print(1.999, 2) prints as "2.00"
double rounding = 0.5; double rounding = 0.5;
for (uint8_t i=0; i<digits; ++i) for (uint8_t i = 0; i < digits; ++i) rounding /= 10.0;
rounding /= 10.0;
number += rounding; number += rounding;
// Extract the integer part of the number and print it // Extract the integer part of the number and print it
unsigned long int_part = (unsigned long)number; uint32_t int_part = (uint32_t)number;
double remainder = number - (double)int_part; double remainder = number - (double)int_part;
n += print(int_part); n += print(int_part);
// Print the decimal point, but only if there are digits beyond // Print the decimal point, but only if there are digits beyond
if (digits > 0) { if (digits > 0) n += print('.');
n += print(".");
}
// Extract digits from the remainder one at a time // Extract digits from the remainder one at a time
while (digits-- > 0) while (digits-- > 0) {
{
remainder *= 10.0; remainder *= 10.0;
int toPrint = int(remainder); const int toPrint = int(remainder);
n += print(toPrint); n += print(toPrint);
remainder -= toPrint; remainder -= toPrint;
} }
@ -240,15 +144,14 @@ size_t Print::printFloat(double number, uint8_t digits)
return n; return n;
} }
#ifdef ENABLE_PRINTF
#if (PrintfEnable == 1) size_t Print::printf(const char *argList, ...) {
size_t Print::printf(const char *argList, ...)
{
const char *ptr; const char *ptr;
double floatNum_f32; double floatNum_f32;
va_list argp; va_list argp;
sint16_t num_s16; int16_t num_s16;
sint32_t num_s32; int32_t num_s32;
uint16_t num_u16; uint16_t num_u16;
uint32_t num_u32; uint32_t num_u32;
char *str; char *str;
@ -257,103 +160,76 @@ size_t Print::printf(const char *argList, ...)
va_start(argp, argList); va_start(argp, argList);
/* Loop through the list to extract all the input arguments */ // Loop through the list to extract all the input arguments
for(ptr = argList; *ptr != '\0'; ptr++) for (ptr = argList; (ch = *ptr); ptr++) {
{ if (ch == '%') { //Check for '%' as there will be format specifier after it
ch= *ptr;
if(ch == '%') /*Check for '%' as there will be format specifier after it */
{
ptr++; ptr++;
ch = *ptr; ch = *ptr;
if((ch>=0x30) && (ch<=0x39)) if (ch >= '0' && ch <= '9') {
{
numOfDigits = 0; numOfDigits = 0;
while((ch>=0x30) && (ch<=0x39)) while (ch >= '0' && ch <= '9') {
{ numOfDigits = numOfDigits * 10 + ch - '0';
numOfDigits = (numOfDigits * 10) + (ch-0x30);
ptr++; ptr++;
ch = *ptr; ch = *ptr;
} }
} }
else else
{ numOfDigits = 0xFF;
numOfDigits = 0xff;
}
switch(ch) { // Decode the type of the argument
switch(ch) /* Decode the type of the argument */
{
case 'C': case 'C':
case 'c': /* Argument type is of char, hence read char data from the argp */ case 'c': // Argument type is of char, hence read char data from the argp
ch = va_arg(argp, int); ch = va_arg(argp, int);
print(ch); print(ch);
break; break;
case 'd': // Argument type is of signed integer, hence read 16bit data from the argp
case 'd': /* Argument type is of signed integer, hence read 16bit data from the argp */
case 'D': case 'D':
num_s32 = va_arg(argp, int); num_s32 = va_arg(argp, int);
print(num_s32, 10); print(num_s32, 10);
break; break;
case 'u': case 'u':
case 'U': /* Argument type is of integer, hence read 32bit unsigend data */ case 'U': // Argument type is of integer, hence read 32bit unsigend data
num_u32 = va_arg(argp, uint32_t); num_u32 = va_arg(argp, uint32_t);
print(num_u32, 10); print(num_u32, 10);
break; break;
case 'x': case 'x':
case 'X': /* Argument type is of hex, hence hexadecimal data from the argp */ case 'X': // Argument type is of hex, hence hexadecimal data from the argp
num_u32 = va_arg(argp, uint32_t); num_u32 = va_arg(argp, uint32_t);
print(num_u32, 16); print(num_u32, 16);
break; break;
case 'b': case 'b':
case 'B': /* Argument type is of binary,Read int and convert to binary */ case 'B': // Argument type is of binary,Read int and convert to binary
num_u32 = va_arg(argp, uint32_t); num_u32 = va_arg(argp, uint32_t);
print(num_u32, 2); print(num_u32, 2);
break; break;
case 'F': case 'F':
case 'f': /* Argument type is of float, hence read double data from the argp */ case 'f': // Argument type is of float, hence read double data from the argp
floatNum_f32 = va_arg(argp, double); floatNum_f32 = va_arg(argp, double);
printFloat(floatNum_f32,10); printFloat(floatNum_f32, 10);
break; break;
case 'S': case 'S':
case 's': /* Argument type is of string, hence get the pointer to sting passed */ case 's': // Argument type is of string, hence get the pointer to sting passed
str = va_arg(argp, char *); str = va_arg(argp, char *);
print(str); print(str);
break; break;
case '%': case '%':
print('%'); print('%');
break; break;
} }
} }
else else
{ print(ch); // As '%' is not detected transmit the char passed
/* As '%' is not detected transmit the char passed */
print(ch);
}
} }
va_end(argp); va_end(argp);
} }
#endif #endif // ENABLE_PRINTF

53
frameworks/CMSIS/LPC1768/lib/Print.h
View File

@ -1,47 +1,43 @@
/* /**
Print.h - Base class that provides print() and println() * Print.h - Base class that provides print() and println()
Copyright (c) 2008 David A. Mellis. All right reserved. * Copyright (c) 2008 David A. Mellis. All right reserved.
*
This library is free software; you can redistribute it and/or * This library is free software; you can redistribute it and/or
modify it under the terms of the GNU Lesser General Public * modify it under the terms of the GNU Lesser General Public
License as published by the Free Software Foundation; either * License as published by the Free Software Foundation; either
version 2.1 of the License, or (at your option) any later version. * version 2.1 of the License, or (at your option) any later version.
*
This library is distributed in the hope that it will be useful, * This library is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of * but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
Lesser General Public License for more details. * Lesser General Public License for more details.
*
You should have received a copy of the GNU Lesser General Public * You should have received a copy of the GNU Lesser General Public
License along with this library; if not, write to the Free Software * License along with this library; if not, write to the Free Software
Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
*/ */
#ifndef CMSIS_Print_h #ifndef _CMSIS_PRINT_H_
#define CMSIS_Print_h #define _CMSIS_PRINT_H_
#include <inttypes.h> #include <inttypes.h>
#include <stdio.h> // for size_t #include <stdio.h> // for size_t
#include <string.h> #include <string.h>
#include "Printable.h" #include "Printable.h"
#define DEC 10 #define DEC 10
#define HEX 16 #define HEX 16
#define OCT 8 #define OCT 8
#define BIN 2 #define BIN 2
class Print class Print {
{
private: private:
int write_error; int write_error;
size_t printNumber(unsigned long, uint8_t); size_t printNumber(unsigned long, uint8_t);
size_t printFloat(double, uint8_t); size_t printFloat(double, uint8_t);
protected: protected:
void setWriteError(int err = 1) { write_error = err; } void setWriteError(const int err = 1) { write_error = err; }
public: public:
Print() : write_error(0) {} Print() : write_error(0) {}
@ -50,7 +46,6 @@ class Print
virtual size_t write(uint8_t) = 0; virtual size_t write(uint8_t) = 0;
size_t write(const char *str) { size_t write(const char *str) {
if (str == NULL) return 0; if (str == NULL) return 0;
return write((const uint8_t *)str, strlen(str)); return write((const uint8_t *)str, strlen(str));
} }
@ -82,4 +77,4 @@ class Print
size_t printf(const char *argList, ...); size_t printf(const char *argList, ...);
}; };
#endif #endif // _CMSIS_PRINT_H_

Write Preview
Loading…
Cancel
Save