libs/at_device
libs
/
at_device
4
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity
at_device/class/mw31/at_device_mw31.c

749 lines
21 KiB
C
Raw Blame History

/*
* File : at_socket_mw31.c
* This file is part of RT-Thread RTOS
* COPYRIGHT (C) 2006 - 2018, RT-Thread Development Team
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
*
* Change Logs:
* Date Author Notes
* 2019-06-23 flybreak first version
*/
#include <stdio.h>
#include <string.h>
#include <at_device_mw31.h>
#define LOG_TAG "at.dev"
#include <at_log.h>
#ifdef AT_DEVICE_USING_MW31
#define MW31_WAIT_CONNECT_TIME 5000
#define MW31_THREAD_STACK_SIZE 2048
#define MW31_THREAD_PRIORITY (RT_THREAD_PRIORITY_MAX / 2)
/* ============================= mw31 network interface operations ============================= */
#define AT_ADDR_LEN 32
#define IPADDR_RESP_SIZE 128
#define IPADDR_SIZE 16
char mw31_ip_addr[AT_ADDR_LEN] = {0};
char mw31_gw_addr[AT_ADDR_LEN] = {0};
char mw31_netmask_addr[AT_ADDR_LEN] = {0};
static void mw31_get_netdev_info(struct rt_work *work, void *work_data)
{
at_response_t resp = RT_NULL;
char mac[AT_ADDR_LEN] = {0};
char dns_server1[AT_ADDR_LEN] = {0};
char dhcp_stat_buf[5] = {0};
ip_addr_t ip_addr;
rt_uint32_t mac_addr[6] = {0};
rt_uint32_t num = 0;
rt_uint8_t dhcp_stat = 0;
struct rt_delayed_work *delay_work = (struct rt_delayed_work *)work;
struct at_device *device = (struct at_device *)work_data;
struct netdev *netdev = device->netdev;
struct at_client *client = device->client;
if (delay_work)
{
rt_free(delay_work);
}
resp = at_create_resp(512, 0, rt_tick_from_millisecond(300));
if (resp == RT_NULL)
{
LOG_E("no memory for mw31 device(%d) response structure.", device->name);
return;
}
/* send mac addr query commond "AT+CIFSR" and wait response */
if (at_obj_exec_cmd(client, resp, "AT+WMAC?") < 0)
{
goto __exit;
}
if (at_resp_parse_line_args_by_kw(resp, "+WMAC:", "+WMAC:%s", mac) <= 0)
{
LOG_E("mw31 device(%s) parse \"AT+WMAC\" command response data error.", device->name);
goto __exit;
}
/* send addr info query commond "AT+CIPSTA?" and wait response */
if (at_obj_exec_cmd(client, resp, "AT+WJAPIP?") < 0)
{
LOG_E("mw31 device(%s) send \"AT+WJAPIP?\" commands error.", device->name);
goto __exit;
}
if (at_resp_parse_line_args_by_kw(resp, "+WJAPIP?:", "+WJAPIP?:%[^,],%[^,],%[^,],%s", mw31_ip_addr, mw31_netmask_addr, mw31_gw_addr, dns_server1) < 0)
{
LOG_E("mw31 device(%s) prase \"AT+WJAPIP?\" command resposne data error.", device->name);
goto __exit;
}
/* set netdev info */
inet_aton(mw31_gw_addr, &ip_addr);
netdev_low_level_set_gw(netdev, &ip_addr);
inet_aton(mw31_netmask_addr, &ip_addr);
netdev_low_level_set_netmask(netdev, &ip_addr);
inet_aton(mw31_ip_addr, &ip_addr);
netdev_low_level_set_ipaddr(netdev, &ip_addr);
sscanf(mac, "%2x%2x%2x%2x%2x%2x",
&mac_addr[0], &mac_addr[1], &mac_addr[2], &mac_addr[3], &mac_addr[4], &mac_addr[5]);
for (num = 0; num < netdev->hwaddr_len; num++)
{
netdev->hwaddr[num] = mac_addr[num];
}
if (rt_strlen(dns_server1) > 0)
{
inet_aton(dns_server1, &ip_addr);
netdev_low_level_set_dns_server(netdev, 0, &ip_addr);
}
/* send DHCP query commond " AT+WDHCP?" and wait response */
if (at_obj_exec_cmd(client, resp, "AT+WDHCP?") < 0)
{
goto __exit;
}
/* parse response data, get the DHCP status */
if (at_resp_parse_line_args_by_kw(resp, "+WDHCP:", "+WDHCP:%s", dhcp_stat_buf) < 0)
{
LOG_E("mw31 device(%s) get DHCP status failed.", device->name);
goto __exit;
}
if (rt_strstr(dhcp_stat_buf, "ON"))
{
dhcp_stat |= 0x03;
}
/* Bit0 - SoftAP DHCP status, Bit1 - Station DHCP status */
netdev_low_level_set_dhcp_status(netdev, dhcp_stat & 0x02 ? RT_TRUE : RT_FALSE);
__exit:
if (resp)
{
at_delete_resp(resp);
}
}
static int mw31_net_init(struct at_device *device);
static int mw31_netdev_set_up(struct netdev *netdev)
{
struct at_device *device = RT_NULL;
device = at_device_get_by_name(AT_DEVICE_NAMETYPE_NETDEV, netdev->name);
if (device == RT_NULL)
{
LOG_E("get mw31 device by netdev name(%s) failed.", netdev->name);
return -RT_ERROR;
}
if (device->is_init == RT_FALSE)
{
mw31_net_init(device);
netdev_low_level_set_status(netdev, RT_TRUE);
LOG_D("the network interface device(%s) set up status", netdev->name);
}
return RT_EOK;
}
static int mw31_netdev_set_down(struct netdev *netdev)
{
struct at_device *device = RT_NULL;
device = at_device_get_by_name(AT_DEVICE_NAMETYPE_NETDEV, netdev->name);
if (device == RT_NULL)
{
LOG_E("get mw31 device by netdev name(%s) failed.", netdev->name);
return -RT_ERROR;
}
if (device->is_init == RT_TRUE)
{
device->is_init = RT_FALSE;
netdev_low_level_set_status(netdev, RT_FALSE);
LOG_D("the network interface device(%s) set down status", netdev->name);
}
return RT_EOK;
}
static int mw31_netdev_set_addr_info(struct netdev *netdev, ip_addr_t *ip_addr, ip_addr_t *netmask, ip_addr_t *gw)
{
int result = RT_EOK;
at_response_t resp = RT_NULL;
struct at_device *device = RT_NULL;
RT_ASSERT(netdev);
RT_ASSERT(ip_addr || netmask || gw);
device = at_device_get_by_name(AT_DEVICE_NAMETYPE_NETDEV, netdev->name);
if (device == RT_NULL)
{
LOG_E("get mw31 device by netdev name(%s) failed.", netdev->name);
return -RT_ERROR;
}
resp = at_create_resp(IPADDR_RESP_SIZE, 0, rt_tick_from_millisecond(300));
if (resp == RT_NULL)
{
LOG_E("no memory for mw31 device(%s) response structure.", device->name);
result = -RT_ENOMEM;
goto __exit;
}
/* Convert numeric IP address into decimal dotted ASCII representation. */
if (ip_addr)
rt_memcpy(mw31_ip_addr, inet_ntoa(*ip_addr), IPADDR_SIZE);
else
rt_memcpy(mw31_ip_addr, inet_ntoa(netdev->ip_addr), IPADDR_SIZE);
if (gw)
rt_memcpy(mw31_gw_addr, inet_ntoa(*gw), IPADDR_SIZE);
else
rt_memcpy(mw31_gw_addr, inet_ntoa(netdev->gw), IPADDR_SIZE);
if (netmask)
rt_memcpy(mw31_netmask_addr, inet_ntoa(*netmask), IPADDR_SIZE);
else
rt_memcpy(mw31_netmask_addr, inet_ntoa(netdev->netmask), IPADDR_SIZE);
/* send addr info set commond "AT+WJAPIP=<ip>,<network>,<gateway>[,<dns>] " and wait response */
if (at_obj_exec_cmd(device->client, resp, "AT+WJAPIP=%s,%s,%s",
mw31_ip_addr, mw31_netmask_addr, mw31_gw_addr) < 0)
{
LOG_E("mw31 device(%s) set address information failed.", device->name);
result = -RT_ERROR;
}
else
{
/* Update netdev information */
if (ip_addr)
netdev_low_level_set_ipaddr(netdev, ip_addr);
if (gw)
netdev_low_level_set_gw(netdev, gw);
if (netmask)
netdev_low_level_set_netmask(netdev, netmask);
LOG_D("mw31 device(%s) set address information successfully.", device->name);
}
__exit:
if (resp)
{
at_delete_resp(resp);
}
return result;
}
static int mw31_netdev_set_dns_server(struct netdev *netdev, uint8_t dns_num, ip_addr_t *dns_server)
{
#define DNS_RESP_SIZE 128
int result = RT_EOK;
at_response_t resp = RT_NULL;
struct at_device *device = RT_NULL;
RT_ASSERT(netdev);
RT_ASSERT(dns_server);
device = at_device_get_by_name(AT_DEVICE_NAMETYPE_NETDEV, netdev->name);
if (device == RT_NULL)
{
LOG_E("get mw31 device by netdev name(%s) failed.", netdev->name);
return -RT_ERROR;
}
resp = at_create_resp(DNS_RESP_SIZE, 0, rt_tick_from_millisecond(300));
if (resp == RT_NULL)
{
LOG_E("no memory for mw31 device(%s) response structure.", device->name);
return -RT_ENOMEM;
}
/* send dns server set commond "AT+WJAPIP=<ip>,<network>,<gateway>[,<dns>] " and wait response */
if (at_obj_exec_cmd(device->client, resp, "AT+WJAPIP=%s,%s,%s,%s",
mw31_ip_addr, mw31_netmask_addr, mw31_gw_addr, inet_ntoa(*dns_server)) < 0)
{
LOG_E("mw31 device(%s) set DNS server(%s) failed.", device->name, inet_ntoa(*dns_server));
result = -RT_ERROR;
}
else
{
netdev_low_level_set_dns_server(netdev, dns_num, dns_server);
LOG_D("mw31 device(%s) set DNS server(%s) successfully.", device->name, inet_ntoa(*dns_server));
}
if (resp)
{
at_delete_resp(resp);
}
return result;
}
static int mw31_netdev_set_dhcp(struct netdev *netdev, rt_bool_t is_enabled)
{
#define MW31_STATION 1
#define RESP_SIZE 128
int result = RT_EOK;
at_response_t resp = RT_NULL;
struct at_device *device = RT_NULL;
const char *send_buf;
RT_ASSERT(netdev);
device = at_device_get_by_name(AT_DEVICE_NAMETYPE_NETDEV, netdev->name);
if (device == RT_NULL)
{
LOG_E("get AT device by netdev name(%s) failed.", netdev->name);
return -RT_ERROR;
}
resp = at_create_resp(RESP_SIZE, 0, rt_tick_from_millisecond(300));
if (resp == RT_NULL)
{
LOG_E("no memory for mw31 device(%s) response structure.", device->name);
return -RT_ENOMEM;
}
if (is_enabled)
{
send_buf = "AT+WDHCP=ON";
}
else
{
send_buf = "AT+WDHCP=OFF";
}
/* send dhcp set commond "AT+WDHCP=" and wait response */
if (at_obj_exec_cmd(device->client, resp, send_buf) < 0)
{
LOG_E("mw31 device(%s) set DHCP status(%d) failed.", device->name, is_enabled);
result = -RT_ERROR;
goto __exit;
}
else
{
netdev_low_level_set_dhcp_status(netdev, is_enabled);
LOG_D("mw31 device(%d) set DHCP status(%d) successfully.", device->name, is_enabled);
}
__exit:
if (resp)
{
at_delete_resp(resp);
}
return result;
}
static const struct netdev_ops mw31_netdev_ops =
{
mw31_netdev_set_up,
mw31_netdev_set_down,
mw31_netdev_set_addr_info,
mw31_netdev_set_dns_server,
mw31_netdev_set_dhcp,
#ifdef NETDEV_USING_PING
RT_NULL,
#endif
#ifdef NETDEV_USING_NETSTAT
RT_NULL,
#endif
};
static struct netdev *mw31_netdev_add(const char *netdev_name)
{
#define ETHERNET_MTU 1500
#define HWADDR_LEN 6
struct netdev *netdev = RT_NULL;
RT_ASSERT(netdev_name);
netdev = (struct netdev *) rt_calloc(1, sizeof(struct netdev));
if (netdev == RT_NULL)
{
LOG_E("no memory for mw31 device(%s) netdev structure.", netdev_name);
return RT_NULL;
}
netdev->mtu = ETHERNET_MTU;
netdev->ops = &mw31_netdev_ops;
netdev->hwaddr_len = HWADDR_LEN;
#ifdef SAL_USING_AT
extern int sal_at_netdev_set_pf_info(struct netdev * netdev);
/* set the network interface socket/netdb operations */
sal_at_netdev_set_pf_info(netdev);
#endif
netdev_register(netdev, netdev_name, RT_NULL);
return netdev;
}
/* ============================= mw31 device operations ============================= */
#define AT_SEND_CMD(client, resp, cmd) \
do { \
(resp) = at_resp_set_info((resp), 256, 0, 5 * RT_TICK_PER_SECOND); \
if (at_obj_exec_cmd((client), (resp), (cmd)) < 0) \
{ \
result = -RT_ERROR; \
goto __exit; \
} \
} while(0) \
static void mw31_netdev_start_delay_work(struct at_device *device)
{
struct rt_delayed_work *net_work = RT_NULL;
net_work = (struct rt_delayed_work *)rt_calloc(1, sizeof(struct rt_delayed_work));
if (net_work == RT_NULL)
{
return;
}
rt_delayed_work_init(net_work, mw31_get_netdev_info, (void *)device);
rt_work_submit(&(net_work->work), RT_TICK_PER_SECOND);
}
static void mw31_init_thread_entry(void *parameter)
{
#define INIT_RETRY 2
struct at_device *device = (struct at_device *) parameter;
struct at_device_mw31 *mw31 = (struct at_device_mw31 *) device->user_data;
struct at_client *client = device->client;
at_response_t resp = RT_NULL;
rt_err_t result = RT_EOK;
rt_size_t i = 0, retry_num = INIT_RETRY;
LOG_D("mw31 device(%s) initialize start.", device->name);
/* wait mw31 device startup finish */
if (at_client_obj_wait_connect(client, MW31_WAIT_CONNECT_TIME))
{
return;
}
resp = at_create_resp(128, 0, 5 * RT_TICK_PER_SECOND);
if (resp == RT_NULL)
{
LOG_E("no memory for mw31 device(%d) response structure.", device->name);
return;
}
while (retry_num--)
{
/* reset module */
AT_SEND_CMD(client, resp, "AT+REBOOT");
/* reset waiting delay */
rt_thread_mdelay(2000);
/* set current mode to Wi-Fi station */
AT_SEND_CMD(client, resp, "AT+WSAPQ");
/* get module version */
AT_SEND_CMD(client, resp, "AT+FWVER?");
/* show module version */
for (i = 0; i < resp->line_counts - 1; i++)
{
LOG_D("%s", at_resp_get_line(resp, i + 1));
}
/* connect to WiFi AP */
if (at_obj_exec_cmd(client, at_resp_set_info(resp, 128, 0, 20 * RT_TICK_PER_SECOND),
"AT+WJAP=%s,%s", mw31->wifi_ssid, mw31->wifi_password) != RT_EOK)
{
LOG_E("AT device(%s) network initialize failed, check ssid(%s) and password(%s).",
device->name, mw31->wifi_ssid, mw31->wifi_password);
result = -RT_ERROR;
goto __exit;
}
__exit:
if (result == RT_EOK)
{
break;
}
else
{
rt_thread_mdelay(1000);
LOG_I("mw31 device(%s) initialize retry...", device->name);
}
}
if (resp)
{
at_delete_resp(resp);
}
if (result != RT_EOK)
{
netdev_low_level_set_status(device->netdev, RT_FALSE);
LOG_E("mw31 device(%s) network initialize failed(%d).", device->name, result);
}
else
{
device->is_init = RT_TRUE;
netdev_low_level_set_status(device->netdev, RT_TRUE);
netdev_low_level_set_link_status(device->netdev, RT_TRUE);
LOG_I("mw31 device(%s) network initialize successfully.", device->name);
}
}
static int mw31_net_init(struct at_device *device)
{
#ifdef AT_DEVICE_MW31_INIT_ASYN
rt_thread_t tid;
tid = rt_thread_create("mw31_net_init", mw31_init_thread_entry, (void *) device,
MW31_THREAD_STACK_SIZE, MW31_THREAD_PRIORITY, 20);
if (tid)
{
rt_thread_startup(tid);
}
else
{
LOG_E("create mw31 device(%s) initialize thread failed.", device->name);
return -RT_ERROR;
}
#else
mw31_init_thread_entry(device);
#endif /* AT_DEVICE_MW31_INIT_ASYN */
return RT_EOK;
}
static void urc_func(struct at_client *client, const char *data, rt_size_t size)
{
struct at_device *device = RT_NULL;
char *client_name = client->device->parent.name;
RT_ASSERT(client && data && size);
device = at_device_get_by_name(AT_DEVICE_NAMETYPE_CLIENT, client_name);
if (device == RT_NULL)
{
LOG_E("get mw31 device by client name(%s) failed.", client_name);
return;
}
if (rt_strstr(data, "STATION_UP"))
{
LOG_I("mw31 device(%s) WIFI is connected.", device->name);
if (device->is_init)
{
netdev_low_level_set_link_status(device->netdev, RT_TRUE);
mw31_netdev_start_delay_work(device);
}
}
else if (rt_strstr(data, "STATION_DOWN"))
{
LOG_I("mw31 device(%s) WIFI is disconnect.", device->name);
if (device->is_init)
{
netdev_low_level_set_link_status(device->netdev, RT_FALSE);
}
}
}
static const struct at_urc urc_table[] =
{
{"+WEVENT:", "\r\n", urc_func},
};
static int mw31_init(struct at_device *device)
{
struct at_device_mw31 *mw31 = (struct at_device_mw31 *) device->user_data;
/* initialize AT client */
at_client_init(mw31->client_name, mw31->recv_line_num);
device->client = at_client_get(mw31->client_name);
if (device->client == RT_NULL)
{
LOG_E("mw31 device(%s) initialize failed, get AT client(%s) failed.",
mw31->device_name, mw31->client_name);
return -RT_ERROR;
}
/* register URC data execution function */
at_obj_set_urc_table(device->client, urc_table, sizeof(urc_table) / sizeof(urc_table[0]));
#ifdef AT_USING_SOCKET
mw31_socket_init(device);
#endif
/* add mw31 device to the netdev list */
device->netdev = mw31_netdev_add(mw31->device_name);
if (device->netdev == RT_NULL)
{
LOG_E("mw31 device(%s) initialize failed, get network interface device failed.", mw31->device_name);
return -RT_ERROR;
}
/* initialize mw31 device network */
return mw31_netdev_set_up(device->netdev);
}
static int mw31_deinit(struct at_device *device)
{
return mw31_netdev_set_down(device->netdev);
}
/* reset eap8266 device and initialize device network again */
static int mw31_reset(struct at_device *device)
{
int result = RT_EOK;
struct at_client *client = device->client;
/* send "AT+RST" commonds to mw31 device */
result = at_obj_exec_cmd(client, RT_NULL, "AT+RST");
rt_thread_mdelay(1000);
/* waiting 10 seconds for mw31 device reset */
device->is_init = RT_FALSE;
if (at_client_obj_wait_connect(client, MW31_WAIT_CONNECT_TIME))
{
return -RT_ETIMEOUT;
}
/* initialize mw31 device network */
mw31_net_init(device);
device->is_init = RT_TRUE;
return result;
}
/* change eap8266 wifi ssid and password information */
static int mw31_wifi_info_set(struct at_device *device, struct at_device_ssid_pwd *info)
{
int result = RT_EOK;
struct at_response *resp = RT_NULL;
if (info->ssid == RT_NULL || info->password == RT_NULL)
{
LOG_E("input mw31 wifi ssid(%s) and password(%s) error.", info->ssid, info->password);
return -RT_ERROR;
}
resp = at_create_resp(128, 0, 20 * RT_TICK_PER_SECOND);
if (resp == RT_NULL)
{
LOG_E("no memory for mw31 device(%s) response structure.", device->name);
return -RT_ENOMEM;
}
/* connect to input wifi ap */
if (at_obj_exec_cmd(device->client, resp, "AT+CWJAP=\"%s\",\"%s\"", info->ssid, info->password) != RT_EOK)
{
LOG_E("mw31 device(%s) wifi connect failed, check ssid(%s) and password(%s).",
device->name, info->ssid, info->password);
result = -RT_ERROR;
}
if (resp)
{
at_delete_resp(resp);
}
return result;
}
static int mw31_control(struct at_device *device, int cmd, void *arg)
{
int result = -RT_ERROR;
RT_ASSERT(device);
switch (cmd)
{
case AT_DEVICE_CTRL_POWER_ON:
case AT_DEVICE_CTRL_POWER_OFF:
case AT_DEVICE_CTRL_LOW_POWER:
case AT_DEVICE_CTRL_SLEEP:
case AT_DEVICE_CTRL_WAKEUP:
case AT_DEVICE_CTRL_NET_CONN:
case AT_DEVICE_CTRL_NET_DISCONN:
case AT_DEVICE_CTRL_GET_SIGNAL:
case AT_DEVICE_CTRL_GET_GPS:
case AT_DEVICE_CTRL_GET_VER:
LOG_W("mw31 not support the control command(%d).", cmd);
break;
case AT_DEVICE_CTRL_RESET:
result = mw31_reset(device);
break;
case AT_DEVICE_CTRL_SET_WIFI_INFO:
result = mw31_wifi_info_set(device, (struct at_device_ssid_pwd *) arg);
break;
default:
LOG_E("input error control command(%d).", cmd);
break;
}
return result;
}
static const struct at_device_ops mw31_device_ops =
{
mw31_init,
mw31_deinit,
mw31_control,
};
static int mw31_device_class_register(void)
{
struct at_device_class *class = RT_NULL;
class = (struct at_device_class *) rt_calloc(1, sizeof(struct at_device_class));
if (class == RT_NULL)
{
LOG_E("no memory for mw31 device class create.");
return -RT_ENOMEM;
}
/* fill MW31 device class object */
#ifdef AT_USING_SOCKET
mw31_socket_class_register(class);
#endif
class->device_ops = &mw31_device_ops;
return at_device_class_register(class, AT_DEVICE_CLASS_MW31);
}
INIT_DEVICE_EXPORT(mw31_device_class_register);
#endif /* AT_DEVICE_USING_MW31 */
Reference in New Issue View Git Blame Copy Permalink