DSView/libsigrok4DSL/hardware/demo/demo.c

/*
 * This file is part of the libsigrok project.
 *
 * Copyright (C) 2010 Uwe Hermann <uwe@hermann-uwe.de>
 * Copyright (C) 2011 Olivier Fauchon <olivier@aixmarseille.com>
 * Copyright (C) 2012 Alexandru Gagniuc <mr.nuke.me@gmail.com>
 *
 * This program 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.
 *
 * This program 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 this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
 */

#include "demo.h"
#include <math.h>
#include <errno.h>
#include <assert.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/stat.h>

#include <inttypes.h>
#include <unistd.h>
#ifdef _WIN32
#include <io.h>
#include <fcntl.h>
#define pipe(fds) _pipe(fds, 4096, _O_BINARY)
#endif

#include "../../log.h"

/* Message logging helpers with subsystem-specific prefix string. */

#undef LOG_PREFIX
#define LOG_PREFIX "demo: "

/* The size of chunks to send through the session bus. */
/* TODO: Should be configurable. */
#define BUFSIZE                512*1024
#define DSO_BUFSIZE            10*1024

static struct DEMO_channels logic_channel_modes[] = {
    {DEMO_LOGIC125x16,  LOGIC,  SR_CHANNEL_LOGIC,  16, 1, SR_MHZ(1), SR_Mn(1),
     SR_KHZ(10), SR_MHZ(125), "Use 16 Channels (Max 125MHz)"},
    {DEMO_LOGIC250x12,  LOGIC,  SR_CHANNEL_LOGIC,  12, 1, SR_MHZ(1), SR_Mn(1),
     SR_KHZ(10), SR_MHZ(250), "Use 12 Channels (Max 250MHz)"},
    {DEMO_LOGIC500x6,  LOGIC,  SR_CHANNEL_LOGIC,  6, 1, SR_MHZ(1), SR_Mn(1),
     SR_KHZ(10), SR_MHZ(500), "Use 6 Channels (Max 500MHz)"},
    {DEMO_LOGIC1000x3,  LOGIC,  SR_CHANNEL_LOGIC,  3, 1, SR_MHZ(1), SR_Mn(1),
     SR_KHZ(10), SR_GHZ(1), "Use 3 Channels (Max 1GHz)"},
};

static struct sr_list_item logic_channel_mode_list[ARRAY_SIZE(logic_channel_modes)+1];

static struct DEMO_channels channel_modes[] = {
    // LA Stream
    {DEMO_LOGIC100x16,  LOGIC,  SR_CHANNEL_LOGIC,  16, 1, SR_MHZ(1), SR_Mn(1),
     SR_KHZ(10), SR_GHZ(1), "Use 16 Channels (Max 20MHz)"},

    // DAQ
    {DEMO_ANALOG10x2,   ANALOG, SR_CHANNEL_ANALOG,  2,  8, SR_MHZ(1), SR_Mn(1),
     SR_HZ(10),  SR_MHZ(10), "Use Channels 0~1 (Max 10MHz)"},

    // OSC
    {DEMO_DSO200x2,     DSO,    SR_CHANNEL_DSO,     2,  8, SR_MHZ(100), SR_Kn(10),
     SR_HZ(100), SR_MHZ(200), "Use Channels 0~1 (Max 200MHz)"},
};


/* Private, per-device-instance driver context. */
/* TODO: struct context as with the other drivers. */

/* List of struct sr_dev_inst, maintained by dev_open()/dev_close(). */
SR_PRIV struct sr_dev_driver demo_driver_info;
static struct sr_dev_driver *di = &demo_driver_info;

extern struct ds_trigger *trigger;

static int vdev_init(struct sr_dev_inst *sdi)
{
    struct session_vdev* vdev = sdi->priv;
    vdev->version = 0;
    vdev->archive = NULL;
    vdev->capfile = 0;

    vdev->samplerates_min_index = 0;
    vdev->samplerates_max_index = 0;

    vdev->logic_buf = NULL;
    vdev->logic_buf_len = 0;
    vdev->analog_buf = NULL;
    vdev->logic_buf = NULL;
    vdev->analog_buf_len = 0;
    vdev->analog_read_pos = 0;

    vdev->cur_block = 0;
    vdev->num_blocks = 0;
    vdev->samplerate = 0;
    vdev->total_samples = 0;
    vdev->trig_time = 0;
    vdev->trig_pos = 0;
    vdev->num_probes = 0;
    vdev->enabled_probes = 0;
    vdev->timebase = SR_NS(500);
    vdev->max_timebase = MAX_TIMEBASE;
    vdev->min_timebase = MIN_TIMEBASE;
    vdev->ref_min = 1;
    vdev->ref_max = 255;
    vdev->max_height = 0;
    vdev->mstatus.measure_valid = TRUE;
    vdev->packet_buffer = NULL;

    vdev->packet_len = 0;
    vdev->packet_time = 0;
    vdev->instant = FALSE;
    vdev->load_data = FALSE;
    vdev->vdiv_change = FALSE;
    vdev->offset_change = FALSE;
    vdev->timebase_change = FALSE;
    vdev->channel_mode_change = FALSE;

    vdev->post_data_len = 0;

    memset(vdev->logic_sel_probe_list,0,LOGIC_MAX_PROBE_NUM);
    vdev->logic_sel_probe_num = 0;
    vdev->logic_ch_mode = DEMO_LOGIC125x16;
    vdev->logic_ch_mode_index = LOGIC125x16;

    vdev->is_loop = FALSE;
    vdev->unit_bits = (sdi->mode == LOGIC) ? 1 : 8;

    vdev->logic_buf = g_try_malloc0(LOGIC_BUF_LEN);
    if(vdev->logic_buf == NULL)
    {
        sr_err("%s: vdev->logic_buf malloc failed", __func__);
        return SR_ERR_MALLOC;  
    }
    vdev->logic_buf_len = LOGIC_BUF_LEN;

    vdev->dso_buf = g_try_malloc0(DSO_PACKET_LEN);
    if(vdev->dso_buf == NULL)
    {
        sr_err("%s: vdev->dso_buf malloc failed", __func__);
        return SR_ERR_MALLOC;  
    }
    
    return SR_OK;
}

static void dso_status_update(struct session_vdev *vdev)
{
    struct sr_status *status = (struct sr_status*)&vdev->mstatus;
   
    status->ch0_cyc_tlen = 340;
    status->ch1_cyc_tlen = 340;
    status->ch0_cyc_cnt = 100;
    status->ch1_cyc_cnt = 85;
    status->ch0_max = 158;
    status->ch1_max = 158;
    status->ch0_min = 78;
    status->ch1_min = 78; 
    status->ch0_cyc_plen = 170;
    status->ch1_cyc_plen = 170;
    status->ch0_cyc_llen = 0;
    status->ch1_cyc_llen = 0;
    status->ch0_level_valid = 0;
    status->ch1_level_valid = 0;
    status->ch0_plevel = 1;
    status->ch1_plevel = 1;
    status->ch0_low_level = 78;
    status->ch1_low_level = 78;
    status->ch0_high_level = 178;
    status->ch1_high_level = 178;
    status->ch0_cyc_rlen = 85;
    status->ch1_cyc_rlen = 85;
    status->ch0_cyc_flen = 85;
    status->ch1_cyc_flen = 85;
    status->ch0_acc_square = 12496225;
    status->ch1_acc_square = 12496225;
    status->ch0_acc_mean = 1280000;
    status->ch1_acc_mean = 1280000;
}

static int logic_adjust_probe(struct sr_dev_inst *sdi, int num_probes)
{
    uint16_t j;
    struct sr_channel *probe;
    struct DSL_context *devc = sdi->priv;
    GSList *l;

    assert(num_probes > 0);

    j = g_slist_length(sdi->channels);
    while(j < num_probes) {
        if (!(probe = sr_channel_new(j, SR_CHANNEL_LOGIC,
                                   TRUE, probe_names[j])))
            return SR_ERR;
        sdi->channels = g_slist_append(sdi->channels, probe);
        j++;
    }

    while(j > num_probes) {
        sdi->channels = g_slist_delete_link(sdi->channels, g_slist_last(sdi->channels));
        j--;
    }

    for(l = sdi->channels; l; l = l->next) {
        probe = (struct sr_channel *)l->data;
        probe->enabled = TRUE;
        probe->type = SR_CHANNEL_LOGIC;
    }
    return SR_OK;
}

static void logic_adjust_samplerate(struct session_vdev * vdev)
{
    vdev->samplerates_max_index = ARRAY_SIZE(samplerates) - 1;
    while (samplerates[vdev->samplerates_max_index] >
           logic_channel_modes[vdev->logic_ch_mode_index].max_samplerate)
        vdev->samplerates_max_index--;

    vdev->samplerates_min_index = 0;
    while (samplerates[vdev->samplerates_min_index] <
           logic_channel_modes[vdev->logic_ch_mode_index].min_samplerate)
        vdev->samplerates_min_index++;

    assert(vdev->samplerates_max_index >= vdev->samplerates_min_index);

    if (vdev->samplerate > samplerates[vdev->samplerates_max_index])
        vdev->samplerate = samplerates[vdev->samplerates_max_index];

    if (vdev->samplerate < samplerates[vdev->samplerates_min_index])
        vdev->samplerate = samplerates[vdev->samplerates_min_index];
}


static void init_analog_random_data(struct session_vdev * vdev)
{
    if(vdev->analog_buf != NULL)
    {
        g_safe_free(vdev->analog_buf);
        vdev->analog_buf = NULL;
    }

    vdev->analog_buf = g_try_malloc0(DSO_BUF_LEN);
    if (vdev->analog_buf == NULL)
    {
        sr_err("%s: vdev->analog_buf malloc failed", __func__);
        return SR_ERR_MALLOC;
    }
    for(int i = 0;i < DSO_BUF_LEN ;i++)
    {
        if(i % 2 == 0)
            *(uint8_t*)(vdev->analog_buf + i) = ANALOG_RANDOM_DATA;
        else
            *(uint8_t*)(vdev->analog_buf + i) = *(uint8_t*)(vdev->analog_buf + i -1);
    }
    vdev->analog_buf_len = DSO_BUF_LEN;
}

static int delay_time(struct session_vdev *vdev)
{
    gdouble packet_elapsed = g_timer_elapsed(packet_interval, NULL);
    gdouble waittime = vdev->packet_time - packet_elapsed;
    if(waittime > 0)
    {
        g_usleep(SR_MS(waittime));
    }
    return SR_OK;
}

static void get_last_packet_len(struct sr_datafeed_logic *logic,struct session_vdev * vdev)
{
    assert(vdev);
    int last_packet_len = vdev->post_data_len - (logic->length / vdev->enabled_probes);
    last_packet_len = (vdev->total_samples/8) - last_packet_len;
    logic->length = last_packet_len * vdev->enabled_probes;
    vdev->post_data_len = vdev->total_samples/8;
}

static void init_pattern_mode_list()
{
    int i;
    if(pattern_logic_count != 1)
    {
        for(i = 1 ;i < pattern_logic_count ; i++)
        {
            if(pattern_strings_logic[i] != NULL)
            {
                g_safe_free(pattern_strings_logic[i]);
            }
        }
    }
    if(pattern_dso_count != 1)
    {
        for(i = 1 ;i < pattern_dso_count ; i++)
        {
            if(pattern_strings_dso[i] != NULL)
            {
                g_safe_free(pattern_strings_dso[i]);
            }
        }
    }
    if(pattern_analog_count != 1)
    {
        for(i = 1 ;i < pattern_analog_count ; i++)
        {
            if(pattern_strings_analog[i] != NULL)
            {
                g_safe_free(pattern_strings_analog[i]);
            }
        }
    }
}

