Rewrite buffer related stuff to avoid weird stack overflow(?) issues
This commit is contained in:
parent
d898f6e518
commit
b5c5fd4ede
|
|
@ -103,14 +103,12 @@ void commandRead(char* arg) {
|
||||||
|
|
||||||
uartPutLine("OK");
|
uartPutLine("OK");
|
||||||
|
|
||||||
uint8_t byteBuffer[DATA_BLOCK_SIZE];
|
// Create data buffer
|
||||||
DataBuffer buffer = {
|
DataBuffer buffer;
|
||||||
.data = byteBuffer,
|
|
||||||
.maxSize = DATA_BLOCK_SIZE,
|
|
||||||
.bytes = 0
|
|
||||||
};
|
|
||||||
|
|
||||||
do {
|
do {
|
||||||
|
buffer.bytes = 0;
|
||||||
|
|
||||||
// Read a single block with up to DATA_BLOCK_SIZE bytes
|
// Read a single block with up to DATA_BLOCK_SIZE bytes
|
||||||
Address nextAddress = eepromReadBlock(range, &buffer);
|
Address nextAddress = eepromReadBlock(range, &buffer);
|
||||||
range.isValid = nextAddress.isValid;
|
range.isValid = nextAddress.isValid;
|
||||||
|
|
@ -121,16 +119,16 @@ void commandRead(char* arg) {
|
||||||
// First the size of the package (1 byte) followed by the data bytes
|
// First the size of the package (1 byte) followed by the data bytes
|
||||||
uartPutChar(buffer.bytes);
|
uartPutChar(buffer.bytes);
|
||||||
|
|
||||||
for (int i = 0; i < buffer.bytes; i++) {
|
for (uint8_t i = 0; i < buffer.bytes; i++) {
|
||||||
uartPutChar(buffer.data[i]);
|
uartPutChar(buffer.data[i]);
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
// Fancy ASCII output
|
// Fancy ASCII output
|
||||||
uartPutChar('<');
|
uartPutString("<0x");
|
||||||
uartPutInteger(buffer.bytes);
|
uartPutHexByte(buffer.bytes);
|
||||||
uartPutChar('>');
|
uartPutChar('>');
|
||||||
|
|
||||||
for (int i = 0; i < buffer.bytes; i++) {
|
for (uint8_t i = 0; i < buffer.bytes; i++) {
|
||||||
uartPutChar(' ');
|
uartPutChar(' ');
|
||||||
uartPutHexByte(buffer.data[i]);
|
uartPutHexByte(buffer.data[i]);
|
||||||
}
|
}
|
||||||
|
|
@ -159,17 +157,12 @@ void commandWrite(char* arg) {
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
// Create data buffer
|
|
||||||
uint8_t byteBuffer[DATA_BLOCK_SIZE];
|
|
||||||
DataBuffer buffer = {
|
|
||||||
.data = byteBuffer,
|
|
||||||
.maxSize = DATA_BLOCK_SIZE,
|
|
||||||
.bytes = 0
|
|
||||||
};
|
|
||||||
|
|
||||||
// "OK" indicates that data can be sent now.
|
// "OK" indicates that data can be sent now.
|
||||||
uartPutLine("OK START");
|
uartPutLine("OK START");
|
||||||
|
|
||||||
|
// Create data buffer
|
||||||
|
DataBuffer buffer;
|
||||||
|
|
||||||
Address currentAddress = startAddress;
|
Address currentAddress = startAddress;
|
||||||
uint8_t block_length = 0;
|
uint8_t block_length = 0;
|
||||||
|
|
||||||
|
|
@ -180,10 +173,8 @@ void commandWrite(char* arg) {
|
||||||
// Read and check block length
|
// Read and check block length
|
||||||
block_length = uartGetChar();
|
block_length = uartGetChar();
|
||||||
|
|
||||||
if (block_length > buffer.maxSize) {
|
if (block_length > DATA_BLOCK_SIZE) {
|
||||||
uartPutString("ERROR maximal block size is: ");
|
uartPutLine("ERROR maximal block size is: " STR(DATA_BLOCK_SIZE));
|
||||||
uartPutInteger(buffer.maxSize);
|
|
||||||
uartPutLine(NULL);
|
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
@ -196,9 +187,6 @@ void commandWrite(char* arg) {
|
||||||
if (buffer.bytes > 0) {
|
if (buffer.bytes > 0) {
|
||||||
currentAddress = eepromWriteBlock(currentAddress, buffer);
|
currentAddress = eepromWriteBlock(currentAddress, buffer);
|
||||||
|
|
||||||
// TODO wait necessary?
|
|
||||||
//_delay_ms(100);
|
|
||||||
|
|
||||||
if (!currentAddress.isValid) {
|
if (!currentAddress.isValid) {
|
||||||
uartPutLine("ERROR reached end of EEPROM while writing block");
|
uartPutLine("ERROR reached end of EEPROM while writing block");
|
||||||
return;
|
return;
|
||||||
|
|
|
||||||
|
|
@ -8,6 +8,10 @@
|
||||||
// Define macro for NOP instruction
|
// Define macro for NOP instruction
|
||||||
#define _NOP() __asm__ __volatile__ ("nop");
|
#define _NOP() __asm__ __volatile__ ("nop");
|
||||||
|
|
||||||
|
// Define macro to convert a preprocessor constant to a string literal
|
||||||
|
#define STR_(x) #x
|
||||||
|
#define STR(x) STR_(x)
|
||||||
|
|
||||||
// Define type for EEPROM addresses
|
// Define type for EEPROM addresses
|
||||||
typedef uint16_t address_t;
|
typedef uint16_t address_t;
|
||||||
|
|
||||||
|
|
@ -28,12 +32,11 @@ typedef struct {
|
||||||
} AddressRange;
|
} AddressRange;
|
||||||
|
|
||||||
// Define type for a block of data (bytes)
|
// Define type for a block of data (bytes)
|
||||||
|
#define DATA_BLOCK_SIZE 64
|
||||||
|
|
||||||
typedef struct {
|
typedef struct {
|
||||||
uint8_t* data;
|
uint8_t data[DATA_BLOCK_SIZE];
|
||||||
uint8_t maxSize;
|
|
||||||
uint8_t bytes;
|
uint8_t bytes;
|
||||||
} DataBuffer;
|
} DataBuffer;
|
||||||
|
|
||||||
#define DATA_BLOCK_SIZE 64
|
|
||||||
|
|
||||||
#endif /* COMMON_H_ */
|
#endif /* COMMON_H_ */
|
||||||
|
|
|
||||||
|
|
@ -132,7 +132,7 @@ Address eepromReadBlock(AddressRange addressRange, DataBuffer* buffer) {
|
||||||
highestAddress = HIGHEST_VALID_ADDRESS;
|
highestAddress = HIGHEST_VALID_ADDRESS;
|
||||||
}
|
}
|
||||||
|
|
||||||
while (currentAddress <= highestAddress && buffer->bytes < buffer->maxSize) {
|
while (currentAddress <= highestAddress && buffer->bytes < DATA_BLOCK_SIZE) {
|
||||||
buffer->data[buffer->bytes++] = eepromReadByte(currentAddress++);
|
buffer->data[buffer->bytes++] = eepromReadByte(currentAddress++);
|
||||||
|
|
||||||
// Handle integer overflow
|
// Handle integer overflow
|
||||||
|
|
|
||||||
|
|
@ -13,7 +13,7 @@
|
||||||
|
|
||||||
// Read and parse command line and dispatch command
|
// Read and parse command line and dispatch command
|
||||||
void parseNextCommand() {
|
void parseNextCommand() {
|
||||||
const int bufferLength = 80;
|
const int bufferLength = 40;
|
||||||
char buffer[bufferLength];
|
char buffer[bufferLength];
|
||||||
|
|
||||||
// Read next command
|
// Read next command
|
||||||
|
|
|
||||||
|
|
@ -4,8 +4,15 @@
|
||||||
#include <avr/io.h>
|
#include <avr/io.h>
|
||||||
#include <stdarg.h>
|
#include <stdarg.h>
|
||||||
#include <stdio.h>
|
#include <stdio.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <string.h>
|
||||||
#include <util/setbaud.h>
|
#include <util/setbaud.h>
|
||||||
|
|
||||||
|
// Hexadecimal digit lookup table
|
||||||
|
static const char hexDigitLookupTable[] = {
|
||||||
|
'0', '1', '2', '3', '4', '5', '6', '7', '8', '9', 'A', 'B', 'C', 'D', 'E', 'F'
|
||||||
|
};
|
||||||
|
|
||||||
// Initialize UART
|
// Initialize UART
|
||||||
void uartInit() {
|
void uartInit() {
|
||||||
// Set Baud register
|
// Set Baud register
|
||||||
|
|
@ -56,18 +63,12 @@ void uartPutLine(char* data) {
|
||||||
uartPutChar('\n');
|
uartPutChar('\n');
|
||||||
}
|
}
|
||||||
|
|
||||||
// Convert an integer to decimal ASCII and transmit
|
|
||||||
void uartPutInteger(int value) {
|
|
||||||
char outBuffer[32];
|
|
||||||
snprintf(outBuffer, 32, "%d", value);
|
|
||||||
uartPutString(outBuffer);
|
|
||||||
}
|
|
||||||
|
|
||||||
// Convert a byte to hexadecimal ASCII and transmit
|
// Convert a byte to hexadecimal ASCII and transmit
|
||||||
void uartPutHexByte(uint8_t byte) {
|
void uartPutHexByte(uint8_t byte) {
|
||||||
char outBuffer[8];
|
// First hex digit: most significant 4 bits
|
||||||
snprintf(outBuffer, 8, "%02hhX", byte);
|
uartPutChar(hexDigitLookupTable[(byte >> 4) & 0x0f]);
|
||||||
uartPutString(outBuffer);
|
// Second hex digit: least significant 4 bits
|
||||||
|
uartPutChar(hexDigitLookupTable[byte & 0x0f]);
|
||||||
}
|
}
|
||||||
|
|
||||||
// Receive a single character (blocking)
|
// Receive a single character (blocking)
|
||||||
|
|
|
||||||
|
|
@ -16,9 +16,6 @@ void uartPutString(char* data);
|
||||||
// Transmit a string followed by a line break
|
// Transmit a string followed by a line break
|
||||||
void uartPutLine(char* data);
|
void uartPutLine(char* data);
|
||||||
|
|
||||||
// Convert an integer to decimal ASCII and transmit
|
|
||||||
void uartPutInteger(int value);
|
|
||||||
|
|
||||||
// Convert a byte to hexadecimal ASCII and transmit
|
// Convert a byte to hexadecimal ASCII and transmit
|
||||||
void uartPutHexByte(uint8_t byte);
|
void uartPutHexByte(uint8_t byte);
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue