nuttx-apps/lte/alt1250/usock_handlers/alt1250_ioctl_normal.c
SPRESENSE 3650251c5e lte/alt1250: Fix bug that caused stack when executing the socket API
Fix a bug that caused the application to get stuck when executing
the socket API after waking up from hibernation and before executing
lte_hibernation_resume().
2024-02-09 14:52:05 +02:00

581 lines
19 KiB
C

/****************************************************************************
* apps/lte/alt1250/usock_handlers/alt1250_ioctl_normal.c
*
* Licensed to the Apache Software Foundation (ASF) under one or more
* contributor license agreements. See the NOTICE file distributed with
* this work for additional information regarding copyright ownership. The
* ASF licenses this file to you under the Apache License, Version 2.0 (the
* "License"); you may not use this file except in compliance with the
* License. You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. See the
* License for the specific language governing permissions and limitations
* under the License.
*
****************************************************************************/
/****************************************************************************
* Included Files
****************************************************************************/
#include <nuttx/config.h>
#include <nuttx/net/usrsock.h>
#include <unistd.h>
#include "alt1250_dbg.h"
#include "alt1250_container.h"
#include "alt1250_socket.h"
#include "alt1250_usockevent.h"
#include "alt1250_postproc.h"
#include "alt1250_devif.h"
#include "alt1250_evt.h"
#include "alt1250_util.h"
#include "alt1250_ioctl_subhdlr.h"
#include "alt1250_usrsock_hdlr.h"
#include "alt1250_netdev.h"
/****************************************************************************
* Pre-processor Definitions
****************************************************************************/
#define RADIOON_SYNC (0)
#define RADIOON_ASYNC (1)
#define REPLY_RETCODE(rep, altrep) (((rep) == 0) ? (altrep) : (rep))
/* RK_02_01_01_10xxx FW version that does not support logging feature */
#define IS_LOG_UNAVAIL_FWVERSION(d) (!strncmp(MODEM_FWVERSION(d), \
"RK_02_01_01", 11))
/****************************************************************************
* Private Function Prototypes
****************************************************************************/
#ifdef CONFIG_LTE_ALT1250_ENABLE_HIBERNATION_MODE
static int send_resume_command(FAR struct alt1250_s *dev,
FAR struct alt_container_s *container,
FAR struct usock_s *usock,
FAR int32_t *usock_result,
int index);
#endif
/****************************************************************************
* Private Functions
****************************************************************************/
/****************************************************************************
* name: postproc_reportnet
****************************************************************************/
static int postproc_reportnet(FAR struct alt1250_s *dev,
FAR struct alt_container_s *reply,
FAR struct usock_s *usock,
FAR int32_t *usock_result,
FAR uint32_t *usock_xid,
FAR struct usock_ackinfo_s *ackinfo,
unsigned long is_async)
{
FAR void **resp = CONTAINER_RESPONSE(reply);
int altcom_result = *((int *)(resp[0]));
dbg_alt1250("%s start\n", __func__);
*usock_result = REPLY_RETCODE(CONTAINER_RESPRES(reply), altcom_result);
return (is_async) ? REP_NO_ACK: REP_SEND_ACK;
}
/****************************************************************************
* name: postproc_radioon
****************************************************************************/
static int postproc_radioon(FAR struct alt1250_s *dev,
FAR struct alt_container_s *reply,
FAR struct usock_s *usock,
FAR int32_t *usock_result,
FAR uint32_t *usock_xid,
FAR struct usock_ackinfo_s *ackinfo,
unsigned long arg)
{
int ret = REP_SEND_ACK;
FAR void **resp = CONTAINER_RESPONSE(reply);
int altcom_result = *((int *)(resp[0]));
dbg_alt1250("%s start\n", __func__);
*usock_result = REPLY_RETCODE(CONTAINER_RESPRES(reply), altcom_result);
if (*usock_result == 0)
{
ret = send_reportnet_command(dev, reply, usock, postproc_reportnet,
arg, usock_result);
MODEM_STATE_RON(dev);
}
return ret;
}
/****************************************************************************
* name: postproc_actpdn
****************************************************************************/
static int postproc_actpdn(FAR struct alt1250_s *dev,
FAR struct alt_container_s *reply,
FAR struct usock_s *usock,
FAR int32_t *usock_result,
FAR uint32_t *usock_xid,
FAR struct usock_ackinfo_s *ackinfo,
unsigned long is_async)
{
FAR void **resp = CONTAINER_RESPONSE(reply);
int altcom_result = *((int *)(resp[0]));
FAR lte_pdn_t *pdn = resp[1];
dbg_alt1250("%s start\n", __func__);
*usock_result = REPLY_RETCODE(CONTAINER_RESPRES(reply), altcom_result);
if (*usock_result == 0)
{
/* After connecting to the LTE network,
* wait for the modem to register the network interface.
*/
usleep(ALT1250_NETIF_READY_DELAY);
alt1250_netdev_ifup(dev, pdn);
}
return (is_async) ? REP_NO_ACK: REP_SEND_ACK;
}
/****************************************************************************
* name: postproc_fwgetversion
****************************************************************************/
int postproc_fwgetversion(FAR struct alt1250_s *dev,
FAR struct alt_container_s *reply,
FAR struct usock_s *usock,
FAR int32_t *usock_result,
FAR uint32_t *usock_xid,
FAR struct usock_ackinfo_s *ackinfo,
unsigned long arg)
{
FAR void **resp = CONTAINER_RESPONSE(reply);
int altcom_result = *((int *)(resp[0]));
lte_version_t *version = (lte_version_t *)(resp[1]);
dbg_alt1250("%s start\n", __func__);
*usock_result = REPLY_RETCODE(CONTAINER_RESPRES(reply), altcom_result);
if (*usock_result == 0)
{
/* Keep version information on the device context */
strncpy(dev->fw_version, version->np_package, LTE_VER_NP_PACKAGE_LEN);
}
return usock ? REP_SEND_ACK : REP_NO_ACK;
}
/****************************************************************************
* name: send_lapi_command
****************************************************************************/
int send_lapi_command(FAR struct alt1250_s *dev,
FAR struct alt_container_s *container,
FAR struct usock_s *usock,
FAR struct lte_ioctl_data_s *ltecmd,
FAR postproc_hdlr_t hdlr,
unsigned long priv,
FAR int32_t *usock_result)
{
set_container_ids(container, USOCKET_USOCKID(usock), ltecmd->cmdid);
set_container_argument(container, ltecmd->inparam, ltecmd->inparamlen);
set_container_response(container, ltecmd->outparam, ltecmd->outparamlen);
set_container_postproc(container, hdlr, priv);
return altdevice_send_command(dev, dev->altfd, container, usock_result);
}
#ifdef CONFIG_LTE_ALT1250_ENABLE_HIBERNATION_MODE
/****************************************************************************
* name: postproc_setreport
****************************************************************************/
static int postproc_setreport(FAR struct alt1250_s *dev,
FAR struct alt_container_s *reply,
FAR struct usock_s *usock,
FAR int32_t *usock_result,
FAR uint32_t *usock_xid,
FAR struct usock_ackinfo_s *ackinfo,
unsigned long arg)
{
int index = (int)arg + 1;
/* Register next report command */
return send_resume_command(dev, reply, usock, usock_result, index);
}
/****************************************************************************
* name: send_getversion_command
****************************************************************************/
static int send_getversion_command(FAR struct alt1250_s *dev,
FAR struct alt_container_s *container,
FAR struct usock_s *usock,
FAR int32_t *usock_result)
{
set_container_ids(container, USOCKET_USOCKID(usock), LTE_CMDID_GETVER);
set_container_argument(container, NULL, 0);
set_container_response(container, alt1250_getevtarg(LTE_CMDID_GETVER), 2);
set_container_postproc(container, postproc_fwgetversion, 0);
return altdevice_send_command(dev, dev->altfd, container, usock_result);
}
/****************************************************************************
* name: send_register_command
****************************************************************************/
static int send_register_command(FAR struct alt1250_s *dev,
FAR struct alt_container_s *container,
FAR struct usock_s *usock,
FAR int32_t *usock_result,
FAR struct lte_ioctl_data_s *ltecmd,
int index)
{
set_container_ids(container, USOCKET_USOCKID(usock), ltecmd->cmdid);
set_container_argument(container, ltecmd->inparam, ltecmd->inparamlen);
set_container_response(container, ltecmd->outparam, ltecmd->outparamlen);
set_container_postproc(container, postproc_setreport, index);
return altdevice_send_command(dev, dev->altfd, container, usock_result);
}
/****************************************************************************
* name: send_resume_command
****************************************************************************/
static int send_resume_command(FAR struct alt1250_s *dev,
FAR struct alt_container_s *container,
FAR struct usock_s *usock,
FAR int32_t *usock_result,
int index)
{
int ret;
int cb_index = index;
uint32_t cmdid;
struct lte_ioctl_data_s ltecmd;
/* Search report CB from table from index */
cmdid = alt1250_search_registered_callback(&cb_index);
if (cmdid != 0x00)
{
ret = alt1250_get_report_ltecmd(dev, cmdid, &ltecmd);
if (ret == OK)
{
/* Register report command */
ret = send_register_command(dev, container, usock, usock_result,
&ltecmd, cb_index);
}
else
{
*usock_result = ret;
ret = REP_SEND_ACK;
}
}
else
{
/* Finally, get firmware version from ALT1250 */
ret = send_getversion_command(dev, container, usock, usock_result);
}
return ret;
}
/****************************************************************************
* name: lte_context_resume
****************************************************************************/
static int lte_context_resume(FAR struct alt1250_s *dev,
FAR struct lte_ioctl_data_s *cmd,
FAR struct alt_container_s *container,
FAR struct usock_s *usock,
FAR int32_t *usock_result)
{
FAR uint8_t *ctx_data = (FAR uint8_t *)cmd->inparam[0];
int len = *(FAR int *)cmd->inparam[1];
int ret = REP_SEND_ACK;
int power = 0;
if (!dev->is_resuming)
{
dbg_alt1250("Modem is not in a resuming mode.\n");
*usock_result = -EPERM;
goto error;
}
if (len != sizeof(struct alt1250_save_ctx))
{
dbg_alt1250("Context data size is invalid(%d!=%d).\n",
sizeof(struct alt1250_save_ctx), len);
*usock_result = -EINVAL;
goto error;
}
ret = alt1250_apply_daemon_context(dev,
(FAR struct alt1250_save_ctx *)
ctx_data);
if (ret < 0)
{
dbg_alt1250("Failed to apply saved alt1250 context(%d).\n", ret);
*usock_result = -EINVAL;
goto error;
}
/* Retry mode is released in order to resume reception from ALT 1250. */
ret = altdevice_powercontrol(dev->altfd, LTE_CMDID_RETRYDISABLE);
if (ret != OK)
{
dbg_alt1250("Failed to stop retry mode(%d).\n", ret);
*usock_result = ret;
ret = REP_SEND_ACK;
goto error;
}
/* After the retry mode is disabled, the ALT1250 daemon can receive
* commands from the ALT1250 and the ALT1250 daemon is ready for normal
* operation, so the "is_resuming" flag is disabled.
*/
dev->is_resuming = false;
/* If the ALT1250 is not powered on, return Resume as failure. */
power = altdevice_powercontrol(dev->altfd, LTE_CMDID_GET_POWER_STAT);
if (!power)
{
dbg_alt1250("Modem is turned off.\n");
*usock_result = -ENETDOWN;
return REP_SEND_ACK;
}
/* Register events so that event notifications are made to the
* report-based Callbacks registered in advance with lte_set_report*().
*/
ret = send_resume_command(dev, container, usock, usock_result, 0);
if (*usock_result != OK)
{
dbg_alt1250("Failed to send resume commands.\n");
}
return ret;
error:
altdevice_powercontrol(dev->altfd, LTE_CMDID_POWEROFF);
/* Resume phase is over */
dev->is_resuming = false;
return ret;
}
#endif
/****************************************************************************
* Public Functions
****************************************************************************/
/****************************************************************************
* name: usockreq_ioctl_normal
****************************************************************************/
int usockreq_ioctl_normal(FAR struct alt1250_s *dev,
FAR struct usrsock_request_buff_s *req,
FAR int32_t *usock_result,
FAR uint32_t *usock_xid,
FAR struct usock_ackinfo_s *ackinfo)
{
FAR struct usrsock_request_ioctl_s *request = &req->request.ioctl_req;
FAR struct lte_ioctl_data_s *ltecmd = &req->req_ioctl.ltecmd;
FAR struct usock_s *usock = NULL;
int ret = REP_SEND_ACK_WOFREE;
uint32_t cmdid = LTE_PURE_CMDID(ltecmd->cmdid);
FAR struct alt_container_s *container;
postproc_hdlr_t postproc_hdlr = NULL;
unsigned long priv = 0;
dbg_alt1250("%s start\n", __func__);
*usock_result = OK;
*usock_xid = request->head.xid;
usock = usocket_search(dev, request->usockid);
if (usock == NULL)
{
dbg_alt1250("Failed to get socket context: %u\n",
request->usockid);
*usock_result = -EBADFD;
return REP_SEND_ACK_WOFREE;
}
container = container_alloc();
if (container == NULL)
{
dbg_alt1250("no container\n");
return REP_NO_CONTAINER;
}
if (LTE_IS_ASYNC_CMD(ltecmd->cmdid) && (ltecmd->cb != NULL))
{
ret = alt1250_regevtcb(cmdid, ltecmd->cb);
if (ret < 0)
{
container_free(container);
*usock_result = ret;
return REP_SEND_ACK_WOFREE;
}
ltecmd->outparam = alt1250_getevtarg(cmdid);
/* The outparam is a array of "*void".
* In asynchronouse API case, the array size is known
* by container in the alt1250 driver.
* So don't need to set the outparamlen here.
*/
}
switch (cmdid)
{
case LTE_CMDID_ACTPDN:
{
alt1250_saveapn(dev, (FAR lte_apn_setting_t *)ltecmd->inparam[0]);
/* The handler is set for post process */
postproc_hdlr = postproc_actpdn;
priv = LTE_IS_ASYNC_CMD(ltecmd->cmdid);
}
break;
case LTE_CMDID_DEACTPDN:
{
alt1250_netdev_ifdown(dev);
}
break;
case LTE_CMDID_TLS_SSL_BIO:
{
/* Override socket id on input parameter from usock file descriptor
* to alt1250 device's socket descriptor
*/
*(FAR int *)(ltecmd->inparam[5]) = USOCKET_ALTSOCKID(usock);
}
break;
case LTE_CMDID_GETVER:
{
/* The handler is set for post process,
* but it will be avoided when the command is asynchronouse.
*/
postproc_hdlr = postproc_fwgetversion;
}
break;
case LTE_CMDID_RADIOON:
{
/* The handler is set for post process */
postproc_hdlr = postproc_radioon;
priv = LTE_IS_ASYNC_CMD(ltecmd->cmdid) ?
RADIOON_ASYNC : RADIOON_SYNC;
}
break;
#ifdef CONFIG_LTE_ALT1250_ENABLE_HIBERNATION_MODE
case LTE_CMDID_RESUME:
return lte_context_resume(dev, ltecmd, container, usock,
usock_result);
#endif
case LTE_CMDID_SAVE_LOG:
case LTE_CMDID_GET_LOGLIST:
case LTE_CMDID_LOGOPEN:
case LTE_CMDID_LOGCLOSE:
case LTE_CMDID_LOGREAD:
case LTE_CMDID_LOGLSEEK:
case LTE_CMDID_LOGREMOVE:
{
if (IS_LOG_UNAVAIL_FWVERSION(dev))
{
container_free(container);
*usock_result = -ENOTSUP;
return REP_SEND_ACK_WOFREE;
}
}
break;
case LTE_CMDID_RADIOOFF:
{
MODEM_STATE_PON(dev);
alt1250_netdev_ifdown(dev);
}
break;
default:
break;
}
USOCKET_SET_REQUEST(usock, request->head.reqid, request->head.xid);
ret = send_lapi_command(dev, container, usock, ltecmd, postproc_hdlr, priv,
usock_result);
if (IS_NEED_CONTAINER_FREE(ret))
{
container_free(container);
}
if (*usock_result < 0)
{
/* In error case, clear callback */
if (LTE_IS_ASYNC_CMD(ltecmd->cmdid) && (ltecmd->cb != NULL))
{
alt1250_regevtcb(cmdid, NULL);
}
}
else if ((ltecmd->cmdid == LTE_CMDID_ACTPDN) ||
(cmdid == LTE_CMDID_TLS_SSL_HANDSHAKE))
{
/* The request from usersock cannot be accepted until the
* response is returned, so the REP_SEND_INPROG is returned
* to delay usock response and make this daemon to be able
* to handle other requests.
*/
ret = REP_SEND_INPROG;
}
else if (LTE_IS_ASYNC_CMD(ltecmd->cmdid))
{
ret = REP_SEND_ACK_WOFREE;
}
return ret;
}