static int get_pattern_mode_index_by_string(uint8_t device_mode , const char* str)
{
    int index = PATTERN_INVALID,
    i = PATTERN_RANDOM;
    if (device_mode == LOGIC)
    {
        while (pattern_strings_logic[i] != NULL)
        {
            if(!strcmp(str,pattern_strings_logic[i]))
            {
                index = i;
                break;
            }
            else
                i++;
        }
    }
    else if (device_mode == DSO)
    {
        while (pattern_strings_dso[i] != NULL)
        {
            if(!strcmp(str,pattern_strings_dso[i]))
            {
                index = i;
                break;
            }
            else
                i++;
        }
    }
    else
    {
        while (pattern_strings_analog[i] != NULL)
        {
            if(!strcmp(str,pattern_strings_analog[i]))
            {
                index = i;
                break;
            }
            else
                i++;
        }
    }

    if(index == PATTERN_INVALID)
        index = PATTERN_RANDOM;
    return index;
}

static int get_pattern_mode_from_file(uint8_t device_mode)
{
    const gchar * filename = NULL;
    char dir_str[500];
    int index = 1;
    int str_len;

    strcpy(dir_str,DS_RES_PATH);
    strcat(dir_str,"../");
    strcat(dir_str,"demo/");

    if(device_mode == LOGIC)
        strcat(dir_str,"logic/");
    else if(device_mode == DSO)
        strcat(dir_str,"dso/");
    else if(device_mode == ANALOG)
        strcat(dir_str,"analog/");

    GDir *dir  = NULL;
    dir = g_dir_open(dir_str,0,NULL);
    if(dir == NULL)
    {
        return SR_ERR;
    }

    while ((filename = g_dir_read_name(dir)) != NULL)
    {
        if (FALSE == g_file_test(filename,G_FILE_TEST_IS_DIR))
        {
            if(strstr(filename,".demo") != NULL)
            {
                str_len = strlen(filename)-strlen(".demo");
                char *file_name = g_try_malloc0(str_len+1);
                if (file_name == NULL)
                {
                    sr_err("%s: file_name malloc failed", __func__);
                    return SR_ERR_MALLOC;
                }
                strncpy(file_name,filename,str_len);
                file_name[str_len] = 0;

                if(device_mode == LOGIC)
                    pattern_strings_logic[index] = file_name;
                else if(device_mode == DSO)
                    pattern_strings_dso[index] = file_name;
                else if(device_mode == ANALOG)
                    pattern_strings_analog[index] = file_name;
                if(index < 99)
                    index++;
            }
        }
    }

    g_dir_close(dir);

    if(device_mode == LOGIC)
        pattern_logic_count = index;
    else if(device_mode == DSO)
        pattern_dso_count = index;
    else if(device_mode == ANALOG)
        pattern_analog_count = index;

    return SR_OK;
}

static void scan_dsl_file(struct sr_dev_inst *sdi)
{
    struct session_vdev * vdev = sdi->priv;
    
    init_pattern_mode_list();

    get_pattern_mode_from_file(LOGIC);
    get_pattern_mode_from_file(DSO);
    get_pattern_mode_from_file(ANALOG);

    if(PATTERN_RANDOM <get_pattern_mode_index_by_string(LOGIC, DEFAULT_LOGIC_FILE))
    {
        int index = get_pattern_mode_index_by_string(LOGIC, DEFAULT_LOGIC_FILE);
        char * str =  pattern_strings_logic[index];
        pattern_strings_logic[index] = pattern_strings_logic[PATTERN_DEFAULT];
        pattern_strings_logic[PATTERN_DEFAULT] = str;
        vdev->sample_generator = PATTERN_DEFAULT;
        sdi->mode = LOGIC;
        reset_dsl_path(sdi,LOGIC,PATTERN_DEFAULT);
    }
    else
    {
        vdev->sample_generator = PATTERN_RANDOM;
        sdi->mode = LOGIC;
        reset_dsl_path(sdi,LOGIC,PATTERN_RANDOM);
    }
}

static int reset_dsl_path(struct sr_dev_inst *sdi,uint8_t device_mode ,uint8_t pattern_mode)
{
    unzFile archive = NULL;
    if(sdi->path != NULL)
        g_safe_free(sdi->path);
    
    char *str = g_try_malloc0(500);
    strcpy(str,DS_RES_PATH);
    strcat(str,"../");
    strcat(str,"demo/");

    if (pattern_mode != PATTERN_RANDOM)
    {
        switch (device_mode)
        {
        case LOGIC:
            if(NULL != pattern_strings_logic[pattern_mode])
            {
                strcat(str,"logic/");
                strcat(str,pattern_strings_logic[pattern_mode]);
            }
            break;
        case DSO:
            if(NULL != pattern_strings_dso[pattern_mode])
            {
                strcat(str,"dso/");
                strcat(str,pattern_strings_dso[pattern_mode]);
            }
            break;
        case ANALOG:
            if(NULL != pattern_strings_analog[pattern_mode])
            {
                strcat(str,"analog/");
                strcat(str,pattern_strings_analog[pattern_mode]);
            }
            break;
        default:
            break;
        }
        strcat(str,".demo");
    }

    if(pattern_mode != PATTERN_RANDOM)
    {
        archive = unzOpen64(str);
        if (NULL != archive){
            sdi->path = str;
            return SR_OK;
        }
        else{
            g_safe_free(str);
            sdi->path = g_strdup("");
            return SR_ERR;
        }

    }
    else{
        g_safe_free(str);
        sdi->path = g_strdup("");
        return SR_OK;
    }
}

static void adjust_samplerate(struct sr_dev_inst *sdi)
{
    struct session_vdev *vdev = sdi->priv;
    if(sdi->mode == LOGIC && vdev->sample_generator > PATTERN_RANDOM)
    {
        return;
    }

    int cur_mode = -1;
    if(sdi->mode == LOGIC)
        cur_mode = 0;
    else if(sdi->mode == DSO)
        cur_mode = 2;
    else if(sdi->mode == ANALOG)
        cur_mode = 1;

    if(cur_mode == -1)
        return;

    vdev->samplerates_max_index = ARRAY_SIZE(samplerates) - 1;
    while (samplerates[vdev->samplerates_max_index] >
           channel_modes[cur_mode].max_samplerate)
        vdev->samplerates_max_index--;

    vdev->samplerates_min_index = 0;
    while (samplerates[vdev->samplerates_min_index] <
           channel_modes[cur_mode].min_samplerate)
        vdev->samplerates_min_index++;

    assert(vdev->samplerates_max_index >= vdev->samplerates_min_index);

    if (vdev->samplerate > samplerates[vdev->samplerates_max_index])
        vdev->samplerate = samplerates[vdev->samplerates_max_index];

    if (vdev->samplerate < samplerates[vdev->samplerates_min_index])
        vdev->samplerate = samplerates[vdev->samplerates_min_index];

}

static void init_random_data(struct session_vdev * vdev,struct sr_dev_inst *sdi)
{
    int cur_probe = 0;
    int probe_count[LOGIC_MAX_PROBE_NUM] = {0};
    uint8_t probe_status[LOGIC_MAX_PROBE_NUM] = {LOGIC_HIGH_LEVEL};

    memset(probe_status,LOGIC_HIGH_LEVEL,16);
    memset(vdev->logic_buf,0,LOGIC_BUF_LEN);

    for(int i = 0 ;i < vdev->enabled_probes;i++)
    {
        probe_count[i] = rand()%SR_KB(5);
    }

    for(int i = 0 ; i < vdev->logic_buf_len ;i++)
    {
        if(i % 8 == 0 && i != 0)
        {
            cur_probe++;
            if(cur_probe >vdev->enabled_probes-1)
                cur_probe = 0;
        }
        if(probe_count[cur_probe]> 0)
        {
            memset(vdev->logic_buf+i,probe_status[cur_probe],1);
            probe_count[cur_probe] -= 1;
        }
        else
        {
            if(probe_status[cur_probe] == LOGIC_HIGH_LEVEL)
                probe_status[cur_probe] = LOGIC_LOW_LEVEL;
            else
                probe_status[cur_probe] = LOGIC_HIGH_LEVEL;
            probe_count[cur_probe] = rand()%SR_KB(5);
            memset(vdev->logic_buf+i,probe_status[cur_probe],1);
            probe_count[cur_probe] -= 1;
        }
    }
    return 0;
}


static int hw_init(struct sr_context *sr_ctx)
{
    return std_hw_init(sr_ctx, di, LOG_PREFIX);
}

static GSList *hw_scan(GSList *options)
{
    struct sr_dev_inst *sdi;
    struct session_vdev *vdev;
    GSList *devices;
    char str[500];

    (void)options;
    devices = NULL;

    sr_info("%s", "Scan demo device.");

    vdev = g_try_malloc0(sizeof(struct session_vdev));
    if (vdev == NULL)
    {
        sr_err("%s: sdi->priv malloc failed", __func__);
        return devices;
    }

    sdi = sr_dev_inst_new(LOGIC, SR_ST_INACTIVE,
                          supported_Demo[0].vendor,
                          supported_Demo[0].model,
                          supported_Demo[0].model_version);
    if (!sdi) {
        g_safe_free(vdev);
        sr_err("Device instance creation failed.");
        return NULL;
    }
    sdi->priv = vdev;
    sdi->driver = di;
    sdi->dev_type = DEV_TYPE_DEMO;

    vdev->is_loop = 0;

    devices = g_slist_append(devices, sdi);

    return devices;
}

static const GSList *hw_dev_mode_list(const struct sr_dev_inst *sdi)
{
    // struct demo_context *devc;
    GSList *l = NULL;
    unsigned int i;

    for (i = 0; i < ARRAY_SIZE(sr_mode_list); i++) {
        // if (devc->profile->dev_caps.mode_caps & (1 << i))
        if (supported_Demo[0].dev_caps.mode_caps & (1 << i))
            l = g_slist_append(l, &sr_mode_list[i]);
    }

    return l;
}

static int hw_dev_open(struct sr_dev_inst *sdi)
{
    int ret;
    assert(sdi);
    assert(sdi->priv);

    if (sdi->status == SR_ST_ACTIVE){
        return SR_OK;
    }

    scan_dsl_file(sdi);
    
    ret = vdev_init(sdi);
    if (ret == SR_OK)
    {
        sdi->status = SR_ST_ACTIVE;
    }

    packet_interval =  g_timer_new();
    run_time =  g_timer_new();
    
    ret = load_virtual_device_session(sdi);
    if (ret != SR_OK)
    {
        sr_err("%s", "Error!Load session file failed.");
        return ret;
    }

    return SR_OK;
}

static int hw_dev_close(struct sr_dev_inst *sdi)
{
    struct session_vdev *vdev;
    int i;
    struct session_packet_buffer *pack_buf;

    if (sdi && sdi->priv)
    {
        vdev = sdi->priv;

        if (vdev->packet_buffer != NULL){
            pack_buf = vdev->packet_buffer;

            g_safe_free(pack_buf->post_buf);

            for (i = 0; i < SESSION_MAX_CHANNEL_COUNT; i++){
                if (pack_buf->block_bufs[i] != NULL){
                    g_safe_free(pack_buf->block_bufs[i]);
                    pack_buf->block_bufs[i] = NULL;
                }
                else{
                    break;
                }
            }
        }

        g_safe_free(vdev->packet_buffer);
        g_safe_free(vdev->logic_buf);
        g_safe_free(vdev->analog_buf);
        g_safe_free(sdi->path);
        g_safe_free(packet_interval);
        g_safe_free(run_time);

        sdi->status = SR_ST_INACTIVE;
        return SR_OK;
    }
    return SR_ERR_CALL_STATUS;
}

static int dev_destroy(struct sr_dev_inst *sdi)
{
    assert(sdi);
    hw_dev_close(sdi);
    sr_dev_inst_free(sdi);
}

