1 files changed, 502 insertions, 0 deletions
diff --git a/samsung-ipc/devices/xmm626/xmm626_sec_modem.c b/samsung-ipc/devices/xmm626/xmm626_sec_modem.c
new file mode 100644
index 0000000..100ef5f
--- /dev/null
+++ b/samsung-ipc/devices/xmm626/xmm626_sec_modem.c
@@ -0,0 +1,502 @@
+/*
+ * This file is part of libsamsung-ipc.
+ *
+ * Copyright (C) 2012 Alexander Tarasikov <alexander.tarasikov@gmail.com>
+ * Copyright (C) 2013-2014 Paul Kocialkowski <contact@paulk.fr>
+ *
+ * libsamsung-ipc 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.
+ *
+ * libsamsung-ipc 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 libsamsung-ipc.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <stdlib.h>
+#include <stdio.h>
+#include <unistd.h>
+#include <string.h>
+#include <fcntl.h>
+#include <sys/ioctl.h>
+#include <sys/select.h>
+
+#include <samsung-ipc.h>
+#include <ipc.h>
+#include <utils.h>
+
+#include "modem.h"
+#include "modem_prj.h"
+#include "modem_link_device_hsic.h"
+
+#include "xmm626.h"
+#include "xmm626_sec_modem.h"
+
+int xmm626_sec_modem_power(int device_fd, int power)
+{
+    int rc;
+
+    if (device_fd < 0)
+        return -1;
+
+    rc = ioctl(device_fd, power ? IOCTL_MODEM_ON : IOCTL_MODEM_OFF, 0);
+    if (rc < 0)
+        return -1;
+
+    return 0;
+}
+
+int xmm626_sec_modem_boot_power(int device_fd, int power)
+{
+    int rc;
+
+    if (device_fd < 0)
+        return -1;
+
+    rc = ioctl(device_fd, power ? IOCTL_MODEM_BOOT_ON : IOCTL_MODEM_BOOT_OFF, 0);
+    if (rc < 0)
+        return -1;
+
+    return 0;
+}
+
+int xmm626_sec_modem_status_online_wait(int device_fd)
+{
+    int status;
+    int i;
+
+    if (device_fd < 0)
+        return -1;
+
+    i = 0;
+    for (i = 0; i < 100; i++) {
+        status = ioctl(device_fd, IOCTL_MODEM_STATUS, 0);
+        if (status == STATE_ONLINE)
+            return 0;
+
+        usleep(50000);
+    }
+
+    return -1;
+}
+
+int xmm626_sec_modem_hci_power(int power)
+{
+    int ehci_rc, ohci_rc;
+
+    ehci_rc = sysfs_value_write(XMM626_SEC_MODEM_EHCI_POWER_SYSFS, !!power);
+    if (ehci_rc >= 0)
+        usleep(50000);
+
+    ohci_rc = sysfs_value_write(XMM626_SEC_MODEM_OHCI_POWER_SYSFS, !!power);
+    if (ohci_rc >= 0)
+        usleep(50000);
+
+    if (ehci_rc < 0 && ohci_rc < 0)
+        return -1;
+
+    return 0;
+}
+
+int xmm626_sec_modem_link_control_enable(int device_fd, int enable)
+{
+    int rc;
+
+    if (device_fd < 0)
+        return -1;
+
+    rc = ioctl(device_fd, IOCTL_LINK_CONTROL_ENABLE, &enable);
+    if (rc < 0)
+        return -1;
+
+    return 0;
+}
+
+int xmm626_sec_modem_link_control_active(int device_fd, int active)
+{
+    int rc;
+
+    if (device_fd < 0)
+        return -1;
+
+    rc = ioctl(device_fd, IOCTL_LINK_CONTROL_ACTIVE, &active);
+    if (rc < 0)
+        return -1;
+
+    return 0;
+}
+
+int xmm626_sec_modem_link_connected_wait(int device_fd)
+{
+    int status;
+    int i;
+
+    if (device_fd < 0)
+        return -1;
+
+    i = 0;
+    for (i = 0; i < 100; i++) {
+        status = ioctl(device_fd, IOCTL_LINK_CONNECTED, 0);
+        if (status)
+            return 0;
+
+        usleep(50000);
+    }
+
+    return -1;
+}
+
+int xmm626_sec_modem_link_get_hostwake_wait(int device_fd)
+{
+    int status;
+    int i;
+
+    if (device_fd < 0)
+        return -1;
+
+    i = 0;
+    for (i = 0; i < 10; i++) {
+        status = ioctl(device_fd, IOCTL_LINK_GET_HOSTWAKE, 0);
+        if (status)
+            return 0;
+
+        usleep(50000);
+    }
+
+    return -1;
+}
+
+int xmm626_sec_modem_fmt_send(struct ipc_client *client,
+    struct ipc_message *message)
+{
+    struct ipc_fmt_header header;
+    void *buffer;
+    size_t length;
+    size_t count;
+    unsigned char *p;
+    int rc;
+
+    if (client == NULL || client->handlers == NULL || client->handlers->write == NULL || message == NULL)
+        return -1;
+
+    ipc_fmt_header_setup(&header, message);
+
+    length = header.length;
+    buffer = calloc(1, length);
+
+    memcpy(buffer, &header, sizeof(struct ipc_fmt_header));
+    if (message->data != NULL && message->size > 0)
+        memcpy((void *) ((unsigned char *) buffer + sizeof(struct ipc_fmt_header)), message->data, message->size);
+
+    ipc_client_log_send(client, message, __func__);
+
+    p = (unsigned char *) buffer;
+
+    count = 0;
+    while (count < length) {
+        rc = client->handlers->write(client->handlers->transport_data, p, length - count);
+        if (rc <= 0) {
+            ipc_client_log(client, "Writing FMT data failed");
+            goto error;
+        }
+
+        count += rc;
+        p += rc;
+    }
+
+    rc = 0;
+    goto complete;
+
+error:
+    rc = -1;
+
+complete:
+    if (buffer != NULL)
+        free(buffer);
+
+    return rc;
+}
+
+int xmm626_sec_modem_fmt_recv(struct ipc_client *client,
+    struct ipc_message *message)
+{
+    struct ipc_fmt_header *header;
+    void *buffer = NULL;
+    size_t length;
+    size_t count;
+    unsigned char *p;
+    int rc;
+
+    if (client == NULL || client->handlers == NULL || client->handlers->read == NULL || message == NULL)
+        return -1;
+
+    length = XMM626_DATA_SIZE;
+    buffer = calloc(1, length);
+
+    rc = client->handlers->read(client->handlers->transport_data, buffer, length);
+    if (rc < (int) sizeof(struct ipc_fmt_header)) {
+        ipc_client_log(client, "Reading FMT header failed");
+        goto error;
+    }
+
+    header = (struct ipc_fmt_header *) buffer;
+
+    ipc_fmt_message_setup(header, message);
+
+    if (header->length > sizeof(struct ipc_fmt_header)) {
+        message->size = header->length - sizeof(struct ipc_fmt_header);
+        message->data = calloc(1, message->size);
+
+        p = (unsigned char *) message->data;
+
+        count = rc - sizeof(struct ipc_fmt_header);
+        if (count > 0) {
+            memcpy(p, (void *) ((unsigned char *) buffer + sizeof(struct ipc_fmt_header)), count);
+            p += count;
+        }
+
+        while (count < message->size) {
+            rc = client->handlers->read(client->handlers->transport_data, p, message->size - count);
+            if (rc <= 0) {
+                ipc_client_log(client, "Reading FMT data failed");
+                goto error;
+            }
+
+            count += rc;
+            p += rc;
+        }
+    }
+
+    ipc_client_log_recv(client, message, __func__);
+
+    rc = 0;
+    goto complete;
+
+error:
+    rc = -1;
+
+complete:
+    if (buffer != NULL)
+        free(buffer);
+
+    return rc;
+}
+
+int xmm626_sec_modem_rfs_send(struct ipc_client *client,
+    struct ipc_message *message)
+{
+    struct ipc_rfs_header header;
+    void *buffer;
+    size_t length;
+    size_t count;
+    unsigned char *p;
+    int rc;
+
+    if (client == NULL || client->handlers == NULL || client->handlers->write == NULL || message == NULL)
+        return -1;
+
+    ipc_rfs_header_setup(&header, message);
+
+    length = header.length;
+    buffer = calloc(1, length);
+
+    memcpy(buffer, &header, sizeof(struct ipc_rfs_header));
+    if (message->data != NULL && message->size > 0)
+        memcpy((void *) ((unsigned char *) buffer + sizeof(struct ipc_rfs_header)), message->data, message->size);
+
+    ipc_client_log_send(client, message, __func__);
+
+    p = (unsigned char *) buffer;
+
+    count = 0;
+    while (count < length) {
+        rc = client->handlers->write(client->handlers->transport_data, p, length - count);
+        if (rc <= 0) {
+            ipc_client_log(client, "Writing RFS data failed");
+            goto error;
+        }
+
+        count += rc;
+        p += rc;
+    }
+
+    rc = 0;
+    goto complete;
+
+error:
+    rc = -1;
+
+complete:
+    if (buffer != NULL)
+        free(buffer);
+
+    return rc;
+}
+
+int xmm626_sec_modem_rfs_recv(struct ipc_client *client,
+    struct ipc_message *message)
+{
+    struct ipc_rfs_header *header;
+    void *buffer = NULL;
+    size_t length;
+    size_t count;
+    unsigned char *p;
+    int rc;
+
+    if (client == NULL || client->handlers == NULL || client->handlers->read == NULL || message == NULL)
+        return -1;
+
+    length = XMM626_DATA_SIZE;
+    buffer = calloc(1, length);
+
+    rc = client->handlers->read(client->handlers->transport_data, buffer, length);
+    if (rc < (int) sizeof(struct ipc_rfs_header)) {
+        ipc_client_log(client, "Reading RFS header failed");
+        goto error;
+    }
+
+    header = (struct ipc_rfs_header *) buffer;
+
+    ipc_rfs_message_setup(header, message);
+
+    if (header->length > sizeof(struct ipc_rfs_header)) {
+        message->size = header->length - sizeof(struct ipc_rfs_header);
+        message->data = calloc(1, message->size);
+
+        p = (unsigned char *) message->data;
+
+        count = rc - sizeof(struct ipc_rfs_header);
+        if (count > 0) {
+            memcpy(p, (void *) ((unsigned char *) buffer + sizeof(struct ipc_rfs_header)), count);
+            p += count;
+        }
+
+        while (count < message->size) {
+            rc = client->handlers->read(client->handlers->transport_data, p, message->size - count);
+            if (rc <= 0) {
+                ipc_client_log(client, "Reading RFS data failed");
+                goto error;
+            }
+
+            count += rc;
+            p += rc;
+        }
+    }
+
+    ipc_client_log_recv(client, message, __func__);
+
+    rc = 0;
+    goto complete;
+
+error:
+    rc = -1;
+
+complete:
+    if (buffer != NULL)
+        free(buffer);
+
+    return rc;
+}
+
+int xmm626_sec_modem_open(int type)
+{
+    int fd;
+
+    switch (type) {
+        case IPC_CLIENT_TYPE_FMT:
+            fd = open(XMM626_SEC_MODEM_IPC0_DEVICE, O_RDWR | O_NOCTTY | O_NONBLOCK);
+            break;
+        case IPC_CLIENT_TYPE_RFS:
+            fd = open(XMM626_SEC_MODEM_RFS0_DEVICE, O_RDWR | O_NOCTTY | O_NONBLOCK);
+            break;
+        default:
+            return -1;
+    }
+
+    return fd;
+}
+
+int xmm626_sec_modem_close(int fd)
+{
+    if (fd < 0)
+        return -1;
+
+    close(fd);
+
+    return 0;
+}
+
+int xmm626_sec_modem_read(int fd, void *buffer, size_t length)
+{
+    int rc;
+
+    if (fd < 0 || buffer == NULL || length <= 0)
+        return -1;
+
+    rc = read(fd, buffer, length);
+
+    return rc;
+}
+
+int xmm626_sec_modem_write(int fd, const void *buffer, size_t length)
+{
+    int rc;
+
+    if (fd < 0 || buffer == NULL || length <= 0)
+        return -1;
+
+    rc = write(fd, buffer, length);
+
+    return rc;
+}
+
+int xmm626_sec_modem_poll(int fd, struct timeval *timeout)
+{
+    fd_set fds;
+    int rc;
+    int status;
+
+    if (fd < 0)
+        return -1;
+
+    FD_ZERO(&fds);
+    FD_SET(fd, &fds);
+
+    rc = select(fd + 1, &fds, NULL, NULL, timeout);
+    if (FD_ISSET(fd, &fds)) {
+        status = ioctl(fd, IOCTL_MODEM_STATUS, 0);
+        if (status != STATE_ONLINE && status != STATE_BOOTING)
+            return 0;
+    }
+
+    return rc;
+}
+
+char *xmm626_sec_modem_gprs_get_iface(int cid)
+{
+    char *iface = NULL;
+
+    if (cid > XMM626_SEC_MODEM_GPRS_IFACE_COUNT)
+        return NULL;
+
+    asprintf(&iface, "%s%d", XMM626_SEC_MODEM_GPRS_IFACE_PREFIX, cid - 1);
+
+    return iface;
+}
+
+int xmm626_sec_modem_gprs_get_capabilities(struct ipc_client_gprs_capabilities *capabilities)
+{
+    if (capabilities == NULL)
+        return -1;
+
+    capabilities->cid_count = XMM626_SEC_MODEM_GPRS_IFACE_COUNT;
+
+    return 0;
+}
+
+// vim:ts=4:sw=4:expandtab