blob: 8b07700c1d94ca9dffd0f4284d4d64fd6f52f231 [file] [log] [blame]
/*
* Copyright (C) 2003, 2004, 2005, 2015 Filip Pizlo. All rights reserved.
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY FILIP PIZLO ``AS IS'' AND ANY
* EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL FILIP PIZLO OR
* CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
* EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
* PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
* PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY
* OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
#include "tsf_internal.h"
#include "tsf_serial_protocol.h"
#ifdef HAVE_PTHREAD
#include <pthread.h>
#endif
/* FIXME: add an recovery helper mode, where after some number of bytes X
* such that X/T > C, where T is the byte size of our current type map,
* we reset types. Also add an extended reset types command, which
* includes a longer magic string. */
static tsf_bool_t write_command(tsf_writer_t writer,
void *arg,
uint8_t command) {
return writer(arg, &command, sizeof(command));
}
static tsf_bool_t write_reset(tsf_writer_t writer,
void *arg) {
return writer(arg, TSF_SP_MAGIC_CODE, TSF_SP_MAGIC_LEN);
}
tsf_serial_out_man_t *tsf_serial_out_man_create(tsf_writer_t writer,
void *arg) {
tsf_serial_out_man_t *ret=malloc(sizeof(tsf_serial_out_man_t));
if (ret==NULL) {
tsf_set_errno("Could not malloc tsf_serial_out_man_t structure.");
return NULL;
}
ret->types=tsf_type_out_map_create();
if (ret->types==NULL) {
free(ret);
return NULL;
}
ret->writer=writer;
ret->arg=arg;
if (!write_reset(writer,arg)) {
tsf_type_out_map_destroy(ret->types);
free(ret);
return NULL;
}
return ret;
}
void tsf_serial_out_man_destroy(tsf_serial_out_man_t *out_man) {
tsf_type_out_map_destroy(out_man->types);
free(out_man);
}
tsf_bool_t tsf_serial_out_man_reset_types(tsf_serial_out_man_t *out_man) {
tsf_type_out_map_t *new_types;
new_types=tsf_type_out_map_create();
if (new_types==NULL) {
return tsf_false;
}
if (!write_reset(out_man->writer,
out_man->arg)) {
tsf_type_out_map_destroy(new_types);
return tsf_false;
}
tsf_type_out_map_destroy(out_man->types);
out_man->types=new_types;
return tsf_true;
}
tsf_bool_t tsf_serial_out_man_write_type(tsf_writer_t writer,
void *arg,
tsf_type_t *type) {
if (!write_command(writer,arg,TSF_SP_C_NEW_TYPE)) {
return tsf_false;
}
return tsf_type_write(type,writer,arg);
}
tsf_bool_t tsf_serial_out_man_write(tsf_serial_out_man_t *out_man,
tsf_buffer_t *buf) {
uint32_t i;
tsf_bool_t created;
uint32_t type_code;
if (!tsf_type_out_map_get_type_code(out_man->types,
buf->type,
NULL,
&created)) {
goto error;
}
if (created) {
if (!tsf_serial_out_man_write_type(out_man->writer,
out_man->arg,
buf->type)) {
goto error;
}
}
for (i = 0; i < tsf_type_in_map_get_num_types(buf->types); ++i) {
if (!tsf_type_out_map_get_type_code(
out_man->types,
tsf_type_in_map_get_type(buf->types, i),
NULL,
&created)) {
goto error;
}
if (created) {
if (!tsf_serial_out_man_write_type(
out_man->writer,
out_man->arg,
tsf_type_in_map_get_type(buf->types, i))) {
goto error;
}
}
}
if (!tsf_type_out_map_get_type_code(out_man->types,
buf->type,
&type_code,
NULL)) {
goto error;
}
if (type_code < TSF_SP_C_CF_DATA_BIT && buf->size < 256) {
if (!write_command(out_man->writer, out_man->arg, TSF_SP_C_CF_DATA_BIT | type_code)) {
goto error;
}
if (!tsf_buffer_write_small_with_type_code(buf,
out_man->types,
out_man->writer,
out_man->arg)) {
goto error;
}
} else {
if (!write_command(out_man->writer, out_man->arg, TSF_SP_C_DATA)) {
goto error;
}
if (!tsf_buffer_write_simple(buf,
type_code,
out_man->types,
out_man->writer,
out_man->arg)) {
goto error;
}
}
return tsf_true;
error:
return tsf_false;
}