static int config_get(int id, GVariant **data, const struct sr_dev_inst *sdi,
                      const struct sr_channel *ch,
                      const struct sr_channel_group *cg)
{
    (void)cg;

    assert(sdi);
    assert(sdi->priv);

    struct session_vdev *vdev = sdi->priv;

    switch (id)
    {
    case SR_CONF_SAMPLERATE:
        *data = g_variant_new_uint64(vdev->samplerate);
        break;
    case SR_CONF_LIMIT_SAMPLES:
        *data = g_variant_new_uint64(vdev->total_samples);
        break;
    case SR_CONF_DEVICE_MODE:
        *data = g_variant_new_int16(sdi->mode);
        break;
    case SR_CONF_INSTANT:
        *data = g_variant_new_boolean(vdev->instant);
        break;
    case SR_CONF_PATTERN_MODE:
        if(sdi->mode == LOGIC)
            *data = g_variant_new_string(pattern_strings_logic[vdev->sample_generator]);
        else if(sdi->mode == DSO)
            *data = g_variant_new_string(pattern_strings_dso[vdev->sample_generator]);
        else
            *data = g_variant_new_string(pattern_strings_analog[vdev->sample_generator]);
        break;
    case SR_CONF_MAX_HEIGHT:
        *data = g_variant_new_string(maxHeights[vdev->max_height]);
        break;
    case SR_CONF_MAX_HEIGHT_VALUE:
        *data = g_variant_new_byte(vdev->max_height);
        break;
    case SR_CONF_PROBE_OFFSET:
        if (ch)
            *data = g_variant_new_uint16(ch->offset);
        break;
    case SR_CONF_PROBE_HW_OFFSET:
        if (ch)
            *data = g_variant_new_uint16(ch->hw_offset);
        break;
    case SR_CONF_PROBE_VDIV:
        if (ch)
            *data = g_variant_new_uint64(ch->vdiv);
        break;
    case SR_CONF_PROBE_FACTOR:
        if (ch)
            *data = g_variant_new_uint64(ch->vfactor);
        break;
    case SR_CONF_TIMEBASE:
        *data = g_variant_new_uint64(vdev->timebase);
        break;
    case SR_CONF_MAX_TIMEBASE:
        *data = g_variant_new_uint64(MAX_TIMEBASE);
        break;
    case SR_CONF_MIN_TIMEBASE:
        *data = g_variant_new_uint64(MIN_TIMEBASE);
        break;
    case SR_CONF_PROBE_COUPLING:
        if (ch)
            *data = g_variant_new_byte(ch->coupling);
        break;
    case SR_CONF_TRIGGER_VALUE:
        if (ch)
            *data = g_variant_new_byte(ch->trig_value);
        break;
    case SR_CONF_PROBE_EN:
        if (ch)
            *data = g_variant_new_boolean(ch->enabled);
        break;
    case SR_CONF_MAX_DSO_SAMPLERATE:
        *data = g_variant_new_uint64(SR_MHZ(200));
        break;
    case SR_CONF_MAX_DSO_SAMPLELIMITS:
        *data = g_variant_new_uint64(SR_Kn(20));
        break;
    case SR_CONF_HW_DEPTH:
        switch (sdi->mode)
        {
        case LOGIC:
            if(vdev->sample_generator == PATTERN_RANDOM)
                *data = g_variant_new_uint64(LOGIC_HW_DEPTH);
            else
                *data = g_variant_new_uint64(vdev->total_samples);
            break;
        case DSO:
                *data = g_variant_new_uint64(vdev->total_samples);
            break;
        case ANALOG:
                *data = g_variant_new_uint64(ANALOG_HW_DEPTH);
            break;
        default:
            break;
        }
        break;
    case SR_CONF_UNIT_BITS:
         *data = g_variant_new_byte(vdev->unit_bits);
        break;
    case SR_CONF_PROBE_MAP_DEFAULT:
        if (!sdi || !ch)
            return SR_ERR;
        *data = g_variant_new_boolean(ch->map_default);
        break;
    case SR_CONF_PROBE_MAP_UNIT:
        if (!sdi || !ch)
            return SR_ERR;
        *data = g_variant_new_string(ch->map_unit);
        break;
    case SR_CONF_PROBE_MAP_MIN:
        if (!sdi || !ch)
            return SR_ERR;
        *data = g_variant_new_double(ch->map_min);
        break;
    case SR_CONF_PROBE_MAP_MAX:
        if (!sdi || !ch)
            return SR_ERR;
        *data = g_variant_new_double(ch->map_max);
        break;
    case SR_CONF_VLD_CH_NUM:
        *data = g_variant_new_int16(vdev->num_probes);
        break;
    case SR_CONF_HAVE_ZERO:
        *data = g_variant_new_boolean(FALSE);
        break;
    case SR_CONF_LOAD_DECODER:
        *data = g_variant_new_boolean(vdev->sample_generator != PATTERN_RANDOM);
        break;
    case SR_CONF_REF_MIN:
        *data = g_variant_new_uint32(vdev->ref_min);
        break;
    case SR_CONF_REF_MAX:
        *data = g_variant_new_uint32(vdev->ref_max);
        break;
    case SR_CONF_CHANNEL_MODE:
        *data = g_variant_new_int16(vdev->logic_ch_mode);
        break;
    default:
        return SR_ERR_NA;
    }

    return SR_OK;
}

static int config_set(int id, GVariant *data, struct sr_dev_inst *sdi,
                      struct sr_channel *ch,
                      struct sr_channel_group *cg)
{
 (void)cg;

    struct session_vdev *vdev;
    const char *stropt;
    unsigned int i;
    int nv;

    assert(sdi);
    assert(sdi->priv);

    vdev = sdi->priv;

    switch (id)
    {
    case SR_CONF_SAMPLERATE:
        vdev->samplerate = g_variant_get_uint64(data);
        sr_dbg("Setting samplerate to %llu.", vdev->samplerate);
        break;
    case SR_CONF_LIMIT_SAMPLES:
        vdev->total_samples = g_variant_get_uint64(data);
        sr_dbg("Setting limit samples to %llu.", vdev->total_samples);
        break;
    case SR_CONF_LIMIT_MSEC:
        break;
    case SR_CONF_DEVICE_MODE:
        sdi->mode = g_variant_get_int16(data);
        switch (sdi->mode)
        {
            case LOGIC:
                if(SR_OK == reset_dsl_path(sdi,sdi->mode ,PATTERN_DEFAULT))
                {
                    vdev->sample_generator = PATTERN_DEFAULT;
                }
                else
                {
                    vdev->sample_generator = PATTERN_RANDOM;
                }
                break;
            case DSO:
                reset_dsl_path(sdi,sdi->mode ,PATTERN_RANDOM);
                vdev->sample_generator = PATTERN_RANDOM;
                break;
            case ANALOG:
                reset_dsl_path(sdi,sdi->mode ,PATTERN_RANDOM);
                vdev->sample_generator = PATTERN_RANDOM;
                break;
            default:
                break;
        }
        load_virtual_device_session(sdi);
        break;
    case SR_CONF_PATTERN_MODE:
        stropt = g_variant_get_string(data, NULL);
        uint8_t tmp_sample_generator = vdev->sample_generator;
        vdev->sample_generator = get_pattern_mode_index_by_string(sdi->mode , stropt);
        if(SR_OK != reset_dsl_path(sdi,sdi->mode,vdev->sample_generator))
        {
            vdev->sample_generator = PATTERN_RANDOM;
        }
        if(sdi->mode == LOGIC)
        {
            if(vdev->sample_generator == PATTERN_RANDOM)
            {
                if(!vdev->channel_mode_change && tmp_sample_generator != vdev->sample_generator)
                {
                    vdev->logic_ch_mode = DEMO_LOGIC125x16;
                    vdev->logic_ch_mode_index = LOGIC125x16;
                    load_virtual_device_session(sdi);
                }
                vdev->channel_mode_change = FALSE;
            }
            else{
                load_virtual_device_session(sdi);
            }
            
        }
        sr_dbg("%s: setting pattern to %d",
            __func__, vdev->sample_generator);
        break;

    case SR_CONF_MAX_HEIGHT:
        stropt = g_variant_get_string(data, NULL);
        for (i = 0; i < ARRAY_SIZE(maxHeights); i++)
        {
            if (!strcmp(stropt, maxHeights[i]))
            {
                vdev->max_height = i;
                break;
            }
        }
        sr_dbg("%s: setting Signal Max Height to %d",
               __func__, vdev->max_height);
        break;
    case SR_CONF_PROBE_EN:
        ch->enabled = g_variant_get_boolean(data);
        break;
    case SR_CONF_PROBE_VDIV:
        ch->vdiv = g_variant_get_uint64(data);
        if(sdi->mode == DSO)
        {
            if(vdev->packet_buffer)
            {
                vdev->packet_buffer->post_len = 0;
                vdev->packet_buffer->block_read_positions[0] = 0;
                vdev->packet_buffer->block_read_positions[1] = 0;
                vdev->packet_buffer->block_chan_read_pos = 0;
            }
            vdev->vdiv_change = TRUE;
        }
        break;
    case SR_CONF_PROBE_FACTOR:
        ch->vfactor = g_variant_get_uint64(data);
        break;
    case SR_CONF_PROBE_OFFSET:
        ch->offset = g_variant_get_uint16(data);
        if(sdi->mode == DSO && ch->vdiv <= SR_mV(200))
        {
            ch->hw_offset = ch->offset;
            vdev->offset_change = TRUE;
        }
        else{
            if(ch->coupling == 0)
            {
                ch->hw_offset = 178;
            }
            else
            {
                ch->hw_offset = 128;
            }
        }
        break;
    case SR_CONF_PROBE_HW_OFFSET:
        ch->hw_offset = g_variant_get_uint16(data);
        break;
    case SR_CONF_TIMEBASE:
        vdev->timebase = g_variant_get_uint64(data);
        if(sdi->mode == DSO)
        {
            g_timer_start(run_time);
            vdev->timebase_change = TRUE;
        } 
        sr_dbg("Setting timebase to %llu.", vdev->timebase);
        break;
    case SR_CONF_PROBE_COUPLING:
        if(sdi->mode != LOGIC)
        {
            if(sdi->mode == DSO && ch->vdiv <= SR_mV(200))
            {
                ch->coupling = g_variant_get_byte(data);
                ch->hw_offset = ch->offset;
            }
            else
            {
                ch->coupling = g_variant_get_byte(data);
                if(ch->coupling == 0)
                {
                    ch->hw_offset = 178;
                }
                else
                {
                    ch->hw_offset = 128;
                }       
            }
        }
        break;
    case SR_CONF_TRIGGER_SOURCE:
        break;
    case SR_CONF_TRIGGER_SLOPE:
        break;
    case SR_CONF_TRIGGER_VALUE:
        ch->trig_value = g_variant_get_byte(data);
        break;
    case SR_CONF_PROBE_MAP_DEFAULT:
        ch->map_default = g_variant_get_boolean(data);
        if (ch->map_default) {
            ch->map_unit = probeMapUnits[0];
            ch->map_min = -(ch->vdiv * ch->vfactor * DS_CONF_DSO_VDIVS / 2000.0);
            ch->map_max = ch->vdiv * ch->vfactor * DS_CONF_DSO_VDIVS / 2000.0;
        }
        break;
    case SR_CONF_PROBE_MAP_UNIT:
        ch->map_unit = g_variant_get_string(data, NULL);
        break;
    case SR_CONF_PROBE_MAP_MIN:
        ch->map_min = g_variant_get_double(data);
        break;
    case SR_CONF_PROBE_MAP_MAX:
        ch->map_max = g_variant_get_double(data);
        if(sdi->mode == ANALOG)
        break;
    case SR_CONF_NUM_BLOCKS:
        vdev->num_blocks = g_variant_get_uint64(data);
        sr_dbg("Setting block number to %llu.", vdev->num_blocks);
        break;
    case SR_CONF_CAPTURE_NUM_PROBES:
        vdev->num_probes = g_variant_get_uint64(data);
        break;
    case SR_CONF_INSTANT:
        vdev->instant = g_variant_get_boolean(data);
        break;
    case SR_CONF_DEMO_INIT:
        load_virtual_device_session(sdi);
        break;
    case SR_CONF_LOOP_MODE:
        vdev->is_loop = g_variant_get_boolean(data);
        sr_info("Set demo loop mode:%d", vdev->is_loop);
        break;
    case SR_CONF_CHANNEL_MODE:
        nv = g_variant_get_int16(data);
        if(sdi->mode == LOGIC && vdev->sample_generator == PATTERN_RANDOM)
        {
            for(i = 0 ; i < ARRAY_SIZE(logic_channel_modes);i++)
            {
                if(logic_channel_modes[i].id == nv)
                {
                    vdev->logic_ch_mode_index = i;
                    vdev->logic_ch_mode = nv;
                    load_virtual_device_session(sdi);
                    vdev->channel_mode_change = TRUE;
                    break;
                }
            }

        }
        break;
    default:
        sr_err("Unknown capability: %d.", id);
        return SR_ERR_NA;
    }

