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