/*
 *  Siano core API module
 *
 *  This file contains implementation for the interface to sms core component
 *
 *  author: Uri Shkolnik
 *
 *  Copyright (c), 2005-2008 Siano Mobile Silicon, Inc.
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License version 2 as
 *  published by the Free Software Foundation;
 *
 *  Software distributed under the License is distributed on an "AS IS"
 *  basis, WITHOUT WARRANTY OF ANY KIND, either express or implied.
 *
 *  See the GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program; if not, write to the Free Software
 *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/dma-mapping.h>
#include <linux/delay.h>
#include <linux/io.h>

#include <linux/firmware.h>
#include <linux/wait.h>
#include <asm/byteorder.h>

#include "smscoreapi.h"
#include "sms-cards.h"
#include "smsir.h"
#include "smsendian.h"

static int sms_dbg;
module_param_named(debug, sms_dbg, int, 0644);
MODULE_PARM_DESC(debug, "set debug level (info=1, adv=2 (or-able))");

struct smscore_device_notifyee_t {
        struct list_head entry;
        hotplug_t hotplug;
};

struct smscore_idlist_t {
        struct list_head entry;
        int             id;
        int             data_type;
};

struct smscore_client_t {
        struct list_head entry;
        struct smscore_device_t *coredev;
        void                    *context;
        struct list_head        idlist;
        onresponse_t    onresponse_handler;
        onremove_t              onremove_handler;
};

void smscore_set_board_id(struct smscore_device_t *core, int id)
{
        core->board_id = id;
}

int smscore_led_state(struct smscore_device_t *core, int led)
{
        if (led >= 0)
                core->led_state = led;
        return core->led_state;
}
EXPORT_SYMBOL_GPL(smscore_set_board_id);

int smscore_get_board_id(struct smscore_device_t *core)
{
        return core->board_id;
}
EXPORT_SYMBOL_GPL(smscore_get_board_id);

struct smscore_registry_entry_t {
        struct list_head entry;
        char                    devpath[32];
        int                             mode;
        enum sms_device_type_st type;
};

static struct list_head g_smscore_notifyees;
static struct list_head g_smscore_devices;
static struct mutex g_smscore_deviceslock;

static struct list_head g_smscore_registry;
static struct mutex g_smscore_registrylock;

static int default_mode = 4;

module_param(default_mode, int, 0644);
MODULE_PARM_DESC(default_mode, "default firmware id (device mode)");

static struct smscore_registry_entry_t *smscore_find_registry(char *devpath)
{
        struct smscore_registry_entry_t *entry;
        struct list_head *next;

        kmutex_lock(&g_smscore_registrylock);
        for (next = g_smscore_registry.next;
             next != &g_smscore_registry;
             next = next->next) {
                entry = (struct smscore_registry_entry_t *) next;
                if (!strcmp(entry->devpath, devpath)) {
                        kmutex_unlock(&g_smscore_registrylock);
                        return entry;
                }
        }
        entry = (struct smscore_registry_entry_t *)
                        kmalloc(sizeof(struct smscore_registry_entry_t),
                                GFP_KERNEL);
        if (entry) {
                entry->mode = default_mode;
                strcpy(entry->devpath, devpath);
                list_add(&entry->entry, &g_smscore_registry);
        } else
                sms_err("failed to create smscore_registry.");
        kmutex_unlock(&g_smscore_registrylock);
        return entry;
}

int smscore_registry_getmode(char *devpath)
{
        struct smscore_registry_entry_t *entry;

        entry = smscore_find_registry(devpath);
        if (entry)
                return entry->mode;
        else
                sms_err("No registry found.");

        return default_mode;
}
EXPORT_SYMBOL_GPL(smscore_registry_getmode);

static enum sms_device_type_st smscore_registry_gettype(char *devpath)
{
        struct smscore_registry_entry_t *entry;

        entry = smscore_find_registry(devpath);
        if (entry)
                return entry->type;
        else
                sms_err("No registry found.");

        return -1;
}

void smscore_registry_setmode(char *devpath, int mode)
{
        struct smscore_registry_entry_t *entry;

        entry = smscore_find_registry(devpath);
        if (entry)
                entry->mode = mode;
        else
                sms_err("No registry found.");
}

static void smscore_registry_settype(char *devpath,
                                     enum sms_device_type_st type)
{
        struct smscore_registry_entry_t *entry;

        entry = smscore_find_registry(devpath);
        if (entry)
                entry->type = type;
        else
                sms_err("No registry found.");
}


static void list_add_locked(struct list_head *new, struct list_head *head,
                            spinlock_t *lock)
{
        unsigned long flags;

        spin_lock_irqsave(lock, flags);

        list_add(new, head);

        spin_unlock_irqrestore(lock, flags);
}

/**
 * register a client callback that called when device plugged in/unplugged
 * NOTE: if devices exist callback is called immediately for each device
 *
 * @param hotplug callback
 *
 * @return 0 on success, <0 on error.
 */
int smscore_register_hotplug(hotplug_t hotplug)
{
        struct smscore_device_notifyee_t *notifyee;
        struct list_head *next, *first;
        int rc = 0;

        kmutex_lock(&g_smscore_deviceslock);

        notifyee = kmalloc(sizeof(struct smscore_device_notifyee_t),
                           GFP_KERNEL);
        if (notifyee) {
                /* now notify callback about existing devices */
                first = &g_smscore_devices;
                for (next = first->next;
                     next != first && !rc;
                     next = next->next) {
                        struct smscore_device_t *coredev =
                                (struct smscore_device_t *) next;
                        rc = hotplug(coredev, coredev->device, 1);
                }

                if (rc >= 0) {
                        notifyee->hotplug = hotplug;
                        list_add(&notifyee->entry, &g_smscore_notifyees);
                } else
                        kfree(notifyee);
        } else
                rc = -ENOMEM;

        kmutex_unlock(&g_smscore_deviceslock);

        return rc;
}
EXPORT_SYMBOL_GPL(smscore_register_hotplug);

/**
 * unregister a client callback that called when device plugged in/unplugged
 *
 * @param hotplug callback
 *
 */
void smscore_unregister_hotplug(hotplug_t hotplug)
{
        struct list_head *next, *first;

        kmutex_lock(&g_smscore_deviceslock);

        first = &g_smscore_notifyees;

        for (next = first->next; next != first;) {
                struct smscore_device_notifyee_t *notifyee =
                        (struct smscore_device_notifyee_t *) next;
                next = next->next;

                if (notifyee->hotplug == hotplug) {
                        list_del(&notifyee->entry);
                        kfree(notifyee);
                }
        }

        kmutex_unlock(&g_smscore_deviceslock);
}
EXPORT_SYMBOL_GPL(smscore_unregister_hotplug);

static void smscore_notify_clients(struct smscore_device_t *coredev)
{
        struct smscore_client_t *client;

        /* the client must call smscore_unregister_client from remove handler */
        while (!list_empty(&coredev->clients)) {
                client = (struct smscore_client_t *) coredev->clients.next;
                client->onremove_handler(client->context);
        }
}

static int smscore_notify_callbacks(struct smscore_device_t *coredev,
                                    struct device *device, int arrival)
{
        struct list_head *next, *first;
        int rc = 0;

        /* note: must be called under g_deviceslock */

        first = &g_smscore_notifyees;

        for (next = first->next; next != first; next = next->next) {
                rc = ((struct smscore_device_notifyee_t *) next)->
                                hotplug(coredev, device, arrival);
                if (rc < 0)
                        break;
        }

        return rc;
}

static struct
smscore_buffer_t *smscore_createbuffer(u8 *buffer, void *common_buffer,
                                       dma_addr_t common_buffer_phys)
{
        struct smscore_buffer_t *cb =
                kmalloc(sizeof(struct smscore_buffer_t), GFP_KERNEL);
        if (!cb) {
                sms_info("kmalloc(...) failed");
                return NULL;
        }

        cb->p = buffer;
        cb->offset_in_common = buffer - (u8 *) common_buffer;
        cb->phys = common_buffer_phys + cb->offset_in_common;

        return cb;
}

/**
 * creates coredev object for a device, prepares buffers,
 * creates buffer mappings, notifies registered hotplugs about new device.
 *
 * @param params device pointer to struct with device specific parameters
 *               and handlers
 * @param coredev pointer to a value that receives created coredev object
 *
 * @return 0 on success, <0 on error.
 */
int smscore_register_device(struct smsdevice_params_t *params,
                            struct smscore_device_t **coredev)
{
        struct smscore_device_t *dev;
        u8 *buffer;

        dev = kzalloc(sizeof(struct smscore_device_t), GFP_KERNEL);
        if (!dev) {
                sms_info("kzalloc(...) failed");
                return -ENOMEM;
        }

        /* init list entry so it could be safe in smscore_unregister_device */
        INIT_LIST_HEAD(&dev->entry);

        /* init queues */
        INIT_LIST_HEAD(&dev->clients);
        INIT_LIST_HEAD(&dev->buffers);

        /* init locks */
        spin_lock_init(&dev->clientslock);
        spin_lock_init(&dev->bufferslock);

        /* init completion events */
        init_completion(&dev->version_ex_done);
        init_completion(&dev->data_download_done);
        init_completion(&dev->trigger_done);
        init_completion(&dev->init_device_done);
        init_completion(&dev->reload_start_done);
        init_completion(&dev->resume_done);
        init_completion(&dev->gpio_configuration_done);
        init_completion(&dev->gpio_set_level_done);
        init_completion(&dev->gpio_get_level_done);
        init_completion(&dev->ir_init_done);

        /* Buffer management */
        init_waitqueue_head(&dev->buffer_mng_waitq);

        /* alloc common buffer */
        dev->common_buffer_size = params->buffer_size * params->num_buffers;
        dev->common_buffer = dma_alloc_coherent(NULL, dev->common_buffer_size,
                                                &dev->common_buffer_phys,
                                                GFP_KERNEL | GFP_DMA);
        if (!dev->common_buffer) {
                smscore_unregister_device(dev);
                return -ENOMEM;
        }

        /* prepare dma buffers */
        for (buffer = dev->common_buffer;
             dev->num_buffers < params->num_buffers;
             dev->num_buffers++, buffer += params->buffer_size) {
                struct smscore_buffer_t *cb =
                        smscore_createbuffer(buffer, dev->common_buffer,
                                             dev->common_buffer_phys);
                if (!cb) {
                        smscore_unregister_device(dev);
                        return -ENOMEM;
                }

                smscore_putbuffer(dev, cb);
        }

        sms_info("allocated %d buffers", dev->num_buffers);

        dev->mode = DEVICE_MODE_NONE;
        dev->context = params->context;
        dev->device = params->device;
        dev->setmode_handler = params->setmode_handler;
        dev->detectmode_handler = params->detectmode_handler;
        dev->sendrequest_handler = params->sendrequest_handler;
        dev->preload_handler = params->preload_handler;
        dev->postload_handler = params->postload_handler;

        dev->device_flags = params->flags;
        strcpy(dev->devpath, params->devpath);

        smscore_registry_settype(dev->devpath, params->device_type);

        /* add device to devices list */
        kmutex_lock(&g_smscore_deviceslock);
        list_add(&dev->entry, &g_smscore_devices);
        kmutex_unlock(&g_smscore_deviceslock);

        *coredev = dev;

        sms_info("device %p created", dev);

        return 0;
}
EXPORT_SYMBOL_GPL(smscore_register_device);


static int smscore_sendrequest_and_wait(struct smscore_device_t *coredev,
                void *buffer, size_t size, struct completion *completion) {
        int rc = coredev->sendrequest_handler(coredev->context, buffer, size);
        if (rc < 0) {
                sms_info("sendrequest returned error %d", rc);
                return rc;
        }

        return wait_for_completion_timeout(completion,
                        msecs_to_jiffies(SMS_PROTOCOL_MAX_RAOUNDTRIP_MS)) ?
                        0 : -ETIME;
}

/**
 * Starts & enables IR operations
 *
 * @return 0 on success, < 0 on error.
 */
static int smscore_init_ir(struct smscore_device_t *coredev)
{
        int ir_io;
        int rc;
        void *buffer;

        coredev->ir.input_dev = NULL;
        ir_io = sms_get_board(smscore_get_board_id(coredev))->board_cfg.ir;
        if (ir_io) {/* only if IR port exist we use IR sub-module */
                sms_info("IR loading");
                rc = sms_ir_init(coredev);

                if      (rc != 0)
                        sms_err("Error initialization DTV IR sub-module");
                else {
                        buffer = kmalloc(sizeof(struct SmsMsgData_ST2) +
                                                SMS_DMA_ALIGNMENT,
                                                GFP_KERNEL | GFP_DMA);
                        if (buffer) {
                                struct SmsMsgData_ST2 *msg =
                                (struct SmsMsgData_ST2 *)
                                SMS_ALIGN_ADDRESS(buffer);

                                SMS_INIT_MSG(&msg->xMsgHeader,
                                                MSG_SMS_START_IR_REQ,
                                                sizeof(struct SmsMsgData_ST2));
                                msg->msgData[0] = coredev->ir.controller;
                                msg->msgData[1] = coredev->ir.timeout;

                                smsendian_handle_tx_message(
                                        (struct SmsMsgHdr_ST2 *)msg);
                                rc = smscore_sendrequest_and_wait(coredev, msg,
                                                msg->xMsgHeader. msgLength,
                                                &coredev->ir_init_done);

                                kfree(buffer);
                        } else
                                sms_err
                                ("Sending IR initialization message failed");
                }
        } else
                sms_info("IR port has not been detected");

        return 0;
}

/**
 * sets initial device mode and notifies client hotplugs that device is ready
 *
 * @param coredev pointer to a coredev object returned by
 *                smscore_register_device
 *
 * @return 0 on success, <0 on error.
 */
int smscore_start_device(struct smscore_device_t *coredev)
{
        int rc = smscore_set_device_mode(
                        coredev, smscore_registry_getmode(coredev->devpath));
        if (rc < 0) {
                sms_info("set device mode faile , rc %d", rc);
                return rc;
        }

        kmutex_lock(&g_smscore_deviceslock);

        rc = smscore_notify_callbacks(coredev, coredev->device, 1);
        smscore_init_ir(coredev);

        sms_info("device %p started, rc %d", coredev, rc);

        kmutex_unlock(&g_smscore_deviceslock);

        return rc;
}
EXPORT_SYMBOL_GPL(smscore_start_device);


static int smscore_load_firmware_family2(struct smscore_device_t *coredev,
                                         void *buffer, size_t size)
{
        struct SmsFirmware_ST *firmware = (struct SmsFirmware_ST *) buffer;
        struct SmsMsgHdr_ST *msg;
        u32 mem_address;
        u8 *payload = firmware->Payload;
        int rc = 0;
        firmware->StartAddress = le32_to_cpu(firmware->StartAddress);
        firmware->Length = le32_to_cpu(firmware->Length);

        mem_address = firmware->StartAddress;

        sms_info("loading FW to addr 0x%x size %d",
                 mem_address, firmware->Length);
        if (coredev->preload_handler) {
                rc = coredev->preload_handler(coredev->context);
                if (rc < 0)
                        return rc;
        }

        /* PAGE_SIZE buffer shall be enough and dma aligned */
        msg = kmalloc(PAGE_SIZE, GFP_KERNEL | GFP_DMA);
        if (!msg)
                return -ENOMEM;

        if (coredev->mode != DEVICE_MODE_NONE) {
                sms_debug("sending reload command.");
                SMS_INIT_MSG(msg, MSG_SW_RELOAD_START_REQ,
                             sizeof(struct SmsMsgHdr_ST));
                rc = smscore_sendrequest_and_wait(coredev, msg,
                                                  msg->msgLength,
                                                  &coredev->reload_start_done);
                mem_address = *(u32 *) &payload[20];
        }

        while (size && rc >= 0) {
                struct SmsDataDownload_ST *DataMsg =
                        (struct SmsDataDownload_ST *) msg;
                int payload_size = min((int) size, SMS_MAX_PAYLOAD_SIZE);

                SMS_INIT_MSG(msg, MSG_SMS_DATA_DOWNLOAD_REQ,
                             (u16)(sizeof(struct SmsMsgHdr_ST) +
                                      sizeof(u32) + payload_size));

                DataMsg->MemAddr = mem_address;
                memcpy(DataMsg->Payload, payload, payload_size);

                if ((coredev->device_flags & SMS_ROM_NO_RESPONSE) &&
                    (coredev->mode == DEVICE_MODE_NONE))
                        rc = coredev->sendrequest_handler(
                                coredev->context, DataMsg,
                                DataMsg->xMsgHeader.msgLength);
                else
                        rc = smscore_sendrequest_and_wait(
                                coredev, DataMsg,
                                DataMsg->xMsgHeader.msgLength,
                                &coredev->data_download_done);

                payload += payload_size;
                size -= payload_size;
                mem_address += payload_size;
        }

        if (rc >= 0) {
                if (coredev->mode == DEVICE_MODE_NONE) {
                        struct SmsMsgData_ST *TriggerMsg =
                                (struct SmsMsgData_ST *) msg;

                        SMS_INIT_MSG(msg, MSG_SMS_SWDOWNLOAD_TRIGGER_REQ,
                                     sizeof(struct SmsMsgHdr_ST) +
                                     sizeof(u32) * 5);

                        TriggerMsg->msgData[0] = firmware->StartAddress;
                                                /* Entry point */
                        TriggerMsg->msgData[1] = 5; /* Priority */
                        TriggerMsg->msgData[2] = 0x200; /* Stack size */
                        TriggerMsg->msgData[3] = 0; /* Parameter */
                        TriggerMsg->msgData[4] = 4; /* Task ID */

                        if (coredev->device_flags & SMS_ROM_NO_RESPONSE) {
                                rc = coredev->sendrequest_handler(
                                        coredev->context, TriggerMsg,
                                        TriggerMsg->xMsgHeader.msgLength);
                                msleep(100);
                        } else
                                rc = smscore_sendrequest_and_wait(
                                        coredev, TriggerMsg,
                                        TriggerMsg->xMsgHeader.msgLength,
                                        &coredev->trigger_done);
                } else {
                        SMS_INIT_MSG(msg, MSG_SW_RELOAD_EXEC_REQ,
                                     sizeof(struct SmsMsgHdr_ST));

                        rc = coredev->sendrequest_handler(coredev->context,
                                                          msg, msg->msgLength);
                }
                msleep(500);
        }

        sms_debug("rc=%d, postload=%p ", rc,
                  coredev->postload_handler);

        kfree(msg);

        return ((rc >= 0) && coredev->postload_handler) ?
                coredev->postload_handler(coredev->context) :
                rc;
}

/**
 * loads specified firmware into a buffer and calls device loadfirmware_handler
 *
 * @param coredev pointer to a coredev object returned by
 *                smscore_register_device
 * @param filename null-terminated string specifies firmware file name
 * @param loadfirmware_handler device handler that loads firmware
 *
 * @return 0 on success, <0 on error.
 */
static int smscore_load_firmware_from_file(struct smscore_device_t *coredev,
                                           char *filename,
                                           loadfirmware_t loadfirmware_handler)
{
        int rc = -ENOENT;
        const struct firmware *fw;
        u8 *fw_buffer;

        if (loadfirmware_handler == NULL && !(coredev->device_flags &
                                              SMS_DEVICE_FAMILY2))
                return -EINVAL;

        rc = request_firmware(&fw, filename, coredev->device);
        if (rc < 0) {
                sms_info("failed to open \"%s\"", filename);
                return rc;
        }
        sms_info("read FW %s, size=%zd", filename, fw->size);
        fw_buffer = kmalloc(ALIGN(fw->size, SMS_ALLOC_ALIGNMENT),
                            GFP_KERNEL | GFP_DMA);
        if (fw_buffer) {
                memcpy(fw_buffer, fw->data, fw->size);

                rc = (coredev->device_flags & SMS_DEVICE_FAMILY2) ?
                      smscore_load_firmware_family2(coredev,
                                                    fw_buffer,
                                                    fw->size) :
                      loadfirmware_handler(coredev->context,
                                           fw_buffer, fw->size);

                kfree(fw_buffer);
        } else {
                sms_info("failed to allocate firmware buffer");
                rc = -ENOMEM;
        }

        release_firmware(fw);

        return rc;
}

/**
 * notifies all clients registered with the device, notifies hotplugs,
 * frees all buffers and coredev object
 *
 * @param coredev pointer to a coredev object returned by
 *                smscore_register_device
 *
 * @return 0 on success, <0 on error.
 */
void smscore_unregister_device(struct smscore_device_t *coredev)
{
        struct smscore_buffer_t *cb;
        int num_buffers = 0;
        int retry = 0;

        kmutex_lock(&g_smscore_deviceslock);

        /* Release input device (IR) resources */
        sms_ir_exit(coredev);

        smscore_notify_clients(coredev);
        smscore_notify_callbacks(coredev, NULL, 0);

        /* at this point all buffers should be back
         * onresponse must no longer be called */

        while (1) {
                while (!list_empty(&coredev->buffers)) {
                        cb = (struct smscore_buffer_t *) coredev->buffers.next;
                        list_del(&cb->entry);
                        kfree(cb);
                        num_buffers++;
                }
                if (num_buffers == coredev->num_buffers)
                        break;
                if (++retry > 10) {
                        sms_info("exiting although "
                                 "not all buffers released.");
                        break;
                }

                sms_info("waiting for %d buffer(s)",
                         coredev->num_buffers - num_buffers);
                msleep(100);
        }

        sms_info("freed %d buffers", num_buffers);

        if (coredev->common_buffer)
                dma_free_coherent(NULL, coredev->common_buffer_size,
                        coredev->common_buffer, coredev->common_buffer_phys);

        if (coredev->fw_buf != NULL)
                kfree(coredev->fw_buf);

        list_del(&coredev->entry);
        kfree(coredev);

        kmutex_unlock(&g_smscore_deviceslock);

        sms_info("device %p destroyed", coredev);
}
EXPORT_SYMBOL_GPL(smscore_unregister_device);

static int smscore_detect_mode(struct smscore_device_t *coredev)
{
        void *buffer = kmalloc(sizeof(struct SmsMsgHdr_ST) + SMS_DMA_ALIGNMENT,
                               GFP_KERNEL | GFP_DMA);
        struct SmsMsgHdr_ST *msg =
                (struct SmsMsgHdr_ST *) SMS_ALIGN_ADDRESS(buffer);
        int rc;

        if (!buffer)
                return -ENOMEM;

        SMS_INIT_MSG(msg, MSG_SMS_GET_VERSION_EX_REQ,
                     sizeof(struct SmsMsgHdr_ST));

        rc = smscore_sendrequest_and_wait(coredev, msg, msg->msgLength,
                                          &coredev->version_ex_done);
        if (rc == -ETIME) {
                sms_err("MSG_SMS_GET_VERSION_EX_REQ failed first try");

                if (wait_for_completion_timeout(&coredev->resume_done,
                                                msecs_to_jiffies(5000))) {
                        rc = smscore_sendrequest_and_wait(
                                coredev, msg, msg->msgLength,
                                &coredev->version_ex_done);
                        if (rc < 0)
                                sms_err("MSG_SMS_GET_VERSION_EX_REQ failed "
                                        "second try, rc %d", rc);
                } else
                        rc = -ETIME;
        }

        kfree(buffer);

        return rc;
}

static char *smscore_fw_lkup[][SMS_NUM_OF_DEVICE_TYPES] = {
        /*Stellar               NOVA A0         Nova B0         VEGA*/
        /*DVBT*/
        {"none", "dvb_nova_12mhz.inp", "dvb_nova_12mhz_b0.inp", "none"},
        /*DVBH*/
        {"none", "dvb_nova_12mhz.inp", "dvb_nova_12mhz_b0.inp", "none"},
        /*TDMB*/
        {"none", "tdmb_nova_12mhz.inp", "tdmb_nova_12mhz_b0.inp", "none"},
        /*DABIP*/
        {"none", "none", "none", "none"},
        /*BDA*/
        {"none", "dvb_nova_12mhz.inp", "dvb_nova_12mhz_b0.inp", "none"},
        /*ISDBT*/
        {"none", "isdbt_nova_12mhz.inp", "isdbt_nova_12mhz_b0.inp", "none"},
        /*ISDBTBDA*/
        {"none", "isdbt_nova_12mhz.inp", "isdbt_nova_12mhz_b0.inp", "none"},
        /*CMMB*/
        {"none", "none", "none", "cmmb_vega_12mhz.inp"}
};

static inline char *sms_get_fw_name(struct smscore_device_t *coredev,
                                    int mode, enum sms_device_type_st type)
{
        char **fw = sms_get_board(smscore_get_board_id(coredev))->fw;
        return (fw && fw[mode]) ? fw[mode] : smscore_fw_lkup[mode][type];
}

/**
 * calls device handler to change mode of operation
 * NOTE: stellar/usb may disconnect when changing mode
 *
 * @param coredev pointer to a coredev object returned by
 *                smscore_register_device
 * @param mode requested mode of operation
 *
 * @return 0 on success, <0 on error.
 */
int smscore_set_device_mode(struct smscore_device_t *coredev, int mode)
{
        void *buffer;
        int rc = 0;
        enum sms_device_type_st type;

        sms_debug("set device mode to %d", mode);
        if (coredev->device_flags & SMS_DEVICE_FAMILY2) {
                if (mode < DEVICE_MODE_DVBT || mode >= DEVICE_MODE_RAW_TUNER) {
                        sms_err("invalid mode specified %d", mode);
                        return -EINVAL;
                }

                smscore_registry_setmode(coredev->devpath, mode);

                if (!(coredev->device_flags & SMS_DEVICE_NOT_READY)) {
                        rc = smscore_detect_mode(coredev);
                        if (rc < 0) {
                                sms_err("mode detect failed %d", rc);
                                return rc;
                        }
                }

                if (coredev->mode == mode) {
                        sms_info("device mode %d already set", mode);
                        return 0;
                }

                if (!(coredev->modes_supported & (1 << mode))) {
                        char *fw_filename;

                        type = smscore_registry_gettype(coredev->devpath);
                        fw_filename = sms_get_fw_name(coredev, mode, type);

                        rc = smscore_load_firmware_from_file(coredev,
                                                             fw_filename, NULL);
                        if (rc < 0) {
                                sms_warn("error %d loading firmware: %s, "
                                         "trying again with default firmware",
                                         rc, fw_filename);

                                /* try again with the default firmware */
                                fw_filename = smscore_fw_lkup[mode][type];
                                rc = smscore_load_firmware_from_file(coredev,
                                                             fw_filename, NULL);

                                if (rc < 0) {
                                        sms_warn("error %d loading "
                                                 "firmware: %s", rc,
                                                 fw_filename);
                                        return rc;
                                }
                        }
                        sms_log("firmware download success: %s", fw_filename);
                } else
                        sms_info("mode %d supported by running "
                                 "firmware", mode);

                buffer = kmalloc(sizeof(struct SmsMsgData_ST) +
                                 SMS_DMA_ALIGNMENT, GFP_KERNEL | GFP_DMA);
                if (buffer) {
                        struct SmsMsgData_ST *msg =
                                (struct SmsMsgData_ST *)
                                        SMS_ALIGN_ADDRESS(buffer);

                        SMS_INIT_MSG(&msg->xMsgHeader, MSG_SMS_INIT_DEVICE_REQ,
                                     sizeof(struct SmsMsgData_ST));
                        msg->msgData[0] = mode;

                        rc = smscore_sendrequest_and_wait(
                                coredev, msg, msg->xMsgHeader.msgLength,
                                &coredev->init_device_done);

                        kfree(buffer);
                } else {
                        sms_err("Could not allocate buffer for "
                                "init device message.");
                        rc = -ENOMEM;
                }
        } else {
                if (mode < DEVICE_MODE_DVBT || mode > DEVICE_MODE_DVBT_BDA) {
                        sms_err("invalid mode specified %d", mode);
                        return -EINVAL;
                }

                smscore_registry_setmode(coredev->devpath, mode);

                if (coredev->detectmode_handler)
                        coredev->detectmode_handler(coredev->context,
                                                    &coredev->mode);

                if (coredev->mode != mode && coredev->setmode_handler)
                        rc = coredev->setmode_handler(coredev->context, mode);
        }

        if (rc >= 0) {
                coredev->mode = mode;
                coredev->device_flags &= ~SMS_DEVICE_NOT_READY;
        }

        if (rc < 0)
                sms_err("return error code %d.", rc);
        return rc;
}