    return SR_OK;

}

static int config_list(int key, GVariant **data, const struct sr_dev_inst *sdi,
                       const struct sr_channel_group *cg)
{
    (void)cg;

    GVariant *gvar;
    GVariantBuilder gvb;

    (void)sdi;
    struct session_vdev *vdev = sdi->priv;

    switch (key)
    {
    case SR_CONF_DEVICE_OPTIONS:
        *data = g_variant_new_from_data(G_VARIANT_TYPE("ai"),
                                        hwoptions, ARRAY_SIZE(hwoptions) * sizeof(int32_t), TRUE, NULL, NULL);
        break;
    case SR_CONF_DEVICE_SESSIONS:
        *data = g_variant_new_from_data(G_VARIANT_TYPE("ai"),
                                        sessions, ARRAY_SIZE(sessions) * sizeof(int32_t), TRUE, NULL, NULL);
        break;
    case SR_CONF_SAMPLERATE:
        g_variant_builder_init(&gvb, G_VARIANT_TYPE("a{sv}"));
        if(sdi->mode == LOGIC && vdev->sample_generator != PATTERN_RANDOM)
        {
             gvar = g_variant_new_from_data(G_VARIANT_TYPE("at"),
                                       samplerates_file, ARRAY_SIZE(samplerates_file) * sizeof(uint64_t), TRUE, NULL, NULL);
        }
        else
        {
            gvar = g_variant_new_from_data(G_VARIANT_TYPE("at"),
                                       samplerates + vdev->samplerates_min_index , (vdev->samplerates_max_index - vdev->samplerates_min_index + 1) * sizeof(uint64_t), TRUE, NULL, NULL);
        }
        g_variant_builder_add(&gvb, "{sv}", "samplerates", gvar);
        *data = g_variant_builder_end(&gvb);
        break;
    case SR_CONF_PATTERN_MODE:
        if(sdi->mode == LOGIC)
        {
            *data = g_variant_new_strv(pattern_strings_logic, pattern_logic_count);
        }
        else if (sdi->mode == DSO)
        {
            *data = g_variant_new_strv(pattern_strings_dso, pattern_dso_count);
        }
        else
        {
            *data = g_variant_new_strv(pattern_strings_analog, pattern_analog_count);
        }
        break;
    case SR_CONF_MAX_HEIGHT:
        *data = g_variant_new_strv(maxHeights, ARRAY_SIZE(maxHeights));
        break;
    case SR_CONF_PROBE_CONFIGS:
        *data = g_variant_new_from_data(G_VARIANT_TYPE("ai"),
                                        probeOptions, ARRAY_SIZE(probeOptions) * sizeof(int32_t), TRUE, NULL, NULL);
        break;
    case SR_CONF_PROBE_VDIV:
        g_variant_builder_init(&gvb, G_VARIANT_TYPE("a{sv}"));
        gvar = g_variant_new_from_data(G_VARIANT_TYPE("at"),
                                       vdivs10to2000, (ARRAY_SIZE(vdivs10to2000)-1) * sizeof(uint64_t), TRUE, NULL, NULL);
        g_variant_builder_add(&gvb, "{sv}", "vdivs", gvar);
        *data = g_variant_builder_end(&gvb);
        break;
    case SR_CONF_PROBE_COUPLING:
        g_variant_builder_init(&gvb, G_VARIANT_TYPE("a{sv}"));
        gvar = g_variant_new_from_data(G_VARIANT_TYPE("ay"),
                probeCoupling, ARRAY_SIZE(probeCoupling)*sizeof(uint8_t), TRUE, NULL, NULL);
        g_variant_builder_add(&gvb, "{sv}", "coupling", gvar);
        *data = g_variant_builder_end(&gvb);
        break;
    case SR_CONF_PROBE_MAP_UNIT:
        *data = g_variant_new_strv(probeMapUnits, ARRAY_SIZE(probeMapUnits));
        break;
    case SR_CONF_CHANNEL_MODE:
        if(sdi->mode == LOGIC&& vdev->sample_generator == PATTERN_RANDOM)
        {
            for(int i = 0;i<ARRAY_SIZE(logic_channel_mode_list);i++)
            {
                logic_channel_mode_list[i].id = logic_channel_modes[i].id;
                logic_channel_mode_list[i].name = logic_channel_modes[i].descr;
                if(i == ARRAY_SIZE(logic_channel_mode_list)-1)
                {
                    logic_channel_mode_list[i].id = -1;
                    logic_channel_mode_list[i].name = NULL;
                }
            }
            *data = g_variant_new_uint64((uint64_t)&logic_channel_mode_list);
        }
        else
            return SR_ERR_ARG;
        break;
    default:
        return SR_ERR_ARG;
    }

    return SR_OK;
}

static int hw_dev_acquisition_start(struct sr_dev_inst *sdi,
        void *cb_data)
{

     (void)cb_data;

    struct session_vdev *vdev;
    struct sr_datafeed_packet packet;
    int ret;
    GSList *l;
    struct sr_channel *probe;

    assert(sdi);
    assert(sdi->priv);


    vdev = sdi->priv;
    vdev->enabled_probes = 0;
    packet.status = SR_PKT_OK;

    vdev->cur_block = 0;

    if(vdev->sample_generator != PATTERN_RANDOM)
    {
        if (vdev->archive != NULL)
        {
            sr_err("history archive is not closed.");
        }

        sr_dbg("Opening archive file %s", sdi->path);

        vdev->archive = unzOpen64(sdi->path);

        if (NULL == vdev->archive)
        {
            sr_err("Failed to open session file '%s': "
                "zip error %d\n",
                sdi->path, ret);
            return SR_ERR;
        }
    }

    for (l = sdi->channels; l; l = l->next)
    {
        probe = l->data;
        if (probe->enabled)
            vdev->enabled_probes++;
    }

    if(sdi->mode == LOGIC)
    {
        vdev->post_data_len = 0;
        vdev->packet_len = LOGIC_PACKET_LEN(vdev->samplerate);
        vdev->packet_time = LOGIC_PACKET_TIME(LOGIC_PACKET_NUM_PER_SEC);
        if(vdev->packet_len < LOGIC_MIN_PACKET_LEN)
        {
            vdev->packet_len = LOGIC_MIN_PACKET_LEN;
            vdev->packet_time = LOGIC_MIN_PACKET_TIME(vdev->samplerate);
        }

        if(vdev->samplerate >= SR_MHZ(100))
        {
            uint64_t ideal_len = 2;
            while (1)
            {
                if(ideal_len>=vdev->packet_len)
                {
                    sr_info("len:%d",ideal_len);
                    vdev->packet_len = ideal_len;
                    break;
                }
                else
                {
                    ideal_len *=2;
                }
            }
            
            vdev->packet_time = vdev->samplerate/8;
            packet_num = ceil(vdev->packet_time/(gdouble)vdev->packet_len);
            vdev->packet_time = 1/(gdouble)packet_num;
            vdev->logic_sel_probe_num = 0;        
        }
        
        if(vdev->sample_generator == PATTERN_RANDOM)
        {
            vdev->logci_cur_packet_num = 1;
            if(logic_post_buf == NULL)
                g_safe_free(logic_post_buf);
            logic_post_buf = g_try_malloc0(vdev->enabled_probes * vdev->packet_len);
            if(logic_post_buf == NULL)
            {
                sr_err("%s: logic_post_buf malloc error", __func__);
                return SR_ERR_MALLOC;
            }
            init_random_data(vdev,sdi);
            g_timer_start(run_time);
            sr_session_source_add(-1, 0, 0, receive_data_logic, sdi);
        }
        else
        {
            sr_session_source_add(-1, 0, 0, receive_data_logic_decoder, sdi);
        }
    }
    else if(sdi->mode == DSO)
    {
        vdev->vdiv_change = TRUE;
        if(vdev->instant){
            vdev->post_data_len = 0;

            gdouble total_time = vdev->timebase /(gdouble)SR_SEC(1)*(gdouble)10;
            uint64_t post_data_per_sec = DSO_PACKET_LEN/total_time;
            vdev->packet_len = 2;
            uint64_t packet_num = post_data_per_sec/vdev->packet_len;
            vdev->packet_time = SEC/(gdouble)packet_num;
        }
        else{
            vdev->packet_time = DSO_PACKET_TIME;
        }
        
        vdev->load_data = TRUE;
        g_timer_start(run_time);
        sr_session_source_add(-1, 0, 0, receive_data_dso, sdi);
    }
    else if(sdi->mode == ANALOG)
    {
        vdev->load_data = TRUE;
        vdev->packet_len = ANALOG_PACKET_LEN(vdev->samplerate);

        if(vdev->packet_len < ANALOG_MIN_PACKET_LEN)
        {
            vdev->packet_len = ANALOG_MIN_PACKET_LEN;
            vdev->packet_time = ANALOG_PACKET_TIME(ANALOG_MIN_PACKET_NUM(vdev->samplerate));
        }
        else
        {
            if (vdev->packet_len % ANALOG_PACKET_ALIGN != 0)
            {
                vdev->packet_len += 1;
            }
            vdev->packet_time = ANALOG_PACKET_TIME(ANALOG_PACKET_NUM_PER_SEC);
        }
        if(vdev->sample_generator == PATTERN_RANDOM)
            init_analog_random_data(vdev);
            
        vdev->analog_read_pos = 0;       

        sr_session_source_add(-1, 0, 0, receive_data_analog, sdi);
    }

    return SR_OK;
}

static int hw_dev_acquisition_stop(const struct sr_dev_inst *sdi, void *cb_data)
{
    struct session_vdev *vdev = sdi->priv;
    struct sr_datafeed_packet packet;
    packet.status = SR_PKT_OK;

    if(sdi->mode != LOGIC)
    {
        packet.type = SR_DF_END;
        ds_data_forward(sdi, &packet);
        close_archive(vdev);
    }

    return SR_OK;
}

static int hw_dev_status_get(const struct sr_dev_inst *sdi, struct sr_status *status, gboolean prg)
{
    (void)prg;

    struct session_vdev *vdev;
    if (sdi)
    {
        vdev = sdi->priv;
        dso_status_update(vdev);
        *status = vdev->mstatus;
        return SR_OK;
    }
    else
    {
        return SR_ERR;
    }
}

