Git-Mirrors/OpenModem
1
0
Fork 0
mirror of https://github.com/markqvist/OpenModem.git synced 2024-10-01 03:15:46 -04:00
Code Issues Actions Packages Projects Releases Wiki Activity

Fixed escape char bug

Browse Source
This commit is contained in:
Mark Qvist 2014-04-16 17:28:16 +02:00
parent 9637efd46f
commit 7b5495b767
7 changed files with 38 additions and 23 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
Modem/compression/heatshrink_encoder.c
View File

@ -38,7 +38,7 @@ static const char *state_names[] = {
};
#else
#define LOG(...) /* no-op */
#define ASSERT(X) /* no-op */
//#define ASSERT(X) /* no-op */
#endif
// Encoder flags
@ -315,7 +315,6 @@ static HSE_state st_step_search(heatshrink_encoder *hse) {
LOG("ss Found match of %d bytes at %d\n", match_length, match_pos);
hse->match_pos = match_pos;
hse->match_length = match_length;
ASSERT(match_pos < 1 << hse->window_sz2 /*window_length*/);
return HSES_YIELD_TAG_BIT;
}

6
Modem/config.h
View File

@ -3,7 +3,7 @@
#define FSK_CFG
// Debug & test options
#define SERIAL_DEBUG true
#define SERIAL_DEBUG false
#define PASSALL false
#define AUTOREPLY false
@ -17,7 +17,7 @@
#define CONFIG_AFSK_RXTIMEOUT 0 // How long a read operation from the modem
// will wait for data before timing out.
#define CONFIG_AFSK_PREAMBLE_LEN 500UL // The length of the packet preamble in milliseconds
#define CONFIG_AFSK_TRAILER_LEN 100UL // The length of the packet tail in milliseconds
#define CONFIG_AFSK_PREAMBLE_LEN 250UL // The length of the packet preamble in milliseconds
#define CONFIG_AFSK_TRAILER_LEN 20UL // The length of the packet tail in milliseconds
#endif

8
Modem/main.c
View File

@ -39,7 +39,6 @@ static size_t serialLen = 0; // Counter for counting length of data from s
static bool sertx = false; // Flag signifying whether it's time to send data
// Received on the serial port.
//////////////////////////////////////////////////////
// And here comes the actual program :) //
//////////////////////////////////////////////////////
@ -52,7 +51,9 @@ static void mp1Callback(struct MP1Packet *packet) {
if (AUTOREPLY && packet->data[0]-128 == 'R' && packet->data[1]-128 == 'Q') {
timer_delay(1000);
mp1Send(&mp1, TEST_PACKET, sizeof(TEST_PACKET));
uint8_t output[sizeof(TEST_PACKET)] = TEST_PACKET;
mp1Send(&mp1, output, sizeof(TEST_PACKET));
}
}
@ -134,7 +135,8 @@ int main(void)
// Reset the timer counter;
start = timer_clock();
// And send a test packet!
mp1Send(&mp1, TEST_PACKET, sizeof(TEST_PACKET));
uint8_t output[sizeof(TEST_PACKET)] = TEST_PACKET;
mp1Send(&mp1, output, sizeof(TEST_PACKET));
}
}
return 0;

34
Modem/protocol/mp1.c
View File