/**
 * calls device handler to get current mode of operation
 *
 * @param coredev pointer to a coredev object returned by
 *                smscore_register_device
 *
 * @return current mode
 */
int smscore_get_device_mode(struct smscore_device_t *coredev)
{
        return coredev->mode;
}
EXPORT_SYMBOL_GPL(smscore_get_device_mode);

/**
 * find client by response id & type within the clients list.
 * return client handle or NULL.
 *
 * @param coredev pointer to a coredev object returned by
 *                smscore_register_device
 * @param data_type client data type (SMS_DONT_CARE for all types)
 * @param id client id (SMS_DONT_CARE for all id)
 *
 */
static struct
smscore_client_t *smscore_find_client(struct smscore_device_t *coredev,
                                      int data_type, int id)
{
        struct smscore_client_t *client = NULL;
        struct list_head *next, *first;
        unsigned long flags;
        struct list_head *firstid, *nextid;


        spin_lock_irqsave(&coredev->clientslock, flags);
        first = &coredev->clients;
        for (next = first->next;
             (next != first) && !client;
             next = next->next) {
                firstid = &((struct smscore_client_t *)next)->idlist;
                for (nextid = firstid->next;
                     nextid != firstid;
                     nextid = nextid->next) {
                        if ((((struct smscore_idlist_t *)nextid)->id == id) &&
                            (((struct smscore_idlist_t *)nextid)->data_type == data_type ||
                            (((struct smscore_idlist_t *)nextid)->data_type == 0))) {
                                client = (struct smscore_client_t *) next;
                                break;
                        }
                }
        }
        spin_unlock_irqrestore(&coredev->clientslock, flags);
        return client;
}

/**
 * find client by response id/type, call clients onresponse handler
 * return buffer to pool on error
 *
 * @param coredev pointer to a coredev object returned by
 *                smscore_register_device
 * @param cb pointer to response buffer descriptor
 *
 */
void smscore_onresponse(struct smscore_device_t *coredev,
                struct smscore_buffer_t *cb) {
        struct SmsMsgHdr_ST *phdr = (struct SmsMsgHdr_ST *) ((u8 *) cb->p
                        + cb->offset);
        struct smscore_client_t *client;
        int rc = -EBUSY;
        static unsigned long last_sample_time; /* = 0; */
        static int data_total; /* = 0; */
        unsigned long time_now = jiffies_to_msecs(jiffies);

        if (!last_sample_time)
                last_sample_time = time_now;

        if (time_now - last_sample_time > 10000) {
                sms_debug("\ndata rate %d bytes/secs",
                          (int)((data_total * 1000) /
                                (time_now - last_sample_time)));

                last_sample_time = time_now;
                data_total = 0;
        }

        data_total += cb->size;
        /* Do we need to re-route? */
        if ((phdr->msgType == MSG_SMS_HO_PER_SLICES_IND) ||
                        (phdr->msgType == MSG_SMS_TRANSMISSION_IND)) {
                if (coredev->mode == DEVICE_MODE_DVBT_BDA)
                        phdr->msgDstId = DVBT_BDA_CONTROL_MSG_ID;
        }


        client = smscore_find_client(coredev, phdr->msgType, phdr->msgDstId);

        /* If no client registered for type & id,
         * check for control client where type is not registered */
        if (client)
                rc = client->onresponse_handler(client->context, cb);

        if (rc < 0) {
                switch (phdr->msgType) {
                case MSG_SMS_GET_VERSION_EX_RES:
                {
                        struct SmsVersionRes_ST *ver =
                                (struct SmsVersionRes_ST *) phdr;
                        sms_debug("MSG_SMS_GET_VERSION_EX_RES "
                                  "id %d prots 0x%x ver %d.%d",
                                  ver->FirmwareId, ver->SupportedProtocols,
                                  ver->RomVersionMajor, ver->RomVersionMinor);

                        coredev->mode = ver->FirmwareId == 255 ?
                                DEVICE_MODE_NONE : ver->FirmwareId;
                        coredev->modes_supported = ver->SupportedProtocols;

                        complete(&coredev->version_ex_done);
                        break;
                }
                case MSG_SMS_INIT_DEVICE_RES:
                        sms_debug("MSG_SMS_INIT_DEVICE_RES");
                        complete(&coredev->init_device_done);
                        break;
                case MSG_SW_RELOAD_START_RES:
                        sms_debug("MSG_SW_RELOAD_START_RES");
                        complete(&coredev->reload_start_done);
                        break;
                case MSG_SMS_DATA_DOWNLOAD_RES:
                        complete(&coredev->data_download_done);
                        break;
                case MSG_SW_RELOAD_EXEC_RES:
                        sms_debug("MSG_SW_RELOAD_EXEC_RES");
                        break;
                case MSG_SMS_SWDOWNLOAD_TRIGGER_RES:
                        sms_debug("MSG_SMS_SWDOWNLOAD_TRIGGER_RES");
                        complete(&coredev->trigger_done);
                        break;
                case MSG_SMS_SLEEP_RESUME_COMP_IND:
                        complete(&coredev->resume_done);
                        break;
                case MSG_SMS_GPIO_CONFIG_EX_RES:
                        sms_debug("MSG_SMS_GPIO_CONFIG_EX_RES");
                        complete(&coredev->gpio_configuration_done);
                        break;
                case MSG_SMS_GPIO_SET_LEVEL_RES:
                        sms_debug("MSG_SMS_GPIO_SET_LEVEL_RES");
                        complete(&coredev->gpio_set_level_done);
                        break;
                case MSG_SMS_GPIO_GET_LEVEL_RES:
                {
                        u32 *msgdata = (u32 *) phdr;
                        coredev->gpio_get_res = msgdata[1];
                        sms_debug("MSG_SMS_GPIO_GET_LEVEL_RES gpio level %d",
                                        coredev->gpio_get_res);
                        complete(&coredev->gpio_get_level_done);
                        break;
                }
                case MSG_SMS_START_IR_RES:
                        complete(&coredev->ir_init_done);
                        break;
                case MSG_SMS_IR_SAMPLES_IND:
                        sms_ir_event(coredev,
                                (const char *)
                                ((char *)phdr
                                + sizeof(struct SmsMsgHdr_ST)),
                                (int)phdr->msgLength
                                - sizeof(struct SmsMsgHdr_ST));
                        break;

                default:
                        break;
                }
                smscore_putbuffer(coredev, cb);
        }
}
EXPORT_SYMBOL_GPL(smscore_onresponse);