static int receive_data_logic(int fd, int revents, const struct sr_dev_inst *sdi)
{
    assert(sdi);
    assert(sdi->priv);

    (void)fd;
    (void)revents;

    struct session_vdev *vdev = sdi->priv;
    struct sr_datafeed_packet packet;
    struct sr_datafeed_logic logic;

    int bToEnd;
    int chan_num;

    bToEnd = 0;

    vdev = sdi->priv;

    chan_num = vdev->enabled_probes;

    if (chan_num < 1){
        sr_err("%s: channel count < 1.", __func__);
        return SR_ERR_ARG;
    }
    if (chan_num > SESSION_MAX_CHANNEL_COUNT){
        sr_err("%s: channel count is to big.", __func__);
        return SR_ERR_ARG;
    }

     g_timer_start(packet_interval);

    if(!vdev->is_loop){
        if(vdev->post_data_len >= vdev->total_samples/8){
            bToEnd = 1;
        }
    }

    if(!bToEnd)
    {
        packet.status = SR_PKT_OK;
        packet.type = SR_DF_LOGIC;
        packet.payload = &logic;
        logic.format = LA_CROSS_DATA;
        logic.index = 0;
        logic.order = 0;
        logic.length = chan_num * vdev->packet_len;

        if(!vdev->is_loop)
        {
            vdev->post_data_len += logic.length / vdev->enabled_probes;
            if(vdev->post_data_len >= vdev->total_samples/8)
            {
                get_last_packet_len(&logic,vdev);
            }
        }

        memset(logic_post_buf,LOGIC_LOW_LEVEL,chan_num * vdev->packet_len);
        if(vdev->samplerate >= LOGIC_FREQ_LIMIT && vdev->total_samples/vdev->samplerate >= SEC)
        {
            for(int i = 0; i < vdev->logic_sel_probe_num;i++)
            {
                uint8_t probe_index = vdev->logic_sel_probe_list[i];
                for(uint16_t j = 0 ; j< vdev->packet_len/8;j++)
                {
                    uint64_t cur_index = (probe_index*8) + (j*vdev->enabled_probes*8);
                    memcpy(logic_post_buf+cur_index,vdev->logic_buf,8);
                }
            }
        }
        else
        {
            uint64_t random = vdev->logic_buf_len - logic.length;
            random = rand() % random;
            int index = vdev->enabled_probes * 8;
            random = floor(random/index)*index;
            memcpy(logic_post_buf,vdev->logic_buf + random,logic.length);
        }
        logic.data = logic_post_buf;

        gdouble ideal_time = vdev->samplerate/8;
        ideal_time = vdev->packet_len/(gdouble)ideal_time;
        ideal_time = vdev->logci_cur_packet_num*ideal_time;
        gdouble packet_elapsed = g_timer_elapsed(run_time, NULL);
        gdouble waittime = ideal_time - packet_elapsed;
        if(waittime > 0)
        {
            g_usleep(SR_MS(waittime));
        }  
        ds_data_forward(sdi, &packet);

        if(vdev->samplerate >= LOGIC_FREQ_LIMIT && vdev->total_samples/vdev->samplerate >= SEC)
        {
            uint16_t target_packet = (LOGIC_BLOCK_LEN/vdev->packet_len);
            if(vdev->logci_cur_packet_num % target_packet == 0)
            {
                vdev->logic_sel_probe_num = rand()%vdev->enabled_probes+1;
                memset(vdev->logic_sel_probe_list,LOGIC_HIGH_LEVEL,vdev->enabled_probes);
                for(int i = 0; i< vdev->logic_sel_probe_num;i++)
                {
                    vdev->logic_sel_probe_list[i] = rand()%vdev->enabled_probes;
                }
            }
        }
        vdev->logci_cur_packet_num++;
    }

    if (bToEnd || revents == -1)
    {
        packet.type = SR_DF_END;
        ds_data_forward(sdi, &packet);
        sr_session_source_remove(-1);
    }

    return TRUE;
}

static int receive_data_logic_decoder(int fd, int revents, const struct sr_dev_inst *sdi)
{
    struct session_vdev *vdev = NULL;
    struct sr_datafeed_packet packet;
    struct sr_datafeed_logic logic;
    struct sr_datafeed_dso dso;

    int ret;
    char file_name[32];
    int channel;
    int ch_index, malloc_chan_index;
    struct session_packet_buffer *pack_buffer;
    unz_file_info64 fileInfo;
    char szFilePath[15];
    int bToEnd;
    int read_chan_index;
    int chan_num;
    uint8_t *p_wr;
    uint8_t *p_rd;
    int byte_align;
    int dir_index;
    int bCheckFile;
    const int file_max_channel_count = 128;

    assert(sdi);
    assert(sdi->priv);

    (void)fd;
    (void)revents;

    sr_detail("Feed chunk.");

    ret = 0;
    bToEnd = 0;
    packet.status = SR_PKT_OK;

    vdev = sdi->priv;

    assert(vdev->unit_bits > 0);
    assert(vdev->archive);

    chan_num = vdev->enabled_probes;
    byte_align = sdi->mode == LOGIC ? 8 : 1;

    if (chan_num < 1){
        sr_err("%s: channel count < 1.", __func__);
        return SR_ERR_ARG;
    }
    if (chan_num > SESSION_MAX_CHANNEL_COUNT){
        sr_err("%s: channel count is to big.", __func__);
        return SR_ERR_ARG;
    }

    g_timer_start(packet_interval);

    // Make buffer
    if (vdev->packet_buffer == NULL){
        vdev->cur_block = 0;

        vdev->packet_buffer = g_try_malloc0(sizeof(struct session_packet_buffer));
        if (vdev->packet_buffer == NULL){
            sr_err("%s: vdev->packet_buffer malloc failed", __func__);
            return SR_ERR_MALLOC;
        }

        for (ch_index = 0; ch_index <= chan_num; ch_index++){
            vdev->packet_buffer->block_bufs[ch_index] = NULL;
            vdev->packet_buffer->block_read_positions[ch_index] = 0;
        }

        vdev->packet_buffer->post_buf_len = chan_num * vdev->packet_len;

        vdev->packet_buffer->post_buf = g_try_malloc0(vdev->packet_buffer->post_buf_len + 1);
        if (vdev->packet_buffer->post_buf == NULL){
            sr_err("%s: vdev->packet_buffer->post_buf malloc failed", __func__);
            return SR_ERR_MALLOC;
        }

        pack_buffer = vdev->packet_buffer;
        pack_buffer->post_len;
        pack_buffer->block_buf_len = 0;
        pack_buffer->block_data_len = 0;
        pack_buffer->block_chan_read_pos = 0;

        max_probe_num = chan_num;
    }
    pack_buffer = vdev->packet_buffer;

    if(chan_num != max_probe_num)
    {
        for(ch_index = 0 ;ch_index < chan_num; ch_index++)
        {
            if(pack_buffer->block_bufs[ch_index] != NULL)
            {
                g_safe_free(pack_buffer->block_bufs[ch_index]);
            }
            pack_buffer->block_bufs[ch_index] = NULL;
            pack_buffer->block_read_positions[ch_index] = 0;
        }
        pack_buffer->block_buf_len = 0;
        pack_buffer->block_data_len = 0;
        pack_buffer->block_chan_read_pos = 0;
        max_probe_num = chan_num;
    }

    if(pack_buffer->post_buf_len != chan_num * vdev->packet_len)
    {
        pack_buffer->post_buf_len = chan_num * vdev->packet_len;
        if(pack_buffer->post_buf != NULL)
        {
            g_safe_free(pack_buffer->post_buf);
        }

        pack_buffer->post_buf = g_try_malloc0(pack_buffer->post_buf_len);
        if (pack_buffer->post_buf == NULL)
        {
            sr_err("%s: pack_buffer->post_buf malloc failed", __func__);
            return SR_ERR_MALLOC;
        }

        pack_buffer->post_len = 0;
    }

    // Make packet.
    read_chan_index = 0;
    dir_index = 0;

    while (pack_buffer->post_len < pack_buffer->post_buf_len)
    {
        if (pack_buffer->block_chan_read_pos >= pack_buffer->block_data_len)
        {
            if(vdev->cur_block >= vdev->num_blocks){
                bToEnd = 1;
                break;
            }

            for (ch_index = 0; ch_index < chan_num; ch_index++)
            {
                bCheckFile = 0;

                while (1)
                {
                    snprintf(file_name, sizeof(file_name)-1, "L-%d/%d", dir_index++, vdev->cur_block);

                    if (unzLocateFile(vdev->archive, file_name, 0) == UNZ_OK){
                        bCheckFile = 1;
                        break;
                    }
                    else if (dir_index > file_max_channel_count){
                        break;
                    }
                }

                if (!bCheckFile)
                {
                    sr_err("can't locate zip inner file:\"%s\"", file_name);
                    send_error_packet(sdi, vdev, &packet);
                    return FALSE;
                }

                if (unzGetCurrentFileInfo64(vdev->archive, &fileInfo, szFilePath,
                                    sizeof(szFilePath), NULL, 0, NULL, 0) != UNZ_OK)
                {
                    sr_err("%s: unzGetCurrentFileInfo64 error.", __func__);
                    send_error_packet(sdi, vdev, &packet);
                    return FALSE;
                }

                if (ch_index == 0){
                    pack_buffer->block_data_len = fileInfo.uncompressed_size;

                    if (pack_buffer->block_data_len > pack_buffer->block_buf_len)
                    {
                        for (malloc_chan_index = 0; malloc_chan_index < chan_num; malloc_chan_index++){
                            // Release the old buffer.
                            if (pack_buffer->block_bufs[malloc_chan_index] != NULL){
                                g_safe_free(pack_buffer->block_bufs[malloc_chan_index]);
                                pack_buffer->block_bufs[malloc_chan_index] = NULL;
                            }

                            pack_buffer->block_bufs[malloc_chan_index] = g_try_malloc0(pack_buffer->block_data_len + 1);
                            if (pack_buffer->block_bufs[malloc_chan_index] == NULL){
                                sr_err("%s: block buffer malloc failed", __func__);
                                send_error_packet(sdi, vdev, &packet);
                                return FALSE;
                            }
                            pack_buffer->block_buf_len = pack_buffer->block_data_len;
                        }
                    }
                }
                else
                {
                    if (pack_buffer->block_data_len != fileInfo.uncompressed_size){
                        sr_err("The block size is not coincident:%s", file_name);
                        send_error_packet(sdi, vdev, &packet);
                        return FALSE;
                    }
                }

                // Read the data to buffer.
                if (unzOpenCurrentFile(vdev->archive) != UNZ_OK)
                {
                    sr_err("can't open zip inner file:\"%s\"", file_name);
                    send_error_packet(sdi, vdev, &packet);
                    return FALSE;
                }

                ret = unzReadCurrentFile(vdev->archive, pack_buffer->block_bufs[ch_index], pack_buffer->block_data_len);
                if (-1 == ret)
                {
                    sr_err("read zip inner file error:\"%s\"", file_name);
                    send_error_packet(sdi, vdev, &packet);
                    return FALSE;
                }
                unzCloseCurrentFile(vdev->archive);
                pack_buffer->block_read_positions[ch_index] = 0; // Reset the read position.
            }
            vdev->cur_block++;
            pack_buffer->block_chan_read_pos = 0;
        }

        p_wr = (uint8_t*)pack_buffer->post_buf + pack_buffer->post_len;
        p_rd = (uint8_t*)pack_buffer->block_bufs[read_chan_index] + pack_buffer->block_read_positions[read_chan_index];
        *p_wr = *p_rd;

        pack_buffer->post_len++;
        pack_buffer->block_read_positions[read_chan_index]++;

        if (pack_buffer->block_read_positions[read_chan_index] % byte_align == 0
                || pack_buffer->block_read_positions[read_chan_index] == pack_buffer->block_data_len)
        {
            read_chan_index++;

            if (pack_buffer->block_read_positions[read_chan_index] == pack_buffer->block_data_len){
                sr_info("Block read end.");
                if (vdev->cur_block < vdev->num_blocks){
                    sr_err("%s", "The block data is not align.");
                    break;
                }
            }

            // Each channel's data is ready.
            if (read_chan_index == chan_num){
                read_chan_index = 0;
                pack_buffer->block_chan_read_pos += byte_align;
            }
        }
    }

    if (pack_buffer->post_len >= byte_align * chan_num)
    {
        packet.type = SR_DF_LOGIC;
        packet.payload = &logic;
        logic.format = LA_CROSS_DATA;
        logic.index = 0;
        logic.order = 0;
        logic.length = pack_buffer->post_len;
        logic.data = pack_buffer->post_buf;

        delay_time(vdev);
        ds_data_forward(sdi, &packet);
        
        pack_buffer->post_len = 0;
    }

    if (bToEnd || revents == -1)
    {
        packet.type = SR_DF_END;
        ds_data_forward(sdi, &packet);
        sr_session_source_remove(-1);
        close_archive(vdev);
    }

    return TRUE;
}

