/****************************************************************************** QTI _ C M D Q . C ******************************************************************************/ /****************************************************************************** @file qti_cmdq.c @brief Tethering Interface module command queues DESCRIPTION Implementation of Tethering Interface module command queues. --------------------------------------------------------------------------- Copyright (c) 2012-2014 Qualcomm Technologies, Inc. All Rights Reserved. Qualcomm Technologies Proprietary and Confidential. --------------------------------------------------------------------------- ******************************************************************************/ /****************************************************************************** EDIT HISTORY FOR FILE $Id:$ when who what, where, why -------- --- ------------------------------------------------------- 5/29/2012 sb Initial version ******************************************************************************/ /*=========================================================================== INCLUDE FILES ===========================================================================*/ #include #include #include #include #include #include #include #include "stm2.h" #include "ds_list.h" #include "ds_cmdq.h" #include "qti_cmdq.h" /*=========================================================================== LOCAL DEFINITIONS AND DECLARATIONS ===========================================================================*/ /*--------------------------------------------------------------------------- Constant representing maximum number of command buffers used by this module ---------------------------------------------------------------------------*/ #define QTI_CMDQ_MAX_CMDS 5 #define LINK_UP_STR '1' #define LINK_DOWN_STR '0' /*--------------------------------------------------------------------------- Executive control state information ---------------------------------------------------------------------------*/ LOCAL struct qti_cmdq_state_s qti_cmdq_state_info; /*=========================================================================== FUNCTION DEFINITIONS ===========================================================================*/ /*=========================================================================== FUNCTION qti_cmdq_cmd_free ===========================================================================*/ /*! @brief Virtual function registered with the Command Thread to free a command buffer, after execution of the command is complete. @return void @note - Dependencies - None - Side Effects - None */ /*=========================================================================*/ LOCAL void qti_cmdq_cmd_free( ds_cmd_t * cmd, void * data ) { qti_cmdq_cmd_t * cmd_buf; (void) cmd; /* Get qmi cmd ptr from user data ptr */ cmd_buf = (qti_cmdq_cmd_t *)data; /* Unset tracker for debug purposes */ cmd_buf->tracker = 0; /* Release dynamic memory */ free( cmd_buf ); LOG_MSG_INFO1("qcmap_cmdq: free one commmand data",0,0,0); return; } /*=========================================================================== FUNCTION qcmap_cmdq_cmd_process ===========================================================================*/ /*! @brief Virtual function registered with the Command Thread to process a command buffer. @return void @note - Dependencies - None - Side Effects - None */ /*=========================================================================*/ LOCAL void qti_cmdq_cmd_process (ds_cmd_t * cmd, void * data) { qti_cmdq_cmd_t * cmd_buf; int sockfd, len, numBytes; struct sockaddr_un sta_qmi_ip; char buffer; (void) cmd; /* Get qmi cmd ptr from user data ptr */ cmd_buf = (qti_cmdq_cmd_t *)data; if (cmd_buf->data.event == QTI_RMNET_DPM_MODEM_NOT_IN_SERVICE_EVENT ) { qti_rmnet_modem_not_in_service(); } else if (cmd_buf->data.event == QTI_DPM_INIT_EVENT ) { if (dpm_client_init() != QTI_SUCCESS ) { LOG_MSG_ERROR("Unable to init DPM client!!",0, 0, 0); } } #ifdef FEATURE_MDM_LE else { if ( cmd_buf->data.interface == ETH_IF && cmd_buf->data.event == QTI_LINK_DOWN_EVENT) { //create socket if ((sockfd = socket(AF_UNIX, SOCK_DGRAM, 0)) < 0) { LOG_MSG_ERROR("Error creating socket, errno: %d", errno, 0, 0); return; } if (fcntl(sockfd, F_SETFD, FD_CLOEXEC) < 0) LOG_MSG_ERROR("Couldn't set Close on Exec, errno: %d", errno, 0, 0); /* Send the event to QMI_IP server socket. */ sta_qmi_ip.sun_family = AF_UNIX; strlcpy(sta_qmi_ip.sun_path, QMI_IP_STA_FILE, sizeof(QMI_IP_STA_FILE)); len = strlen(sta_qmi_ip.sun_path) + sizeof(sta_qmi_ip.sun_family); //post event buffer = LINK_DOWN_STR; if ((numBytes = sendto(sockfd, (const char *) &buffer, sizeof(buffer), 0, (struct sockaddr *)&sta_qmi_ip, len)) == -1) LOG_MSG_ERROR("Send Failed from sta interface context", 0, 0, 0); close(sockfd); } qti_qcmap_cmd_exec(cmd_buf->data.event, cmd_buf->data.interface); } #endif return; } /*=========================================================================== FUNCTION qti_cmdq_cleanup ===========================================================================*/ /*! @brief Performs cleanup of executive module. Invoked at process termination. @return void @note - Dependencies - None - Side Effects - None */ /*=========================================================================*/ LOCAL void qti_cmdq_cleanup ( void ) { /* Purge command queue to release heap memory */ (void)ds_cmdq_deinit( &qti_cmdq_state_info.cmdq ); } /*=========================================================================== GLOBAL FUNCTION DEFINITIONS ===========================================================================*/ /*=========================================================================== FUNCTION qti_cmdq_get_cmd ===========================================================================*/ /*! @brief Function to get a command buffer for asynchronous processing @return void @note - Dependencies - None - Side Effects - Allocated heap memory */ /*=========================================================================*/ qti_cmdq_cmd_t * qti_cmdq_get_cmd ( void ) { qti_cmdq_cmd_t * cmd_buf = NULL; /* Allocate command buffer */ if((cmd_buf = malloc(sizeof(qti_cmdq_cmd_t))) == NULL ) { LOG_MSG_INFO1("qcmap_cmdq: malloc failed\n",0,0,0); return NULL; } /* Assign self-reference in DS cmd payload */ cmd_buf->cmd.data = (void*)cmd_buf; cmd_buf->tracker = 1; /* Asssign default execution and free handlers */ cmd_buf->cmd.execute_f = qti_cmdq_cmd_process; cmd_buf->cmd.free_f = qti_cmdq_cmd_free; return cmd_buf; } /*=========================================================================== FUNCTION qti_cmdq_release_cmd ===========================================================================*/ /*! @brief Function to release a command buffer @return void @note - Dependencies - None - Side Effects - Returns memory to heap */ /*=========================================================================*/ void qti_cmdq_release_cmd ( qti_cmdq_cmd_t * cmd_buf ) { if( cmd_buf->cmd.free_f ) { cmd_buf->cmd.free_f( &cmd_buf->cmd, cmd_buf->cmd.data ); } else { LOG_MSG_INFO1("qcmap_cmdq: Specified buffer not valid, ignoring\n",0,0,0); } return; } /*=========================================================================== FUNCTION qti_cmdq_put_cmd ===========================================================================*/ /*! @brief Function to post a command buffer for asynchronous processing @return int - 0 on successful operation, -1 otherwise @note - Dependencies - None - Side Effects - None */ /*=========================================================================*/ int qti_cmdq_put_cmd ( const qti_cmdq_cmd_t * cmdbuf ) { /* Append command buffer to the command queue */ int result = ds_cmdq_enq( &qti_cmdq_state_info.cmdq, &cmdbuf->cmd ); return result; } /*=========================================================================== FUNCTION qti_cmdq_wait ===========================================================================*/ /*! @brief Forces calling thread to wait on exit of command processing thread. @return void @note - Dependencies - None - Side Effects - Calling thread is blocked indefinitely */ /*=========================================================================*/ void qti_cmdq_wait ( void ) { ds_cmdq_join_thread( &qti_cmdq_state_info.cmdq ); } /*=========================================================================== FUNCTION qti_cmdq_init ===========================================================================*/ /*! @brief Main initialization routine of the executive control module. @return void @note - Dependencies - None - Side Effects - None */ /*=========================================================================*/ void qti_cmdq_init ( void ) { /* Register process termination cleanup handler */ atexit( qti_cmdq_cleanup ); /*------------------------------------------------------------------------- Initialize command queue for asynch processing -------------------------------------------------------------------------*/ ds_cmdq_init( &qti_cmdq_state_info.cmdq, QTI_CMDQ_MAX_CMDS ); return; } /*=========================================================================== FUNCTION qti_get_cmdq_length ===========================================================================*/ /*! @brief Function returns the number of outstanding messages in command queue. @return void @note - Dependencies - None - Side Effects - None */ /*=========================================================================*/ int qti_get_cmdq_length( void ) { return qti_cmdq_state_info.cmdq.nel; }