/**
 * return pointer to next free buffer descriptor from core pool
 *
 * @param coredev pointer to a coredev object returned by
 *                smscore_register_device
 *
 * @return pointer to descriptor on success, NULL on error.
 */
struct smscore_buffer_t *smscore_getbuffer(struct smscore_device_t *coredev)
{
        struct smscore_buffer_t *cb = NULL;
        unsigned long flags;

        DEFINE_WAIT(wait);

        spin_lock_irqsave(&coredev->bufferslock, flags);

        /* This function must return a valid buffer, since the buffer list is
         * finite, we check that there is an available buffer, if not, we wait
         * until such buffer become available.
         */

        prepare_to_wait(&coredev->buffer_mng_waitq, &wait, TASK_INTERRUPTIBLE);

        if (list_empty(&coredev->buffers))
                schedule();

        finish_wait(&coredev->buffer_mng_waitq, &wait);

        cb = (struct smscore_buffer_t *) coredev->buffers.next;
        list_del(&cb->entry);

        spin_unlock_irqrestore(&coredev->bufferslock, flags);

        return cb;
}
EXPORT_SYMBOL_GPL(smscore_getbuffer);

/**
 * return buffer descriptor to a pool
 *
 * @param coredev pointer to a coredev object returned by
 *                smscore_register_device
 * @param cb pointer buffer descriptor
 *
 */
void smscore_putbuffer(struct smscore_device_t *coredev,
                struct smscore_buffer_t *cb) {
        wake_up_interruptible(&coredev->buffer_mng_waitq);
        list_add_locked(&cb->entry, &coredev->buffers, &coredev->bufferslock);
}
EXPORT_SYMBOL_GPL(smscore_putbuffer);

static int smscore_validate_client(struct smscore_device_t *coredev,
                                   struct smscore_client_t *client,
                                   int data_type, int id)
{
        struct smscore_idlist_t *listentry;
        struct smscore_client_t *registered_client;

        if (!client) {
                sms_err("bad parameter.");
                return -EFAULT;
        }
        registered_client = smscore_find_client(coredev, data_type, id);
        if (registered_client == client)
                return 0;

        if (registered_client) {
                sms_err("The msg ID already registered to another client.");
                return -EEXIST;
        }
        listentry = kzalloc(sizeof(struct smscore_idlist_t), GFP_KERNEL);
        if (!listentry) {
                sms_err("Can't allocate memory for client id.");
                return -ENOMEM;
        }
        listentry->id = id;
        listentry->data_type = data_type;
        list_add_locked(&listentry->entry, &client->idlist,
                        &coredev->clientslock);
        return 0;
}

/**
 * creates smsclient object, check that id is taken by another client
 *
 * @param coredev pointer to a coredev object from clients hotplug
 * @param initial_id all messages with this id would be sent to this client
 * @param data_type all messages of this type would be sent to this client
 * @param onresponse_handler client handler that is called to
 *                           process incoming messages
 * @param onremove_handler client handler that is called when device is removed
 * @param context client-specific context
 * @param client pointer to a value that receives created smsclient object
 *
 * @return 0 on success, <0 on error.
 */
int smscore_register_client(struct smscore_device_t *coredev,
                            struct smsclient_params_t *params,
                            struct smscore_client_t **client)
{
        struct smscore_client_t *newclient;
        /* check that no other channel with same parameters exists */
        if (smscore_find_client(coredev, params->data_type,
                                params->initial_id)) {
                sms_err("Client already exist.");
                return -EEXIST;
        }

        newclient = kzalloc(sizeof(struct smscore_client_t), GFP_KERNEL);
        if (!newclient) {
                sms_err("Failed to allocate memory for client.");
                return -ENOMEM;
        }

        INIT_LIST_HEAD(&newclient->idlist);
        newclient->coredev = coredev;
        newclient->onresponse_handler = params->onresponse_handler;
        newclient->onremove_handler = params->onremove_handler;
        newclient->context = params->context;
        list_add_locked(&newclient->entry, &coredev->clients,
                        &coredev->clientslock);
        smscore_validate_client(coredev, newclient, params->data_type,
                                params->initial_id);
        *client = newclient;
        sms_debug("%p %d %d", params->context, params->data_type,
                  params->initial_id);

        return 0;
}
EXPORT_SYMBOL_GPL(smscore_register_client);

/**
 * frees smsclient object and all subclients associated with it
 *
 * @param client pointer to smsclient object returned by
 *               smscore_register_client
 *
 */
void smscore_unregister_client(struct smscore_client_t *client)
{
        struct smscore_device_t *coredev = client->coredev;
        unsigned long flags;

        spin_lock_irqsave(&coredev->clientslock, flags);


        while (!list_empty(&client->idlist)) {
                struct smscore_idlist_t *identry =
                        (struct smscore_idlist_t *) client->idlist.next;
                list_del(&identry->entry);
                kfree(identry);
        }

        sms_info("%p", client->context);

        list_del(&client->entry);
        kfree(client);

        spin_unlock_irqrestore(&coredev->clientslock, flags);
}
EXPORT_SYMBOL_GPL(smscore_unregister_client);

/**
 * verifies that source id is not taken by another client,
 * calls device handler to send requests to the device
 *
 * @param client pointer to smsclient object returned by
 *               smscore_register_client
 * @param buffer pointer to a request buffer
 * @param size size (in bytes) of request buffer
 *
 * @return 0 on success, <0 on error.
 */