int get_bit(uint64_t timebase)
{
    if(timebase < SR_MS(1) && timebase >= SR_US(20))
        return SR_MS(1)/timebase*2;
    else if(timebase < SR_MS(200) && timebase >= SR_MS(1))
        return SR_MS(200)/timebase*2;
    else if(timebase <= SR_SEC(10) && timebase > SR_MS(200))
        return SR_SEC(40)/timebase*2;
    else
        return 200;
}

static int receive_data_dso(int fd, int revents, const struct sr_dev_inst *sdi)
{
 struct session_vdev *vdev = NULL;
    struct sr_datafeed_packet packet;
    struct sr_datafeed_dso dso;
    struct sr_channel *probe;

    int ret;
    char file_name[32];
    int ch_index, malloc_chan_index;
    struct session_packet_buffer *pack_buffer;
    unz_file_info64 fileInfo;
    char szFilePath[15];
    int bToEnd;
    int read_chan_index;
    int chan_num;
    uint8_t *p_wr;
    uint8_t *p_rd;
    int byte_align;
    int dir_index;
    int bCheckFile;
    const int file_max_channel_count = 128;

    uint16_t tem;
    uint8_t val = 0;
    uint64_t vdiv;

    assert(sdi);
    assert(sdi->priv);

    (void)fd;
    (void)revents;

    sr_detail("Feed chunk.");

    ret = 0;
    bToEnd = 0;
    packet.status = SR_PKT_OK;

    vdev = sdi->priv;

    assert(vdev->unit_bits > 0);
    if(vdev->sample_generator != PATTERN_RANDOM)
    {
        assert(vdev->archive);
    }

    chan_num = vdev->num_probes;
    byte_align = sdi->mode == LOGIC ? 8 : 1;

    if (chan_num < 1){
        sr_err("%s: channel count < 1.", __func__);
        return SR_ERR_ARG;
    }
    if (chan_num > SESSION_MAX_CHANNEL_COUNT){
        sr_err("%s: channel count is to big.", __func__);
        return SR_ERR_ARG;
    }

    // Make buffer
    if (vdev->packet_buffer == NULL){
        vdev->cur_block = 0;

        vdev->packet_buffer = g_try_malloc0(sizeof(struct session_packet_buffer));
        if (vdev->packet_buffer == NULL){
            sr_err("%s: vdev->packet_buffer malloc failed", __func__);
            return SR_ERR_MALLOC;
        }

        for (ch_index = 0; ch_index <= chan_num; ch_index++){
            vdev->packet_buffer->block_bufs[ch_index] = NULL;
            vdev->packet_buffer->block_read_positions[ch_index] = 0;
        }

        vdev->packet_buffer->post_buf_len = chan_num * 10000;

        vdev->packet_buffer->post_buf = g_try_malloc0(vdev->packet_buffer->post_buf_len);
        if (vdev->packet_buffer->post_buf == NULL){
            sr_err("%s: vdev->packet_buffer->post_buf malloc failed", __func__);
            return SR_ERR_MALLOC;
        }

        pack_buffer = vdev->packet_buffer;
        pack_buffer->post_len;
        pack_buffer->block_buf_len = 0;
        pack_buffer->block_data_len = 0;
        pack_buffer->block_chan_read_pos = 0;
    }
    pack_buffer = vdev->packet_buffer;
    if(pack_buffer->post_buf_len != chan_num * 10000)
    {
        vdev->packet_buffer->post_buf_len = chan_num * 10000;
        if(pack_buffer->post_buf != NULL)
        {
            g_safe_free(pack_buffer->post_buf);
        }
        pack_buffer->post_buf = g_try_malloc0(pack_buffer->post_buf_len);
        if (pack_buffer->post_buf == NULL)
        {
            sr_err("%s: pack_buffer->post_buf malloc failed", __func__);
            return SR_ERR_MALLOC;
        }

        pack_buffer->post_len = 0;
    }

    if(chan_num != max_probe_num)
    {
        for(ch_index = 0 ;ch_index < chan_num; ch_index++)
        {
            if(pack_buffer->block_bufs[ch_index] != NULL)
            {
                g_safe_free(pack_buffer->block_bufs[ch_index]);
            }
            pack_buffer->block_bufs[ch_index] = NULL;
            pack_buffer->block_read_positions[ch_index] = 0;
        }
        pack_buffer->block_buf_len = 0;
        pack_buffer->block_data_len = 0;
        pack_buffer->block_chan_read_pos = 0;
        max_probe_num = chan_num;
    }

    // Make packet.
    read_chan_index = 0;
    dir_index = 0;

    if(vdev->vdiv_change || vdev->timebase_change ||vdev->offset_change)
    {
        if(vdev->sample_generator == PATTERN_RANDOM)
        {
            for(int i = 0 ; i < pack_buffer->post_buf_len ;i++)
            {
                if(i % 2 == 0)
                    *(uint8_t*)(pack_buffer->post_buf + i) = DSO_RANDOM_DATA;
                else
                    *(uint8_t*)(pack_buffer->post_buf + i) = *(uint8_t*)(pack_buffer->post_buf + i -1);
            }
            pack_buffer->post_len = pack_buffer->post_buf_len;
        }
        else
        {
            if(vdev->load_data)
            {
                pack_buffer->post_len = 0;
                while (pack_buffer->post_len < pack_buffer->post_buf_len)
                {
                    if (pack_buffer->block_chan_read_pos >= pack_buffer->block_data_len)
                    {
                        if (vdev->cur_block >= vdev->num_blocks){
                            vdev->cur_block = 0;
                        }

                        for (ch_index = 0; ch_index < chan_num; ch_index++)
                        {
                            bCheckFile = 0;

                            while (1)
                            {
                                if (sdi->mode  == LOGIC)
                                    snprintf(file_name, sizeof(file_name)-1, "L-%d/%d", dir_index++, vdev->cur_block);
                                else if (sdi->mode == DSO)
                                    snprintf(file_name, sizeof(file_name)-1, "O-%d/0", dir_index++);

                                if (unzLocateFile(vdev->archive, file_name, 0) == UNZ_OK){
                                    bCheckFile = 1;
                                    break;
                                }
                                else if (dir_index > file_max_channel_count){
                                    break;
                                }
                            }

                        if (!bCheckFile)
                        {
                            sr_err("cant't locate zip inner file:\"%s\"", file_name);
                            send_error_packet(sdi, vdev, &packet);
                            return FALSE;
                        }

                            if (unzGetCurrentFileInfo64(vdev->archive, &fileInfo, szFilePath,
                                                sizeof(szFilePath), NULL, 0, NULL, 0) != UNZ_OK)
                            {
                                sr_err("%s: unzGetCurrentFileInfo64 error.", __func__);
                                send_error_packet(sdi, vdev, &packet);
                                return FALSE;
                            }

                            if (ch_index == 0){
                                pack_buffer->block_data_len = fileInfo.uncompressed_size;

                                if (pack_buffer->block_data_len > pack_buffer->block_buf_len)
                                {
                                    for (malloc_chan_index = 0; malloc_chan_index < chan_num; malloc_chan_index++){
                                        // Release the old buffer.
                                        if (pack_buffer->block_bufs[malloc_chan_index] != NULL){
                                            g_safe_free(pack_buffer->block_bufs[malloc_chan_index]);
                                            pack_buffer->block_bufs[malloc_chan_index] = NULL;
                                        }

                                        pack_buffer->block_bufs[malloc_chan_index] = g_try_malloc0(pack_buffer->block_data_len + 1);
                                        if (pack_buffer->block_bufs[malloc_chan_index] == NULL){
                                            sr_err("%s: block buffer malloc failed", __func__);
                                            send_error_packet(sdi, vdev, &packet);
                                            return FALSE;
                                        }
                                        pack_buffer->block_buf_len = pack_buffer->block_data_len;
                                    }
                                }
                            }
                            else
                            {
                                if (pack_buffer->block_data_len != fileInfo.uncompressed_size){
                                    sr_err("The block size is not coincident:%s", file_name);
                                    send_error_packet(sdi, vdev, &packet);
                                    return FALSE;
                                }
                            }

                            // Read the data to buffer.
                            if (unzOpenCurrentFile(vdev->archive) != UNZ_OK)
                            {
                                sr_err("cant't open zip inner file:\"%s\"", file_name);
                                send_error_packet(sdi, vdev, &packet);
                                return FALSE;
                            }

                            ret = unzReadCurrentFile(vdev->archive, pack_buffer->block_bufs[ch_index], pack_buffer->block_data_len);
                            if (-1 == ret)
                            {
                                sr_err("read zip inner file error:\"%s\"", file_name);
                                send_error_packet(sdi, vdev, &packet);
                                return FALSE;
                            }
                            unzCloseCurrentFile(vdev->archive);
                            pack_buffer->block_read_positions[ch_index] = 0; // Reset the read position.
                        }
                        vdev->cur_block++;
                        pack_buffer->block_chan_read_pos = 0;
                    }

                    p_wr = (uint8_t*)pack_buffer->post_buf + pack_buffer->post_len;
                    p_rd = (uint8_t*)pack_buffer->block_bufs[read_chan_index] + pack_buffer->block_read_positions[read_chan_index];
                    *p_wr = *p_rd;

                    pack_buffer->post_len++;
                    pack_buffer->block_read_positions[read_chan_index]++;

                    if (pack_buffer->block_read_positions[read_chan_index] % byte_align == 0
                            || pack_buffer->block_read_positions[read_chan_index] == pack_buffer->block_data_len)
                    {
                        read_chan_index++;

                        if (pack_buffer->block_read_positions[read_chan_index] == pack_buffer->block_data_len){
                            sr_info("Block read end.");
                            if (vdev->cur_block < vdev->num_blocks){
                                sr_err("%s", "The block data is not align.");
                                break;
                            }
                        }

                        // Each channel's data is ready.
                        if (read_chan_index == chan_num){
                            read_chan_index = 0;
                            pack_buffer->block_chan_read_pos += byte_align;
                        }
                    }
                }
                memcpy(vdev->dso_buf,pack_buffer->post_buf,DSO_PACKET_LEN);
                vdev->load_data = FALSE;
            }
            else{
                memcpy(pack_buffer->post_buf,vdev->dso_buf,DSO_PACKET_LEN);
                pack_buffer->post_buf_len = DSO_PACKET_LEN;
            }
            
        }

        if(vdev->timebase_change || vdev->vdiv_change || vdev->offset_change)
        {
            int index;
            int bit = get_bit(vdev->timebase); 

            if(vdev->sample_generator!= PATTERN_RANDOM)
            {
                void* tmp_buf = g_try_malloc0(bit);
                if(tmp_buf == NULL)
                {
                    sr_err("%s: tmp_buf malloc failed", __func__);
                    return SR_ERR_MALLOC;
                }
                for(int i = 0 ; i < bit ; i++)
                {
                    if(i%2 == 0)
                    {
                        if(bit == 10)
                            index = i * 16;
                        else
                            index = i * 100 / (bit / 2);
                    }
                    else
                    {
                        
                        if(bit == 10)
                            index = (i-1) * 16 + 1;
                        else
                            index = (i-1) * 100 / (bit / 2) + 1;
                    }
                    *((uint8_t*)tmp_buf+ i) = *((uint8_t*)pack_buffer->post_buf + index + 30);
                }

                for(int i = 0 ; i < DSO_PACKET_LEN/bit ; i++)
                {
                    memcpy(pack_buffer->post_buf+i*bit,tmp_buf,bit);
                }

                g_safe_free(tmp_buf);
            }

            uint16_t offset;
            uint16_t high_gate,low_gate;
            for(int i = 0 ; i < pack_buffer->post_buf_len; i++)
            {
                if(i % 2 == 0)
                    probe = g_slist_nth(sdi->channels, 0)->data;
                else
                    probe = g_slist_nth(sdi->channels, 1)->data;
                if(!probe->enabled){
                    if(i % 2 == 0)
                        probe = g_slist_nth(sdi->channels, 1)->data;
                    else
                        probe = g_slist_nth(sdi->channels, 0)->data;
                }
                vdiv = probe->vdiv;
                offset = probe->offset;

                uint8_t temp_val = *((uint8_t*)pack_buffer->post_buf + i);

                if(vdiv > SR_mV(200))
                {
                    if(temp_val > DSO_MID_VAL)
                    {
                        val = temp_val - DSO_MID_VAL;
                        tem = val * DSO_DEFAULT_VDIV / vdiv;
                        temp_val = DSO_MID_VAL + tem;
                    }
                    else if(temp_val < DSO_MID_VAL)
                    {
                        val = DSO_MID_VAL - temp_val;
                        tem =  val * DSO_DEFAULT_VDIV / vdiv;
                        temp_val = DSO_MID_VAL - tem;
                    }
                    *((uint8_t*)pack_buffer->post_buf + i) = temp_val;
                }
                else{
                    if(temp_val > DSO_MID_VAL)
                    {
                        val = temp_val - DSO_MID_VAL;
                        tem = (uint16_t)val * (uint16_t)DSO_DEFAULT_VDIV/(uint16_t)vdiv;
                        tem = DSO_EXPAND_MID_VAL(SR_mV(200)/vdiv) + tem;
                    }
                    else if(temp_val < DSO_MID_VAL)
                    {
                        val = DSO_MID_VAL - temp_val;
                        tem =  (uint16_t)val * (uint16_t)DSO_DEFAULT_VDIV/(uint16_t)vdiv;
                        tem =  DSO_EXPAND_MID_VAL(SR_mV(200)/vdiv) - tem;
                    }
                    else{
                        tem =  DSO_EXPAND_MID_VAL(SR_mV(200)/vdiv);
                    }

                    high_gate =  DSO_EXPAND_MID_VAL(SR_mV(200)/vdiv);
                    high_gate -= probe->offset;
                    low_gate = high_gate + DSO_LIMIT;
                    if(tem <=high_gate)
                        tem = DSO_MAX_VAL;
                    else if(tem >=low_gate)
                        tem = DSO_MIN_VAL;
                    else
                        tem-= high_gate;
                    *((uint8_t*)pack_buffer->post_buf + i) = (uint8_t)tem;
                }
            }

            vdev->offset_change = FALSE;
            vdev->timebase_change = FALSE;
            vdev->vdiv_change = FALSE;
        }
    }

    gdouble total_time = vdev->timebase /(gdouble)SR_SEC(1)*(gdouble)10;
    gdouble total_time_elapsed = g_timer_elapsed(run_time, NULL);

    if(!vdev->instant)
    {
        if (total_time_elapsed < total_time)
        {
            gdouble percent = total_time_elapsed / total_time;
            int buf_len = percent* DSO_PACKET_LEN;
            if(buf_len %2 != 0)
                buf_len +=1;
            pack_buffer->post_len = buf_len;
        }
        else
        {
            uint8_t top0;
            uint8_t top1;
            if(vdev->sample_generator == PATTERN_RANDOM)
            {
                top0 = *((uint8_t*)pack_buffer->post_buf + pack_buffer->post_buf_len -2);
                top1 = *((uint8_t*)pack_buffer->post_buf + pack_buffer->post_buf_len -1);
            }
            else
            {
                top0 = *((uint8_t*)pack_buffer->post_buf + get_bit(vdev->timebase) -2);
                top1 = *((uint8_t*)pack_buffer->post_buf + get_bit(vdev->timebase) -1);
            }

            for(int i = pack_buffer->post_len -1; i > 1; i -= 2){
                *((uint8_t*)pack_buffer->post_buf + i) = *((uint8_t*)pack_buffer->post_buf + i - 2);
            }

            for(int i = pack_buffer->post_len -2; i > 0; i -= 2){
                *((uint8_t*)pack_buffer->post_buf + i) = *((uint8_t*)pack_buffer->post_buf + i - 2);
            }

            *(uint8_t*)pack_buffer->post_buf = top0;
            *((uint8_t*)pack_buffer->post_buf + 1)= top1;
            pack_buffer->post_len = DSO_PACKET_LEN;
        }
        
    }
    else
    {
        if(DSO_PACKET_LEN >vdev->post_data_len)
        {
            pack_buffer->post_len = vdev->packet_len;
            vdev->post_data_len += vdev->packet_len;
        }
        else
        {
            bToEnd = 1;
            vdev->instant = FALSE;
        }
    }

    if (pack_buffer->post_len >= byte_align * chan_num && !bToEnd)
    {
        packet.type = SR_DF_DSO;
        packet.payload = &dso;
        dso.probes = sdi->channels;
        dso.mq = SR_MQ_VOLTAGE;
        dso.unit = SR_UNIT_VOLT;
        dso.mqflags = SR_MQFLAG_AC;
        dso.num_samples = pack_buffer->post_len / chan_num;
        if (vdev->instant)
            dso.data = pack_buffer->post_buf+vdev->post_data_len;
        else
            dso.data = pack_buffer->post_buf;
        
        delay_time(vdev);
        g_timer_start(packet_interval);
        // Send data back.
        ds_data_forward(sdi, &packet);
    }

    if (bToEnd || revents == -1)
    {
        packet.type = SR_DF_END;
        ds_data_forward(sdi, &packet);
        sr_session_source_remove(-1);
    }

    return TRUE;
}


