board_periph_modem.c

Go to the documentation of this file.

 
#include "board_periph_modem.h"
 
#include <stdint.h>
#include <stdio.h>
#include <string.h>
 
#include "emu_host_io_internal.h"

typedef enum : uint32_t {
  k_modem_channel  = 7U,  
  k_modem_cmd_cap  = 64U, 
  k_modem_resp_cap = 96U, 
  k_modem_cr       = 13U, 
  k_modem_lf       = 10U, 
} modem_geom_t;

typedef struct {
  const char* cmd;  
  const char* resp; 
} modem_reply_t;

static const modem_reply_t s_k_modem_script[] = {
  {"AT", "\r\nOK\r\n"},
  {"ATE0", "\r\nOK\r\n"},
  {"AT+CMEE=1", "\r\nOK\r\n"},
  {"AT+CPIN?", "\r\n+CPIN: READY\r\n\r\nOK\r\n"},
  {"AT+CSQ", "\r\n+CSQ: 17,99\r\n\r\nOK\r\n"},
  {"AT+CREG=1", "\r\nOK\r\n\r\n+CREG: 1\r\n"},
  {"AT+CREG?", "\r\n+CREG: 1,1\r\n\r\nOK\r\n"},
  {"AT+CGATT?", "\r\n+CGATT: 1\r\n\r\nOK\r\n"},
};

static const char s_k_modem_cme_error[] = "\r\n+CME ERROR: 4\r\n";

typedef struct {
  bool     attached;             
  char     cmd[k_modem_cmd_cap]; 
  uint32_t cmd_len;              
  uint32_t answered;             
  uint32_t errors;               
} modem_model_t;

static modem_model_t s_modem;

RA8_INTERNAL static uint32_t internal_modem_emit(const char* resp, uint8_t* out, uint32_t out_cap)
{
  uint32_t n = 0U;
  while ((n < out_cap) && (resp[n] != '\0')) {
    out[n] = (uint8_t)resp[n];
    n++;
  }
  return n;
}

RA8_INTERNAL static uint32_t internal_modem_answer_line(uint8_t* out, uint32_t out_cap)
{
  s_modem.cmd[s_modem.cmd_len] = '\0';
  const uint32_t count         = (uint32_t)(sizeof(s_k_modem_script) / sizeof(s_k_modem_script[0]));
  for (uint32_t i = 0U; i < count; i++) {
    if (strcmp(s_modem.cmd, s_k_modem_script[i].cmd) == 0) {
      s_modem.answered++;
      return internal_modem_emit(s_k_modem_script[i].resp, out, out_cap);
    }
  }
  s_modem.errors++;
  return internal_modem_emit(s_k_modem_cme_error, out, out_cap);
}
 
bool board_modem_attach(void)
{
  s_modem.attached = true;
  board_modem_reset();
  return true;
}
 
bool board_modem_attached(void)
{
  return s_modem.attached;
}
 
uint8_t board_modem_channel(void)
{
  return (uint8_t)k_modem_channel;
}
 
uint32_t board_modem_feed_tx(uint8_t tx, uint8_t* out, uint32_t out_cap)
{
  if ((out == nullptr) || (out_cap == 0U)) {
    return 0U;
  }
  if (tx == (uint8_t)k_modem_lf) {
    return 0U; /* modems terminate on CR; LF (if any) is not a delimiter */
  }
  if (tx == (uint8_t)k_modem_cr) {
    const uint32_t n = internal_modem_answer_line(out, out_cap);
    s_modem.cmd_len  = 0U;
    return n;
  }
  if (s_modem.cmd_len < (uint32_t)(k_modem_cmd_cap - 1U)) {
    s_modem.cmd[s_modem.cmd_len] = (char)tx;
    s_modem.cmd_len++;
  }
  return 0U;
}
 
void board_modem_reset(void)
{
  s_modem.cmd_len = 0U;
  s_modem.cmd[0]  = '\0';
}
 
void board_modem_report(void)
{
  if (!s_modem.attached) {
    return;
  }
  if ((s_modem.answered == 0U) && (s_modem.errors == 0U)) {
    return;
  }
  (void)priv_emu_io_errf("  AT modem      : %u command(s) answered, %u +CME ERROR\n",
                         s_modem.answered,
                         s_modem.errors);
}