int smsclient_sendrequest(struct smscore_client_t *client,
                          void *buffer, size_t size)
{
        struct smscore_device_t *coredev;
        struct SmsMsgHdr_ST *phdr = (struct SmsMsgHdr_ST *) buffer;
        int rc;

        if (client == NULL) {
                sms_err("Got NULL client");
                return -EINVAL;
        }

        coredev = client->coredev;

        /* check that no other channel with same id exists */
        if (coredev == NULL) {
                sms_err("Got NULL coredev");
                return -EINVAL;
        }

        rc = smscore_validate_client(client->coredev, client, 0,
                                     phdr->msgSrcId);
        if (rc < 0)
                return rc;

        return coredev->sendrequest_handler(coredev->context, buffer, size);
}
EXPORT_SYMBOL_GPL(smsclient_sendrequest);


/* old GPIO managments implementation */
int smscore_configure_gpio(struct smscore_device_t *coredev, u32 pin,
                           struct smscore_config_gpio *pinconfig)
{
        struct {
                struct SmsMsgHdr_ST hdr;
                u32 data[6];
        } msg;

        if (coredev->device_flags & SMS_DEVICE_FAMILY2) {
                msg.hdr.msgSrcId = DVBT_BDA_CONTROL_MSG_ID;
                msg.hdr.msgDstId = HIF_TASK;
                msg.hdr.msgFlags = 0;
                msg.hdr.msgType  = MSG_SMS_GPIO_CONFIG_EX_REQ;
                msg.hdr.msgLength = sizeof(msg);

                msg.data[0] = pin;
                msg.data[1] = pinconfig->pullupdown;

                /* Convert slew rate for Nova: Fast(0) = 3 / Slow(1) = 0; */
                msg.data[2] = pinconfig->outputslewrate == 0 ? 3 : 0;

                switch (pinconfig->outputdriving) {
                case SMS_GPIO_OUTPUTDRIVING_16mA:
                        msg.data[3] = 7; /* Nova - 16mA */
                        break;
                case SMS_GPIO_OUTPUTDRIVING_12mA:
                        msg.data[3] = 5; /* Nova - 11mA */
                        break;
                case SMS_GPIO_OUTPUTDRIVING_8mA:
                        msg.data[3] = 3; /* Nova - 7mA */
                        break;
                case SMS_GPIO_OUTPUTDRIVING_4mA:
                default:
                        msg.data[3] = 2; /* Nova - 4mA */
                        break;
                }

                msg.data[4] = pinconfig->direction;
                msg.data[5] = 0;
        } else /* TODO: SMS_DEVICE_FAMILY1 */
                return -EINVAL;

        return coredev->sendrequest_handler(coredev->context,
                                            &msg, sizeof(msg));
}

int smscore_set_gpio(struct smscore_device_t *coredev, u32 pin, int level)
{
        struct {
                struct SmsMsgHdr_ST hdr;
                u32 data[3];
        } msg;

        if (pin > MAX_GPIO_PIN_NUMBER)
                return -EINVAL;

        msg.hdr.msgSrcId = DVBT_BDA_CONTROL_MSG_ID;
        msg.hdr.msgDstId = HIF_TASK;
        msg.hdr.msgFlags = 0;
        msg.hdr.msgType  = MSG_SMS_GPIO_SET_LEVEL_REQ;
        msg.hdr.msgLength = sizeof(msg);

        msg.data[0] = pin;
        msg.data[1] = level ? 1 : 0;
        msg.data[2] = 0;

        return coredev->sendrequest_handler(coredev->context,
                                            &msg, sizeof(msg));
}

/* new GPIO management implementation */
static int GetGpioPinParams(u32 PinNum, u32 *pTranslatedPinNum,
                u32 *pGroupNum, u32 *pGroupCfg) {

        *pGroupCfg = 1;

        if (PinNum >= 0 && PinNum <= 1) {
                *pTranslatedPinNum = 0;
                *pGroupNum = 9;
                *pGroupCfg = 2;
        } else if (PinNum >= 2 && PinNum <= 6) {
                *pTranslatedPinNum = 2;
                *pGroupNum = 0;
                *pGroupCfg = 2;
        } else if (PinNum >= 7 && PinNum <= 11) {
                *pTranslatedPinNum = 7;
                *pGroupNum = 1;
        } else if (PinNum >= 12 && PinNum <= 15) {
                *pTranslatedPinNum = 12;
                *pGroupNum = 2;
                *pGroupCfg = 3;
        } else if (PinNum == 16) {
                *pTranslatedPinNum = 16;
                *pGroupNum = 23;
        } else if (PinNum >= 17 && PinNum <= 24) {
                *pTranslatedPinNum = 17;
                *pGroupNum = 3;
        } else if (PinNum == 25) {
                *pTranslatedPinNum = 25;
                *pGroupNum = 6;
        } else if (PinNum >= 26 && PinNum <= 28) {
                *pTranslatedPinNum = 26;
                *pGroupNum = 4;
        } else if (PinNum == 29) {
                *pTranslatedPinNum = 29;
                *pGroupNum = 5;
                *pGroupCfg = 2;
        } else if (PinNum == 30) {
                *pTranslatedPinNum = 30;
                *pGroupNum = 8;
        } else if (PinNum == 31) {
                *pTranslatedPinNum = 31;
                *pGroupNum = 17;
        } else
                return -1;

        *pGroupCfg <<= 24;

        return 0;
}

int smscore_gpio_configure(struct smscore_device_t *coredev, u8 PinNum,
                struct smscore_gpio_config *pGpioConfig) {

        u32 totalLen;
        u32 TranslatedPinNum = 0;
        u32 GroupNum = 0;
        u32 ElectricChar;
        u32 groupCfg;
        void *buffer;
        int rc;

        struct SetGpioMsg {
                struct SmsMsgHdr_ST xMsgHeader;
                u32 msgData[6];
        } *pMsg;


        if (PinNum > MAX_GPIO_PIN_NUMBER)
                return -EINVAL;

        if (pGpioConfig == NULL)
                return -EINVAL;

        totalLen = sizeof(struct SmsMsgHdr_ST) + (sizeof(u32) * 6);

        buffer = kmalloc(totalLen + SMS_DMA_ALIGNMENT,
                        GFP_KERNEL | GFP_DMA);
        if (!buffer)
                return -ENOMEM;

        pMsg = (struct SetGpioMsg *) SMS_ALIGN_ADDRESS(buffer);

        pMsg->xMsgHeader.msgSrcId = DVBT_BDA_CONTROL_MSG_ID;
        pMsg->xMsgHeader.msgDstId = HIF_TASK;
        pMsg->xMsgHeader.msgFlags = 0;
        pMsg->xMsgHeader.msgLength = (u16) totalLen;
        pMsg->msgData[0] = PinNum;

        if (!(coredev->device_flags & SMS_DEVICE_FAMILY2)) {
                pMsg->xMsgHeader.msgType = MSG_SMS_GPIO_CONFIG_REQ;
                if (GetGpioPinParams(PinNum, &TranslatedPinNum, &GroupNum,
                                &groupCfg) != 0)
                        return -EINVAL;

                pMsg->msgData[1] = TranslatedPinNum;
                pMsg->msgData[2] = GroupNum;
                ElectricChar = (pGpioConfig->PullUpDown)
                                | (pGpioConfig->InputCharacteristics << 2)
                                | (pGpioConfig->OutputSlewRate << 3)
                                | (pGpioConfig->OutputDriving << 4);
                pMsg->msgData[3] = ElectricChar;
                pMsg->msgData[4] = pGpioConfig->Direction;
                pMsg->msgData[5] = groupCfg;
        } else {
                pMsg->xMsgHeader.msgType = MSG_SMS_GPIO_CONFIG_EX_REQ;
                pMsg->msgData[1] = pGpioConfig->PullUpDown;
                pMsg->msgData[2] = pGpioConfig->OutputSlewRate;
                pMsg->msgData[3] = pGpioConfig->OutputDriving;
                pMsg->msgData[4] = pGpioConfig->Direction;
                pMsg->msgData[5] = 0;
        }

        smsendian_handle_tx_message((struct SmsMsgHdr_ST *)pMsg);
        rc = smscore_sendrequest_and_wait(coredev, pMsg, totalLen,
                        &coredev->gpio_configuration_done);

        if (rc != 0) {
                if (rc == -ETIME)
                        sms_err("smscore_gpio_configure timeout");
                else
                        sms_err("smscore_gpio_configure error");
        }
        kfree(buffer);

        return rc;
}