static int receive_data_analog(int fd, int revents, const struct sr_dev_inst *sdi)
{
    struct session_vdev *vdev = sdi->priv;
    struct sr_datafeed_packet packet;
    struct sr_datafeed_analog analog;
    struct sr_channel *probe = NULL;

    char file_name[32];
    int ret;

    assert(sdi);
    assert(sdi->priv);

    (void)fd;
    (void)revents;

    sr_detail("Feed chunk.");

    packet.status = SR_PKT_OK;

    assert(vdev->unit_bits > 0);

    g_timer_start(packet_interval);

    if(vdev->load_data)
    {
        if(vdev->sample_generator != PATTERN_RANDOM)
        {
            vdev->analog_buf_len = 0;

            void* analog_data = g_try_malloc0(ANALOG_DATA_LEN_PER_CYCLE);
            if(analog_data == NULL)
            {
                sr_err("%s:analog_data malloc failed",__func__);
                return SR_ERR_MALLOC;
            }

            snprintf(file_name, sizeof(file_name)-1, "%s-%d/%d", "A",
                         0, 0);

            if (unzLocateFile(vdev->archive, file_name, 0) != UNZ_OK)
            {
                sr_err("can't locate zip inner file:\"%s\"", file_name);
                send_error_packet(sdi, vdev, &packet);
                return FALSE;
            }
            if (unzOpenCurrentFile(vdev->archive) != UNZ_OK)
            {
                sr_err("can't open zip inner file:\"%s\"", file_name);
                send_error_packet(sdi, vdev, &packet);
                return FALSE;
            }

            ret = unzReadCurrentFile(vdev->archive, analog_data, ANALOG_DATA_LEN_PER_CYCLE);
            if (-1 == ret)
            {
                sr_err("read zip inner file error:\"%s\"", file_name);
                send_error_packet(sdi, vdev, &packet);
                return FALSE;
            }

            uint64_t total_buf_len = ANALOG_CYCLE_RATIO * vdev->total_samples * ANALOG_PROBE_NUM;
            if(total_buf_len % ANALOG_DATA_LEN_PER_CYCLE != 0)
            {
                total_buf_len = total_buf_len / ANALOG_DATA_LEN_PER_CYCLE * ANALOG_DATA_LEN_PER_CYCLE;
            }

            if(vdev->analog_buf != NULL)
            {
                g_safe_free(vdev->analog_buf);
                vdev->analog_buf = NULL;
            }
            vdev->analog_buf = (g_try_malloc0(total_buf_len));
            if (vdev->analog_buf == NULL)
            {
                sr_err("%s: vdev->analog_buf malloc failed", __func__);
                return SR_ERR_MALLOC;
            }
            vdev->analog_buf_len = total_buf_len;
            uint64_t per_block_after_expend = total_buf_len / ANALOG_DATA_LEN_PER_CYCLE;

            probe = g_slist_nth(sdi->channels, 0)->data;
            uint64_t p0_vdiv = probe->vdiv;
            probe = g_slist_nth(sdi->channels, 1)->data;
            uint64_t p1_vdiv = probe->vdiv;
            uint64_t vdiv;
            uint8_t val = 0;
            uint16_t tem;
            uint64_t cur_l = 0;
            for(int i = 0 ; i < ANALOG_DATA_LEN_PER_CYCLE;i++)
            {
                if(i % 2 == 0)
                    vdiv = p0_vdiv;
                else
                    vdiv = p1_vdiv;
                tem = 0;

                uint8_t temp_value = *((uint8_t*)analog_data + i);

                if(temp_value > ANALOG_MID_VAL){
                    val = temp_value - ANALOG_MID_VAL;
                    tem = val * ANALOG_DEFAULT_VDIV / vdiv;
                    if(tem >= ANALOG_MID_VAL)
                        temp_value = ANALOG_MIN_VAL;
                    else
                        temp_value = ANALOG_MID_VAL + tem;
                }
                else if(temp_value < ANALOG_MID_VAL)
                {
                    val = ANALOG_MID_VAL - temp_value;
                    tem =  val * ANALOG_DEFAULT_VDIV / vdiv;

                    if(tem >= ANALOG_MID_VAL)
                        temp_value = ANALOG_MAX_VAL;
                    else
                        temp_value = ANALOG_MID_VAL - tem;
                }

                for(int j = 0 ; j <per_block_after_expend ;j++)
                {
                    if(i % 2 == 0)
                    {
                        cur_l = i * per_block_after_expend + j * 2;
                    }
                    else
                    {
                        cur_l = 1 + (i - 1) * per_block_after_expend + j * 2;
                    }
                    memset(vdev->analog_buf + cur_l,temp_value,1);
                }
            }
            g_safe_free(analog_data);
        }
        vdev->load_data = FALSE;
    }

    void* buf = g_try_malloc0(vdev->packet_len);
    if(buf == NULL)
    {
        sr_err("%s: buf malloc failed", __func__);
        return SR_ERR_MALLOC;
    }
    if(vdev->analog_read_pos + vdev->packet_len >= vdev->analog_buf_len - 1 )
    {
        uint64_t back_len = vdev->analog_buf_len - vdev->analog_read_pos;
        for (int i = 0; i < back_len; i++)
        {
            uint8_t temp_val = *((uint8_t*)vdev->analog_buf + vdev->analog_read_pos + i);
            memset(buf + i,temp_val,1);
        }

        uint64_t front_len = vdev->packet_len - back_len;
        for (int i = 0; i < front_len; i++)
        {
            uint8_t temp_val = *((uint8_t*)vdev->analog_buf + i);
            memset(buf + back_len + i,temp_val,1);
        }
        vdev->analog_read_pos = front_len;
    }
    else
    {
        memcpy(buf,vdev->analog_buf + vdev->analog_read_pos,vdev->packet_len);
        vdev->analog_read_pos += vdev->packet_len;
    }

    packet.type = SR_DF_ANALOG;
    packet.payload = &analog;
    analog.probes = sdi->channels;
    analog.num_samples = vdev->packet_len / vdev->num_probes;
    analog.unit_bits = vdev->unit_bits;
    analog.mq = SR_MQ_VOLTAGE;
    analog.unit = SR_UNIT_VOLT;
    analog.mqflags = SR_MQFLAG_AC;
    analog.data = buf;

    delay_time(vdev);
    ds_data_forward(sdi, &packet);
    g_safe_free(buf);

    return TRUE;
}