@ -20,6 +20,10 @@ static uint8_t lastByte = 0x00;
// decompressing packet data.
static uint8_t compressionBuffer[MP1_MAX_FRAME_LENGTH+10];
// An int to hold amount of free RAM updated
// by the FREE_RAM function;
static int FREE_RAM;
// The GET_BIT macro is used in the interleaver
// and deinterleaver to access single bits of a
// byte.
@ -68,6 +72,8 @@ static void mp1Decode(MP1 *mp1) {
buffer++;
}
if (SERIAL_DEBUG) kprintf("[TS=%d] ", mp1->packetLength);
// Set the payload length of the packet to the counted
// length minus 1, so we remove the checksum
packet.dataLength = mp1->packetLength - 2 - (header & 0x01);
@ -76,7 +82,9 @@ static void mp1Decode(MP1 *mp1) {
if (header & MP1_HEADER_COMPRESSION) {
// If we have, we decompress it and use the
// decompressed data for the packet
if (SERIAL_DEBUG) kprintf("[CS=%d] ", packet.dataLength);
size_t decompressedSize = decompress(buffer, packet.dataLength);
if (SERIAL_DEBUG) kprintf("[DS=%d]", decompressedSize);
packet.dataLength = decompressedSize;
memcpy(buffer, compressionBuffer, decompressedSize);
}
@ -113,7 +121,7 @@ void mp1Poll(MP1 *mp1) {
// HDLC_FLAG), we will start looking at the
// incoming data and perform forward error
// correction on it.
if (mp1->reading && (byte != AX25_ESC) ) {
if ((mp1->reading && (byte != AX25_ESC )) || (mp1->reading && (mp1->escape && byte == AX25_ESC))) {
mp1->readLength++;
// Check if we have read three bytes. If we
@ -331,7 +339,6 @@ static void mp1Putbyte(MP1 *mp1, uint8_t byte) {
if (sendParityBlock) {
uint8_t p = mp1ParityBlock(lastByte, byte);
//kfile_putc(p, mp1->modem);
mp1Interleave(mp1, p);
}
@ -342,9 +349,11 @@ static void mp1Putbyte(MP1 *mp1, uint8_t byte) {
// This function accepts a buffer with data
// to be transmitted, and structures it into
// a valid packet.
void mp1Send(MP1 *mp1, const void *_buffer, size_t length) {
void mp1Send(MP1 *mp1, void *_buffer, size_t length) {
// Get the transmit data buffer
const uint8_t *buffer = (const uint8_t *)_buffer;
uint8_t *buffer = (uint8_t *)_buffer;
uint8_t *compressed = (uint8_t *)compressionBuffer;
// Initialize checksum to zero
mp1->checksum_out = MP1_CHECKSUM_INIT;
@ -352,9 +361,6 @@ void mp1Send(MP1 *mp1, const void *_buffer, size_t length) {
// We also reset the interleave counter to zero
mp1->interleaveCounter = 0;
// Transmit the HDLC_FLAG to signify start of TX
kfile_putc(HDLC_FLAG, mp1->modem);
// We start out assuming we should not use
// compression.
bool packetCompression = false;
@ -369,6 +375,7 @@ void mp1Send(MP1 *mp1, const void *_buffer, size_t length) {
// Write the compressed data into the
// outgoing data buffer
memcpy(buffer, compressionBuffer, compressedSize);
// Make sure to set the length of the
// data to the new (compressed) length
length = compressedSize;
@ -377,6 +384,8 @@ void mp1Send(MP1 *mp1, const void *_buffer, size_t length) {
// so we don't do anything.
}
// Transmit the HDLC_FLAG to signify start of TX
kfile_putc(HDLC_FLAG, mp1->modem);
// We now need to construct a header, that
// can tell the receiving end whether the
@ -437,8 +446,8 @@ void mp1Send(MP1 *mp1, const void *_buffer, size_t length) {
// counter reaches 3, a block will be
// transmitted.
while (length--) {
mp1->checksum_out = mp1->checksum_out ^ *buffer;
mp1Putbyte(mp1, *buffer++);
mp1->checksum_out = mp1->checksum_out ^ *buffer;
mp1Putbyte(mp1, *buffer++);
}
// Finally we write the checksum to the
@ -466,8 +475,9 @@ void mp1Init(MP1 *mp1, KFile *modem, mp1_callback_t callback) {
// how much available memory we have left.
int freeRam(void) {
extern int __heap_start, *__brkval;
int v;
return (int) &v - (__brkval == 0 ? (int) &__heap_start : (int) __brkval);
int v;
FREE_RAM = (int) &v - (__brkval == 0 ? (int) &__heap_start : (int) __brkval);
return FREE_RAM;
}
// Following is the functions responsible
@ -601,6 +611,7 @@ void mp1Deinterleave(MP1 *mp1) {
size_t compress(uint8_t *input, size_t length) {
heatshrink_encoder *hse = heatshrink_encoder_alloc(8, 4);
if (hse == NULL) {
if (SERIAL_DEBUG) kprintf("Could not allocate compressor\n");
return 0;
}
@ -627,6 +638,7 @@ size_t compress(uint8_t *input, size_t length) {
size_t decompress(uint8_t *input, size_t length) {
heatshrink_decoder *hsd = heatshrink_decoder_alloc(MP1_MAX_FRAME_LENGTH, 8, 4);
if (hsd == NULL) {
if (SERIAL_DEBUG) kprintf("Could not allocate decompressor\n");
return 0;
}

4
Modem/protocol/mp1.h
View File

@ -6,7 +6,7 @@
// Frame sizing & checksum
#define MP1_MIN_FRAME_LENGTH 3
#define MP1_MAX_FRAME_LENGTH 300
#define MP1_MAX_FRAME_LENGTH 250
#define MP1_INTERLEAVE_SIZE 3
#define MP1_CHECKSUM_INIT 0xAA
@ -59,7 +59,7 @@ typedef struct MP1Packet {
void mp1Init(MP1 *mp1, KFile *modem, mp1_callback_t callback);
void mp1Read(MP1 *mp1, int byte);
void mp1Poll(MP1 *mp1);
void mp1Send(MP1 *mp1, const void *_buffer, size_t length);
void mp1Send(MP1 *mp1, void *_buffer, size_t length);
int freeRam(void);
size_t compress(uint8_t *input, size_t length);

4
bertos/cpu/avr/drv/ser_mega.c
View File

@ -690,7 +690,9 @@ static void spi_init(UNUSED_ARG(struct SerialHardware *, _hw), UNUSED_ARG(struct
* - as input but tied high forever!
* This driver set the pin as output.
*/
#warning FIXME:SPI SS pin set as output for proper operation, check schematics for possible conflicts.
// Squelching this warning
// #warning FIXME:SPI SS pin set as output for proper operation, check schematics for possible conflicts.
ATOMIC(SPI_DDR |= BV(SPI_SS_BIT));
ATOMIC(SPI_DDR &= ~BV(SPI_MISO_BIT));

2
buildrev.h
View File

@ -1,2 +1,2 @@
#define VERS_BUILD 1206
#define VERS_BUILD 1281
#define VERS_HOST "vixen"