2536 lines
77 KiB
C
Raw Normal View History

2014-01-15 19:48:01 +08:00
/*
* 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
*/
2018-07-08 17:48:18 +08:00
#include "demo.h"
2022-07-14 13:50:40 +08:00
#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: "
2014-01-15 19:48:01 +08:00
/* The size of chunks to send through the session bus. */
/* TODO: Should be configurable. */
#define BUFSIZE 512*1024
#define DSO_BUFSIZE 10*1024
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
static struct DEMO_channels channel_modes_f[] = {
2022-10-27 17:22:55 +08:00
// LA Stream
{DEMO_LOGIC100x16, LOGIC, SR_CHANNEL_LOGIC, 16, 1, SR_MHZ(1), SR_Mn(1),
SR_KHZ(10), SR_MHZ(100), "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),
2023-05-04 10:46:56 +08:00
SR_HZ(100), SR_MHZ(200), "Use Channels 0~1 (Max 200MHz)"},
2022-10-27 17:22:55 +08:00
};
2014-01-15 19:48:01 +08:00
/* 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;
2023-05-04 10:46:56 +08:00
2014-01-15 19:48:01 +08:00
extern struct ds_trigger *trigger;
2023-05-04 10:46:56 +08:00
static int 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_free(pattern_strings_logic[i]);
pattern_strings_logic[i] =NULL;
}
}
}
if(pattern_dso_count != 1)
{
for(i = 1 ;i < pattern_dso_count ; i++)
{
if(pattern_strings_dso[i] != NULL)
{
2023-05-04 10:55:04 +08:00
g_free(pattern_strings_dso[i]);
2023-05-04 10:46:56 +08:00
pattern_strings_dso[i] =NULL;
}
}
}
if(pattern_analog_count != 1)
{
for(i = 1 ;i < pattern_analog_count ; i++)
{
if(pattern_strings_analog[i] != NULL)
{
g_free(pattern_strings_analog[i]);
pattern_strings_analog[i] =NULL;
}
}
}
}
static int get_pattern_mode_index_by_string(uint8_t device_mode , const char* str)
2014-01-15 19:48:01 +08:00
{
2023-05-04 10:46:56 +08:00
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++;
}
}
return index;
2014-01-15 19:48:01 +08:00
}
2023-05-04 10:46:56 +08:00
static int scan_dsl_file(struct sr_dev_inst *sdi)
2018-07-08 17:48:18 +08:00
{
2023-05-04 10:46:56 +08:00
unzFile archive = NULL;
unz_file_info64 fileInfo;
char szFilePath[15];
char **sections, **keys, *metafile, *val;
GKeyFile *kf;
int ret, devcnt, i, j;
int mode = LOGIC;
gboolean get_mode = FALSE;
char dir_str[500];
const gchar * filename = NULL;
init_pattern_mode_list();
strcpy(dir_str,DS_RES_PATH);
strcat(dir_str,"demo/");
GDir *dir = NULL;
dir = g_dir_open(dir_str,0,NULL);
if(dir == NULL)
{
return;
}
2018-07-08 17:48:18 +08:00
2023-05-04 10:46:56 +08:00
int logic_index = 1;
int dso_index = 1;
int analog_index = 1;
while ((filename = g_dir_read_name(dir)) != NULL)
{
if (FALSE == g_file_test(filename,G_FILE_TEST_IS_DIR))
{
get_mode = FALSE;
if(strstr(filename,".dsl") != NULL)
{
char file_path_str[500] = "";
strcat(file_path_str,dir_str);
strcat(file_path_str,filename);
char *tmp_file_name = g_try_malloc0(20);
if(tmp_file_name == NULL)
{
sr_err("%s: pattern mode string malloc error.", __func__);
return SR_ERR_MALLOC;
}
archive = unzOpen64(file_path_str);
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;
}
2018-07-08 17:48:18 +08:00
2023-05-04 10:46:56 +08:00
unzReadCurrentFile(archive, metafile, fileInfo.uncompressed_size);
unzCloseCurrentFile(archive);
2018-07-08 17:48:18 +08:00
2023-05-04 10:46:56 +08:00
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;
}
sections = g_key_file_get_groups(kf, NULL);
for (i = 0; sections[i]; i++)
{
if (!strncmp(sections[i], "header", 6))
{
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);
get_mode = TRUE;
break;
}
}
}
if (get_mode)
{
break;
}
}
2018-07-08 17:48:18 +08:00
2023-05-04 10:46:56 +08:00
if(mode == LOGIC)
{
if(logic_index == 99)
continue;
else
{
snprintf(tmp_file_name, strlen(filename)-strlen(".dsl")+1 , "%s", filename);
pattern_strings_logic[logic_index] = tmp_file_name;
logic_index++;
pattern_logic_count++;
}
}
else if(mode == DSO)
{
if(dso_index == 99)
continue;
else
{
snprintf(tmp_file_name, strlen(filename)-strlen(".dsl")+1, "%s", filename);
pattern_strings_dso[dso_index] = tmp_file_name;
dso_index++;
pattern_dso_count++;
}
}
else
{
if(analog_index == 99)
continue;
else
{
snprintf(tmp_file_name, strlen(filename)-strlen(".dsl")+1, "%s", filename);
pattern_strings_analog[analog_index] = tmp_file_name;
analog_index++;
pattern_analog_count++;
}
}
}
}
}
g_dir_close(dir);
//至少有一个协议文件,则设置第一个文件为默认
if (logic_index > 1)
{
cur_sample_generator = pre_sample_generator = PATTERN_DEFAULT;
strcat(dir_str,pattern_strings_logic[1]);
strcat(dir_str,".dsl");
sdi->mode = LOGIC;
sdi->path = g_strdup(dir_str);
}
else
{
cur_sample_generator = pre_sample_generator = PATTERN_RANDOM;
sdi->mode = LOGIC;
sdi->path = g_strdup("");
}
2018-07-08 17:48:18 +08:00
}
2023-05-04 10:46:56 +08:00
//通过信号模式索引获取文件名
static char* get_dsl_path_by_pattern_mode(uint8_t device_mode , uint8_t pattern_mode)
{
2023-05-04 10:46:56 +08:00
unzFile archive = NULL;
int index = -1;
char *str = g_try_malloc0(500);
strcpy(str,DS_RES_PATH);
strcat(str,"demo/");
if (pattern_mode != PATTERN_RANDOM)
{
switch (device_mode)
{
case LOGIC:
if(NULL != pattern_strings_logic[pattern_mode])
{
strcat(str,pattern_strings_logic[pattern_mode]);
}
break;
case DSO:
if(NULL != pattern_strings_dso[pattern_mode])
{
strcat(str,pattern_strings_dso[pattern_mode]);
}
break;
case ANALOG:
if(NULL != pattern_strings_analog[pattern_mode])
{
strcat(str,pattern_strings_analog[pattern_mode]);
}
break;
default:
break;
}
strcat(str,".dsl");
}
if(pattern_mode != PATTERN_RANDOM)
{
//检查文件是否有效
archive = unzOpen64(str);
if (NULL != archive)
{
return str;
}
else
{
return "";
}
}
else
{
return NULL;
}
}
2023-05-04 10:46:56 +08:00
static void adjust_samplerate(struct sr_dev_inst *sdi)
{
2023-05-04 10:46:56 +08:00
if(sdi->mode == LOGIC && cur_sample_generator > PATTERN_RANDOM)
{
return;
}
2023-05-04 10:46:56 +08:00
struct session_vdev *vdev = sdi->priv;
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_f[cur_mode].max_samplerate)
vdev->samplerates_max_index--;
vdev->samplerates_min_index = 0;
while (samplerates[vdev->samplerates_min_index] <
channel_modes_f[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];
}
//初始化random数据
static int init_random_data(struct session_vdev * vdev)
{
uint8_t random_val;
if(vdev->logic_buf != NULL)
{
g_free(vdev->logic_buf);
}
2023-05-04 10:46:56 +08:00
if(!(vdev->logic_buf = g_try_malloc0(SR_MB(10))))
{
return SR_ERR;
}
vdev->logic_buf_len = SR_MB(10);
for(int i = 0 ; i < vdev->logic_buf_len ;i++)
{
random_val = abs(rand())%256;
if(random_val >= 128)
{
*(uint8_t*)(vdev->logic_buf + i) = (uint8_t)255;
}
else
{
*(uint8_t*)(vdev->logic_buf + i) = (uint8_t)0;
}
}
return;
}
static int hw_init(struct sr_context *sr_ctx)
{
return std_hw_init(sr_ctx, di, LOG_PREFIX);
}
2014-01-15 19:48:01 +08:00
static GSList *hw_scan(GSList *options)
{
struct sr_dev_inst *sdi;
2023-05-04 10:46:56 +08:00
struct session_vdev *vdev;
2014-01-15 19:48:01 +08:00
GSList *devices;
2023-05-04 10:46:56 +08:00
char str[500];
2014-01-15 19:48:01 +08:00
(void)options;
devices = NULL;
2022-07-28 16:57:15 +08:00
sr_info("%s", "Scan demo device.");
2023-05-04 10:46:56 +08:00
vdev = g_try_malloc0(sizeof(struct session_vdev));
if (vdev == NULL)
{
sr_err("%s: sdi->priv malloc failed", __func__);
return SR_ERR_MALLOC;
2018-07-08 17:48:18 +08:00
}
2023-05-04 10:46:56 +08:00
sdi = sr_dev_inst_new(LOGIC, SR_ST_INACTIVE,
supported_Demo[0].vendor,
supported_Demo[0].model,
supported_Demo[0].model_version);
2014-01-15 19:48:01 +08:00
if (!sdi) {
2023-05-04 10:46:56 +08:00
g_free(vdev);
2014-01-15 19:48:01 +08:00
sr_err("Device instance creation failed.");
return NULL;
}
2023-05-04 10:46:56 +08:00
sdi->priv = vdev;
2014-01-15 19:48:01 +08:00
sdi->driver = di;
2022-07-28 16:57:15 +08:00
sdi->dev_type = DEV_TYPE_DEMO;
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
devices = g_slist_append(devices, sdi);
2014-01-15 19:48:01 +08:00
return devices;
}
2018-07-08 17:48:18 +08:00
static const GSList *hw_dev_mode_list(const struct sr_dev_inst *sdi)
2014-09-24 18:43:42 +08:00
{
2023-05-04 10:46:56 +08:00
// struct demo_context *devc;
2014-09-24 18:43:42 +08:00
GSList *l = NULL;
2017-05-23 22:39:00 +08:00
unsigned int i;
2014-09-24 18:43:42 +08:00
2022-07-26 15:45:46 +08:00
for (i = 0; i < ARRAY_SIZE(sr_mode_list); i++) {
2023-05-04 10:46:56 +08:00
// if (devc->profile->dev_caps.mode_caps & (1 << i))
if (supported_Demo[0].dev_caps.mode_caps & (1 << i))
2022-07-26 15:45:46 +08:00
l = g_slist_append(l, &sr_mode_list[i]);
2014-09-24 18:43:42 +08:00
}
return l;
}
2014-01-15 19:48:01 +08:00
static int hw_dev_open(struct sr_dev_inst *sdi)
{
2023-05-04 10:46:56 +08:00
int ret;
assert(sdi);
assert(sdi->priv);
2023-05-04 10:46:56 +08:00
if (sdi->status == SR_ST_ACTIVE){
return SR_OK;
2023-05-04 10:46:56 +08:00
}
//扫描目录文件
scan_dsl_file(sdi);
struct session_vdev* vdev = sdi->priv;
vdev->trig_pos = 0;
vdev->trig_time = 0;
vdev->cur_block = 0;
vdev->cur_channel = 0;
vdev->cur_probes = 0;
vdev->num_blocks = 0;
if(sdi->mode == LOGIC)
{
vdev->unit_bits = 1;
}
else
{
vdev->unit_bits = 8;
}
2023-05-04 10:46:56 +08:00
//固定值
vdev->ref_min = 1;
vdev->ref_max = 255;
2023-05-04 10:46:56 +08:00
vdev->timebase = SR_NS(500);
vdev->max_timebase = MAX_TIMEBASE;
vdev->min_timebase = MIN_TIMEBASE;
vdev->mstatus.measure_valid = TRUE;
vdev->archive = NULL;
vdev->capfile = 0;
vdev->packet_buffer = NULL;
vdev->logic_buf = NULL;
sdi->status = SR_ST_ACTIVE;
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
packet_interval = g_timer_new();
2023-05-04 13:57:29 +08:00
run_time = g_timer_new();
2023-05-04 10:46:56 +08:00
//这个可以再看下怎么改
init_random_data(vdev);
ret = load_virtual_device_session(sdi);
if (ret != SR_OK)
{
sr_err("%s", "Error!Load session file failed.");
return ret;
}
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
return SR_OK;
2014-01-15 19:48:01 +08:00
}
static int hw_dev_close(struct sr_dev_inst *sdi)
{
2023-05-04 10:46:56 +08:00
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_free(pack_buf->block_bufs[i]);
pack_buf->block_bufs[i] = NULL;
}
else{
break;
}
}
}
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
g_safe_free(vdev->packet_buffer);
//数据
g_safe_free(vdev->logic_buf);
g_safe_free(vdev->analog_buf);
g_safe_free(sdi->path);
2023-05-04 13:57:29 +08:00
//不释放也可以?
// g_timer_destroy(packet_interval);
// g_timer_destroy(run_time);
2023-05-04 10:46:56 +08:00
sdi->status = SR_ST_INACTIVE;
return SR_OK;
}
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
return SR_ERR_CALL_STATUS;
2014-01-15 19:48:01 +08:00
}
2022-07-28 16:57:15 +08:00
static int dev_destroy(struct sr_dev_inst *sdi)
{
2023-05-04 10:46:56 +08:00
assert(sdi);
2022-07-28 16:57:15 +08:00
hw_dev_close(sdi);
2023-05-04 10:46:56 +08:00
sdi->path = NULL;
2022-07-28 16:57:15 +08:00
sr_dev_inst_free(sdi);
2014-01-15 19:48:01 +08:00
}
2014-09-24 18:43:42 +08:00
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)
2014-01-15 19:48:01 +08:00
{
2023-05-04 10:46:56 +08:00
(void)cg;
2022-09-29 15:50:37 +08:00
assert(sdi);
assert(sdi->priv);
2023-05-04 10:46:56 +08:00
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;
2014-01-15 19:48:01 +08:00
case SR_CONF_DEVICE_MODE:
2014-09-24 18:43:42 +08:00
*data = g_variant_new_int16(sdi->mode);
2014-01-15 19:48:01 +08:00
break;
2023-05-04 10:46:56 +08:00
case SR_CONF_DEMO_CHANGE:
*data = g_variant_new_boolean(is_change);
2015-04-17 00:21:14 +08:00
break;
case SR_CONF_INSTANT:
2023-05-04 10:46:56 +08:00
*data = g_variant_new_boolean(instant);
break;
2014-01-15 19:48:01 +08:00
case SR_CONF_PATTERN_MODE:
2023-05-04 10:46:56 +08:00
if(sdi->mode == LOGIC)
*data = g_variant_new_string(pattern_strings_logic[cur_sample_generator]);
else if(sdi->mode == DSO)
*data = g_variant_new_string(pattern_strings_dso[cur_sample_generator]);
else
*data = g_variant_new_string(pattern_strings_analog[cur_sample_generator]);
break;
case SR_CONF_MAX_HEIGHT:
2023-05-04 10:46:56 +08:00
*data = g_variant_new_string(maxHeights[vdev->max_height]);
break;
case SR_CONF_MAX_HEIGHT_VALUE:
2023-05-04 10:46:56 +08:00
*data = g_variant_new_byte(vdev->max_height);
break;
2019-09-09 00:07:19 -07:00
case SR_CONF_PROBE_OFFSET:
2023-05-04 10:46:56 +08:00
if (ch)
*data = g_variant_new_uint16(ch->offset);
2019-09-09 00:07:19 -07:00
break;
case SR_CONF_PROBE_HW_OFFSET:
2023-05-04 10:46:56 +08:00
if (ch)
*data = g_variant_new_uint16(ch->hw_offset);
2015-11-04 00:27:42 +08:00
break;
case SR_CONF_PROBE_VDIV:
2023-05-04 10:46:56 +08:00
if (ch)
*data = g_variant_new_uint64(ch->vdiv);
2014-06-29 19:27:43 +08:00
break;
case SR_CONF_PROBE_FACTOR:
2023-05-04 10:46:56 +08:00
if (ch)
*data = g_variant_new_uint64(ch->vfactor);
break;
2014-06-29 19:27:43 +08:00
case SR_CONF_TIMEBASE:
2023-05-04 10:46:56 +08:00
*data = g_variant_new_uint64(vdev->timebase);
2014-06-29 19:27:43 +08:00
break;
2018-07-08 17:48:18 +08:00
case SR_CONF_MAX_TIMEBASE:
*data = g_variant_new_uint64(MAX_TIMEBASE);
break;
2019-11-24 00:17:48 -08:00
case SR_CONF_MIN_TIMEBASE:
*data = g_variant_new_uint64(MIN_TIMEBASE);
break;
case SR_CONF_PROBE_COUPLING:
2023-05-04 10:46:56 +08:00
if (ch)
*data = g_variant_new_byte(ch->coupling);
2014-06-29 19:27:43 +08:00
break;
case SR_CONF_TRIGGER_VALUE:
2023-05-04 10:46:56 +08:00
if (ch)
*data = g_variant_new_byte(ch->trig_value);
break;
case SR_CONF_PROBE_EN:
2023-05-04 10:46:56 +08:00
if (ch)
*data = g_variant_new_boolean(ch->enabled);
2014-06-29 19:27:43 +08:00
break;
2015-04-17 00:21:14 +08:00
case SR_CONF_MAX_DSO_SAMPLERATE:
2023-05-04 10:46:56 +08:00
*data = g_variant_new_uint64(SR_MHZ(200));
2015-04-17 00:21:14 +08:00
break;
case SR_CONF_MAX_DSO_SAMPLELIMITS:
2023-05-04 10:46:56 +08:00
*data = g_variant_new_uint64(SR_Kn(20));
2015-04-17 00:21:14 +08:00
break;
case SR_CONF_HW_DEPTH:
2023-05-04 10:46:56 +08:00
if(sdi->mode == DSO || (sdi->mode == LOGIC && cur_sample_generator != PATTERN_RANDOM))
{
*data = g_variant_new_uint64(vdev->total_samples);
}
else if(sdi->mode == ANALOG)
{
*data = g_variant_new_uint64(SR_MHZ(12.5));
}
else
{
*data = g_variant_new_uint64(SR_MHZ(100));
}
break;
case SR_CONF_UNIT_BITS:
2023-05-04 10:46:56 +08:00
*data = g_variant_new_byte(vdev->unit_bits);
break;
2019-09-09 00:07:19 -07:00
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);
2016-06-25 09:58:07 +08:00
break;
case SR_CONF_VLD_CH_NUM:
2023-05-04 10:46:56 +08:00
*data = g_variant_new_int16(vdev->num_probes);
2018-07-08 17:48:18 +08:00
break;
case SR_CONF_HAVE_ZERO:
2023-05-04 10:46:56 +08:00
break;
case SR_CONF_LOAD_DECODER:
*data = g_variant_new_boolean(cur_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;
default:
2023-05-04 10:46:56 +08:00
return SR_ERR_NA;
}
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
return SR_OK;
2014-01-15 19:48:01 +08:00
}
2014-09-24 18:43:42 +08:00
static int config_set(int id, GVariant *data, struct sr_dev_inst *sdi,
struct sr_channel *ch,
2017-05-23 22:39:00 +08:00
struct sr_channel_group *cg)
2014-01-15 19:48:01 +08:00
{
2023-05-04 10:46:56 +08:00
(void)cg;
2022-09-29 15:50:37 +08:00
2023-05-04 10:46:56 +08:00
struct session_vdev *vdev;
const char *stropt;
unsigned int i;
2014-09-24 18:43:42 +08:00
2022-09-29 15:50:37 +08:00
assert(sdi);
assert(sdi->priv);
2023-05-04 10:46:56 +08:00
vdev = sdi->priv;
switch (id)
{
case SR_CONF_SAMPLERATE:
vdev->samplerate = g_variant_get_uint64(data);
if(sdi->mode == LOGIC && cur_sample_generator >PATTERN_RANDOM)
{
samplerates_file[0] = vdev->samplerate;
}
sr_dbg("Setting samplerate to %llu.", vdev->samplerate);
break;
case SR_CONF_LIMIT_SAMPLES:
vdev->total_samples = g_variant_get_uint64(data);
if(sdi->mode == LOGIC && cur_sample_generator >PATTERN_RANDOM)
{
samplecounts_file[0] = vdev->total_samples;
}
sr_dbg("Setting limit samples to %llu.", vdev->total_samples);
break;
case SR_CONF_LIMIT_MSEC:
break;
case SR_CONF_DEVICE_MODE:
2014-09-24 18:43:42 +08:00
sdi->mode = g_variant_get_int16(data);
2023-05-04 10:46:56 +08:00
//恢复默认信号模式
switch (sdi->mode)
{
case LOGIC:
//默认为第一个协议模式(后面添加枚举)
if("" != get_dsl_path_by_pattern_mode(sdi->mode,PATTERN_DEFAULT))
{
cur_sample_generator = pre_sample_generator = PATTERN_DEFAULT;
sdi->path = g_strdup(get_dsl_path_by_pattern_mode(sdi->mode,PATTERN_DEFAULT));
}
//没有第一个协议
else
{
cur_sample_generator = pre_sample_generator = PATTERN_RANDOM;
sdi->path = g_strdup("");
}
break;
case DSO:
//默认为RANDOM
cur_sample_generator = pre_sample_generator = PATTERN_RANDOM;
sdi->path = g_strdup("");
case ANALOG:
//默认为RANDOM
cur_sample_generator = pre_sample_generator = PATTERN_RANDOM;
sdi->path = g_strdup("");
default:
break;
}
load_virtual_device_session(sdi);
break;
case SR_CONF_PATTERN_MODE:
stropt = g_variant_get_string(data, NULL);
2023-05-04 10:46:56 +08:00
pre_sample_generator= cur_sample_generator;
//字符串有效
if(get_pattern_mode_index_by_string(sdi->mode , stropt) != PATTERN_INVALID)
{
switch (sdi->mode)
{
case LOGIC:
cur_sample_generator = get_pattern_mode_index_by_string(sdi->mode , stropt);
break;
case DSO:
cur_sample_generator = get_pattern_mode_index_by_string(sdi->mode , stropt);
break;
case ANALOG:
cur_sample_generator = get_pattern_mode_index_by_string(sdi->mode , stropt);
break;
default:
break;
}
//文件无效
if ("" == (sdi->path = get_dsl_path_by_pattern_mode(sdi->mode,cur_sample_generator)) &&
cur_sample_generator != PATTERN_RANDOM)
{
cur_sample_generator = pre_sample_generator;
}
}
//字符串无效,返回
else
{
cur_sample_generator = pre_sample_generator;
}
//模式发生切换,需要重新载入
if(cur_sample_generator != pre_sample_generator)
{
is_change = TRUE;
}
2014-01-15 19:48:01 +08:00
sr_dbg("%s: setting pattern to %d",
2023-05-04 10:46:56 +08:00
__func__, cur_sample_generator);
break;
case SR_CONF_MAX_HEIGHT:
stropt = g_variant_get_string(data, NULL);
2023-05-04 10:46:56 +08:00
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",
2023-05-04 10:46:56 +08:00
__func__, vdev->max_height);
break;
case SR_CONF_PROBE_EN:
2014-09-24 18:43:42 +08:00
ch->enabled = g_variant_get_boolean(data);
2023-05-04 10:46:56 +08:00
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;
}
vdiv_change = TRUE;
2018-05-27 19:01:26 +08:00
}
2023-05-04 10:46:56 +08:00
break;
case SR_CONF_PROBE_FACTOR:
ch->vfactor = g_variant_get_uint64(data);
2023-05-04 10:46:56 +08:00
break;
case SR_CONF_PROBE_OFFSET:
2019-09-09 00:07:19 -07:00
ch->offset = g_variant_get_uint16(data);
2023-05-04 10:46:56 +08:00
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);
2023-05-04 13:57:29 +08:00
if(sdi->mode == DSO)
g_timer_start(run_time);
2023-05-04 10:46:56 +08:00
sr_dbg("Setting timebase to %llu.", vdev->timebase);
break;
case SR_CONF_PROBE_COUPLING:
2015-04-17 00:21:14 +08:00
ch->coupling = g_variant_get_byte(data);
2023-05-04 10:46:56 +08:00
if(sdi->mode == ANALOG)
{
if(ch->coupling == 0)
ch->hw_offset = 178;
else
ch->hw_offset = 128;
}
else if(sdi->mode == DSO)
{
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);
2023-05-04 10:46:56 +08:00
break;
case SR_CONF_PROBE_MAP_DEFAULT:
2019-09-09 00:07:19 -07:00
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;
}
2023-05-04 10:46:56 +08:00
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:
instant = g_variant_get_boolean(data);
break;
case SR_CONF_DEMO_CHANGE:
is_change = g_variant_get_boolean(data);
break;
//初始化DEMO
case SR_CONF_DEMO_INIT:
pre_sample_generator = cur_sample_generator;
load_virtual_device_session(sdi);
default:
sr_err("Unknown capability: %d.", id);
return SR_ERR_NA;
}
return SR_OK;
2014-01-15 19:48:01 +08:00
}
2014-09-24 18:43:42 +08:00
static int config_list(int key, GVariant **data, const struct sr_dev_inst *sdi,
const struct sr_channel_group *cg)
2014-01-15 19:48:01 +08:00
{
2023-05-04 10:46:56 +08:00
(void)cg;
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
GVariant *gvar;
GVariantBuilder gvb;
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
(void)sdi;
struct session_vdev *vdev = sdi->priv;
switch (key)
{
2014-01-15 19:48:01 +08:00
case SR_CONF_DEVICE_OPTIONS:
*data = g_variant_new_from_data(G_VARIANT_TYPE("ai"),
2023-05-04 10:46:56 +08:00
hwoptions, ARRAY_SIZE(hwoptions) * sizeof(int32_t), TRUE, NULL, NULL);
2014-01-15 19:48:01 +08:00
break;
2015-06-06 22:24:00 +08:00
case SR_CONF_DEVICE_SESSIONS:
*data = g_variant_new_from_data(G_VARIANT_TYPE("ai"),
2023-05-04 10:46:56 +08:00
sessions, ARRAY_SIZE(sessions) * sizeof(int32_t), TRUE, NULL, NULL);
2015-06-06 22:24:00 +08:00
break;
2014-01-15 19:48:01 +08:00
case SR_CONF_SAMPLERATE:
2023-05-04 10:46:56 +08:00
g_variant_builder_init(&gvb, G_VARIANT_TYPE("a{sv}"));
if(sdi->mode == LOGIC && cur_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);
}
2014-01-15 19:48:01 +08:00
g_variant_builder_add(&gvb, "{sv}", "samplerates", gvar);
2023-05-04 10:46:56 +08:00
*data = g_variant_builder_end(&gvb);
break;
2014-01-15 19:48:01 +08:00
case SR_CONF_PATTERN_MODE:
2023-05-04 10:46:56 +08:00
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"),
2023-05-04 10:46:56 +08:00
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"),
2023-05-04 10:46:56 +08:00
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;
2023-05-04 10:46:56 +08:00
default:
return SR_ERR_ARG;
}
2014-01-15 19:48:01 +08:00
return SR_OK;
}
2023-05-04 10:46:56 +08:00
static int hw_dev_acquisition_start(struct sr_dev_inst *sdi,
void *cb_data)
2014-01-15 19:48:01 +08:00
{
2023-05-04 10:46:56 +08:00
(void)cb_data;
struct session_vdev *vdev;
struct sr_datafeed_packet packet;
int ret;
2015-11-04 00:27:42 +08:00
GSList *l;
struct sr_channel *probe;
2023-05-04 10:46:56 +08:00
assert(sdi);
assert(sdi->priv);
vdev = sdi->priv;
vdev->enabled_probes = 0;
packet.status = SR_PKT_OK;
vdev->cur_block = 0;
vdev->cur_channel = 0;
//在启动前检查文件是否有效
if(cur_sample_generator != PATTERN_RANDOM)
{
if (vdev->archive != NULL)
{
sr_err("history archive is not closed.");
}
2023-05-04 10:46:56 +08:00
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;
2015-11-04 00:27:42 +08:00
}
2023-05-04 10:46:56 +08:00
}
if (sdi->mode == LOGIC)
vdev->cur_channel = 0;
else
vdev->cur_channel = vdev->num_probes - 1;
2018-07-08 17:48:18 +08:00
2023-05-04 10:46:56 +08:00
for (l = sdi->channels; l; l = l->next)
{
probe = l->data;
if (probe->enabled)
vdev->enabled_probes++;
}
/* Send header packet to the session bus. */
std_session_send_df_header(sdi, LOG_PREFIX);
/* Send trigger packet to the session bus */
if (vdev->trig_pos != 0)
{
struct ds_trigger_pos session_trigger;
2018-07-08 17:48:18 +08:00
if (sdi->mode == DSO)
2023-05-04 10:46:56 +08:00
session_trigger.real_pos = vdev->trig_pos * vdev->enabled_probes / vdev->num_probes;
else
session_trigger.real_pos = vdev->trig_pos;
packet.type = SR_DF_TRIGGER;
packet.payload = &session_trigger;
ds_data_forward(sdi, &packet);
}
2018-07-08 17:48:18 +08:00
2023-05-04 10:46:56 +08:00
if(sdi->mode == LOGIC)
{
enabled_probe_num = 0;
for(GSList *l = sdi->channels; l; l = l->next)
{
2015-11-04 00:27:42 +08:00
probe = (struct sr_channel *)l->data;
2023-05-04 10:46:56 +08:00
if(probe->enabled)
{
enabled_probe_num++;
}
}
is_first = TRUE;
post_data_len = 0;
uint64_t post_date_per_second = vdev->samplerate / 8 ;
packet_len = post_date_per_second / 22;
packet_len = floor(packet_len/8)*8;
packet_time = 1/(double)22;
if(cur_sample_generator == PATTERN_RANDOM)
{
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)
{
is_first = TRUE;
vdiv_change = TRUE;
packet_time = 1/(double)200;
2023-05-04 13:57:29 +08:00
g_timer_start(run_time);
2023-05-04 10:46:56 +08:00
sr_session_source_add(-1, 0, 0, receive_data_dso, sdi);
}
else if(sdi->mode == ANALOG)
{
is_first = TRUE;
gdouble total_time = vdev->total_samples/vdev->samplerate;
uint64_t post_date_per_second = vdev->total_samples / total_time *2;
packet_len = post_date_per_second / 22;
if(packet_len <= 1)
{
packet_len = 2;
packet_time = post_date_per_second / 2;
packet_time = 1/packet_time;
}
else
{
if (packet_len %2 != 0)
{
packet_len += 1;
}
packet_time = 1/(double)22;
}
2023-05-04 13:57:29 +08:00
2023-05-04 10:46:56 +08:00
vdev->analog_buf_len = 0;
vdev->analog_read_pos = 0;
2023-05-04 13:57:29 +08:00
g_timer_start(run_time);
2023-05-04 10:46:56 +08:00
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;
*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)
{
struct session_vdev *vdev = NULL;
struct sr_datafeed_packet packet;
struct sr_datafeed_logic logic;
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);
chan_num = enabled_probe_num;
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);
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;
}
}
pack_buffer = vdev->packet_buffer;
// Make packet.
read_chan_index = 0;
dir_index = 0;
if(post_data_len >= vdev->total_samples/8)
{
bToEnd = 1;
}
if(!bToEnd)
{
packet.type = SR_DF_LOGIC;
packet.payload = &logic;
logic.format = LA_CROSS_DATA;
logic.index = 0;
logic.order = 0;
logic.length = chan_num * packet_len;
//防止越界
post_data_len += logic.length / enabled_probe_num;
if(post_data_len >= vdev->total_samples/8)
{
int last_packet_len = post_data_len - (logic.length / enabled_probe_num);
last_packet_len = (vdev->total_samples/8) - last_packet_len;
logic.length = last_packet_len * enabled_probe_num;
}
//注意传输缓冲
uint64_t random = vdev->logic_buf_len - logic.length;
random = abs(rand()) %random;
logic.data = vdev->logic_buf + random;
gdouble packet_elapsed = g_timer_elapsed(packet_interval, NULL);
gdouble waittime = packet_time - packet_elapsed;
if(waittime > 0)
{
g_usleep(waittime*1000000);
}
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);
}
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 = enabled_probe_num;
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 * 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;
}
pack_buffer = vdev->packet_buffer;
//传输块长度需要更新
if(pack_buffer->post_buf_len != chan_num * packet_len)
{
pack_buffer->post_buf_len = chan_num * packet_len;
if(pack_buffer->post_buf != NULL)
{
g_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("cant't locate zip inner file:\"%s\"", file_name);
send_error_packet(sdi, vdev, &packet);
return FALSE;
2015-11-04 00:27:42 +08:00
}
2023-05-04 10:46:56 +08:00
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_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;
}
2015-04-17 00:21:14 +08:00
}
2023-05-04 10:46:56 +08:00
}
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;
2015-11-04 00:27:42 +08:00
}
}
2023-05-04 10:46:56 +08:00
// 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.
2014-01-15 19:48:01 +08:00
}
2023-05-04 10:46:56 +08:00
vdev->cur_block++;
pack_buffer->block_chan_read_pos = 0;
2014-01-15 19:48:01 +08:00
}
2023-05-04 10:46:56 +08:00
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;
}
}
2015-11-04 00:27:42 +08:00
2023-05-04 10:46:56 +08:00
// Each channel's data is ready.
if (read_chan_index == chan_num){
read_chan_index = 0;
pack_buffer->block_chan_read_pos += byte_align;
2014-09-24 18:43:42 +08:00
}
2014-01-15 19:48:01 +08:00
}
2023-05-04 10:46:56 +08:00
}
2019-09-09 00:07:19 -07:00
2023-05-04 10:46:56 +08:00
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;
post_data_len += logic.length / enabled_probe_num;
if(post_data_len >= vdev->total_samples/8)
{
int last_packet_len = post_data_len - (logic.length / enabled_probe_num);
last_packet_len = (vdev->total_samples/8) - last_packet_len;
logic.length = last_packet_len * enabled_probe_num;
}
logic.data = pack_buffer->post_buf;
gdouble packet_elapsed = g_timer_elapsed(packet_interval, NULL);
gdouble waittime = packet_time - packet_elapsed;
if(waittime > 0){
g_usleep(waittime*1000000);
2019-09-09 00:07:19 -07:00
}
2023-05-04 10:46:56 +08:00
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);
2015-11-04 00:27:42 +08:00
}
2023-05-04 10:46:56 +08:00
return TRUE;
2014-01-15 19:48:01 +08:00
}
2023-05-04 10:46:56 +08:00
static int receive_data_dso(int fd, int revents, const struct sr_dev_inst *sdi)
2014-01-15 19:48:01 +08:00
{
2023-05-04 10:46:56 +08:00
struct session_vdev *vdev = NULL;
2014-01-15 19:48:01 +08:00
struct sr_datafeed_packet packet;
2014-04-14 17:46:11 +08:00
struct sr_datafeed_dso dso;
2023-05-04 10:46:56 +08:00
struct sr_channel *probe;
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
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;
uint16_t tem;
uint8_t val = 0;
uint64_t vdiv;
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
assert(sdi);
assert(sdi->priv);
(void)fd;
(void)revents;
sr_detail("Feed chunk.");
ret = 0;
bToEnd = 0;
packet.status = SR_PKT_OK;
2023-05-04 10:46:56 +08:00
vdev = sdi->priv;
assert(vdev->unit_bits > 0);
if(cur_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;
2019-09-09 00:07:19 -07:00
}
2023-05-04 10:46:56 +08:00
//初始化读取块
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;
//不需要+1
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_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;
if(vdiv_change)
{
//随机
if(cur_sample_generator == PATTERN_RANDOM)
{
//波形不太理想
for(int i = 0 ; i < pack_buffer->post_buf_len ;i++)
{
*(uint8_t*)(pack_buffer->post_buf + i) = rand()%40 +110;
}
pack_buffer->post_len = pack_buffer->post_buf_len;
}
//文件
2018-05-27 19:01:26 +08:00
else
2023-05-04 10:46:56 +08:00
{
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;
2014-01-15 19:48:01 +08:00
break;
}
2023-05-04 10:46:56 +08:00
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_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;
2014-01-15 19:48:01 +08:00
}
}
}
2023-05-04 10:46:56 +08:00
}
//处理vdiv
for(int i = 0 ; i < pack_buffer->post_buf_len; i++)
{
tem = 0;
if(i % 2 == 0)
probe = g_slist_nth(sdi->channels, 0)->data;
else
probe = g_slist_nth(sdi->channels, 1)->data;
vdiv = probe->vdiv;
uint8_t temp_val = *((uint8_t*)pack_buffer->post_buf + i);
if(temp_val>128)
{
val = temp_val - 128;
tem = val * 1000 / vdiv;
tem = 128 + tem;
if(tem >= 255)
temp_val = 255;
else
temp_val = tem;
2014-01-15 19:48:01 +08:00
}
2023-05-04 10:46:56 +08:00
else if(temp_val < 128 && temp_val != 0)
{
val = 128 - temp_val;
tem = val * 1000 / vdiv;
tem = 128 - tem;
if(tem == 0)
temp_val = 1;
else
temp_val = tem;
}
*((uint8_t*)pack_buffer->post_buf + i) = temp_val;
}
vdiv_change = FALSE;
}
2023-05-04 13:57:29 +08:00
//计算时间
gdouble total_time = vdev->timebase /(gdouble)SR_SEC(1)*(gdouble)10;
gdouble total_time_elapsed = g_timer_elapsed(run_time, NULL);
if (total_time_elapsed < total_time && !instant)
{
gdouble percent = total_time_elapsed / total_time;
int buf_len = percent* 20000;
if(buf_len %2 != 0)
buf_len -=1;
pack_buffer->post_len = buf_len;
}
else
{
//数据循环
uint8_t top0;
uint8_t top1;
if(cur_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 + 198);
top1 = *((uint8_t*)pack_buffer->post_buf + 199);
}
2023-05-04 10:46:56 +08:00
2023-05-04 13:57:29 +08:00
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);
}
2023-05-04 10:46:56 +08:00
2023-05-04 13:57:29 +08:00
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);
}
2023-05-04 10:46:56 +08:00
2023-05-04 13:57:29 +08:00
*(uint8_t*)pack_buffer->post_buf = top0;
*((uint8_t*)pack_buffer->post_buf + 1)= top1;
pack_buffer->post_len = 20000;
}
2023-05-04 10:46:56 +08:00
if (pack_buffer->post_len >= byte_align * chan_num)
{
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;
dso.data = pack_buffer->post_buf;
gdouble packet_elapsed = g_timer_elapsed(packet_interval, NULL);
gdouble waittime = packet_time - packet_elapsed;
if(waittime > 0){
g_usleep(waittime*1000000);
}
g_timer_start(packet_interval);
// Send data back.
ds_data_forward(sdi, &packet);
}
if(instant)
{
bToEnd = 1;
instant = FALSE;
}
if (bToEnd || revents == -1)
{
packet.type = SR_DF_END;
ds_data_forward(sdi, &packet);
sr_session_source_remove(-1);
2023-05-04 10:55:04 +08:00
// if(cur_sample_generator != PATTERN_RANDOM)
// {
// close_archive(vdev);
// }
2023-05-04 10:46:56 +08:00
}
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;
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
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(is_first)
{
void* analog_data = g_try_malloc0(206);
if(analog_data == NULL)
{
sr_err("%s:cant' malloc",__func__);
return SR_ERR_MALLOC;
}
//随机数据
if(cur_sample_generator == PATTERN_RANDOM)
{
for(int i = 0 ; i < 206 ;i++)
{
*(uint8_t*)(analog_data + i) = rand()%40 +110;
}
}
//文件
else
{
snprintf(file_name, sizeof(file_name)-1, "%s-%d/%d", "A",
0, 0);
if (unzLocateFile(vdev->archive, file_name, 0) != UNZ_OK)
{
sr_err("cant't locate zip inner file:\"%s\"", file_name);
send_error_packet(sdi, vdev, &packet);
return FALSE;
}
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, analog_data, 206);
if (-1 == ret)
{
sr_err("read zip inner file error:\"%s\"", file_name);
send_error_packet(sdi, vdev, &packet);
return FALSE;
}
}
//计算放大后数据
gdouble rate = 103 / (gdouble)2048 ;
uint64_t total_buf_len = rate * vdev->total_samples;
if(total_buf_len % 103 != 0)
{
total_buf_len = total_buf_len / 103 * 103;
}
total_buf_len = total_buf_len * 2;
if(vdev->analog_buf != NULL)
{
g_free(vdev->analog_buf);
vdev->analog_buf = NULL;
}
vdev->analog_buf = (g_try_malloc0(total_buf_len));
if (vdev->analog_buf == NULL)
{
return SR_ERR_MALLOC;
}
vdev->analog_buf_len = total_buf_len;
uint64_t per_block_after_expend = total_buf_len /206;
//根据vdiv对电压进行放大
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 < 206;i++)
{
if(i == 0 || i % 2 == 0)
vdiv = p0_vdiv;
else
vdiv = p1_vdiv;
tem = 0;
uint8_t temp_value = *((uint8_t*)analog_data + i);
if(temp_value > 128){
val = temp_value - 128;
tem = val * 1000 / vdiv;
tem = 128 + tem;
if(tem >= 255)
temp_value = 255;
else
temp_value = tem;
}
else if(temp_value < 128 && temp_value != 0)
{
val = 128 - temp_value;
tem = val * 1000 / vdiv;
tem = 128 - tem;
if(tem == 0)
temp_value = 1;
2015-11-04 00:27:42 +08:00
else
2023-05-04 10:46:56 +08:00
temp_value = tem;
2015-11-04 00:27:42 +08:00
}
2023-05-04 10:46:56 +08:00
//对数据进行拓展
for(int j = 0 ; j <per_block_after_expend ;j++)
{
if(i % 2 == 0)
{
cur_l = i * per_block_after_expend + j * 2;
}
2019-09-09 00:07:19 -07:00
else
2023-05-04 10:46:56 +08:00
{
cur_l = 1 + (i - 1) * per_block_after_expend + j * 2;
}
memset(vdev->analog_buf + cur_l,temp_value,1);
2014-01-15 19:48:01 +08:00
}
2023-05-04 10:46:56 +08:00
}
is_first = FALSE;
}
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
//注意区分发送数据额缓冲数据
void* buf;
if(vdev->analog_read_pos + packet_len >= vdev->analog_buf_len - 1 )
{
buf = g_try_malloc0(packet_len);
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);
}
2015-11-04 00:27:42 +08:00
2023-05-04 10:46:56 +08:00
uint64_t front_len = 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);
2014-01-15 19:48:01 +08:00
}
2023-05-04 10:46:56 +08:00
vdev->analog_read_pos = front_len;
}
else
{
buf = (uint8_t*) vdev->analog_buf + vdev->analog_read_pos;
vdev->analog_read_pos += packet_len;
}
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
packet.type = SR_DF_ANALOG;
packet.payload = &analog;
analog.probes = sdi->channels;
analog.num_samples = 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;
gdouble packet_elapsed = g_timer_elapsed(packet_interval, NULL);
gdouble waittime = packet_time - packet_elapsed;
if(waittime > 0){
g_usleep(waittime*1000000);
2014-01-15 19:48:01 +08:00
}
2023-05-04 10:46:56 +08:00
ds_data_forward(sdi, &packet);
return TRUE;
2014-01-15 19:48:01 +08:00
}
2023-05-04 10:46:56 +08:00
static void send_error_packet(const struct sr_dev_inst *cb_sdi, struct session_vdev *vdev, struct sr_datafeed_packet *packet)
2014-01-15 19:48:01 +08:00
{
2023-05-04 10:46:56 +08:00
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);
}
2014-01-15 19:48:01 +08:00
2015-11-04 00:27:42 +08:00
2023-05-04 10:46:56 +08:00
static int close_archive(struct session_vdev *vdev)
{
if(cur_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;
}
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
return SR_OK;
2014-01-15 19:48:01 +08:00
}
2023-05-04 10:46:56 +08:00
static int load_virtual_device_session(struct sr_dev_inst *sdi)
2014-01-15 19:48:01 +08:00
{
2023-05-04 10:46:56 +08:00
GKeyFile *kf;
unzFile archive = NULL;
char szFilePath[15];
unz_file_info64 fileInfo;
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
struct sr_channel *probe;
int ret, devcnt, i, j;
uint16_t probenum;
uint64_t tmp_u64, total_probes, enabled_probes;
uint16_t p;
int64_t tmp_64;
char **sections, **keys, *metafile, *val;
char probename[SR_MAX_PROBENAME_LEN + 1];
int mode = LOGIC;
int channel_type = SR_CHANNEL_LOGIC;
double tmp_double;
int version = 1;
assert(sdi);
//如果不是random要检查文件
if (cur_sample_generator != PATTERN_RANDOM)
{
assert(sdi->path);
}
//逻辑分析仪初始化RANDOM
if (sdi->mode == LOGIC && cur_sample_generator == PATTERN_RANDOM)
{
sdi->driver->config_set(SR_CONF_SAMPLERATE,
g_variant_new_uint64(SR_MHZ(1)), sdi, NULL, NULL);
sdi->driver->config_set(SR_CONF_LIMIT_SAMPLES,
g_variant_new_uint64(SR_MHZ(1)), sdi, NULL, NULL);
sr_dev_probes_free(sdi);
sdi->driver->config_set(SR_CONF_CAPTURE_NUM_PROBES,
g_variant_new_uint64(16), sdi, NULL, NULL);
sdi->driver->config_set(SR_CONF_NUM_BLOCKS,
g_variant_new_uint64(6), sdi, NULL, NULL);
char* probe_val;
for (int i = 0; i < 16; i++)
{
probe_val = probe_names[i];
if (!(probe = sr_channel_new(i, SR_CHANNEL_LOGIC, TRUE, probe_val)))
{
sr_err("%s: create channel failed", __func__);
sr_dev_inst_free(sdi);
return SR_ERR;
}
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
sdi->channels = g_slist_append(sdi->channels, probe);
}
adjust_samplerate(sdi);
}
//示波器初始化
else if(sdi->mode == DSO)
{
sdi->driver->config_set(SR_CONF_SAMPLERATE,
g_variant_new_uint64(SR_MHZ(100)), sdi, NULL, NULL);
sdi->driver->config_set(SR_CONF_LIMIT_SAMPLES,
g_variant_new_uint64(SR_KHZ(10)), sdi, NULL, NULL);
sr_dev_probes_free(sdi);
sdi->driver->config_set(SR_CONF_CAPTURE_NUM_PROBES,
g_variant_new_uint64(2), sdi, NULL, NULL);
sdi->driver->config_set(SR_CONF_NUM_BLOCKS,
g_variant_new_uint64(1), sdi, NULL, NULL);
char* probe_val;
for (int i = 0; i < 2; i++)
{
probe_val = probe_names[i];
if (!(probe = sr_channel_new(i, SR_CHANNEL_DSO, TRUE, probe_val)))
{
sr_err("%s: create channel failed", __func__);
sr_dev_inst_free(sdi);
return SR_ERR;
}
probe->enabled = TRUE;
probe->coupling = 1;
probe->vdiv = 1000;
probe->vfactor = 1000;
probe->hw_offset = 128;
probe->offset = 128;
probe->trig_value = 0.5;
sdi->channels = g_slist_append(sdi->channels, probe);
}
adjust_samplerate(sdi);
}
//数据记录仪初始化
else if(sdi->mode == ANALOG)
{
sdi->driver->config_set(SR_CONF_SAMPLERATE,
g_variant_new_uint64(SR_MHZ(1)), sdi, NULL, NULL);
sdi->driver->config_set(SR_CONF_LIMIT_SAMPLES,
g_variant_new_uint64(SR_MHZ(1)), sdi, NULL, NULL);
sr_dev_probes_free(sdi);
sdi->driver->config_set(SR_CONF_CAPTURE_NUM_PROBES,
g_variant_new_uint64(2), sdi, NULL, NULL);
sdi->driver->config_set(SR_CONF_NUM_BLOCKS,
g_variant_new_uint64(1), sdi, NULL, NULL);
char* probe_val;
for (int i = 0; i < 2; i++)
{
probe_val = probe_names[i];
if (!(probe = sr_channel_new(i, SR_CHANNEL_ANALOG, TRUE, probe_val)))
{
sr_err("%s: create channel failed", __func__);
sr_dev_inst_free(sdi);
return SR_ERR;
}
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
//做一个用于通道初始化的函数
probe->enabled = TRUE;
probe->bits = 8;
probe->vdiv = 1000;
probe->hw_offset = 128;
probe->offset = 128;
probe->coupling = 1;
probe->vfactor = 1;
probe->trig_value = 128;
probe->map_default = TRUE;
probe->map_unit = "V";
probe->map_min = -(probe->vdiv * probe->vfactor * DS_CONF_DSO_VDIVS / 2000.0);
probe->map_max = probe->vdiv * probe->vfactor * DS_CONF_DSO_VDIVS / 2000.0;
sdi->channels = g_slist_append(sdi->channels, probe);
}
adjust_samplerate(sdi);
}
//协议文件初始化
else
{
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;
}
2023-05-04 10:46:56 +08:00
if (!(metafile = g_try_malloc(fileInfo.uncompressed_size)))
{
sr_err("%s: metafile malloc failed", __func__);
return SR_ERR_MALLOC;
}
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
unzReadCurrentFile(archive, metafile, fileInfo.uncompressed_size);
unzCloseCurrentFile(archive);
2015-11-04 00:27:42 +08:00
2023-05-04 10:46:56 +08:00
if (unzClose(archive) != UNZ_OK)
{
sr_err("%s: Close zip archive error.", __func__);
return SR_ERR;
}
archive = NULL;
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
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;
}
2014-01-15 19:48:01 +08:00
2023-05-04 10:46:56 +08:00
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);
}
}
}
2023-05-04 10:46:56 +08:00
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);
sr_info("keys:%s , val:%s", keys[j],val);
if (!strcmp(keys[j], "device mode"))
{
mode = strtoull(val, NULL, 10);
}
else if (!strcmp(keys[j], "samplerate"))
{
sr_parse_sizestring(val, &tmp_u64);
sdi->driver->config_set(SR_CONF_SAMPLERATE,
g_variant_new_uint64(tmp_u64), sdi, NULL, NULL);
}
else if (!strcmp(keys[j], "total samples"))
{
tmp_u64 = strtoull(val, NULL, 10);
sdi->driver->config_set(SR_CONF_LIMIT_SAMPLES,
g_variant_new_uint64(tmp_u64), sdi, NULL, NULL);
}
else if (!strcmp(keys[j], "total blocks"))
{
tmp_u64 = strtoull(val, NULL, 10);
sdi->driver->config_set(SR_CONF_NUM_BLOCKS,
g_variant_new_uint64(tmp_u64), sdi, NULL, NULL);
}
else if (!strcmp(keys[j], "total probes"))
{
sr_dev_probes_free(sdi);
total_probes = strtoull(val, NULL, 10);
sdi->driver->config_set(SR_CONF_CAPTURE_NUM_PROBES,
g_variant_new_uint64(total_probes), sdi, NULL, NULL);
}
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_free(metafile);
2014-09-24 18:43:42 +08:00
}
2023-05-04 10:46:56 +08:00
return SR_OK;
2014-09-24 18:43:42 +08:00
}
2023-05-04 10:46:56 +08:00
2014-01-15 19:48:01 +08:00
SR_PRIV struct sr_dev_driver demo_driver_info = {
2015-11-04 00:27:42 +08:00
.name = "virtual-demo",
2014-01-15 19:48:01 +08:00
.longname = "Demo driver and pattern generator",
.api_version = 1,
2022-08-08 15:59:50 +08:00
.driver_type = DRIVER_TYPE_DEMO,
2014-01-15 19:48:01 +08:00
.init = hw_init,
2023-05-04 10:46:56 +08:00
.cleanup = NULL,
2022-08-15 17:23:54 +08:00
.scan = hw_scan,
2014-09-24 18:43:42 +08:00
.dev_mode_list = hw_dev_mode_list,
2014-01-15 19:48:01 +08:00
.config_get = config_get,
.config_set = config_set,
.config_list = config_list,
.dev_open = hw_dev_open,
.dev_close = hw_dev_close,
2022-07-28 16:57:15 +08:00
.dev_destroy = dev_destroy,
2014-09-24 18:43:42 +08:00
.dev_status_get = hw_dev_status_get,
2014-01-15 19:48:01 +08:00
.dev_acquisition_start = hw_dev_acquisition_start,
.dev_acquisition_stop = hw_dev_acquisition_stop,
.priv = NULL,
};