static void send_error_packet(const struct sr_dev_inst *cb_sdi, struct session_vdev *vdev, struct sr_datafeed_packet *packet)
{
    packet->type = SR_DF_END;
    packet->status = SR_PKT_SOURCE_ERROR;
    ds_data_forward(cb_sdi, packet);
    sr_session_source_remove(-1);
    close_archive(vdev);
}


static int close_archive(struct session_vdev *vdev)
{
    if(vdev->sample_generator != PATTERN_RANDOM)
    {
        assert(vdev->archive);

        // close current inner file
        if (vdev->capfile)
        {
            unzCloseCurrentFile(vdev->archive);
            vdev->capfile = 0;
        }

        int ret = unzClose(vdev->archive);
        if (ret != UNZ_OK)
        {
            sr_err("close zip archive error!");
        }

        vdev->archive = NULL;
    }

    return SR_OK;
}

static int load_virtual_device_session(struct sr_dev_inst *sdi)
{
    GKeyFile *kf;
    unzFile archive = NULL;
    char szFilePath[15];
    unz_file_info64 fileInfo;

    struct sr_channel *probe;
    int devcnt, i, j;
    uint64_t tmp_u64, total_probes, enabled_probes;
    char **sections, **keys, *metafile, *val,*probe_name;
    int mode = LOGIC;
    int channel_type = SR_CHANNEL_LOGIC;
    int version = 1;

    struct session_vdev * vdev = sdi->priv;

    assert(sdi);
    if (vdev->sample_generator != PATTERN_RANDOM)
    {
        assert(sdi->path);
    }
        
    switch (sdi->mode)
    {
    case LOGIC:
        if(vdev->sample_generator != PATTERN_RANDOM){
            archive = unzOpen64(sdi->path);
            if (NULL == archive)
            {
                sr_err("%s: Load zip file error.", __func__);
                return SR_ERR;
            }
            if (unzLocateFile(archive, "header", 0) != UNZ_OK)
            {
                unzClose(archive);
                sr_err("%s: unzLocateFile error.", __func__);
                return SR_ERR;
            }
            if (unzGetCurrentFileInfo64(archive, &fileInfo, szFilePath,
                                        sizeof(szFilePath), NULL, 0, NULL, 0) != UNZ_OK)
            {
                unzClose(archive);
                sr_err("%s: unzGetCurrentFileInfo64 error.", __func__);
                return SR_ERR;
            }
            if (unzOpenCurrentFile(archive) != UNZ_OK)
            {
                sr_err("%s: Cant't open zip inner file.", __func__);
                unzClose(archive);
                return SR_ERR;
            }

            if (!(metafile = g_try_malloc(fileInfo.uncompressed_size)))
            {
                sr_err("%s: metafile malloc failed", __func__);
                return SR_ERR_MALLOC;
            }

            unzReadCurrentFile(archive, metafile, fileInfo.uncompressed_size);
            unzCloseCurrentFile(archive);

            if (unzClose(archive) != UNZ_OK)
            {
                sr_err("%s: Close zip archive error.", __func__);
                return SR_ERR;
            }
            archive = NULL;

            kf = g_key_file_new();
            if (!g_key_file_load_from_data(kf, metafile, fileInfo.uncompressed_size, 0, NULL))
            {
                sr_err("Failed to parse metadata.");
                return SR_ERR;
            }

            devcnt = 0;
            sections = g_key_file_get_groups(kf, NULL);

            for (i = 0; sections[i]; i++)
            {
                if (!strcmp(sections[i], "version"))
                {
                    keys = g_key_file_get_keys(kf, sections[i], NULL, NULL);
                    for (j = 0; keys[j]; j++)
                    {
                        val = g_key_file_get_string(kf, sections[i], keys[j], NULL);
                        if (!strcmp(keys[j], "version"))
                        {
                            version = strtoull(val, NULL, 10);
                            sr_info("The 'header' file format version:%d", version);
                        }
                    }
                }

                if (!strncmp(sections[i], "header", 6))
                {
                    enabled_probes = total_probes = 0;
                    keys = g_key_file_get_keys(kf, sections[i], NULL, NULL);

                    for (j = 0; keys[j]; j++)
                    {
                        val = g_key_file_get_string(kf, sections[i], keys[j], NULL);

                        if (!strcmp(keys[j], "device mode"))
                        {
                            mode = strtoull(val, NULL, 10);
                        }
                        else if (!strcmp(keys[j], "samplerate"))
                        {
                            sr_parse_sizestring(val, &tmp_u64);
                            vdev->samplerate = tmp_u64;
                            if(sdi->mode == LOGIC && vdev->sample_generator >PATTERN_RANDOM)
                            {
                                samplerates_file[0] = vdev->samplerate;
                            }
                        }
                        else if (!strcmp(keys[j], "total samples"))
                        {
                            tmp_u64 = strtoull(val, NULL, 10);
                            vdev->total_samples = tmp_u64;
                            if(sdi->mode == LOGIC && vdev->sample_generator >PATTERN_RANDOM)
                            {
                                samplecounts_file[0] = vdev->total_samples;
                            }
                        }
                        else if (!strcmp(keys[j], "total blocks"))
                        {
                            tmp_u64 = strtoull(val, NULL, 10);
                            vdev->num_blocks = tmp_u64;
                        }
                        else if (!strcmp(keys[j], "total probes"))
                        {
                            sr_dev_probes_free(sdi);
                            total_probes = strtoull(val, NULL, 10);
                            vdev->num_probes = total_probes;
                        }
                        else if (!strncmp(keys[j], "probe", 5))
                        {
                            enabled_probes++;
                            tmp_u64 = strtoul(keys[j] + 5, NULL, 10);
                            channel_type = (mode == DSO) ? SR_CHANNEL_DSO : (mode == ANALOG) ? SR_CHANNEL_ANALOG
                                                                                            : SR_CHANNEL_LOGIC;
                            if (!(probe = sr_channel_new(tmp_u64, channel_type, TRUE, val)))
                            {
                                sr_err("%s: create channel failed", __func__);
                                sr_dev_inst_free(sdi);
                                return SR_ERR;
                            }

                            sdi->channels = g_slist_append(sdi->channels, probe);
                        }
                    }
                    adjust_samplerate(sdi);
                    g_strfreev(keys);
                }
                devcnt++;
            }

            g_strfreev(sections);
            g_key_file_free(kf);
            g_safe_free(metafile);
        }
        else
        {
            vdev->samplerate = LOGIC_DEFAULT_SAMPLERATE;
            vdev->total_samples = LOGIC_DEFAULT_TOTAL_SAMPLES;
            vdev->num_probes = logic_channel_modes[vdev->logic_ch_mode_index].num;
            sr_dev_probes_free(sdi);

            for (int i = 0; i < vdev->num_probes; i++)
            {
                probe_name = probe_names[i];
                if (!(probe = sr_channel_new(i, SR_CHANNEL_LOGIC, TRUE, probe_name)))
                {
                    sr_err("%s: create channel failed", __func__);
                    sr_dev_inst_free(sdi);
                    return SR_ERR;
                }
                sdi->channels = g_slist_append(sdi->channels, probe);
            }
            logic_adjust_samplerate(sdi->priv);
        }
        break;
    case DSO:
        vdev->samplerate = DSO_DEFAULT_SAMPLERATE;
        vdev->total_samples = DSO_DEFAULT_TOTAL_SAMPLES;
        vdev->num_probes = DSO_DEFAULT_NUM_PROBE;
        vdev->num_blocks = DSO_DEFAULT_NUM_BLOCK;
        sr_dev_probes_free(sdi);

        for (int i = 0; i < DSO_DEFAULT_NUM_PROBE; i++)
        {
            probe_name = probe_names[i];
            if (!(probe = sr_channel_new(i, SR_CHANNEL_DSO, TRUE, probe_name)))
            {
                sr_err("%s: create channel failed", __func__);
                sr_dev_inst_free(sdi);
                return SR_ERR;
            }
            probe->enabled = DSO_DEFAULT_ENABLE;
            probe->coupling = DSO_DEFAULT_COUPLING;
            probe->vdiv = DSO_DEFAULT_VIDV;
            probe->vfactor = DSO_DEFAULT_VFACOTR;
            probe->hw_offset = DSO_DEFAULT_HW_OFFSET;
            probe->offset = DSO_DEFAULT_OFFSET;
            probe->trig_value = DSO_DEFAULT_TRIG_VAL;
            sdi->channels = g_slist_append(sdi->channels, probe);
        }
        adjust_samplerate(sdi);
        break;
    case ANALOG:
        vdev->samplerate = ANALOG_DEFAULT_SAMPLERATE;
        vdev->total_samples = ANALOG_DEFAULT_TOTAL_SAMPLES;
        vdev->num_probes = ANALOG_DEFAULT_NUM_PROBE;
        vdev->num_blocks = ANALOG_DEFAULT_NUM_BLOCK;
        sr_dev_probes_free(sdi);
        
        for (int i = 0; i < ANALOG_DEFAULT_NUM_PROBE; i++)
        {
            probe_name = probe_names[i];
            if (!(probe = sr_channel_new(i, SR_CHANNEL_ANALOG, TRUE, probe_name)))
            {
                sr_err("%s: create channel failed", __func__);
                sr_dev_inst_free(sdi);
                return SR_ERR;
            }
            probe->bits = ANALOG_DEFAULT_BIT;
            probe->enabled = ANALOG_DEFAULT_ENABLE;
            probe->coupling = ANALOG_DEFAULT_COUPLING;
            probe->vdiv = ANALOG_DEFAULT_VIDV;
            probe->vfactor = ANALOG_DEFAULT_VFACOTR;
            probe->hw_offset = ANALOG_DEFAULT_HW_OFFSET;
            probe->offset = ANALOG_DEFAULT_OFFSET;
            probe->trig_value = ANALOG_DEFAULT_TRIG_VAL;
            probe->map_default = ANALOG_DEFAULT_MAP_DEFAULT;
            probe->map_unit = ANALOG_DEFAULT_MAP_UNIT;
            probe->map_min =  ANALOG_DEFAULT_MAP_MIN;
            probe->map_max = ANALOG_DEFAULT_MAP_MAX;

            sdi->channels = g_slist_append(sdi->channels, probe);
        }
        adjust_samplerate(sdi);
        break;
    default:
        break;
    }
    return SR_OK;
}


SR_PRIV struct sr_dev_driver demo_driver_info = {
    .name = "virtual-demo",
    .longname = "Demo driver and pattern generator",
    .api_version = 1,
    .driver_type = DRIVER_TYPE_DEMO,
    .init = hw_init,
    .cleanup = NULL,
    .scan = hw_scan,
    .dev_mode_list = hw_dev_mode_list,
    .config_get = config_get,
    .config_set = config_set,
    .config_list = config_list,
    .dev_open = hw_dev_open,
    .dev_close = hw_dev_close,
    .dev_destroy = dev_destroy,
    .dev_status_get = hw_dev_status_get,
    .dev_acquisition_start = hw_dev_acquisition_start,
    .dev_acquisition_stop = hw_dev_acquisition_stop,
    .priv = NULL,
};