OrgZephyr/zephyr
OrgZephyr
/
zephyr
mirror of https://github.com/zephyrproject-rtos/zephyr.git
1
0
Fork 0
Code Issues Releases Wiki Activity
zephyr/drivers/modem/wncm14a2a.c

1839 lines
42 KiB
C
Raw Blame History

/*
* Copyright (c) 2018 Foundries.io
*
* SPDX-License-Identifier: Apache-2.0
*/
#define SYS_LOG_DOMAIN "modem_wncm14a2a"
#define SYS_LOG_LEVEL CONFIG_SYS_LOG_MODEM_LEVEL
#include <logging/sys_log.h>
#include <zephyr/types.h>
#include <stddef.h>
#include <stdlib.h>
#include <ctype.h>
#include <errno.h>
#include <zephyr.h>
#include <gpio.h>
#include <device.h>
#include <init.h>
#include <net/net_context.h>
#include <net/net_if.h>
#include <net/net_offload.h>
#include <net/net_pkt.h>
#if defined(CONFIG_NET_UDP)
#include <net/udp.h>
#endif
#if defined(CONFIG_NET_TCP)
#include <net/tcp.h>
#endif
#include <drivers/modem/modem_receiver.h>
/* Uncomment the #define below to enable a hexdump of all incoming
* data from the modem receiver
*/
/* #define ENABLE_VERBOSE_MODEM_RECV_HEXDUMP 1 */
struct mdm_control_pinconfig {
char *dev_name;
u32_t pin;
};
#define PINCONFIG(name_, pin_) { \
.dev_name = name_, \
.pin = pin_ \
}
/* pin settings */
enum mdm_control_pins {
MDM_BOOT_MODE_SEL = 0,
MDM_POWER,
MDM_KEEP_AWAKE,
MDM_RESET,
SHLD_3V3_1V8_SIG_TRANS_ENA,
#ifdef CONFIG_WNCM14A2A_GPIO_MDM_SEND_OK_PIN
MDM_SEND_OK,
#endif
MAX_MDM_CONTROL_PINS,
};
static const struct mdm_control_pinconfig pinconfig[] = {
/* MDM_BOOT_MODE_SEL */
PINCONFIG(CONFIG_WNCM14A2A_GPIO_MDM_BOOT_MODE_SEL_NAME,
CONFIG_WNCM14A2A_GPIO_MDM_BOOT_MODE_SEL_PIN),
/* MDM_POWER */
PINCONFIG(CONFIG_WNCM14A2A_GPIO_MDM_POWER_NAME,
CONFIG_WNCM14A2A_GPIO_MDM_POWER_PIN),
/* MDM_KEEP_AWAKE */
PINCONFIG(CONFIG_WNCM14A2A_GPIO_MDM_KEEP_AWAKE_NAME,
CONFIG_WNCM14A2A_GPIO_MDM_KEEP_AWAKE_PIN),
/* MDM_RESET */
PINCONFIG(CONFIG_WNCM14A2A_GPIO_MDM_RESET_NAME,
CONFIG_WNCM14A2A_GPIO_MDM_RESET_PIN),
/* SHLD_3V3_1V8_SIG_TRANS_ENA */
PINCONFIG(CONFIG_WNCM14A2A_GPIO_MDM_SHLD_TRANS_ENA_NAME,
CONFIG_WNCM14A2A_GPIO_MDM_SHLD_TRANS_ENA_PIN),
#ifdef CONFIG_WNCM14A2A_GPIO_MDM_SEND_OK_PIN
/* MDM_SEND_OK */
PINCONFIG(CONFIG_WNCM14A2A_GPIO_MDM_SEND_OK_NAME,
CONFIG_WNCM14A2A_GPIO_MDM_SEND_OK_PIN),
#endif
};
#define MDM_UART_DEV_NAME CONFIG_WNCM14A2A_UART_DRV_NAME
#define MDM_BOOT_MODE_SPECIAL 0
#define MDM_BOOT_MODE_NORMAL 1
#define MDM_POWER_ENABLE 0
#define MDM_POWER_DISABLE 1
#define MDM_KEEP_AWAKE_DISABLED 0
#define MDM_KEEP_AWAKE_ENABLED 1
#define MDM_RESET_NOT_ASSERTED 0
#define MDM_RESET_ASSERTED 1
#define SHLD_3V3_1V8_SIG_TRANS_DISABLED 0
#define SHLD_3V3_1V8_SIG_TRANS_ENABLED 1
#define MDM_SEND_OK_ENABLED 0
#define MDM_SEND_OK_DISABLED 1
#define MDM_CMD_TIMEOUT K_SECONDS(5)
#define MDM_CMD_SEND_TIMEOUT K_SECONDS(10)
#define MDM_CMD_CONN_TIMEOUT K_SECONDS(31)
#define MDM_MAX_DATA_LENGTH 1500
#define MDM_RECV_MAX_BUF 30
#define MDM_RECV_BUF_SIZE 128
#define MDM_MAX_SOCKETS 6
#define BUF_ALLOC_TIMEOUT K_SECONDS(1)
#define CMD_HANDLER(cmd_, cb_) { \
.cmd = cmd_, \
.cmd_len = (u16_t)sizeof(cmd_)-1, \
.func = on_cmd_ ## cb_ \
}
#define MDM_MANUFACTURER_LENGTH 10
#define MDM_MODEL_LENGTH 16
#define MDM_REVISION_LENGTH 64
#define MDM_IMEI_LENGTH 16
#define RSSI_TIMEOUT_SECS 30
NET_BUF_POOL_DEFINE(mdm_recv_pool, MDM_RECV_MAX_BUF, MDM_RECV_BUF_SIZE,
0, NULL);
static u8_t mdm_recv_buf[MDM_MAX_DATA_LENGTH];
/* RX thread structures */
K_THREAD_STACK_DEFINE(wncm14a2a_rx_stack,
CONFIG_MODEM_WNCM14A2A_RX_STACK_SIZE);
struct k_thread wncm14a2a_rx_thread;
/* RX thread work queue */
K_THREAD_STACK_DEFINE(wncm14a2a_workq_stack,
CONFIG_MODEM_WNCM14A2A_RX_WORKQ_STACK_SIZE);
static struct k_work_q wncm14a2a_workq;
struct wncm14a2a_socket {
struct net_context *context;
sa_family_t family;
enum net_sock_type type;
enum net_ip_protocol ip_proto;
struct sockaddr src;
struct sockaddr dst;
int socket_id;
bool socket_reading;
/** semaphore */
struct k_sem sock_send_sem;
/** socket callbacks */
struct k_work recv_cb_work;
net_context_recv_cb_t recv_cb;
struct net_pkt *recv_pkt;
void *recv_user_data;
};
struct wncm14a2a_iface_ctx {
struct net_if *iface;
u8_t mac_addr[6];
/* GPIO PORT devices */
struct device *gpio_port_dev[MAX_MDM_CONTROL_PINS];
/* RX specific attributes */
struct mdm_receiver_context mdm_ctx;
/* socket data */
struct wncm14a2a_socket sockets[MDM_MAX_SOCKETS];
int last_socket_id;
int last_error;
/* semaphores */
struct k_sem response_sem;
/* RSSI work */
struct k_delayed_work rssi_query_work;
/* modem data */
char mdm_manufacturer[MDM_MANUFACTURER_LENGTH];
char mdm_model[MDM_MODEL_LENGTH];
char mdm_revision[MDM_REVISION_LENGTH];
char mdm_imei[MDM_IMEI_LENGTH];
/* modem state */
int ev_csps;
int ev_rrcstate;
};
struct cmd_handler {
const char *cmd;
u16_t cmd_len;
void (*func)(struct net_buf **buf, u16_t len);
};
static struct wncm14a2a_iface_ctx ictx;
static void wncm14a2a_read_rx(struct net_buf **buf);
/*** Verbose Debugging Functions ***/
#if defined(ENABLE_VERBOSE_MODEM_RECV_HEXDUMP)
static inline void _hexdump(const u8_t *packet, size_t length)
{
char output[sizeof("xxxxyyyy xxxxyyyy")];
int n = 0, k = 0;
u8_t byte;
while (length--) {
if (n % 16 == 0) {
printk(" %08X ", n);
}
byte = *packet++;
printk("%02X ", byte);
if (byte < 0x20 || byte > 0x7f) {
output[k++] = '.';
} else {
output[k++] = byte;
}
n++;
if (n % 8 == 0) {
if (n % 16 == 0) {
output[k] = '\0';
printk(" [%s]\n", output);
k = 0;
} else {
printk(" ");
}
}
}
if (n % 16) {
int i;
output[k] = '\0';
for (i = 0; i < (16 - (n % 16)); i++) {
printk(" ");
}
if ((n % 16) < 8) {
printk(" "); /* one extra delimiter after 8 chars */
}
printk(" [%s]\n", output);
}
}
#else
#define _hexdump(...)
#endif
static struct wncm14a2a_socket *socket_get(void)
{
int i;
struct wncm14a2a_socket *sock = NULL;
for (i = 0; i < MDM_MAX_SOCKETS; i++) {
if (!ictx.sockets[i].context) {
sock = &ictx.sockets[i];
break;
}
}
return sock;
}
static struct wncm14a2a_socket *socket_from_id(int socket_id)
{
int i;
struct wncm14a2a_socket *sock = NULL;
if (socket_id < 1) {
return NULL;
}
for (i = 0; i < MDM_MAX_SOCKETS; i++) {
if (ictx.sockets[i].socket_id == socket_id) {
sock = &ictx.sockets[i];
break;
}
}
return sock;
}
static void socket_put(struct wncm14a2a_socket *sock)
{
if (!sock) {
return;
}
sock->context = NULL;
sock->socket_id = 0;
(void)memset(&sock->src, 0, sizeof(struct sockaddr));
(void)memset(&sock->dst, 0, sizeof(struct sockaddr));
}
char *wncm14a2a_sprint_ip_addr(const struct sockaddr *addr)
{
static char buf[NET_IPV6_ADDR_LEN];
#if defined(CONFIG_NET_IPV6)
if (addr->sa_family == AF_INET6) {
return net_addr_ntop(AF_INET6, &net_sin6(addr)->sin6_addr,
buf, sizeof(buf));
} else
#endif
#if defined(CONFIG_NET_IPV4)
if (addr->sa_family == AF_INET) {
return net_addr_ntop(AF_INET, &net_sin(addr)->sin_addr,
buf, sizeof(buf));
} else
#endif
{
SYS_LOG_ERR("Unknown IP address family:%d", addr->sa_family);
return NULL;
}
}
/* Send an AT command with a series of response handlers */
static int send_at_cmd(struct wncm14a2a_socket *sock,
const u8_t *data, int timeout)
{
int ret;
ictx.last_error = 0;
SYS_LOG_DBG("OUT: [%s]", data);
mdm_receiver_send(&ictx.mdm_ctx, data, strlen(data));
mdm_receiver_send(&ictx.mdm_ctx, "\r\n", 2);
if (timeout == K_NO_WAIT) {
return 0;
}
if (!sock) {
k_sem_reset(&ictx.response_sem);
ret = k_sem_take(&ictx.response_sem, timeout);
} else {
k_sem_reset(&sock->sock_send_sem);
ret = k_sem_take(&sock->sock_send_sem, timeout);
}
if (ret == 0) {
ret = ictx.last_error;
} else if (ret == -EAGAIN) {
ret = -ETIMEDOUT;
}
return ret;
}
static int send_data(struct wncm14a2a_socket *sock, struct net_pkt *pkt)
{
int ret;
struct net_buf *frag;
char buf[sizeof("AT@SOCKWRITE=#,####,1\r")];
if (!sock) {
return -EINVAL;
}
ictx.last_error = 0;
frag = pkt->frags;
/* use SOCKWRITE with binary mode formatting */
snprintk(buf, sizeof(buf), "AT@SOCKWRITE=%d,%u,1\r",
sock->socket_id, net_buf_frags_len(frag));
mdm_receiver_send(&ictx.mdm_ctx, buf, strlen(buf));
/* Loop through packet data and send */
while (frag) {
mdm_receiver_send(&ictx.mdm_ctx,
frag->data, frag->len);
frag = frag->frags;
}
mdm_receiver_send(&ictx.mdm_ctx, "\r\n", 2);
k_sem_reset(&sock->sock_send_sem);
ret = k_sem_take(&sock->sock_send_sem, MDM_CMD_SEND_TIMEOUT);
if (ret == 0) {
ret = ictx.last_error;
} else if (ret == -EAGAIN) {
ret = -ETIMEDOUT;
}
return ret;
}
/*** NET_BUF HELPERS ***/
static bool is_crlf(u8_t c)
{
if (c == '\n' || c == '\r') {
return true;
} else {
return false;
}
}
static void net_buf_skipcrlf(struct net_buf **buf)
{
/* chop off any /n or /r */
while (*buf && is_crlf(*(*buf)->data)) {
net_buf_pull_u8(*buf);
if (!(*buf)->len) {
*buf = net_buf_frag_del(NULL, *buf);
}
}
}
static u16_t net_buf_findcrlf(struct net_buf *buf, struct net_buf **frag,
u16_t *offset)
{
u16_t len = 0, pos = 0;
while (buf && !is_crlf(*(buf->data + pos))) {
if (pos + 1 >= buf->len) {
len += buf->len;
buf = buf->frags;
pos = 0;
} else {
pos++;
}
}
if (buf && is_crlf(*(buf->data + pos))) {
len += pos;
*offset = pos;
*frag = buf;
return len;
}
return 0;
}
/*** UDP / TCP Helper Function ***/
/* Setup IP header data to be used by some network applications.
* While much is dummy data, some fields such as dst, port and family are
* important.
* Return the IP + protocol header length.
*/
static int net_pkt_setup_ip_data(struct net_pkt *pkt,
struct wncm14a2a_socket *sock)
{
int hdr_len = 0;
u16_t src_port = 0, dst_port = 0;
#if defined(CONFIG_NET_IPV6)
if (net_pkt_family(pkt) == AF_INET6) {
net_buf_add(pkt->frags, NET_IPV6H_LEN);
/* set IPv6 data */
NET_IPV6_HDR(pkt)->vtc = 0x60;
NET_IPV6_HDR(pkt)->tcflow = 0;
NET_IPV6_HDR(pkt)->flow = 0;
net_ipaddr_copy(&NET_IPV6_HDR(pkt)->src,
&((struct sockaddr_in6 *)&sock->dst)->sin6_addr);
net_ipaddr_copy(&NET_IPV6_HDR(pkt)->dst,
&((struct sockaddr_in6 *)&sock->src)->sin6_addr);
NET_IPV6_HDR(pkt)->nexthdr = sock->ip_proto;
src_port = net_sin6(&sock->dst)->sin6_port;
dst_port = net_sin6(&sock->src)->sin6_port;
net_pkt_set_ip_hdr_len(pkt, sizeof(struct net_ipv6_hdr));
net_pkt_set_ipv6_ext_len(pkt, 0);
hdr_len = sizeof(struct net_ipv6_hdr);
} else
#endif
#if defined(CONFIG_NET_IPV4)
if (net_pkt_family(pkt) == AF_INET) {
net_buf_add(pkt->frags, NET_IPV4H_LEN);
/* set IPv4 data */
NET_IPV4_HDR(pkt)->vhl = 0x45;
NET_IPV4_HDR(pkt)->tos = 0x00;
net_ipaddr_copy(&NET_IPV4_HDR(pkt)->src,
&((struct sockaddr_in *)&sock->dst)->sin_addr);
net_ipaddr_copy(&NET_IPV4_HDR(pkt)->dst,
&((struct sockaddr_in *)&sock->src)->sin_addr);
NET_IPV4_HDR(pkt)->proto = sock->ip_proto;
src_port = net_sin(&sock->dst)->sin_port;
dst_port = net_sin(&sock->src)->sin_port;
net_pkt_set_ip_hdr_len(pkt, sizeof(struct net_ipv4_hdr));
hdr_len = sizeof(struct net_ipv4_hdr);
} else
#endif
{
/* no error here as hdr_len is checked later for 0 value */
}
#if defined(CONFIG_NET_UDP)
if (sock->ip_proto == IPPROTO_UDP) {
struct net_udp_hdr hdr, *udp;
net_buf_add(pkt->frags, NET_UDPH_LEN);
udp = net_udp_get_hdr(pkt, &hdr);
(void)memset(udp, 0, NET_UDPH_LEN);
/* Setup UDP header */
udp->src_port = src_port;
udp->dst_port = dst_port;
net_udp_set_hdr(pkt, udp);
hdr_len += NET_UDPH_LEN;
} else
#endif
#if defined(CONFIG_NET_TCP)
if (sock->ip_proto == IPPROTO_TCP) {
struct net_tcp_hdr hdr, *tcp;
net_buf_add(pkt->frags, NET_TCPH_LEN);
tcp = net_tcp_get_hdr(pkt, &hdr);
(void)memset(tcp, 0, NET_TCPH_LEN);
/* Setup TCP header */
tcp->src_port = src_port;
tcp->dst_port = dst_port;
net_tcp_set_hdr(pkt, tcp);
hdr_len += NET_TCPH_LEN;
} else
#endif /* CONFIG_NET_TCP */
{
/* no error here as hdr_len is checked later for 0 value */
}
return hdr_len;
}
/*** MODEM RESPONSE HANDLERS ***/
/* Last Socket ID Handler */
static void on_cmd_atcmdecho(struct net_buf **buf, u16_t len)
{
char value[2];
/* make sure only a single digit is picked up for socket_id */
value[0] = net_buf_pull_u8(*buf);
ictx.last_socket_id = atoi(value);
}
/* Echo Handler for commands without related sockets */
static void on_cmd_atcmdecho_nosock(struct net_buf **buf, u16_t len)
{
/* clear last_socket_id */
ictx.last_socket_id = 0;
}
static void on_cmd_atcmdinfo_manufacturer(struct net_buf **buf, u16_t len)
{
net_buf_linearize(ictx.mdm_manufacturer, sizeof(ictx.mdm_manufacturer),
*buf, 0, len);
SYS_LOG_INF("Manufacturer: %s", ictx.mdm_manufacturer);
}
static void on_cmd_atcmdinfo_model(struct net_buf **buf, u16_t len)
{
net_buf_linearize(ictx.mdm_model, sizeof(ictx.mdm_model),
*buf, 0, len);
SYS_LOG_INF("Model: %s", ictx.mdm_model);
}
static void on_cmd_atcmdinfo_revision(struct net_buf **buf, u16_t len)
{
net_buf_linearize(ictx.mdm_revision, sizeof(ictx.mdm_revision),
*buf, 0, len);
SYS_LOG_INF("Revision: %s", ictx.mdm_revision);
}
static void on_cmd_atcmdecho_nosock_imei(struct net_buf **buf, u16_t len)
{
struct net_buf *frag = NULL;
u16_t offset;
/* make sure IMEI data is received */
if (len < MDM_IMEI_LENGTH) {
SYS_LOG_DBG("Waiting for data");
/* wait for more data */
k_sleep(K_MSEC(100));
wncm14a2a_read_rx(buf);
}
net_buf_skipcrlf(buf);
if (!*buf) {
SYS_LOG_DBG("Unable to find IMEI (net_buf_skipcrlf)");
return;
}
frag = NULL;
len = net_buf_findcrlf(*buf, &frag, &offset);
if (!frag) {
SYS_LOG_DBG("Unable to find IMEI (net_buf_findcrlf)");
return;
}
net_buf_linearize(ictx.mdm_imei, sizeof(ictx.mdm_imei), *buf, 0, len);
SYS_LOG_INF("IMEI: %s", ictx.mdm_imei);
}
/* Handler: %MEAS: RSSI:Reported= -68, Ant0= -63, Ant1= -251 */
static void on_cmd_atcmdinfo_rssi(struct net_buf **buf, u16_t len)
{
int start = 0, i = 0;
size_t value_size;
char value[64];
value_size = sizeof(value);
(void)memset(value, 0, value_size);
while (*buf && len > 0 && i < value_size) {
value[i] = net_buf_pull_u8(*buf);
if (!(*buf)->len) {
*buf = net_buf_frag_del(NULL, *buf);
}
/* 2nd "=" marks the beginning of the RSSI value */
if (start < 2) {
if (value[i] == '=') {
start++;
}
continue;
}
/* "," marks the end of the RSSI value */
if (value[i] == ',') {
value[i] = '\0';
break;
}
i++;
}
if (i > 0) {
ictx.mdm_ctx.data_rssi = atoi(value);
SYS_LOG_INF("RSSI: %d", ictx.mdm_ctx.data_rssi);
} else {
SYS_LOG_WRN("Bad format found for RSSI");
}
}
/* Handler: OK */
static void on_cmd_sockok(struct net_buf **buf, u16_t len)
{
struct wncm14a2a_socket *sock = NULL;
ictx.last_error = 0;
sock = socket_from_id(ictx.last_socket_id);
if (!sock) {
k_sem_give(&ictx.response_sem);
} else {
k_sem_give(&sock->sock_send_sem);
}
}
/* Handler: ERROR */
static void on_cmd_sockerror(struct net_buf **buf, u16_t len)
{
struct wncm14a2a_socket *sock = NULL;
ictx.last_error = -EIO;
sock = socket_from_id(ictx.last_socket_id);
if (!sock) {
k_sem_give(&ictx.response_sem);
} else {
k_sem_give(&sock->sock_send_sem);
}
}
/* Handler: @EXTERR:<exterror_id> */
static void on_cmd_sockexterror(struct net_buf **buf, u16_t len)
{
char value[8];
struct wncm14a2a_socket *sock = NULL;
net_buf_linearize(value, sizeof(value), *buf, 0, len);
ictx.last_error = -atoi(value);
SYS_LOG_ERR("@EXTERR:%d", ictx.last_error);
sock = socket_from_id(ictx.last_socket_id);
if (!sock) {
k_sem_give(&ictx.response_sem);
} else {
k_sem_give(&sock->sock_send_sem);
}
}
/* Handler: @SOCKDIAL:<status> */
static void on_cmd_sockdial(struct net_buf **buf, u16_t len)
{
char value[8];
net_buf_linearize(value, sizeof(value), *buf, 0, len);
ictx.last_error = atoi(value);
k_sem_give(&ictx.response_sem);
}
/* Handler: @SOCKCREAT:<socket_id> */
static void on_cmd_sockcreat(struct net_buf **buf, u16_t len)
{
char value[2];
struct wncm14a2a_socket *sock = NULL;
/* look up new socket by special id */
sock = socket_from_id(MDM_MAX_SOCKETS + 1);
if (sock) {
/* make sure only a single digit is picked up for socket_id */
value[0] = net_buf_pull_u8(*buf);
sock->socket_id = atoi(value);
}
/* don't give back semaphore -- OK to follow */
}
/* Handler: @SOCKWRITE:<actual_length> */
static void on_cmd_sockwrite(struct net_buf **buf, u16_t len)
{
char value[8];
int write_len;
struct wncm14a2a_socket *sock = NULL;
/* TODO: check against what we wanted to send */
net_buf_linearize(value, sizeof(value), *buf, 0, len);
write_len = atoi(value);
if (write_len <= 0) {
return;
}
sock = socket_from_id(ictx.last_socket_id);
if (sock) {
k_sem_give(&sock->sock_send_sem);
}
}
static void sockreadrecv_cb_work(struct k_work *work)
{
struct wncm14a2a_socket *sock = NULL;
struct net_pkt *pkt;
sock = CONTAINER_OF(work, struct wncm14a2a_socket, recv_cb_work);
/* return data */
pkt = sock->recv_pkt;
sock->recv_pkt = NULL;
if (sock->recv_cb) {
sock->recv_cb(sock->context, pkt, 0, sock->recv_user_data);
} else {
net_pkt_unref(pkt);
}
}
/* Handler: @SOCKREAD:<actual_length>,"<hex encoded binary>" */
static void on_cmd_sockread(struct net_buf **buf, u16_t len)
{
struct wncm14a2a_socket *sock = NULL;
struct net_buf *frag;
u8_t c = 0;
u16_t pos;
int i, actual_length, hdr_len = 0;
size_t value_size;
char value[10];
/* first comma marks the end of actual_length */
i = 0;
value_size = sizeof(value);
(void)memset(value, 0, value_size);
while (*buf && i < value_size) {
value[i++] = net_buf_pull_u8(*buf);
len--;
if (!(*buf)->len) {
*buf = net_buf_frag_del(NULL, *buf);
}
if (value[i-1] == ',') {
i--;
break;
}
}
/* make sure we still have buf data, the last pulled character was
* a comma and that the next char in the buffer is a quote.
*/
if (!*buf || value[i] != ',' || *(*buf)->data != '\"') {
SYS_LOG_ERR("Incorrect format! Ignoring data!");
return;
}
/* clear the comma */
value[i] = '\0';
actual_length = atoi(value);
/* skip quote */
len--;
net_buf_pull_u8(*buf);
if (!(*buf)->len) {
*buf = net_buf_frag_del(NULL, *buf);
}
/* check that we have enough data */
if (!*buf || len > (actual_length * 2) + 1) {
SYS_LOG_ERR("Incorrect format! Ignoring data!");
return;
}
sock = socket_from_id(ictx.last_socket_id);
if (!sock) {
SYS_LOG_ERR("Socket not found! (%d)", ictx.last_socket_id);
return;
}
/* allocate an RX pkt */
sock->recv_pkt = net_pkt_get_rx(sock->context, BUF_ALLOC_TIMEOUT);
if (!sock->recv_pkt) {
SYS_LOG_ERR("Failed net_pkt_get_reserve_rx!");
goto cleanup;
}
/* set pkt data */
net_pkt_set_context(sock->recv_pkt, sock->context);
net_pkt_set_family(sock->recv_pkt, sock->family);
/* add a data buffer */
frag = net_pkt_get_frag(sock->recv_pkt, BUF_ALLOC_TIMEOUT);
if (!frag) {
SYS_LOG_ERR("Failed net_pkt_get_frag!");
net_pkt_unref(sock->recv_pkt);
sock->recv_pkt = NULL;
goto cleanup;
}
net_pkt_frag_add(sock->recv_pkt, frag);
/* add IP / protocol headers */
hdr_len = net_pkt_setup_ip_data(sock->recv_pkt, sock);
/* move hex encoded data from the buffer to the recv_pkt */
for (i = 0; i < actual_length * 2; i++) {
char c2 = *(*buf)->data;
if (isdigit(c2)) {
c += c2 - '0';
} else if (isalpha(c2)) {
c += c2 - (isupper(c2) ? 'A' - 10 : 'a' - 10);
} else {
/* TODO: unexpected input! skip? */
}
if (i % 2) {
pos = net_pkt_append(sock->recv_pkt, 1, &c,
BUF_ALLOC_TIMEOUT);
if (pos != 1) {
SYS_LOG_ERR("Unable to add data! Aborting!");
net_pkt_unref(sock->recv_pkt);
sock->recv_pkt = NULL;
goto cleanup;
}
c = 0;
} else {
c = c << 4;
}
/* pull data from buf and advance to the next frag if needed */
net_buf_pull_u8(*buf);
if (!(*buf)->len) {
*buf = net_buf_frag_del(NULL, *buf);
}
}
net_pkt_set_appdatalen(sock->recv_pkt, actual_length);
if (hdr_len > 0) {
frag = net_frag_get_pos(sock->recv_pkt, hdr_len, &pos);
NET_ASSERT(frag);
net_pkt_set_appdata(sock->recv_pkt, frag->data + pos);
} else {
net_pkt_set_appdata(sock->recv_pkt,
sock->recv_pkt->frags->data);
}
/* Let's do the callback processing in a different work queue in
* case the app takes a long time.
*/
k_work_submit_to_queue(&wncm14a2a_workq, &sock->recv_cb_work);
cleanup:
sock->socket_reading = false;
}
/* Handler: @SOCKDATAIND: <socket_id>,<session_status>,<left_bytes> */
static void on_cmd_sockdataind(struct net_buf **buf, u16_t len)
{
int socket_id, session_status, left_bytes;
char *delim1, *delim2;
char value[sizeof("#,#,#####\r")];
char sendbuf[sizeof("AT@SOCKREAD=#,#####\r")];
struct wncm14a2a_socket *sock = NULL;
net_buf_linearize(value, sizeof(value), *buf, 0, len);
/* First comma separator marks the end of socket_id */
delim1 = strchr(value, ',');
if (!delim1) {
SYS_LOG_ERR("Missing 1st comma");
return;
}
*delim1++ = '\0';
socket_id = atoi(value);
/* Second comma separator marks the end of session_status */
/* TODO: ignore for now, but maybe this is useful? */
delim2 = strchr(delim1, ',');
if (!delim2) {
SYS_LOG_ERR("Missing 2nd comma");
return;
}
*delim2++ = '\0';
session_status = atoi(delim1);
/* Third param is for left_bytes */
/* TODO: ignore for now because we ask for max data len
* but maybe this is useful in the future?
*/
left_bytes = atoi(delim2);
sock = socket_from_id(socket_id);
if (!sock) {
SYS_LOG_ERR("Unable to find socket_id:%d", socket_id);
return;
}
if (left_bytes > 0) {
if (!sock->socket_reading) {
SYS_LOG_DBG("socket_id:%d left_bytes:%d",
socket_id, left_bytes);
/* TODO: add a timeout to unset this */
sock->socket_reading = true;
snprintk(sendbuf, sizeof(sendbuf), "AT@SOCKREAD=%d,%d",
sock->socket_id, left_bytes);
/* We still have a lock from hitting this cmd trigger,
* so don't hold one when we send the new command
*/
send_at_cmd(sock, sendbuf, K_NO_WAIT);
} else {
SYS_LOG_DBG("SKIPPING socket_id:%d left_bytes:%d",
socket_id, left_bytes);
}
}
}
static void on_cmd_socknotifyev(struct net_buf **buf, u16_t len)
{
char value[40];
int p1 = 0, p2 = 0;
net_buf_linearize(value, sizeof(value), *buf, 0, len);
/* walk value till 1st quote */
while (p1 < len && value[p1] != '\"') {
p1++;
}
if (value[p1] != '\"') {
/* 1st quote not found */
return;
}
p1++;
p2 = p1;
while (p2 < len && value[p2] != '\"') {
p2++;
}
if (value[p2] != '\"') {
/* 2nd quote not found */
return;
}
/* clear quote */
value[p2] = '\0';
p2++;
/* skip comma if present */
if (value[p2] == ',') {
p2++;
}
/* CSPS: 0: Moved to PS mode, 1: Moved to CS/PS mode */
if (!strncmp(&value[p1], "CSPS", 4)) {
ictx.ev_csps = atoi(&value[p2]);
/* This also signifies that RRCSTATE = 1 */
ictx.ev_rrcstate = 1;
SYS_LOG_DBG("CSPS:%d", ictx.ev_csps);
/* RRCSTATE: 0: RRC Idle, 1: RRC Connected, 2: RRC Unknown */
} else if (!strncmp(&value[p1], "RRCSTATE", 8)) {
ictx.ev_rrcstate = atoi(&value[p2]);
SYS_LOG_DBG("RRCSTATE:%d", ictx.ev_rrcstate);
} else if (!strncmp(&value[p1], "LTIME", 5)) {
/* local time from network */
SYS_LOG_INF("LTIME:%s", &value[p2]);
} else if (!strncmp(&value[p1], "SIB1", 4)) {
/* do nothing? */
SYS_LOG_DBG("SIB1");
} else {
SYS_LOG_DBG("UNHANDLED: [%s:%s]", &value[p1], &value[p2]);
}
}
static int net_buf_ncmp(struct net_buf *buf, const u8_t *s2, size_t n)
{
struct net_buf *frag = buf;
u16_t offset = 0;
while ((n > 0) && (*(frag->data + offset) == *s2) && (*s2 != '\0')) {
if (offset == frag->len) {
if (!frag->frags) {
break;
}
frag = frag->frags;
offset = 0;
} else {
offset++;
}
s2++;
n--;
}
return (n == 0) ? 0 : (*(frag->data + offset) - *s2);
}
static inline struct net_buf *read_rx_allocator(s32_t timeout, void *user_data)
{
return net_buf_alloc((struct net_buf_pool *)user_data, timeout);
}
static void wncm14a2a_read_rx(struct net_buf **buf)
{
u8_t uart_buffer[MDM_RECV_BUF_SIZE];
size_t bytes_read = 0;
int ret;
u16_t rx_len;
/* read all of the data from mdm_receiver */
while (true) {
ret = mdm_receiver_recv(&ictx.mdm_ctx,
uart_buffer,
sizeof(uart_buffer),
&bytes_read);
if (ret < 0) {
/* mdm_receiver buffer is empty */
break;
}
_hexdump(uart_buffer, bytes_read);
/* make sure we have storage */
if (!*buf) {
*buf = net_buf_alloc(&mdm_recv_pool, BUF_ALLOC_TIMEOUT);
if (!*buf) {
SYS_LOG_ERR("Can't allocate RX data! "
"Skipping data!");
break;
}
}
rx_len = net_buf_append_bytes(*buf, bytes_read, uart_buffer,
BUF_ALLOC_TIMEOUT,
read_rx_allocator,
&mdm_recv_pool);
if (rx_len < bytes_read) {
SYS_LOG_ERR("Data was lost! read %u of %u!",
rx_len, bytes_read);
}
}
}
/* RX thread */
static void wncm14a2a_rx(void)
{
struct net_buf *rx_buf = NULL;
struct net_buf *frag = NULL;
int i;
u16_t offset, len;
static const struct cmd_handler handlers[] = {
/* NON-SOCKET COMMAND ECHOES to clear last_socket_id */
CMD_HANDLER("ATE1", atcmdecho_nosock),
CMD_HANDLER("AT%PDNSET=", atcmdecho_nosock),
CMD_HANDLER("ATI", atcmdecho_nosock),
CMD_HANDLER("AT+CGSN", atcmdecho_nosock_imei),
CMD_HANDLER("AT%MEAS=", atcmdecho_nosock),
CMD_HANDLER("AT@INTERNET=", atcmdecho_nosock),
CMD_HANDLER("AT@SOCKDIAL=", atcmdecho_nosock),
CMD_HANDLER("AT@SOCKCREAT=", atcmdecho_nosock),
/* SOCKET COMMAND ECHOES for last_socket_id processing */
CMD_HANDLER("AT@SOCKCONN=", atcmdecho),
CMD_HANDLER("AT@SOCKWRITE=", atcmdecho),
CMD_HANDLER("AT@SOCKREAD=", atcmdecho),
CMD_HANDLER("AT@SOCKCLOSE=", atcmdecho),
/* MODEM Information */
CMD_HANDLER("Manufacturer: ", atcmdinfo_manufacturer),
CMD_HANDLER("Model: ", atcmdinfo_model),
CMD_HANDLER("Revision: ", atcmdinfo_revision),
CMD_HANDLER("%MEAS: RSSI:", atcmdinfo_rssi),
/* SOLICITED SOCKET RESPONSES */
CMD_HANDLER("OK", sockok),
CMD_HANDLER("ERROR", sockerror),
CMD_HANDLER("@EXTERR:", sockexterror),
CMD_HANDLER("@SOCKDIAL:", sockdial),
CMD_HANDLER("@SOCKCREAT:", sockcreat),
CMD_HANDLER("@OCKCREAT:", sockcreat), /* seeing this a lot */
CMD_HANDLER("@SOCKWRITE:", sockwrite),
CMD_HANDLER("@SOCKREAD:", sockread),
/* UNSOLICITED SOCKET RESPONSES */
CMD_HANDLER("@SOCKDATAIND:", sockdataind),
CMD_HANDLER("%NOTIFYEV:", socknotifyev),
};
while (true) {
/* wait for incoming data */
k_sem_take(&ictx.mdm_ctx.rx_sem, K_FOREVER);
wncm14a2a_read_rx(&rx_buf);
while (rx_buf) {
net_buf_skipcrlf(&rx_buf);
if (!rx_buf) {
break;
}
frag = NULL;
len = net_buf_findcrlf(rx_buf, &frag, &offset);
if (!frag) {
break;
}
/* look for matching data handlers */
i = -1;
for (i = 0; i < ARRAY_SIZE(handlers); i++) {
if (net_buf_ncmp(rx_buf, handlers[i].cmd,
handlers[i].cmd_len) == 0) {
/* found a matching handler */
SYS_LOG_DBG("MATCH %s (len:%u)",
handlers[i].cmd, len);
/* skip cmd_len */
rx_buf = net_buf_skip(rx_buf,
handlers[i].cmd_len);
/* locate next cr/lf */
frag = NULL;
len = net_buf_findcrlf(rx_buf,
&frag, &offset);
if (!frag) {
break;
}
/* call handler */
if (handlers[i].func) {
handlers[i].func(&rx_buf, len);
}
frag = NULL;
/* make sure buf still has data */
if (!rx_buf) {
break;
}
/* locate next cr/lf */
len = net_buf_findcrlf(rx_buf,
&frag, &offset);
if (!frag) {
break;
}
break;
}
}
if (frag && rx_buf) {
/* clear out processed line (buffers) */
while (frag && rx_buf != frag) {
rx_buf = net_buf_frag_del(NULL, rx_buf);
}
net_buf_pull(rx_buf, offset);
}
}
/* give up time if we have a solid stream of data */
k_yield();
}
}
static int modem_pin_init(void)
{
SYS_LOG_INF("Setting Modem Pins");
/* Hard reset the modem (>5 seconds required)
* (doesn't go through the signal level translator)
*/
SYS_LOG_DBG("MDM_RESET_PIN -> ASSERTED");
gpio_pin_write(ictx.gpio_port_dev[MDM_RESET],
pinconfig[MDM_RESET].pin, MDM_RESET_ASSERTED);
k_sleep(K_SECONDS(7));
SYS_LOG_DBG("MDM_RESET_PIN -> NOT_ASSERTED");
gpio_pin_write(ictx.gpio_port_dev[MDM_RESET],
pinconfig[MDM_RESET].pin, MDM_RESET_NOT_ASSERTED);
/* disable signal level translator (necessary
* for the modem to boot properly). All signals
* except mdm_reset go through the level translator
* and have internal pull-up/down in the module. While
* the level translator is disabled, these pins will
* be in the correct state.
*/
SYS_LOG_DBG("SIG_TRANS_ENA_PIN -> DISABLED");
gpio_pin_write(ictx.gpio_port_dev[SHLD_3V3_1V8_SIG_TRANS_ENA],
pinconfig[SHLD_3V3_1V8_SIG_TRANS_ENA].pin,
SHLD_3V3_1V8_SIG_TRANS_DISABLED);
/* While the level translator is disabled and ouptut pins
* are tristated, make sure the inputs are in the same state
* as the WNC Module pins so that when the level translator is
* enabled, there are no differences.
*/
SYS_LOG_DBG("MDM_BOOT_MODE_SEL_PIN -> NORMAL");
gpio_pin_write(ictx.gpio_port_dev[MDM_BOOT_MODE_SEL],
pinconfig[MDM_BOOT_MODE_SEL].pin, MDM_BOOT_MODE_NORMAL);
SYS_LOG_DBG("MDM_POWER_PIN -> ENABLE");
gpio_pin_write(ictx.gpio_port_dev[MDM_POWER],
pinconfig[MDM_POWER].pin, MDM_POWER_ENABLE);
SYS_LOG_DBG("MDM_KEEP_AWAKE_PIN -> ENABLED");
gpio_pin_write(ictx.gpio_port_dev[MDM_KEEP_AWAKE],
pinconfig[MDM_KEEP_AWAKE].pin, MDM_KEEP_AWAKE_ENABLED);
#ifdef CONFIG_WNCM14A2A_GPIO_MDM_SEND_OK_PIN
SYS_LOG_DBG("MDM_SEND_OK_PIN -> ENABLED");
gpio_pin_write(ictx.gpio_port_dev[MDM_SEND_OK],
pinconfig[MDM_SEND_OK].pin, MDM_SEND_OK_ENABLED);
#endif
/* wait for the WNC Module to perform its initial boot correctly */
k_sleep(K_SECONDS(1));
/* Enable the level translator.
* The input pins should now be the same as how the M14A module is
* driving them with internal pull ups/downs.
* When enabled, there will be no changes in the above 4 pins...
*/
SYS_LOG_DBG("SIG_TRANS_ENA_PIN -> ENABLED");
gpio_pin_write(ictx.gpio_port_dev[SHLD_3V3_1V8_SIG_TRANS_ENA],
pinconfig[SHLD_3V3_1V8_SIG_TRANS_ENA].pin,
SHLD_3V3_1V8_SIG_TRANS_ENABLED);
SYS_LOG_INF("... Done!");
return 0;
}
static void modem_wakeup_pin_fix(void)
{
/* AT&T recommend toggling the KEEP_AWAKE signal to reduce missed
* UART characters.
*/
SYS_LOG_DBG("Toggling MDM_KEEP_AWAKE_PIN to avoid missed characters");
k_sleep(K_MSEC(20));
SYS_LOG_DBG("MDM_KEEP_AWAKE_PIN -> DISABLED");
gpio_pin_write(ictx.gpio_port_dev[MDM_KEEP_AWAKE],
pinconfig[MDM_KEEP_AWAKE].pin, MDM_KEEP_AWAKE_DISABLED);
k_sleep(K_SECONDS(2));
SYS_LOG_DBG("MDM_KEEP_AWAKE_PIN -> ENABLED");
gpio_pin_write(ictx.gpio_port_dev[MDM_KEEP_AWAKE],
pinconfig[MDM_KEEP_AWAKE].pin, MDM_KEEP_AWAKE_ENABLED);
k_sleep(K_MSEC(20));
}
static void wncm14a2a_rssi_query_work(struct k_work *work)
{
int ret;
/* query modem RSSI */
ret = send_at_cmd(NULL, "AT%MEAS=\"23\"", MDM_CMD_TIMEOUT);
if (ret < 0) {
SYS_LOG_ERR("AT%%MEAS ret:%d", ret);
return;
}
/* re-start RSSI query work */
k_delayed_work_submit_to_queue(&wncm14a2a_workq,
&ictx.rssi_query_work,
K_SECONDS(RSSI_TIMEOUT_SECS));
}
static void wncm14a2a_modem_reset(void)
{
int ret = 0, retry_count = 0, counter = 0;
/* bring down network interface */
atomic_clear_bit(ictx.iface->if_dev->flags, NET_IF_UP);
restart:
/* stop RSSI delay work */
k_delayed_work_cancel(&ictx.rssi_query_work);
modem_pin_init();
SYS_LOG_INF("Waiting for modem to respond");
/* Give the modem a while to start responding to simple 'AT' commands.
* Also wait for CSPS=1 or RRCSTATE=1 notification
*/
ret = -1;
while (counter++ < 50 && ret < 0) {
k_sleep(K_SECONDS(2));
ret = send_at_cmd(NULL, "AT", MDM_CMD_TIMEOUT);
if (ret < 0 && ret != -ETIMEDOUT) {
break;
}
}
if (ret < 0) {
SYS_LOG_ERR("MODEM WAIT LOOP ERROR: %d", ret);
goto error;
}
SYS_LOG_INF("Setting modem to always stay awake");
modem_wakeup_pin_fix();
ret = send_at_cmd(NULL, "ATE1", MDM_CMD_TIMEOUT);
if (ret < 0) {
SYS_LOG_ERR("ATE1 ret:%d", ret);
goto error;
}
ret = send_at_cmd(NULL, "AT%PDNSET=1,\"" CONFIG_MODEM_WNCM14A2A_APN_NAME
"\",\"IPV4V6\"", MDM_CMD_TIMEOUT);
if (ret < 0) {
SYS_LOG_ERR("AT%%PDNSET ret:%d", ret);
goto error;
}
/* query modem info */
SYS_LOG_INF("Querying modem information");
ret = send_at_cmd(NULL, "ATI", MDM_CMD_TIMEOUT);
if (ret < 0) {
SYS_LOG_ERR("ATI ret:%d", ret);
goto error;
}
/* query modem IMEI */
ret = send_at_cmd(NULL, "AT+CGSN", MDM_CMD_TIMEOUT);
if (ret < 0) {
SYS_LOG_ERR("AT+CGSN ret:%d", ret);
goto error;
}
SYS_LOG_INF("Waiting for network");
/* query modem RSSI */
wncm14a2a_rssi_query_work(NULL);
k_sleep(K_SECONDS(2));
counter = 0;
/* wait for RSSI > -1000 and != 0 */
while (counter++ < 15 &&
(ictx.mdm_ctx.data_rssi <= -1000 ||
ictx.mdm_ctx.data_rssi == 0)) {
/* stop RSSI delay work */
k_delayed_work_cancel(&ictx.rssi_query_work);
wncm14a2a_rssi_query_work(NULL);
k_sleep(K_SECONDS(2));
}
if (ictx.mdm_ctx.data_rssi <= -1000 || ictx.mdm_ctx.data_rssi == 0) {
retry_count++;
if (retry_count > 3) {
SYS_LOG_ERR("Failed network init. Too many attempts!");
ret = -ENETUNREACH;
goto error;
}
SYS_LOG_ERR("Failed network init. Restarting process.");
goto restart;
}
SYS_LOG_INF("Network is ready.");
ret = send_at_cmd(NULL, "AT@INTERNET=1", MDM_CMD_TIMEOUT);
if (ret < 0) {
SYS_LOG_ERR("AT@INTERNET ret:%d", ret);
goto error;
}
ret = send_at_cmd(NULL, "AT@SOCKDIAL=1", MDM_CMD_TIMEOUT);
if (ret < 0) {
SYS_LOG_ERR("SOCKDIAL=1 CHECK ret:%d", ret);
/* don't report this as an error, we retry later */
ret = 0;
}
/* Set iface up */
net_if_up(ictx.iface);
error:
return;
}
static void wncm14a2a_modem_reset_work(struct k_work *work)
{
wncm14a2a_modem_reset();
}
static int wncm14a2a_init(struct device *dev)
{
static struct k_delayed_work reset_work;
int i, ret = 0;
ARG_UNUSED(dev);
/* check for valid pinconfig */
__ASSERT(sizeof(pinconfig) == MAX_MDM_CONTROL_PINS,
"Incorrect modem pinconfig!");
(void)memset(&ictx, 0, sizeof(ictx));
for (i = 0; i < MDM_MAX_SOCKETS; i++) {
k_work_init(&ictx.sockets[i].recv_cb_work,
sockreadrecv_cb_work);
k_sem_init(&ictx.sockets[i].sock_send_sem, 0, 1);
}
k_sem_init(&ictx.response_sem, 0, 1);
/* initialize the work queue */
k_work_q_start(&wncm14a2a_workq,
wncm14a2a_workq_stack,
K_THREAD_STACK_SIZEOF(wncm14a2a_workq_stack),
K_PRIO_COOP(7));
ictx.last_socket_id = 0;
/* setup port devices and pin directions */
for (i = 0; i < MAX_MDM_CONTROL_PINS; i++) {
ictx.gpio_port_dev[i] =
device_get_binding(pinconfig[i].dev_name);
if (!ictx.gpio_port_dev[i]) {
SYS_LOG_ERR("gpio port (%s) not found!",
pinconfig[i].dev_name);
return -ENODEV;
}
gpio_pin_configure(ictx.gpio_port_dev[i], pinconfig[i].pin,
GPIO_DIR_OUT);
}
/* Set modem data storage */
ictx.mdm_ctx.data_manufacturer = ictx.mdm_manufacturer;
ictx.mdm_ctx.data_model = ictx.mdm_model;
ictx.mdm_ctx.data_revision = ictx.mdm_revision;
ictx.mdm_ctx.data_imei = ictx.mdm_imei;
ret = mdm_receiver_register(&ictx.mdm_ctx, MDM_UART_DEV_NAME,
mdm_recv_buf, sizeof(mdm_recv_buf));
if (ret < 0) {
SYS_LOG_ERR("Error registering modem receiver (%d)!", ret);
goto error;
}
/* start RX thread */
k_thread_create(&wncm14a2a_rx_thread, wncm14a2a_rx_stack,
K_THREAD_STACK_SIZEOF(wncm14a2a_rx_stack),
(k_thread_entry_t) wncm14a2a_rx,
NULL, NULL, NULL, K_PRIO_COOP(7), 0, K_NO_WAIT);
/* init RSSI query */
k_delayed_work_init(&ictx.rssi_query_work, wncm14a2a_rssi_query_work);
/* Let's start the modem reset in a workq so that init can proceed */
k_delayed_work_init(&reset_work, wncm14a2a_modem_reset_work);
ret = k_delayed_work_submit_to_queue(&wncm14a2a_workq,
&reset_work, K_MSEC(10));
error:
return ret;
}
/*** OFFLOAD FUNCTIONS ***/
static int offload_get(sa_family_t family,
enum net_sock_type type,
enum net_ip_protocol ip_proto,
struct net_context **context)
{
int ret;
char buf[sizeof("AT@SOCKCREAT=#,#\r")];
struct wncm14a2a_socket *sock = NULL;
/* new socket */
sock = socket_get();
if (!sock) {
return -ENOMEM;
}
(*context)->offload_context = sock;
sock->family = family;
sock->type = type;
sock->ip_proto = ip_proto;
sock->context = *context;
sock->socket_id = MDM_MAX_SOCKETS + 1; /* socket # needs assigning */
snprintk(buf, sizeof(buf), "AT@SOCKCREAT=%d,%d", type,
family == AF_INET ? 0 : 1);
ret = send_at_cmd(NULL, buf, MDM_CMD_TIMEOUT);
if (ret < 0) {
SYS_LOG_ERR("AT@SOCKCREAT ret:%d", ret);
socket_put(sock);
}
return ret;
}
static int offload_bind(struct net_context *context,
const struct sockaddr *addr,
socklen_t addrlen)
{
struct wncm14a2a_socket *sock = NULL;
if (!context) {
return -EINVAL;
}
sock = (struct wncm14a2a_socket *)context->offload_context;
if (!sock) {
SYS_LOG_ERR("Can't locate socket for net_ctx:%p!", context);
return -EINVAL;
}
/* save bind address information */
sock->src.sa_family = addr->sa_family;
#if defined(CONFIG_NET_IPV6)
if (addr->sa_family == AF_INET6) {
net_ipaddr_copy(&net_sin6(&sock->src)->sin6_addr,
&net_sin6(addr)->sin6_addr);
net_sin6(&sock->src)->sin6_port = net_sin6(addr)->sin6_port;
} else
#endif
#if defined(CONFIG_NET_IPV4)
if (addr->sa_family == AF_INET) {
net_ipaddr_copy(&net_sin(&sock->src)->sin_addr,
&net_sin(addr)->sin_addr);
net_sin(&sock->src)->sin_port = net_sin(addr)->sin_port;
} else
#endif
{
return -EPFNOSUPPORT;
}
return 0;
}
static int offload_listen(struct net_context *context, int backlog)
{
/* NOT IMPLEMENTED */
return -ENOTSUP;
}
static int offload_connect(struct net_context *context,
const struct sockaddr *addr,
socklen_t addrlen,
net_context_connect_cb_t cb,
s32_t timeout,
void *user_data)
{
int ret, dst_port = -1;
s32_t timeout_sec = timeout / MSEC_PER_SEC;
char buf[sizeof("AT@SOCKCONN=#,###.###.###.###,#####,#####\r")];
struct wncm14a2a_socket *sock;
if (!context || !addr) {
return -EINVAL;
}
sock = (struct wncm14a2a_socket *)context->offload_context;
if (!sock) {
SYS_LOG_ERR("Can't locate socket for net_ctx:%p!", context);
return -EINVAL;
}
if (sock->socket_id < 1) {
SYS_LOG_ERR("Invalid socket_id(%d) for net_ctx:%p!",
sock->socket_id, context);
return -EINVAL;
}
sock->dst.sa_family = addr->sa_family;
#if defined(CONFIG_NET_IPV6)
if (addr->sa_family == AF_INET6) {
net_ipaddr_copy(&net_sin6(&sock->dst)->sin6_addr,
&net_sin6(addr)->sin6_addr);
dst_port = ntohs(net_sin6(addr)->sin6_port);
net_sin6(&sock->dst)->sin6_port = dst_port;
} else
#endif
#if defined(CONFIG_NET_IPV4)
if (addr->sa_family == AF_INET) {
net_ipaddr_copy(&net_sin(&sock->dst)->sin_addr,
&net_sin(addr)->sin_addr);
dst_port = ntohs(net_sin(addr)->sin_port);
net_sin(&sock->dst)->sin_port = dst_port;
} else
#endif
{
return -EINVAL;
}
if (dst_port < 0) {
SYS_LOG_ERR("Invalid port: %d", dst_port);
return -EINVAL;
}
/* minimum timeout in seconds is 30 */
if (timeout_sec < 30) {
timeout_sec = 30;
}
snprintk(buf, sizeof(buf), "AT@SOCKCONN=%d,\"%s\",%d,%d",
sock->socket_id, wncm14a2a_sprint_ip_addr(addr),
dst_port, timeout_sec);
ret = send_at_cmd(sock, buf, MDM_CMD_CONN_TIMEOUT);
if (ret < 0) {
SYS_LOG_ERR("AT@SOCKCONN ret:%d", ret);
}
if (cb) {
cb(context, ret, user_data);
}
return ret;
}
static int offload_accept(struct net_context *context,
net_tcp_accept_cb_t cb,
s32_t timeout,
void *user_data)
{
/* NOT IMPLEMENTED */
return -ENOTSUP;
}
static int offload_sendto(struct net_pkt *pkt,
const struct sockaddr *dst_addr,
socklen_t addrlen,
net_context_send_cb_t cb,
s32_t timeout,
void *token,
void *user_data)
{
struct net_context *context = net_pkt_context(pkt);
struct wncm14a2a_socket *sock;
int ret = 0;
if (!context) {
return -EINVAL;
}
sock = (struct wncm14a2a_socket *)context->offload_context;
if (!sock) {
SYS_LOG_ERR("Can't locate socket for net_ctx:%p!", context);
return -EINVAL;
}
ret = send_data(sock, pkt);
if (ret < 0) {
SYS_LOG_ERR("send_data error: %d", ret);
}
net_pkt_unref(pkt);
if (cb) {
cb(context, ret, token, user_data);
}
return ret;
}
static int offload_send(struct net_pkt *pkt,
net_context_send_cb_t cb,
s32_t timeout,
void *token,
void *user_data)
{
struct net_context *context = net_pkt_context(pkt);
socklen_t addrlen;
addrlen = 0;
#if defined(CONFIG_NET_IPV6)
if (net_pkt_family(pkt) == AF_INET6) {
addrlen = sizeof(struct sockaddr_in6);
} else
#endif /* CONFIG_NET_IPV6 */
#if defined(CONFIG_NET_IPV4)
if (net_pkt_family(pkt) == AF_INET) {
addrlen = sizeof(struct sockaddr_in);
} else
#endif /* CONFIG_NET_IPV4 */
{
return -EPFNOSUPPORT;
}
return offload_sendto(pkt, &context->remote, addrlen, cb,
timeout, token, user_data);
}
static int offload_recv(struct net_context *context,
net_context_recv_cb_t cb,
s32_t timeout,
void *user_data)
{
struct wncm14a2a_socket *sock;
if (!context) {
return -EINVAL;
}
sock = (struct wncm14a2a_socket *)context->offload_context;
if (!sock) {
SYS_LOG_ERR("Can't locate socket for net_ctx:%p!", context);
return -EINVAL;
}
sock->recv_cb = cb;
sock->recv_user_data = user_data;
return 0;
}
static int offload_put(struct net_context *context)
{
struct wncm14a2a_socket *sock;
char buf[sizeof("AT@SOCKCLOSE=#\r")];
int ret;
if (!context) {
return -EINVAL;
}
sock = (struct wncm14a2a_socket *)context->offload_context;
if (!sock) {
/* socket was already closed? Exit quietly here. */
return 0;
}
snprintk(buf, sizeof(buf), "AT@SOCKCLOSE=%d", sock->socket_id);
ret = send_at_cmd(sock, buf, MDM_CMD_TIMEOUT);
if (ret < 0) {
SYS_LOG_ERR("AT@SOCKCLOSE ret:%d", ret);
}
/* clear last_socket_id */
ictx.last_socket_id = 0;
sock->context->connect_cb = NULL;
sock->context->recv_cb = NULL;
sock->context->send_cb = NULL;
socket_put(sock);
net_context_unref(context);
return 0;
}
static struct net_offload offload_funcs = {
.get = offload_get,
.bind = offload_bind,
.listen = offload_listen, /* TODO */
.connect = offload_connect,
.accept = offload_accept, /* TODO */
.send = offload_send,
.sendto = offload_sendto,
.recv = offload_recv,
.put = offload_put,
};
static inline u8_t *wncm14a2a_get_mac(struct device *dev)
{
struct wncm14a2a_iface_ctx *ctx = dev->driver_data;
ctx->mac_addr[0] = 0x00;
ctx->mac_addr[1] = 0x10;
UNALIGNED_PUT(sys_cpu_to_be32(sys_rand32_get()),
(u32_t *) ((void *)ctx->mac_addr+2));
return ctx->mac_addr;
}
static void offload_iface_init(struct net_if *iface)
{
struct device *dev = net_if_get_device(iface);
struct wncm14a2a_iface_ctx *ctx = dev->driver_data;
iface->if_dev->offload = &offload_funcs;
net_if_set_link_addr(iface, wncm14a2a_get_mac(dev),
sizeof(ctx->mac_addr),
NET_LINK_ETHERNET);
ctx->iface = iface;
}
static struct net_if_api api_funcs = {
.init = offload_iface_init,
.send = NULL,
};
NET_DEVICE_OFFLOAD_INIT(modem_wncm14a2a, "MODEM_WNCM14A2A",
wncm14a2a_init, &ictx,
NULL, CONFIG_MODEM_WNCM14A2A_INIT_PRIORITY, &api_funcs,
MDM_MAX_DATA_LENGTH);
Reference in New Issue View Git Blame Copy Permalink