static int disconnect_req(struct sap_connection *conn, uint8_t disc_type) { DBG("conn %p state %d disc_type 0x%02x", conn, conn->state, disc_type); switch (disc_type) { case SAP_DISCONNECTION_TYPE_GRACEFUL: if (conn->state == SAP_STATE_DISCONNECTED || conn->state == SAP_STATE_CONNECT_IN_PROGRESS || conn->state == SAP_STATE_CONNECT_MODEM_BUSY) return -EPERM; if (conn->state == SAP_STATE_CONNECTED) { conn->state = SAP_STATE_GRACEFUL_DISCONNECT; conn->processing_req = SAP_NO_REQ; disconnect_ind(conn, disc_type); /* Timer will disconnect if client won't do.*/ start_guard_timer(conn, SAP_TIMER_GRACEFUL_DISCONNECT); } return 0; case SAP_DISCONNECTION_TYPE_IMMEDIATE: if (conn->state == SAP_STATE_DISCONNECTED || conn->state == SAP_STATE_CONNECT_IN_PROGRESS || conn->state == SAP_STATE_CONNECT_MODEM_BUSY) return -EPERM; if (conn->state == SAP_STATE_CONNECTED || conn->state == SAP_STATE_GRACEFUL_DISCONNECT) { conn->state = SAP_STATE_IMMEDIATE_DISCONNECT; conn->processing_req = SAP_NO_REQ; stop_guard_timer(conn); disconnect_ind(conn, disc_type); sap_disconnect_req(conn, 0); } return 0; case SAP_DISCONNECTION_TYPE_CLIENT: if (conn->state != SAP_STATE_CONNECTED && conn->state != SAP_STATE_GRACEFUL_DISCONNECT) { sap_error_rsp(conn); return -EPERM; } conn->state = SAP_STATE_CLIENT_DISCONNECT; conn->processing_req = SAP_NO_REQ; stop_guard_timer(conn); sap_disconnect_req(conn, 0); return 0; default: error("Unknown disconnection type (0x%02x).", disc_type); return -EINVAL; } }
int sap_connect_rsp(void *sap_device, uint8_t status) { struct sap_server *server = sap_device; struct sap_connection *conn = server->conn; char buf[SAP_BUF_SIZE]; struct sap_message *msg = (struct sap_message *) buf; struct sap_parameter *param = (struct sap_parameter *) msg->param; size_t size = sizeof(struct sap_message); if (!conn) return -EINVAL; DBG("state %d pr 0x%02x status 0x%02x", conn->state, conn->processing_req, status); if (conn->state != SAP_STATE_CONNECT_IN_PROGRESS) return -EPERM; memset(buf, 0, sizeof(buf)); msg->id = SAP_CONNECT_RESP; msg->nparam = 0x01; /* Add connection status */ param->id = SAP_PARAM_ID_CONN_STATUS; param->len = htons(SAP_PARAM_ID_CONN_STATUS_LEN); *param->val = status; size += PARAMETER_SIZE(SAP_PARAM_ID_CONN_STATUS_LEN); switch (status) { case SAP_STATUS_OK: sap_set_connected(server); break; case SAP_STATUS_OK_ONGOING_CALL: DBG("ongoing call. Wait for reset indication!"); conn->state = SAP_STATE_CONNECT_MODEM_BUSY; break; case SAP_STATUS_MAX_MSG_SIZE_NOT_SUPPORTED: /* Add MaxMsgSize */ msg->nparam++; param = (struct sap_parameter *) &buf[size]; param->id = SAP_PARAM_ID_MAX_MSG_SIZE; param->len = htons(SAP_PARAM_ID_MAX_MSG_SIZE_LEN); put_be16(SAP_BUF_SIZE, ¶m->val); size += PARAMETER_SIZE(SAP_PARAM_ID_MAX_MSG_SIZE_LEN); /* fall */ default: conn->state = SAP_STATE_DISCONNECTED; /* Timer will shutdown channel if client doesn't send * CONNECT_REQ or doesn't shutdown channel itself.*/ start_guard_timer(server, SAP_TIMER_NO_ACTIVITY); break; } conn->processing_req = SAP_NO_REQ; return send_message(conn, buf, size); }
int sap_connect_rsp(void *sap_device, uint8_t status, uint16_t maxmsgsize) { struct sap_connection *conn = sap_device; char buf[SAP_BUF_SIZE]; struct sap_message *msg = (struct sap_message *) buf; struct sap_parameter *param = (struct sap_parameter *) msg->param; size_t size = sizeof(struct sap_message); if (!conn) return -EINVAL; DBG("state %d pr 0x%02x status 0x%02x", conn->state, conn->processing_req, status); if (conn->state != SAP_STATE_CONNECT_IN_PROGRESS) return -EPERM; memset(buf, 0, sizeof(buf)); msg->id = SAP_CONNECT_RESP; msg->nparam = 0x01; /* Add connection status */ param->id = SAP_PARAM_ID_CONN_STATUS; param->len = htons(SAP_PARAM_ID_CONN_STATUS_LEN); *param->val = status; size += PARAMETER_SIZE(SAP_PARAM_ID_CONN_STATUS_LEN); /* Add MaxMsgSize */ if (maxmsgsize) { uint16_t *len; msg->nparam++; param = (struct sap_parameter *) &buf[size]; param->id = SAP_PARAM_ID_MAX_MSG_SIZE; param->len = htons(SAP_PARAM_ID_MAX_MSG_SIZE_LEN); len = (uint16_t *) ¶m->val; *len = htons(maxmsgsize); size += PARAMETER_SIZE(SAP_PARAM_ID_MAX_MSG_SIZE_LEN); } if (status == SAP_STATUS_OK) { sap_set_connected(conn); } else if (status == SAP_STATUS_OK_ONGOING_CALL) { DBG("ongoing call. Wait for reset indication!"); conn->state = SAP_STATE_CONNECT_MODEM_BUSY; } else { conn->state = SAP_STATE_DISCONNECTED; /* Timer will shutdown channel if client doesn't send * CONNECT_REQ or doesn't shutdown channel itself.*/ start_guard_timer(conn, SAP_TIMER_NO_ACTIVITY); } conn->processing_req = SAP_NO_REQ; return send_message(sap_device, buf, size); }
static void sap_connect_cb(GIOChannel *io, GError *gerr, gpointer data) { struct sap_connection *conn = data; DBG("conn %p, io %p", conn, io); if (!conn) return; /* Timer will shutdown the channel in case of lack of client activity */ start_guard_timer(conn, SAP_TIMER_NO_ACTIVITY); g_io_add_watch_full(io, G_PRIORITY_DEFAULT, G_IO_IN | G_IO_ERR | G_IO_HUP | G_IO_NVAL, sap_io_cb, conn, sap_io_destroy); }
int sap_disconnect_rsp(void *sap_device) { struct sap_server *server = sap_device; struct sap_connection *conn = server->conn; struct sap_message msg; if (!conn) return -EINVAL; DBG("state %d pr 0x%02x", conn->state, conn->processing_req); switch (conn->state) { case SAP_STATE_CLIENT_DISCONNECT: memset(&msg, 0, sizeof(msg)); msg.id = SAP_DISCONNECT_RESP; conn->state = SAP_STATE_DISCONNECTED; conn->processing_req = SAP_NO_REQ; /* Timer will close channel if client doesn't do it.*/ start_guard_timer(server, SAP_TIMER_NO_ACTIVITY); return send_message(conn, &msg, sizeof(msg)); case SAP_STATE_IMMEDIATE_DISCONNECT: conn->state = SAP_STATE_DISCONNECTED; conn->processing_req = SAP_NO_REQ; if (conn->io) { g_io_channel_shutdown(conn->io, TRUE, NULL); g_io_channel_unref(conn->io); conn->io = NULL; } return 0; default: break; } return 0; }
int sap_connect_rsp(void *sap_device, uint8_t status, uint16_t maxmsgsize) { struct sap_connection *conn = sap_device; char buf[SAP_BUF_SIZE]; struct sap_message *msg = (struct sap_message *) buf; struct sap_parameter *param = (struct sap_parameter *) msg->param; size_t size = sizeof(struct sap_message); if (!conn) return -EINVAL; DBG("state %d pr 0x%02x status 0x%02x", conn->state, conn->processing_req, status); if (conn->state != SAP_STATE_CONNECT_IN_PROGRESS) return -EPERM; memset(buf, 0, sizeof(buf)); msg->id = SAP_CONNECT_RESP; msg->nparam = 0x01; /* Add connection status */ param->id = SAP_PARAM_ID_CONN_STATUS; param->len = htons(SAP_PARAM_ID_CONN_STATUS_LEN); *param->val = status; size += PARAMETER_SIZE(SAP_PARAM_ID_CONN_STATUS_LEN); /* Add MaxMsgSize */ if (maxmsgsize && (status == SAP_STATUS_MAX_MSG_SIZE_NOT_SUPPORTED || status == SAP_STATUS_MAX_MSG_SIZE_TOO_SMALL)) { uint16_t *len; msg->nparam++; param = (struct sap_parameter *) &buf[size]; param->id = SAP_PARAM_ID_MAX_MSG_SIZE; param->len = htons(SAP_PARAM_ID_MAX_MSG_SIZE_LEN); len = (uint16_t *) ¶m->val; *len = htons(maxmsgsize); size += PARAMETER_SIZE(SAP_PARAM_ID_MAX_MSG_SIZE_LEN); } if (status == SAP_STATUS_OK) { gboolean connected = TRUE; DBG("sap - emitting property changed signal connected=true"); emit_property_changed(connection, server->path, SAP_SERVER_INTERFACE, "Connected", DBUS_TYPE_BOOLEAN, &connected); conn->state = SAP_STATE_CONNECTED; } else { DBG("sap connection status=%d",status); conn->state = SAP_STATE_DISCONNECTED; /* Timer will shutdown channel if client doesn't send * CONNECT_REQ or doesn't shutdown channel itself.*/ start_guard_timer(conn, SAP_TIMER_NO_ACTIVITY); } conn->processing_req = SAP_NO_REQ; return send_message(sap_device, buf, size); }