int smscore_gpio_set_level(struct smscore_device_t *coredev, u8 PinNum,
                u8 NewLevel) {

        u32 totalLen;
        int rc;
        void *buffer;

        struct SetGpioMsg {
                struct SmsMsgHdr_ST xMsgHeader;
                u32 msgData[3]; /* keep it 3 ! */
        } *pMsg;

        if ((NewLevel > 1) || (PinNum > MAX_GPIO_PIN_NUMBER) ||
                        (PinNum > MAX_GPIO_PIN_NUMBER))
                return -EINVAL;

        totalLen = sizeof(struct SmsMsgHdr_ST) +
                        (3 * sizeof(u32)); /* keep it 3 ! */

        buffer = kmalloc(totalLen + SMS_DMA_ALIGNMENT,
                        GFP_KERNEL | GFP_DMA);
        if (!buffer)
                return -ENOMEM;

        pMsg = (struct SetGpioMsg *) SMS_ALIGN_ADDRESS(buffer);

        pMsg->xMsgHeader.msgSrcId = DVBT_BDA_CONTROL_MSG_ID;
        pMsg->xMsgHeader.msgDstId = HIF_TASK;
        pMsg->xMsgHeader.msgFlags = 0;
        pMsg->xMsgHeader.msgType = MSG_SMS_GPIO_SET_LEVEL_REQ;
        pMsg->xMsgHeader.msgLength = (u16) totalLen;
        pMsg->msgData[0] = PinNum;
        pMsg->msgData[1] = NewLevel;

        /* Send message to SMS */
        smsendian_handle_tx_message((struct SmsMsgHdr_ST *)pMsg);
        rc = smscore_sendrequest_and_wait(coredev, pMsg, totalLen,
                        &coredev->gpio_set_level_done);

        if (rc != 0) {
                if (rc == -ETIME)
                        sms_err("smscore_gpio_set_level timeout");
                else
                        sms_err("smscore_gpio_set_level error");
        }
        kfree(buffer);

        return rc;
}

int smscore_gpio_get_level(struct smscore_device_t *coredev, u8 PinNum,
                u8 *level) {

        u32 totalLen;
        int rc;
        void *buffer;

        struct SetGpioMsg {
                struct SmsMsgHdr_ST xMsgHeader;
                u32 msgData[2];
        } *pMsg;


        if (PinNum > MAX_GPIO_PIN_NUMBER)
                return -EINVAL;

        totalLen = sizeof(struct SmsMsgHdr_ST) + (2 * sizeof(u32));

        buffer = kmalloc(totalLen + SMS_DMA_ALIGNMENT,
                        GFP_KERNEL | GFP_DMA);
        if (!buffer)
                return -ENOMEM;

        pMsg = (struct SetGpioMsg *) SMS_ALIGN_ADDRESS(buffer);

        pMsg->xMsgHeader.msgSrcId = DVBT_BDA_CONTROL_MSG_ID;
        pMsg->xMsgHeader.msgDstId = HIF_TASK;
        pMsg->xMsgHeader.msgFlags = 0;
        pMsg->xMsgHeader.msgType = MSG_SMS_GPIO_GET_LEVEL_REQ;
        pMsg->xMsgHeader.msgLength = (u16) totalLen;
        pMsg->msgData[0] = PinNum;
        pMsg->msgData[1] = 0;

        /* Send message to SMS */
        smsendian_handle_tx_message((struct SmsMsgHdr_ST *)pMsg);
        rc = smscore_sendrequest_and_wait(coredev, pMsg, totalLen,
                        &coredev->gpio_get_level_done);

        if (rc != 0) {
                if (rc == -ETIME)
                        sms_err("smscore_gpio_get_level timeout");
                else
                        sms_err("smscore_gpio_get_level error");
        }
        kfree(buffer);

        /* Its a race between other gpio_get_level() and the copy of the single
         * global 'coredev->gpio_get_res' to  the function's variable 'level'
         */
        *level = coredev->gpio_get_res;

        return rc;
}

static int __init smscore_module_init(void)
{
        int rc = 0;

        INIT_LIST_HEAD(&g_smscore_notifyees);
        INIT_LIST_HEAD(&g_smscore_devices);
        kmutex_init(&g_smscore_deviceslock);

        INIT_LIST_HEAD(&g_smscore_registry);
        kmutex_init(&g_smscore_registrylock);

        return rc;
}

static void __exit smscore_module_exit(void)
{
        kmutex_lock(&g_smscore_deviceslock);
        while (!list_empty(&g_smscore_notifyees)) {
                struct smscore_device_notifyee_t *notifyee =
                        (struct smscore_device_notifyee_t *)
                                g_smscore_notifyees.next;

                list_del(&notifyee->entry);
                kfree(notifyee);
        }
        kmutex_unlock(&g_smscore_deviceslock);

        kmutex_lock(&g_smscore_registrylock);
        while (!list_empty(&g_smscore_registry)) {
                struct smscore_registry_entry_t *entry =
                        (struct smscore_registry_entry_t *)
                                g_smscore_registry.next;

                list_del(&entry->entry);
                kfree(entry);
        }
        kmutex_unlock(&g_smscore_registrylock);

        sms_debug("");
}

module_init(smscore_module_init);
module_exit(smscore_module_exit);

MODULE_DESCRIPTION("Siano MDTV Core module");
MODULE_AUTHOR("Siano Mobile Silicon, Inc. (uris@siano-ms.com)");
MODULE_LICENSE("GPL");