ascii_serial_com_register_pointers.c

Go to the documentation of this file.

#include "ascii_serial_com_register_pointers.h"
#include "asc_exception.h"
#include <assert.h>
 
/** \file */
 
#if REGWIDTHBYTES == 1
#define put_val_into_bytes(x, b) convert_uint8_to_hex(x, (b), true)
#define get_val_from_bytes(b) convert_hex_to_uint8((b))
#elif REGWIDTHBYTES == 2
#define put_val_into_bytes(x, b) convert_uint16_to_hex(x, (b), true)
#define get_val_from_bytes(b) convert_hex_to_uint16((b))
#elif REGWIDTHBYTES == 4
#define put_val_into_bytes(x, b) convert_uint32_to_hex(x, (b), true)
#define get_val_from_bytes(b) convert_hex_to_uint32((b))
#endif
 
void ascii_serial_com_register_pointers_init(
    ascii_serial_com_register_pointers *register_pointers_state,
    volatile REGTYPE **pointers, REGTYPE *write_masks, uint16_t n_regs) {
  register_pointers_state->pointers = pointers;
  register_pointers_state->write_masks = write_masks;
  register_pointers_state->n_regs = n_regs;
}
 
void ascii_serial_com_register_pointers_handle_message(
    ascii_serial_com *asc, char ascVersion, char appVersion, char command,
    char *data, size_t dataLen, void *register_pointers_state_vp) {
  if (!register_pointers_state_vp) {
    ascii_serial_com_put_error_in_output_buffer(asc, ascVersion, appVersion,
                                                command, data, dataLen,
                                                ASC_ERROR_REG_BLOCK_NULL);
    return;
  }
  const ascii_serial_com_register_pointers *register_pointers_state =
      (ascii_serial_com_register_pointers *)register_pointers_state_vp;
  if (command != 'r' && command != 'w') {
    ascii_serial_com_put_error_in_output_buffer(asc, ascVersion, appVersion,
                                                command, data, dataLen,
                                                ASC_ERROR_UNEXPECTED_COMMAND);
    return;
  }
  if (dataLen < 4) { // need room for reg num
    ascii_serial_com_put_error_in_output_buffer(asc, ascVersion, appVersion,
                                                command, data, dataLen,
                                                ASC_ERROR_DATA_TOO_SHORT);
    return;
  }
  uint16_t reg_num = convert_hex_to_uint16(data);
  if (reg_num >= register_pointers_state->n_regs) {
    ascii_serial_com_put_error_in_output_buffer(asc, ascVersion, appVersion,
                                                command, data, dataLen,
                                                ASC_ERROR_REGNUM_OOB);
    return;
  }
  volatile REGTYPE *pointer = register_pointers_state->pointers[reg_num];
  if (command == 'r') {
    REGTYPE reg_val = 0;
    if (pointer) {
      reg_val = *pointer;
    }
    data[4] = ',';
    put_val_into_bytes(reg_val, data + 5);
    dataLen = 5 + REGWIDTHBYTES * 2;
  } else {
    if (dataLen < 5 + REGWIDTHBYTES) {
      ascii_serial_com_put_error_in_output_buffer(asc, ascVersion, appVersion,
                                                  command, data, dataLen,
                                                  ASC_ERROR_REGVAL_LEN);
      return;
    }
    if (pointer) {
      REGTYPE new_reg_val = get_val_from_bytes(data + 5);
      REGTYPE mask = register_pointers_state->write_masks[reg_num];
      *pointer = (new_reg_val & mask) | (*pointer & ~mask);
    }
    dataLen = 4;
  }
  ascii_serial_com_put_message_in_output_buffer(asc, ascVersion, appVersion,
                                                command, data, dataLen);
}