|
@ -39,12 +39,14 @@ |
|
|
* void Max7219_init(); |
|
|
* void Max7219_init(); |
|
|
* void Max7219_PutByte(uint8_t data); |
|
|
* void Max7219_PutByte(uint8_t data); |
|
|
* void Max7219(uint8_t reg, uint8_t data); |
|
|
* void Max7219(uint8_t reg, uint8_t data); |
|
|
* void Max7219_LED_On(uint8_t row, uint8_t col); |
|
|
* void Max7219_LED_On(uint8_t col, uint8_t row); |
|
|
* void Max7219_LED_Off(uint8_t row, uint8_t col); |
|
|
* void Max7219_LED_Off(uint8_t col, uint8_t row); |
|
|
* void Max7219_LED_Toggle(uint8_t row, uint8_t col); |
|
|
* void Max7219_LED_Toggle(uint8_t col, uint8_t row); |
|
|
* void Max7219_Clear_Row(uint8_t row); |
|
|
* void Max7219_Clear_Row(uint8_t row); |
|
|
* void Max7219_Clear_Column(uint8_t col); |
|
|
* void Max7219_Clear_Column(uint8_t col); |
|
|
* void Max7219_Set_Row(uint8_t row, uint8_t val); |
|
|
* void Max7219_Set_Row(uint8_t row, uint8_t val); |
|
|
|
|
|
* void Max7219_Set_2_Rows(uint8_t row, uint16_t val); |
|
|
|
|
|
* void Max7219_Set_4_Rows(uint8_t row, uint32_t val); |
|
|
* void Max7219_Set_Column(uint8_t col, uint8_t val); |
|
|
* void Max7219_Set_Column(uint8_t col, uint8_t val); |
|
|
* void Max7219_idle_tasks(); |
|
|
* void Max7219_idle_tasks(); |
|
|
*/ |
|
|
*/ |
|
@ -62,9 +64,10 @@ |
|
|
static uint8_t LEDs[8] = { 0 }; |
|
|
static uint8_t LEDs[8] = { 0 }; |
|
|
|
|
|
|
|
|
void Max7219_PutByte(uint8_t data) { |
|
|
void Max7219_PutByte(uint8_t data) { |
|
|
|
|
|
CRITICAL_SECTION_START |
|
|
for (uint8_t i = 8; i--;) { |
|
|
for (uint8_t i = 8; i--;) { |
|
|
#ifdef CPU_32_BIT // The 32-bit processors are so fast, a small delay in the code is needed
|
|
|
#ifdef CPU_32_BIT // The 32-bit processors are so fast, a small delay in the code is needed
|
|
|
// to let the signal wires stabilize.
|
|
|
delayMicroseconds(5); // to let the signal wires stabilize.
|
|
|
WRITE(MAX7219_CLK_PIN, LOW); // tick
|
|
|
WRITE(MAX7219_CLK_PIN, LOW); // tick
|
|
|
delayMicroseconds(5); |
|
|
delayMicroseconds(5); |
|
|
WRITE(MAX7219_DIN_PIN, (data & 0x80) ? HIGH : LOW); // send 1 or 0 based on data bit
|
|
|
WRITE(MAX7219_DIN_PIN, (data & 0x80) ? HIGH : LOW); // send 1 or 0 based on data bit
|
|
@ -79,14 +82,22 @@ void Max7219_PutByte(uint8_t data) { |
|
|
|
|
|
|
|
|
data <<= 1; |
|
|
data <<= 1; |
|
|
} |
|
|
} |
|
|
|
|
|
CRITICAL_SECTION_END |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
void Max7219(const uint8_t reg, const uint8_t data) { |
|
|
void Max7219(const uint8_t reg, const uint8_t data) { |
|
|
|
|
|
#ifdef CPU_32_BIT |
|
|
|
|
|
delayMicroseconds(5); |
|
|
|
|
|
#endif |
|
|
|
|
|
CRITICAL_SECTION_START |
|
|
WRITE(MAX7219_LOAD_PIN, LOW); // begin
|
|
|
WRITE(MAX7219_LOAD_PIN, LOW); // begin
|
|
|
#ifdef CPU_32_BIT // The 32-bit processors are so fast, a small delay in the code is needed
|
|
|
#ifdef CPU_32_BIT // The 32-bit processors are so fast, a small delay in the code is needed
|
|
|
delayMicroseconds(5); // to let the signal wires stabilize.
|
|
|
delayMicroseconds(5); // to let the signal wires stabilize.
|
|
|
#endif |
|
|
#endif |
|
|
Max7219_PutByte(reg); // specify register
|
|
|
Max7219_PutByte(reg); // specify register
|
|
|
|
|
|
#ifdef CPU_32_BIT |
|
|
|
|
|
delayMicroseconds(5); |
|
|
|
|
|
#endif |
|
|
Max7219_PutByte(data); // put data
|
|
|
Max7219_PutByte(data); // put data
|
|
|
#ifdef CPU_32_BIT |
|
|
#ifdef CPU_32_BIT |
|
|
delayMicroseconds(5); |
|
|
delayMicroseconds(5); |
|
@ -96,45 +107,103 @@ void Max7219(const uint8_t reg, const uint8_t data) { |
|
|
delayMicroseconds(5); |
|
|
delayMicroseconds(5); |
|
|
#endif |
|
|
#endif |
|
|
WRITE(MAX7219_LOAD_PIN, HIGH); |
|
|
WRITE(MAX7219_LOAD_PIN, HIGH); |
|
|
|
|
|
CRITICAL_SECTION_END |
|
|
|
|
|
#ifdef CPU_32_BIT |
|
|
|
|
|
delayMicroseconds(5); |
|
|
|
|
|
#endif |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
void Max7219_LED_Set(const uint8_t row, const uint8_t col, const bool on) { |
|
|
void Max7219_LED_Set(const uint8_t row, const uint8_t col, const bool on) { |
|
|
if (row > 7 || col > 7) return; |
|
|
if (row > 7 || col > 7) { |
|
|
|
|
|
int r,c; |
|
|
|
|
|
r = row; |
|
|
|
|
|
c = col; |
|
|
|
|
|
SERIAL_ECHOPAIR("??? Max7219_LED_Set(",r); |
|
|
|
|
|
SERIAL_ECHOPAIR(",",c); |
|
|
|
|
|
SERIAL_ECHO(")\n"); |
|
|
|
|
|
return; |
|
|
|
|
|
} |
|
|
if (TEST(LEDs[row], col) == on) return; // if LED is already on/off, leave alone
|
|
|
if (TEST(LEDs[row], col) == on) return; // if LED is already on/off, leave alone
|
|
|
if (on) SBI(LEDs[row], col); else CBI(LEDs[row], col); |
|
|
if (on) SBI(LEDs[row], col); else CBI(LEDs[row], col); |
|
|
Max7219(8 - row, LEDs[row]); |
|
|
Max7219(8 - row, LEDs[row]); |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
void Max7219_LED_On(const uint8_t row, const uint8_t col) { |
|
|
void Max7219_LED_On(const uint8_t col, const uint8_t row) { |
|
|
Max7219_LED_Set(row, col, true); |
|
|
if (row > 7 || col > 7) { |
|
|
|
|
|
int r,c; |
|
|
|
|
|
r = row; |
|
|
|
|
|
c = col; |
|
|
|
|
|
SERIAL_ECHOPAIR("??? Max7219_LED_On(",c); |
|
|
|
|
|
SERIAL_ECHOPAIR(",",r); |
|
|
|
|
|
SERIAL_ECHO(")\n"); |
|
|
|
|
|
return; |
|
|
|
|
|
} |
|
|
|
|
|
Max7219_LED_Set(col, row, true); |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
void Max7219_LED_Off(const uint8_t row, const uint8_t col) { |
|
|
void Max7219_LED_Off(const uint8_t col, const uint8_t row) { |
|
|
Max7219_LED_Set(row, col, false); |
|
|
if (row > 7 || col > 7) { |
|
|
|
|
|
int r,c; |
|
|
|
|
|
r = row; |
|
|
|
|
|
c = col; |
|
|
|
|
|
SERIAL_ECHOPAIR("??? Max7219_LED_Off(",r); |
|
|
|
|
|
SERIAL_ECHOPAIR(",",c); |
|
|
|
|
|
SERIAL_ECHO(")\n"); |
|
|
|
|
|
return; |
|
|
|
|
|
} |
|
|
|
|
|
Max7219_LED_Set(col, row, false); |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
void Max7219_LED_Toggle(const uint8_t row, const uint8_t col) { |
|
|
void Max7219_LED_Toggle(const uint8_t col, const uint8_t row) { |
|
|
if (row > 7 || col > 7) return; |
|
|
if (row > 7 || col > 7) { |
|
|
|
|
|
int r,c; |
|
|
|
|
|
r = row; |
|
|
|
|
|
c = col; |
|
|
|
|
|
SERIAL_ECHOPAIR("??? Max7219_LED_Toggle(",r); |
|
|
|
|
|
SERIAL_ECHOPAIR(",",c); |
|
|
|
|
|
SERIAL_ECHO(")\n"); |
|
|
|
|
|
return; |
|
|
|
|
|
} |
|
|
if (TEST(LEDs[row], col)) |
|
|
if (TEST(LEDs[row], col)) |
|
|
Max7219_LED_Off(row, col); |
|
|
Max7219_LED_Off(col, row); |
|
|
else |
|
|
else |
|
|
Max7219_LED_On(row, col); |
|
|
Max7219_LED_On(col, row); |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
void Max7219_Clear_Column(const uint8_t col) { |
|
|
void Max7219_Clear_Column(const uint8_t col) { |
|
|
if (col > 7) return; |
|
|
if (col > 7) { |
|
|
|
|
|
int c; |
|
|
|
|
|
c = col; |
|
|
|
|
|
SERIAL_ECHOPAIR("??? Max7219_Clear_Column(",c); |
|
|
|
|
|
SERIAL_ECHO(")\n"); |
|
|
|
|
|
return; |
|
|
|
|
|
} |
|
|
LEDs[col] = 0; |
|
|
LEDs[col] = 0; |
|
|
Max7219(8 - col, LEDs[col]); |
|
|
Max7219(8 - col, LEDs[col]); |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
void Max7219_Clear_Row(const uint8_t row) { |
|
|
void Max7219_Clear_Row(const uint8_t row) { |
|
|
if (row > 7) return; |
|
|
if (row > 7) { |
|
|
|
|
|
int r; |
|
|
|
|
|
r = row; |
|
|
|
|
|
SERIAL_ECHOPAIR("??? Max7219_Clear_Row(",r); |
|
|
|
|
|
SERIAL_ECHO(")\n"); |
|
|
|
|
|
return; |
|
|
|
|
|
} |
|
|
for (uint8_t c = 0; c <= 7; c++) |
|
|
for (uint8_t c = 0; c <= 7; c++) |
|
|
Max7219_LED_Off(c, row); |
|
|
Max7219_LED_Off(c, row); |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
void Max7219_Set_Row(const uint8_t row, const uint8_t val) { |
|
|
void Max7219_Set_Row(const uint8_t row, const uint8_t val) { |
|
|
if (row > 7) return; |
|
|
if (row > 7 || val>255) { |
|
|
|
|
|
int r, v; |
|
|
|
|
|
r = row; |
|
|
|
|
|
v = val; |
|
|
|
|
|
SERIAL_ECHOPAIR("??? Max7219_Set_Row(",r); |
|
|
|
|
|
SERIAL_ECHOPAIR(",",v); |
|
|
|
|
|
SERIAL_ECHO(")\n"); |
|
|
|
|
|
return; |
|
|
|
|
|
} |
|
|
for (uint8_t b = 0; b <= 7; b++) |
|
|
for (uint8_t b = 0; b <= 7; b++) |
|
|
if (TEST(val, b)) |
|
|
if (TEST(val, b)) |
|
|
Max7219_LED_On(7 - b, row); |
|
|
Max7219_LED_On(7 - b, row); |
|
@ -142,8 +211,47 @@ void Max7219_Set_Row(const uint8_t row, const uint8_t val) { |
|
|
Max7219_LED_Off(7 - b, row); |
|
|
Max7219_LED_Off(7 - b, row); |
|
|
} |
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void Max7219_Set_2_Rows(const uint8_t row, const uint16_t val) { |
|
|
|
|
|
if (row > 6 || val>65535) { |
|
|
|
|
|
int r, v; |
|
|
|
|
|
r = row; |
|
|
|
|
|
v = val; |
|
|
|
|
|
SERIAL_ECHOPAIR("??? Max7219_Set_2_Rows(",r); |
|
|
|
|
|
SERIAL_ECHOPAIR(",",v); |
|
|
|
|
|
SERIAL_ECHO(")\n"); |
|
|
|
|
|
return; |
|
|
|
|
|
} |
|
|
|
|
|
Max7219_Set_Row(row+1, (val & 0xff00) >> 8 ); |
|
|
|
|
|
Max7219_Set_Row(row+0, (val & 0xff)); |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void Max7219_Set_4_Rows(const uint8_t row, const uint32_t val) { |
|
|
|
|
|
if (row > 4 ) { |
|
|
|
|
|
int r; |
|
|
|
|
|
long v; |
|
|
|
|
|
r = row; |
|
|
|
|
|
v = val; |
|
|
|
|
|
SERIAL_ECHOPAIR("??? Max7219_Set_4_Rows(",r); |
|
|
|
|
|
SERIAL_ECHOPAIR(",",v); |
|
|
|
|
|
SERIAL_ECHO(")\n"); |
|
|
|
|
|
return; |
|
|
|
|
|
} |
|
|
|
|
|
Max7219_Set_Row(row+3, (val & 0xff000000) >> 24); |
|
|
|
|
|
Max7219_Set_Row(row+2, (val & 0xff0000) >> 16); |
|
|
|
|
|
Max7219_Set_Row(row+1, (val & 0xff00) >> 8); |
|
|
|
|
|
Max7219_Set_Row(row+0, (val & 0xff)); |
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
void Max7219_Set_Column(const uint8_t col, const uint8_t val) { |
|
|
void Max7219_Set_Column(const uint8_t col, const uint8_t val) { |
|
|
if (col > 7) return; |
|
|
if (val > 255 || col > 7) { |
|
|
|
|
|
int v,c; |
|
|
|
|
|
v = val; |
|
|
|
|
|
c = col; |
|
|
|
|
|
SERIAL_ECHOPAIR("??? Max7219_Column(",c); |
|
|
|
|
|
SERIAL_ECHOPAIR(",",v); |
|
|
|
|
|
SERIAL_ECHO(")\n"); |
|
|
|
|
|
return; |
|
|
|
|
|
} |
|
|
LEDs[col] = val; |
|
|
LEDs[col] = val; |
|
|
Max7219(8 - col, LEDs[col]); |
|
|
Max7219(8 - col, LEDs[col]); |
|
|
} |
|
|
} |
|
@ -206,10 +314,23 @@ void Max7219_init() { |
|
|
* or clear a row is not very significant. |
|
|
* or clear a row is not very significant. |
|
|
*/ |
|
|
*/ |
|
|
void Max7219_idle_tasks() { |
|
|
void Max7219_idle_tasks() { |
|
|
|
|
|
#if MAX7219_DEBUG_STEPPER_HEAD || MAX7219_DEBUG_STEPPER_TAIL || MAX7219_DEBUG_STEPPER_QUEUE |
|
|
|
|
|
CRITICAL_SECTION_START |
|
|
|
|
|
#if MAX7219_DEBUG_STEPPER_HEAD || MAX7219_DEBUG_STEPPER_QUEUE |
|
|
|
|
|
uint8_t head; |
|
|
|
|
|
head = planner.block_buffer_head; |
|
|
|
|
|
#endif |
|
|
|
|
|
#if MAX7219_DEBUG_STEPPER_TAIL || MAX7219_DEBUG_STEPPER_QUEUE |
|
|
|
|
|
uint8_t tail; |
|
|
|
|
|
tail = planner.block_buffer_tail; |
|
|
|
|
|
#endif |
|
|
|
|
|
CRITICAL_SECTION_END |
|
|
|
|
|
#endif |
|
|
|
|
|
|
|
|
#if ENABLED(MAX7219_DEBUG_PRINTER_ALIVE) |
|
|
#if ENABLED(MAX7219_DEBUG_PRINTER_ALIVE) |
|
|
static int debug_cnt = 0; |
|
|
static int debug_cnt = 0; |
|
|
#ifdef CPU_32_BIT |
|
|
#ifdef CPU_32_BIT |
|
|
if (debug_cnt++ > 400) { |
|
|
if (debug_cnt++ > 1000) { |
|
|
#else |
|
|
#else |
|
|
if (debug_cnt++ > 100) { |
|
|
if (debug_cnt++ > 100) { |
|
|
#endif |
|
|
#endif |
|
@ -219,26 +340,40 @@ void Max7219_idle_tasks() { |
|
|
#endif |
|
|
#endif |
|
|
|
|
|
|
|
|
#ifdef MAX7219_DEBUG_STEPPER_HEAD |
|
|
#ifdef MAX7219_DEBUG_STEPPER_HEAD |
|
|
Max7219_Clear_Row(MAX7219_DEBUG_STEPPER_HEAD); |
|
|
static int16_t last_head_cnt=0; |
|
|
Max7219_Clear_Row(MAX7219_DEBUG_STEPPER_HEAD + 1); |
|
|
if (last_head_cnt != head) { |
|
|
if ( planner.block_buffer_head < 8) |
|
|
if ( last_head_cnt < 8) |
|
|
Max7219_LED_On( planner.block_buffer_head, MAX7219_DEBUG_STEPPER_HEAD); |
|
|
Max7219_LED_Off( last_head_cnt, MAX7219_DEBUG_STEPPER_HEAD); |
|
|
|
|
|
else |
|
|
|
|
|
Max7219_LED_Off( last_head_cnt-8, MAX7219_DEBUG_STEPPER_HEAD+1); |
|
|
|
|
|
|
|
|
|
|
|
last_head_cnt = head; |
|
|
|
|
|
if ( head < 8) |
|
|
|
|
|
Max7219_LED_On(head, MAX7219_DEBUG_STEPPER_HEAD); |
|
|
else |
|
|
else |
|
|
Max7219_LED_On( planner.block_buffer_head-8, MAX7219_DEBUG_STEPPER_HEAD+1); |
|
|
Max7219_LED_On(head-8, MAX7219_DEBUG_STEPPER_HEAD+1); |
|
|
|
|
|
} |
|
|
#endif |
|
|
#endif |
|
|
|
|
|
|
|
|
#ifdef MAX7219_DEBUG_STEPPER_TAIL |
|
|
#ifdef MAX7219_DEBUG_STEPPER_TAIL |
|
|
Max7219_Clear_Row(MAX7219_DEBUG_STEPPER_TAIL); |
|
|
static int16_t last_tail_cnt=0; |
|
|
Max7219_Clear_Row(MAX7219_DEBUG_STEPPER_TAIL + 1); |
|
|
if (last_tail_cnt != tail) { |
|
|
if ( planner.block_buffer_tail < 8) |
|
|
if ( last_tail_cnt < 8) |
|
|
Max7219_LED_On( planner.block_buffer_tail, MAX7219_DEBUG_STEPPER_TAIL ); |
|
|
Max7219_LED_Off( last_tail_cnt, MAX7219_DEBUG_STEPPER_TAIL); |
|
|
|
|
|
else |
|
|
|
|
|
Max7219_LED_Off( last_tail_cnt-8, MAX7219_DEBUG_STEPPER_TAIL+1); |
|
|
|
|
|
|
|
|
|
|
|
last_tail_cnt = tail; |
|
|
|
|
|
if ( tail < 8) |
|
|
|
|
|
Max7219_LED_On(tail, MAX7219_DEBUG_STEPPER_TAIL); |
|
|
else |
|
|
else |
|
|
Max7219_LED_On( planner.block_buffer_tail-8, MAX7219_DEBUG_STEPPER_TAIL+1 ); |
|
|
Max7219_LED_On(tail-8, MAX7219_DEBUG_STEPPER_TAIL+1); |
|
|
|
|
|
} |
|
|
#endif |
|
|
#endif |
|
|
|
|
|
|
|
|
#ifdef MAX7219_DEBUG_STEPPER_QUEUE |
|
|
#ifdef MAX7219_DEBUG_STEPPER_QUEUE |
|
|
static int16_t last_depth = 0; |
|
|
static int16_t last_depth = 0; |
|
|
int16_t current_depth = planner.block_buffer_head - planner.block_buffer_tail; |
|
|
int16_t current_depth = head - tail; |
|
|
if (current_depth != last_depth) { // usually, no update will be needed.
|
|
|
if (current_depth != last_depth) { // usually, no update will be needed.
|
|
|
if (current_depth < 0) current_depth += BLOCK_BUFFER_SIZE; |
|
|
if (current_depth < 0) current_depth += BLOCK_BUFFER_SIZE; |
|
|
NOMORE(current_depth, BLOCK_BUFFER_SIZE); |
|
|
NOMORE(current_depth, BLOCK_BUFFER_SIZE); |
|
@ -249,10 +384,10 @@ void Max7219_idle_tasks() { |
|
|
en = max(current_depth, last_depth); |
|
|
en = max(current_depth, last_depth); |
|
|
if (current_depth < last_depth) |
|
|
if (current_depth < last_depth) |
|
|
for (uint8_t i = st; i <= en; i++) // clear the highest order LEDs
|
|
|
for (uint8_t i = st; i <= en; i++) // clear the highest order LEDs
|
|
|
Max7219_LED_Off(i >> 1, MAX7219_DEBUG_STEPPER_QUEUE + (i & 1)); |
|
|
Max7219_LED_Off(i/2, MAX7219_DEBUG_STEPPER_QUEUE + (i & 1)); |
|
|
else |
|
|
else |
|
|
for (uint8_t i = st; i <= en; i++) // set the highest order LEDs
|
|
|
for (uint8_t i = st; i <= en; i++) // set the LEDs to current depth
|
|
|
Max7219_LED_On(i >> 1, MAX7219_DEBUG_STEPPER_QUEUE + (i & 1)); |
|
|
Max7219_LED_On(i/2, MAX7219_DEBUG_STEPPER_QUEUE + (i & 1)); |
|
|
|
|
|
|
|
|
last_depth = current_depth; |
|
|
last_depth = current_depth; |
|
|
} |
|
|
} |
|
|