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);
}