Scott Lahteine
4 years ago
10 changed files with 101 additions and 96 deletions
@ -0,0 +1,90 @@ |
|||
/**
|
|||
* Marlin 3D Printer Firmware |
|||
* Copyright (c) 2020 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
|
|||
* |
|||
* Based on Sprinter and grbl. |
|||
* Copyright (c) 2011 Camiel Gubbels / Erik van der Zalm |
|||
* |
|||
* 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 <https://www.gnu.org/licenses/>.
|
|||
* |
|||
*/ |
|||
|
|||
#include "../inc/MarlinConfig.h" |
|||
#include "../gcode/parser.h" |
|||
|
|||
#if NEED_HEX_PRINT |
|||
|
|||
#include "hex_print.h" |
|||
|
|||
#ifdef CPU_32_BIT |
|||
constexpr int byte_start = 4; |
|||
static char _hex[] = "0x00000000"; |
|||
#else |
|||
constexpr int byte_start = 0; |
|||
static char _hex[] = "0x0000"; |
|||
#endif |
|||
|
|||
char* hex_byte(const uint8_t b) { |
|||
_hex[byte_start + 4] = hex_nybble(b >> 4); |
|||
_hex[byte_start + 5] = hex_nybble(b); |
|||
return &_hex[byte_start + 4]; |
|||
} |
|||
|
|||
inline void _hex_word(const uint16_t w) { |
|||
_hex[byte_start + 2] = hex_nybble(w >> 12); |
|||
_hex[byte_start + 3] = hex_nybble(w >> 8); |
|||
_hex[byte_start + 4] = hex_nybble(w >> 4); |
|||
_hex[byte_start + 5] = hex_nybble(w); |
|||
} |
|||
|
|||
char* hex_word(const uint16_t w) { |
|||
_hex_word(w); |
|||
return &_hex[byte_start + 2]; |
|||
} |
|||
|
|||
#ifdef CPU_32_BIT |
|||
char* hex_long(const uint32_t l) { |
|||
_hex[2] = hex_nybble(l >> 28); |
|||
_hex[3] = hex_nybble(l >> 24); |
|||
_hex[4] = hex_nybble(l >> 20); |
|||
_hex[5] = hex_nybble(l >> 16); |
|||
_hex_word((uint16_t)(l & 0xFFFF)); |
|||
return &_hex[2]; |
|||
} |
|||
#endif |
|||
|
|||
char* hex_address(const void * const w) { |
|||
#ifdef CPU_32_BIT |
|||
(void)hex_long((ptr_int_t)w); |
|||
#else |
|||
(void)hex_word((ptr_int_t)w); |
|||
#endif |
|||
return _hex; |
|||
} |
|||
|
|||
void print_hex_nybble(const uint8_t n) { SERIAL_CHAR(hex_nybble(n)); } |
|||
void print_hex_byte(const uint8_t b) { SERIAL_ECHO(hex_byte(b)); } |
|||
void print_hex_word(const uint16_t w) { SERIAL_ECHO(hex_word(w)); } |
|||
void print_hex_address(const void * const w) { SERIAL_ECHO(hex_address(w)); } |
|||
|
|||
void print_hex_long(const uint32_t w, const char delimiter) { |
|||
SERIAL_ECHOPGM("0x"); |
|||
for (int B = 24; B >= 8; B -= 8){ |
|||
print_hex_byte(w >> B); |
|||
SERIAL_CHAR(delimiter); |
|||
} |
|||
print_hex_byte(w); |
|||
} |
|||
|
|||
#endif // NEED_HEX_PRINT
|
@ -1,90 +0,0 @@ |
|||
/**
|
|||
* Marlin 3D Printer Firmware |
|||
* Copyright (c) 2020 MarlinFirmware [https://github.com/MarlinFirmware/Marlin]
|
|||
* |
|||
* Based on Sprinter and grbl. |
|||
* Copyright (c) 2011 Camiel Gubbels / Erik van der Zalm |
|||
* |
|||
* 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 <https://www.gnu.org/licenses/>.
|
|||
* |
|||
*/ |
|||
|
|||
#include "../inc/MarlinConfig.h" |
|||
#include "../gcode/parser.h" |
|||
|
|||
#if ANY(AUTO_BED_LEVELING_UBL, M100_FREE_MEMORY_WATCHER, DEBUG_GCODE_PARSER, TMC_DEBUG, MARLIN_DEV_MODE) |
|||
|
|||
#include "hex_print_routines.h" |
|||
|
|||
#ifdef CPU_32_BIT |
|||
constexpr int byte_start = 4; |
|||
static char _hex[] = "0x00000000"; |
|||
#else |
|||
constexpr int byte_start = 0; |
|||
static char _hex[] = "0x0000"; |
|||
#endif |
|||
|
|||
char* hex_byte(const uint8_t b) { |
|||
_hex[byte_start + 4] = hex_nybble(b >> 4); |
|||
_hex[byte_start + 5] = hex_nybble(b); |
|||
return &_hex[byte_start + 4]; |
|||
} |
|||
|
|||
inline void _hex_word(const uint16_t w) { |
|||
_hex[byte_start + 2] = hex_nybble(w >> 12); |
|||
_hex[byte_start + 3] = hex_nybble(w >> 8); |
|||
_hex[byte_start + 4] = hex_nybble(w >> 4); |
|||
_hex[byte_start + 5] = hex_nybble(w); |
|||
} |
|||
|
|||
char* hex_word(const uint16_t w) { |
|||
_hex_word(w); |
|||
return &_hex[byte_start + 2]; |
|||
} |
|||
|
|||
#ifdef CPU_32_BIT |
|||
char* hex_long(const uint32_t l) { |
|||
_hex[2] = hex_nybble(l >> 28); |
|||
_hex[3] = hex_nybble(l >> 24); |
|||
_hex[4] = hex_nybble(l >> 20); |
|||
_hex[5] = hex_nybble(l >> 16); |
|||
_hex_word((uint16_t)(l & 0xFFFF)); |
|||
return &_hex[2]; |
|||
} |
|||
#endif |
|||
|
|||
char* hex_address(const void * const w) { |
|||
#ifdef CPU_32_BIT |
|||
(void)hex_long((ptr_int_t)w); |
|||
#else |
|||
(void)hex_word((ptr_int_t)w); |
|||
#endif |
|||
return _hex; |
|||
} |
|||
|
|||
void print_hex_nybble(const uint8_t n) { SERIAL_CHAR(hex_nybble(n)); } |
|||
void print_hex_byte(const uint8_t b) { SERIAL_ECHO(hex_byte(b)); } |
|||
void print_hex_word(const uint16_t w) { SERIAL_ECHO(hex_word(w)); } |
|||
void print_hex_address(const void * const w) { SERIAL_ECHO(hex_address(w)); } |
|||
|
|||
void print_hex_long(const uint32_t w, const char delimiter) { |
|||
SERIAL_ECHOPGM("0x"); |
|||
for (int B = 24; B >= 8; B -= 8){ |
|||
print_hex_byte(w >> B); |
|||
SERIAL_CHAR(delimiter); |
|||
} |
|||
print_hex_byte(w); |
|||
} |
|||
|
|||
#endif // AUTO_BED_LEVELING_UBL || M100_FREE_MEMORY_WATCHER || DEBUG_GCODE_PARSER
|
Loading…
Reference in new issue