DSView/libsigrok4DSL/lib_main.c
2022-11-10 19:18:10 +08:00

1590 lines
33 KiB
C

/*
* This file is part of the DSView project.
* DSView is based on PulseView.
*
* Copyright (C) 2022 DreamSourceLab <support@dreamsourcelab.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 "libsigrok-internal.h"
#include "log.h"
#include <pthread.h>
#include <stdlib.h>
#include <string.h>
#include "config.h"
#ifdef _WIN32
#include <windows.h>
#define _sleep(m) Sleep((m))
#else
#include <unistd.h>
#define _sleep(m) usleep((m)*1000)
#endif
#define MAX_DEVCIE_LIST_LENGTH 20
#undef LOG_PREFIX
#define LOG_PREFIX "lib_main: "
char DS_RES_PATH[500] = {0};
struct sr_lib_context
{
dslib_event_callback_t event_callback;
struct sr_context *sr_ctx;
GList *device_list; // All device instance, sr_dev_inst* type
pthread_mutex_t mutext;
int lib_exit_flag;
int attach_event_flag;
int detach_event_flag;
int is_waitting_reconnect;
int check_reconnect_times;
struct libusb_device *attach_device_handle;
struct libusb_device *detach_device_handle;
struct sr_dev_inst *actived_device_instance;
GThread *hotplug_thread;
GThread *collect_thread;
ds_datafeed_callback_t data_forward_callback;
int callback_thread_count;
int is_delay_destory_actived_device;
int is_stop_by_detached;
};
static void hotplug_event_listen_callback(struct libusb_context *ctx, struct libusb_device *dev, int event);
static void usb_hotplug_process_proc();
static void destroy_device_instance(struct sr_dev_inst *dev);
static void close_device_instance(struct sr_dev_inst *dev);
static int open_device_instance(struct sr_dev_inst *dev);
static void collect_run_proc();
static void post_event_async(int event);
static void send_event(int event);
static void make_demo_device_to_list();
static void process_attach_event(int isEvent);
static struct libusb_device* get_new_attached_usb_device();
static struct libusb_device* get_new_detached_usb_device();
static struct sr_lib_context lib_ctx = {
.event_callback = NULL,
.sr_ctx = NULL,
.device_list = NULL,
.hotplug_thread = NULL,
.lib_exit_flag = 0,
.attach_event_flag = 0,
.detach_event_flag = 0,
.is_waitting_reconnect = 0,
.check_reconnect_times = 0,
.attach_device_handle = NULL,
.detach_device_handle = NULL,
.actived_device_instance = NULL,
.data_forward_callback = NULL,
.collect_thread = NULL,
.callback_thread_count = 0,
.is_delay_destory_actived_device = 0,
.is_stop_by_detached = 0,
};
/**
* Must call first
*/
SR_API int ds_lib_init()
{
int ret = 0;
struct sr_dev_driver **drivers = NULL;
struct sr_dev_driver **dr = NULL;
if (lib_ctx.sr_ctx != NULL)
{
return SR_ERR_HAVE_DONE;
}
sr_log_init(); // try init log
sr_info("Init %s.", SR_LIB_NAME);
ret = sr_init(&lib_ctx.sr_ctx);
if (ret != SR_OK)
{
return ret;
}
lib_ctx.lib_exit_flag = 0;
// Init trigger.
ds_trigger_init();
// Initialise all libsigrok drivers
drivers = sr_driver_list();
for (dr = drivers; *dr; dr++)
{
if (sr_driver_init(lib_ctx.sr_ctx, *dr) != SR_OK)
{
sr_err("Failed to initialize driver '%s'", (*dr)->name);
return SR_ERR;
}
}
pthread_mutex_init(&lib_ctx.mutext, NULL); // init locker
make_demo_device_to_list();
lib_ctx.sr_ctx->hotplug_tv.tv_sec = 0;
lib_ctx.sr_ctx->hotplug_tv.tv_usec = 0;
/**
* User can use custom hotplug function.
*/
lib_ctx.sr_ctx->listen_hotplug_ext = NULL;
lib_ctx.sr_ctx->close_hotplug_ext = NULL;
lib_ctx.sr_ctx->hotplug_wait_timout_ext = NULL;
#ifdef _WIN32
#ifdef HAVE_EXTERN_INIT
lib_extern_init(lib_ctx.sr_ctx);
#endif
#endif
// Scan the all hardware device.
sr_info("%s", "Scan all connected hardware device.");
process_attach_event(0);
sr_listen_hotplug(lib_ctx.sr_ctx, hotplug_event_listen_callback);
/** Start usb hotplug thread */
lib_ctx.hotplug_thread = g_thread_new("hotplug_proc", usb_hotplug_process_proc, NULL);
return SR_OK;
}
#ifndef _WIN32
SR_PRIV int lib_extern_init(struct sr_context *ctx){
return SR_OK;
}
#endif
/**
* Free all resource before program exits
*/
SR_API int ds_lib_exit()
{
GSList *l;
if (lib_ctx.sr_ctx == NULL)
{
return SR_ERR_HAVE_DONE;
}
sr_info("Uninit %s.", SR_LIB_NAME);
ds_release_actived_device();
sr_close_hotplug(lib_ctx.sr_ctx);
lib_ctx.lib_exit_flag = 1; // all thread to exit
if (lib_ctx.hotplug_thread != NULL)
{
g_thread_join(lib_ctx.hotplug_thread);
lib_ctx.hotplug_thread = NULL;
}
// The device is not in list.
if (lib_ctx.is_delay_destory_actived_device && lib_ctx.actived_device_instance != NULL)
{
sr_info("The current device is delayed for destruction, handle:%p", lib_ctx.actived_device_instance->handle);
destroy_device_instance(lib_ctx.actived_device_instance);
lib_ctx.actived_device_instance = NULL;
lib_ctx.is_delay_destory_actived_device = 0;
}
// Release all device
for (l = lib_ctx.device_list; l; l = l->next)
{
destroy_device_instance((struct sr_dev_inst *)l->data);
}
g_safe_free_list(lib_ctx.device_list);
pthread_mutex_destroy(&lib_ctx.mutext); // uninit locker
// Uninit trigger.
ds_trigger_destroy();
if (sr_exit(lib_ctx.sr_ctx) != SR_OK)
{
sr_err("%s", "call sr_exit error");
}
lib_ctx.sr_ctx = NULL;
sr_hw_cleanup_all();
sr_log_uninit(); // try uninit log
return SR_OK;
}
/**
* Set the firmware binary file directory
*/
SR_API void ds_set_firmware_resource_dir(const char *dir)
{
if (dir)
{
strcpy(DS_RES_PATH, dir);
int len = strlen(DS_RES_PATH);
if (DS_RES_PATH[len - 1] != '/')
{
DS_RES_PATH[len] = '/';
DS_RES_PATH[len + 1] = 0;
}
sr_info("Firmware resource directory:\"%s\"", DS_RES_PATH);
}
}
/**
* Set event callback, event type see enum libsigrok_event_type
*/
SR_API void ds_set_event_callback(dslib_event_callback_t cb)
{
lib_ctx.event_callback = cb;
}
/**
* Set the data receive callback.
*/
SR_API void ds_set_datafeed_callback(ds_datafeed_callback_t cb)
{
lib_ctx.data_forward_callback = cb;
}
/**
* Get the device list, if the field _handle is 0, the list visited to end.
* User need call free() to release the buffer. If the list is empty, the out_list is null.
*/
SR_API int ds_get_device_list(struct ds_device_base_info **out_list, int *out_count)
{
int num;
struct ds_device_base_info *array = NULL;
struct ds_device_base_info *p = NULL;
GSList *l;
struct sr_dev_inst *dev;
if (out_list == NULL)
{
return SR_ERR_ARG;
}
*out_list = NULL;
pthread_mutex_lock(&lib_ctx.mutext);
num = g_slist_length(lib_ctx.device_list);
if (num == 0)
{
pthread_mutex_unlock(&lib_ctx.mutext);
return SR_OK;
}
array = (struct ds_device_info *)malloc(sizeof(struct ds_device_base_info) * (num + 1));
if (array == NULL)
{
pthread_mutex_unlock(&lib_ctx.mutext);
return SR_ERR_MALLOC;
}
p = array;
for (l = lib_ctx.device_list; l; l = l->next)
{
dev = l->data;
p->handle = dev->handle;
strncpy(p->name, dev->name, sizeof(p->name) - 1);
p++;
}
p->handle = 0; // is the end
p->name[0] = '\0';
if (out_count)
{
*out_count = num;
}
pthread_mutex_unlock(&lib_ctx.mutext);
*out_list = array;
return SR_OK;
}
/**
* Active a device.
*/
SR_API int ds_active_device(ds_device_handle handle)
{
GSList *l;
struct sr_dev_inst *dev;
int bFind = 0;
int ret;
if (handle == NULL_HANDLE)
{
return SR_ERR_ARG;
}
ret = SR_OK;
sr_info("%s", "Start activating device.");
if (ds_is_collecting())
{
sr_err("%s", "Error!The current device is collecting, can not switch it.");
return SR_ERR_CALL_STATUS;
}
pthread_mutex_lock(&lib_ctx.mutext);
if (lib_ctx.actived_device_instance != NULL)
{
if (lib_ctx.is_delay_destory_actived_device)
{
sr_info("The current device is delayed for destruction, handle:%p", lib_ctx.actived_device_instance->handle);
destroy_device_instance(lib_ctx.actived_device_instance);
lib_ctx.actived_device_instance = NULL;
lib_ctx.is_delay_destory_actived_device = 0;
}
else
{
sr_info("Close the previous device \"%s\"", lib_ctx.actived_device_instance->name);
close_device_instance(lib_ctx.actived_device_instance);
}
}
// To open the new.
for (l = lib_ctx.device_list; l; l = l->next)
{
dev = l->data;
if (dev->handle == handle)
{
bFind = 1;
if (dev->dev_type == DEV_TYPE_USB && DS_RES_PATH[0] == '\0'){
sr_err("%s", "Please call ds_set_firmware_resource_dir() to set the firmware resource path.");
}
if (dev->dev_type == DEV_TYPE_FILELOG)
sr_info("virtual device name: \"%s\".", dev->name);
else
sr_info("device name: \"%s\".", dev->name);
if (open_device_instance(dev) == SR_OK)
{
lib_ctx.actived_device_instance = dev;
}
else
{
sr_err("%s", "Open device error!");
ret = SR_ERR_CALL_STATUS;
}
break;
}
}
pthread_mutex_unlock(&lib_ctx.mutext);
sr_info("%s", "Activating device end.");
if (!bFind)
{
sr_err("ds_active_device() error, can't find the device.");
return SR_ERR_CALL_STATUS;
}
return ret;
}
/**
* Active a device
* if @index is -1, will select the last one.
*/
SR_API int ds_active_device_by_index(int index)
{
GSList *l;
struct sr_dev_inst *dev;
ds_device_handle handle = NULL;
ds_device_handle lst_handle = NULL;
int i = 0;
pthread_mutex_lock(&lib_ctx.mutext);
// Get index
for (l = lib_ctx.device_list; l; l = l->next)
{
dev = l->data;
lst_handle = dev->handle;
if (index == i)
{
handle = dev->handle;
break;
}
++i;
}
pthread_mutex_unlock(&lib_ctx.mutext);
if (index == -1)
{
handle = lst_handle; // Get the last one.
}
if (handle == NULL)
{
sr_err("%s", "ds_active_device_by_index(), index is error!");
return SR_ERR_CALL_STATUS;
}
return ds_active_device(handle);
}
/**
* Get the selected device index.
*/
SR_API int ds_get_actived_device_index()
{
int dex = -1;
GSList *l;
int i = 0;
if (lib_ctx.actived_device_instance == NULL)
{
return -1;
}
pthread_mutex_lock(&lib_ctx.mutext);
for (l = lib_ctx.device_list; l; l = l->next)
{
if ((struct sr_dev_inst *)l->data == lib_ctx.actived_device_instance)
{
dex = i;
break;
}
i++;
}
pthread_mutex_unlock(&lib_ctx.mutext);
return dex;
}
/**
* Detect whether the active device exists
*/
SR_API int ds_have_actived_device()
{
if (lib_ctx.actived_device_instance != NULL)
{
return 1;
}
return 0;
}
/**
* Create a device from session file, and append to the list.
*/
SR_API int ds_device_from_file(const char *file_path)
{
struct sr_dev_inst *dev;
int ret;
if (file_path == NULL || *file_path == '\0'){
sr_err("%s", "Error!File name is empty.");
return SR_ERR_ARG;
}
dev = NULL;
ret = sr_new_virtual_device(file_path, &dev);
if (ret != SR_OK){
return ret;
}
pthread_mutex_lock(&lib_ctx.mutext);
lib_ctx.device_list = g_slist_append(lib_ctx.device_list, dev);
pthread_mutex_unlock(&lib_ctx.mutext);
return SR_OK;
}
/**
* Get the decive supports work mode, mode list: LOGIC、ANALOG、DSO
* return type see struct sr_dev_mode.
*/
SR_API const GSList *ds_get_actived_device_mode_list()
{
GSList *l;
struct sr_dev_inst *dev;
dev = lib_ctx.actived_device_instance;
if (dev == NULL)
{
sr_err("%s", "Have no actived device.");
}
if (dev->driver == NULL || dev->driver->dev_mode_list == NULL)
{
sr_err("%s", "Module not implemented.");
return NULL;
}
return dev->driver->dev_mode_list(dev);
}
/**
* Remove one device from the list, and destory it.
* User need to call ds_get_device_list() to get the new list.
*/
SR_API int ds_remove_device(ds_device_handle handle)
{
GSList *l;
struct sr_dev_inst *dev;
int bFind = 0;
if (handle == NULL_HANDLE)
return SR_ERR_ARG;
if (lib_ctx.actived_device_instance != NULL && lib_ctx.actived_device_instance->handle == handle && ds_is_collecting())
{
sr_err("%s", "Device is collecting, can't remove it.");
return SR_ERR_CALL_STATUS;
}
if (lib_ctx.actived_device_instance != NULL && lib_ctx.is_delay_destory_actived_device && lib_ctx.actived_device_instance->handle == handle)
{
sr_info("The current device is delayed for destruction, handle:%p", lib_ctx.actived_device_instance->handle);
destroy_device_instance(lib_ctx.actived_device_instance);
lib_ctx.actived_device_instance = NULL;
lib_ctx.is_delay_destory_actived_device = 0;
}
pthread_mutex_lock(&lib_ctx.mutext);
for (l = lib_ctx.device_list; l; l = l->next)
{
dev = l->data;
if (dev->handle == handle)
{
lib_ctx.device_list = g_slist_remove(lib_ctx.device_list, l->data);
if (dev == lib_ctx.actived_device_instance)
{
lib_ctx.actived_device_instance = NULL;
}
destroy_device_instance(dev);
bFind = 1;
break;
}
}
pthread_mutex_unlock(&lib_ctx.mutext);
if (bFind == 0)
return SR_ERR_CALL_STATUS;
return SR_OK;
}
/**
* Get the actived device info.
* If the actived device is not exists, the handle filed will be set null.
*/
SR_API int ds_get_actived_device_info(struct ds_device_full_info *fill_info)
{
struct sr_dev_inst *dev;
struct ds_device_full_info *p;
int ret;
if (fill_info == NULL)
return SR_ERR_ARG;
ret = SR_ERR_CALL_STATUS;
p = fill_info;
p->handle = NULL_HANDLE;
p->name[0] = '\0';
p->path[0] = '\0';
p->driver_name[0] = '\0';
p->dev_type = DEV_TYPE_UNKOWN;
p->di = NULL;
pthread_mutex_lock(&lib_ctx.mutext);
dev = lib_ctx.actived_device_instance;
if (dev != NULL)
{
p->handle = dev->handle;
p->dev_type = dev->dev_type;
p->di = dev;
strncpy(p->name, dev->name, sizeof(p->name) - 1);
if (dev->driver && dev->driver->name)
{
strncpy(p->driver_name, dev->driver->name, sizeof(p->driver_name) - 1);
}
if (dev->dev_type == DEV_TYPE_FILELOG && dev->path != NULL){
strncpy(p->path, dev->path, sizeof(p->path) - 1);
}
ret = SR_OK;
}
pthread_mutex_unlock(&lib_ctx.mutext);
return ret;
}
/**
* Get actived device work model. mode list:LOGIC、ANALOG、DSO
*/
SR_API int ds_get_actived_device_mode()
{
int mode = UNKNOWN_DSL_MODE;
pthread_mutex_lock(&lib_ctx.mutext);
if (lib_ctx.actived_device_instance != NULL)
{
mode = lib_ctx.actived_device_instance->mode;
}
pthread_mutex_unlock(&lib_ctx.mutext);
return mode;
}
/**
* Start collect data
*/
SR_API int ds_start_collect()
{
int ret;
struct sr_dev_inst *di;
di = lib_ctx.actived_device_instance;
sr_info("%s", "Start collect.");
if (ds_is_collecting())
{
sr_err("%s", "Error,it's collecting!");
return SR_ERR_CALL_STATUS;
}
if (di == NULL)
{
sr_err("%s", "Please set a current device first.");
return SR_ERR_CALL_STATUS;
}
if (di->status == SR_ST_INITIALIZING)
{
sr_err("Error!The device is initializing.");
return SR_ERR_CALL_STATUS;
}
if (ds_channel_is_enabled() == 0)
{
sr_err("%s", "There have no useable channel, unable to collect.");
return SR_ERR_CALL_STATUS;
}
if (lib_ctx.data_forward_callback == NULL)
{
sr_err("%s", "Error! Data forwarding callback is not set, see \"ds_set_datafeed_callback()\".");
return SR_ERR_CALL_STATUS;
}
// Create new session.
sr_session_new();
ret = open_device_instance(di); // open device
if (ret != SR_OK)
{
sr_err("%s", "Open device error!");
return ret;
}
lib_ctx.collect_thread = g_thread_new("collect_run_proc", collect_run_proc, NULL);
return SR_OK;
}
static void collect_run_proc()
{
int ret;
struct sr_dev_inst *di;
int bError;
bError = 0;
di = lib_ctx.actived_device_instance;
send_event(DS_EV_COLLECT_TASK_START);
sr_info("%s", "Collect thread start.");
if (di == NULL || di->driver == NULL || di->driver->dev_acquisition_start == NULL)
{
sr_err("%s", "The device cannot be used.");
bError = 1;
goto END;
}
ret = di->driver->dev_acquisition_start(di, (void *)di);
if (ret != SR_OK)
{
sr_err("Failed to start acquisition of device in "
"running session: %d",
ret);
bError = 1;
goto END;
}
send_event(DS_EV_DEVICE_RUNNING);
ret = sr_session_run();
send_event(DS_EV_DEVICE_STOPPED);
if (ret != SR_OK)
{
sr_err("%s", "Run session error!");
bError = 1;
goto END;
}
END:
sr_info("%s", "Collect thread end.");
lib_ctx.collect_thread = NULL;
if (bError)
send_event(DS_EV_COLLECT_TASK_END_BY_ERROR);
else if (lib_ctx.is_stop_by_detached)
post_event_async(DS_EV_COLLECT_TASK_END_BY_DETACHED);
else
send_event(DS_EV_COLLECT_TASK_END); // Normal end.
lib_ctx.is_stop_by_detached = 0;
}
/**
* Stop collect data
*/
SR_API int ds_stop_collect()
{
sr_info("%s", "Stop collect.");
if (!ds_is_collecting())
{
sr_err("%s", "It's not collecting now.");
return SR_ERR_CALL_STATUS;
}
// Stop current session.
sr_session_stop();
// Wait the collect thread ends.
if (lib_ctx.collect_thread != NULL)
g_thread_join(lib_ctx.collect_thread);
lib_ctx.collect_thread = NULL;
return SR_OK;
}
/**
* Check if the device is collecting.
*/
SR_API int ds_is_collecting()
{
if (lib_ctx.collect_thread != NULL)
{
return 1;
}
return 0;
}
SR_API int ds_release_actived_device()
{
if (lib_ctx.actived_device_instance == NULL){
return SR_ERR_CALL_STATUS;
}
if (ds_is_collecting()){
ds_stop_collect();
}
sr_info("%s", "Release current actived device.");
close_device_instance(lib_ctx.actived_device_instance);
// Destroy current session.
sr_session_destroy();
return SR_OK;
}
int ds_trigger_is_enabled()
{
GSList *l;
struct sr_channel *p;
int ret;
ret = 0;
pthread_mutex_lock(&lib_ctx.mutext);
if (lib_ctx.actived_device_instance != NULL)
{
for (l = lib_ctx.actived_device_instance->channels; l; l = l->next)
{
p = (struct sr_channel *)l->data;
if (p->trigger && p->trigger[0] != '\0')
{
ret = 1;
break;
}
}
}
pthread_mutex_unlock(&lib_ctx.mutext);
return ret;
}
SR_API int ds_trigger_reset()
{
return ds_trigger_init();
}
/**-------------------public end ---------------*/
/**-------------------config -------------------*/
SR_API int ds_get_actived_device_config(const struct sr_channel *ch,
const struct sr_channel_group *cg,
int key, GVariant **data)
{
if (lib_ctx.actived_device_instance == NULL)
{
sr_err("%s", "Have no actived device.");
return SR_ERR_CALL_STATUS;
}
return sr_config_get(lib_ctx.actived_device_instance->driver,
lib_ctx.actived_device_instance,
ch,
cg,
key,
data);
}
SR_API int ds_set_actived_device_config(const struct sr_channel *ch,
const struct sr_channel_group *cg,
int key, GVariant *data)
{
if (lib_ctx.actived_device_instance == NULL)
{
sr_err("%s", "Have no actived device.");
return SR_ERR_CALL_STATUS;
}
return sr_config_set(
lib_ctx.actived_device_instance,
ch,
cg,
key,
data);
}
SR_API int ds_get_actived_device_config_list(const struct sr_channel_group *cg,
int key, GVariant **data)
{
if (lib_ctx.actived_device_instance == NULL)
{
sr_err("%s", "Have no actived device.");
return SR_ERR_CALL_STATUS;
}
return sr_config_list(lib_ctx.actived_device_instance->driver,
lib_ctx.actived_device_instance,
cg,
key,
data);
}
SR_API const struct sr_config_info *ds_get_actived_device_config_info(int key)
{
if (lib_ctx.actived_device_instance == NULL)
{
sr_err("%s", "Have no actived device.");
return SR_ERR_CALL_STATUS;
}
return sr_config_info_get(key);
}
SR_API int ds_get_actived_device_status(struct sr_status *status, gboolean prg)
{
if (lib_ctx.actived_device_instance == NULL)
{
sr_err("%s", "Have no actived device.");
return SR_ERR_CALL_STATUS;
}
return sr_status_get(lib_ctx.actived_device_instance, status, prg);
}
SR_API struct sr_config *ds_new_config(int key, GVariant *data)
{
return sr_config_new(key, data);
}
SR_API void ds_free_config(struct sr_config *src)
{
sr_config_free(src);
}
SR_API int ds_dsl_option_value_to_code(int work_mode, int config_id, const char *value)
{
if (work_mode == LOGIC)
return sr_dslogic_option_value_to_code(lib_ctx.actived_device_instance, config_id, value);
else
return sr_dscope_option_value_to_code(lib_ctx.actived_device_instance, config_id, value);
}
/**-----------channel -------------*/
SR_API int ds_enable_device_channel(const struct sr_channel *ch, gboolean enable)
{
if (lib_ctx.actived_device_instance == NULL)
{
return SR_ERR_CALL_STATUS;
}
return sr_enable_device_channel(lib_ctx.actived_device_instance, ch, enable);
}
SR_API int ds_enable_device_channel_index(int ch_index, gboolean enable)
{
if (lib_ctx.actived_device_instance == NULL)
{
return SR_ERR_CALL_STATUS;
}
return sr_dev_probe_enable(lib_ctx.actived_device_instance, ch_index, enable);
}
SR_API int ds_set_device_channel_name(int ch_index, const char *name)
{
if (lib_ctx.actived_device_instance == NULL)
{
return SR_ERR_CALL_STATUS;
}
return sr_dev_probe_name_set(lib_ctx.actived_device_instance, ch_index, name);
}
/**
* check that at least one probe is enabled
*/
int ds_channel_is_enabled()
{
GSList *l;
struct sr_channel *p;
int ret;
ret = 0;
pthread_mutex_lock(&lib_ctx.mutext);
if (lib_ctx.actived_device_instance != NULL)
{
for (l = lib_ctx.actived_device_instance->channels; l; l = l->next)
{
p = (struct sr_channel *)l->data;
if (p->enabled)
{
ret = 1;
break;
}
}
}
pthread_mutex_unlock(&lib_ctx.mutext);
return ret;
}
GSList *ds_get_actived_device_channels()
{
if (lib_ctx.actived_device_instance != NULL)
{
return lib_ctx.actived_device_instance->channels;
}
return NULL;
}
/**-------------------config end-------------------*/
/**-------------------internal function ---------------*/
/**
* Check whether the USB device is in the device list.
*/
SR_PRIV int sr_usb_device_is_exists(libusb_device *usb_dev)
{
GSList *l;
struct sr_dev_inst *dev;
int bFind = 0;
if (usb_dev == NULL)
{
sr_err("%s", "sr_usb_device_is_exists(), @usb_dev is null.");
return 0;
}
pthread_mutex_lock(&lib_ctx.mutext);
for (l = lib_ctx.device_list; l; l = l->next)
{
dev = l->data;
if (dev->handle == (ds_device_handle)usb_dev)
{
bFind = 1;
break;
}
}
pthread_mutex_unlock(&lib_ctx.mutext);
return bFind;
}
/**
* Forward the data.
*/
SR_PRIV int ds_data_forward(const struct sr_dev_inst *sdi,
const struct sr_datafeed_packet *packet)
{
if (!sdi)
{
sr_err("%s: sdi was NULL", __func__);
return SR_ERR_ARG;
}
if (!packet)
{
sr_err("%s: packet was NULL", __func__);
return SR_ERR_ARG;
}
if (lib_ctx.data_forward_callback != NULL){
lib_ctx.data_forward_callback(sdi, packet);
return SR_OK;
}
return SR_ERR;
}
SR_PRIV int current_device_acquisition_stop()
{
struct sr_dev_inst *di;
di = lib_ctx.actived_device_instance;
if (di != NULL && di->driver && di->driver->dev_acquisition_stop)
{
return di->driver->dev_acquisition_stop(di, (void *)di);
}
return SR_ERR;
}
/**--------------------internal function end-----------*/
/**-------------------private function ---------------*/
static int update_device_handle(struct libusb_device *old_dev, struct libusb_device *new_dev)
{
GSList *l;
struct sr_dev_inst *dev;
struct sr_usb_dev_inst *usb_dev_info;
uint8_t bus;
uint8_t address;
int bFind = 0;
pthread_mutex_lock(&lib_ctx.mutext);
for (l = lib_ctx.device_list; l; l = l->next)
{
dev = l->data;
usb_dev_info = dev->conn;
if (usb_dev_info != NULL && dev->handle == (ds_device_handle)old_dev)
{
// Release the old device and the resource.
if (dev == lib_ctx.actived_device_instance)
{
sr_info("%s", "Release the old device's resource.");
close_device_instance(dev);
}
bus = libusb_get_bus_number(new_dev);
address = libusb_get_device_address(new_dev);
usb_dev_info->usb_dev = new_dev;
usb_dev_info->bus = bus;
usb_dev_info->address = address;
dev->handle = new_dev;
bFind = 1;
// Reopen the device.
if (dev == lib_ctx.actived_device_instance)
{
sr_info("%s", "Reopen the current device.");
open_device_instance(dev);
}
break;
}
}
pthread_mutex_unlock(&lib_ctx.mutext);
if (bFind)
{
return SR_OK;
}
return SR_ERR;
}
/**
* hotplug event
*/
static void hotplug_event_listen_callback(struct libusb_context *ctx, struct libusb_device *dev, int event)
{
int bDone = 0;
if (dev == NULL){
if (event == USB_EV_HOTPLUG_ATTACH)
dev = get_new_attached_usb_device();
else
dev = get_new_detached_usb_device();
}
if (dev == NULL){
sr_err("%s", "hotplug_event_listen_callback(), no devices to process");
return;
}
if (event == USB_EV_HOTPLUG_ATTACH)
{
sr_info("One device attached,handle:%p", dev);
if (lib_ctx.is_waitting_reconnect)
{
if (lib_ctx.attach_device_handle != NULL)
{
sr_err("One attached device haven't processed complete,handle:%p",
lib_ctx.attach_device_handle);
}
if (lib_ctx.detach_device_handle == NULL)
{
sr_err("%s", "The detached device handle is null, but the status is waitting for reconnect.");
}
else
{
if (update_device_handle(lib_ctx.detach_device_handle, dev) != SR_OK)
{
bDone = 1;
sr_info("%s", "One device loose contact, but it reconnect success.");
}
else
{
sr_err("Update device handle error! can't find the old.");
}
lib_ctx.detach_device_handle = NULL;
}
}
if (bDone == 0)
{
lib_ctx.attach_event_flag = 1; // Is a new device attched.
lib_ctx.attach_device_handle = dev;
}
lib_ctx.is_waitting_reconnect = 0;
}
else if (event == USB_EV_HOTPLUG_DETTACH)
{
sr_info("One device detached,handle:%p", dev);
if (lib_ctx.detach_device_handle != NULL)
{
sr_err("One detached device haven't processed complete,handle:%p",
lib_ctx.detach_device_handle);
}
if (lib_ctx.actived_device_instance != NULL
&& lib_ctx.actived_device_instance->handle == (ds_device_handle)dev
&& ds_is_collecting())
{
sr_info("%s", "The collecting device is detached, will stop the collect thread.");
lib_ctx.is_stop_by_detached = 1;
ds_release_actived_device();
}
/**
* Begin to wait the device reconnect, if timeout, will process the detach event.
*/
lib_ctx.is_waitting_reconnect = 1;
lib_ctx.check_reconnect_times = 0;
lib_ctx.detach_device_handle = dev;
}
else
{
sr_err("%s", "Unknown usb device event");
}
}
static void process_attach_event(int isEvent)
{
struct sr_dev_driver **drivers;
GList *dev_list;
GSList *l;
struct sr_dev_driver *dr;
int num = 0;
if (isEvent){
sr_info("%s", "Process device attach event.");
}
drivers = sr_driver_list();
while (*drivers)
{
dr = *drivers;
if (dr->driver_type == DRIVER_TYPE_HARDWARE)
{
dev_list = dr->scan(NULL);
if (dev_list != NULL)
{
sr_info("Get new device list by driver \"%s\"", dr->name);
pthread_mutex_lock(&lib_ctx.mutext);
for (l = dev_list; l; l = l->next)
{
lib_ctx.device_list = g_slist_append(lib_ctx.device_list, l->data);
num++;
}
pthread_mutex_unlock(&lib_ctx.mutext);
g_slist_free(dev_list);
}
}
drivers++;
}
// Tell user one new device attched, and the list is updated.
if (num > 0 && isEvent){
post_event_async(DS_EV_NEW_DEVICE_ATTACH);
}
lib_ctx.attach_device_handle = NULL;
}
static void process_detach_event()
{
GSList *l;
struct sr_dev_inst *dev;
struct sr_dev_driver *driver_ins;
libusb_device *ev_dev;
int ev;
sr_info("%s", "Process device detach event.");
ev = DS_EV_INACTIVE_DEVICE_DETACH;
ev_dev = lib_ctx.detach_device_handle;
if (ev_dev == NULL)
{
sr_err("%s", "The detached device handle is null.");
return;
}
lib_ctx.detach_device_handle = NULL;
pthread_mutex_lock(&lib_ctx.mutext);
for (l = lib_ctx.device_list; l; l = l->next)
{
dev = l->data;
if (dev->handle == (ds_device_handle)ev_dev)
{
// Found the device, and remove it from list.
lib_ctx.device_list = g_slist_remove(lib_ctx.device_list, l->data);
if (dev == lib_ctx.actived_device_instance)
{
sr_info("The current device will be delayed for destruction, handle:%p", dev->handle);
lib_ctx.is_delay_destory_actived_device = 1;
ev = DS_EV_CURRENT_DEVICE_DETACH;
}
else
{
destroy_device_instance(dev);
}
break;
}
}
pthread_mutex_unlock(&lib_ctx.mutext);
// Tell user a new device detached, and the list is updated.
post_event_async(ev);
}
static void usb_hotplug_process_proc()
{
sr_info("%s", "Hotplug thread start!");
while (!lib_ctx.lib_exit_flag)
{
sr_hotplug_wait_timout(lib_ctx.sr_ctx);
if (lib_ctx.attach_event_flag){
process_attach_event(1);
lib_ctx.attach_event_flag = 0;
}
if (lib_ctx.detach_event_flag){
process_detach_event();
lib_ctx.detach_event_flag = 0;
}
_sleep(100);
if (lib_ctx.is_waitting_reconnect)
{
lib_ctx.check_reconnect_times++;
// 500ms
if (lib_ctx.check_reconnect_times == 5)
{
// Device loose contact,wait for it reconnection timeout.
lib_ctx.detach_event_flag = 1; // use detach event
lib_ctx.is_waitting_reconnect = 0;
}
}
}
if (lib_ctx.callback_thread_count > 0)
{
sr_info("%d callback thread is actived, waiting all ends...", lib_ctx.callback_thread_count);
}
// Wait all callback thread end.
while (lib_ctx.callback_thread_count > 0)
{
_sleep(100);
}
sr_info("%s", "Hotplug thread end!");
}
static void make_demo_device_to_list()
{
struct sr_dev_driver **drivers;
struct sr_dev_driver *dr;
GList *dev_list;
GSList *l;
drivers = sr_driver_list();
while (*drivers)
{
dr = *drivers;
if (dr->driver_type == DRIVER_TYPE_DEMO)
{
dev_list = dr->scan(NULL);
if (dev_list != NULL)
{
for (l = dev_list; l; l = l->next)
{
lib_ctx.device_list = g_slist_append(lib_ctx.device_list, l->data);
}
g_slist_free(dev_list);
}
}
drivers++;
}
}
static void destroy_device_instance(struct sr_dev_inst *dev)
{
if (dev == NULL || dev->driver == NULL)
{
sr_err("%s", "destroy_device_instance() argument error.");
return;
}
struct sr_dev_driver *driver_ins;
driver_ins = dev->driver;
if (driver_ins->dev_destroy)
driver_ins->dev_destroy(dev);
else if (driver_ins->dev_close)
driver_ins->dev_close(dev);
}
static void close_device_instance(struct sr_dev_inst *dev)
{
if (dev == NULL || dev->driver == NULL)
{
sr_err("%s", "close_device_instance() argument error.");
return;
}
struct sr_dev_driver *driver_ins;
driver_ins = dev->driver;
if (driver_ins->dev_close)
driver_ins->dev_close(dev);
}
static int open_device_instance(struct sr_dev_inst *dev)
{
if (dev == NULL || dev->driver == NULL)
{
sr_err("%s", "open_device_instance() argument error.");
return SR_ERR_ARG;
}
struct sr_dev_driver *driver_ins;
driver_ins = dev->driver;
if (driver_ins->dev_open)
{
driver_ins->dev_open(dev);
return SR_OK;
}
return SR_ERR_CALL_STATUS;
}
static void post_event_proc(int event)
{
if (lib_ctx.event_callback != NULL)
{
lib_ctx.event_callback(event);
}
pthread_mutex_lock(&lib_ctx.mutext);
lib_ctx.callback_thread_count--;
pthread_mutex_unlock(&lib_ctx.mutext);
}
static void post_event_async(int event)
{
pthread_mutex_lock(&lib_ctx.mutext);
lib_ctx.callback_thread_count++;
pthread_mutex_unlock(&lib_ctx.mutext);
g_thread_new("callback_thread", post_event_proc, event);
}
static void send_event(int event)
{
if (lib_ctx.event_callback != NULL)
{
lib_ctx.event_callback(event);
}
}
static struct libusb_device* get_new_attached_usb_device()
{
struct libusb_device* array[MAX_DEVCIE_LIST_LENGTH];
int num;
int i;
GList *l;
int bFind;
struct libusb_device* dev;
struct sr_dev_inst *dev_ins;
sr_info("To find new attached device.");
dev = NULL;
num = 0;
ds_scan_all_device_list(lib_ctx.sr_ctx->libusb_ctx, &array, MAX_DEVCIE_LIST_LENGTH, &num);
pthread_mutex_lock(&lib_ctx.mutext);
for (i = 0; i < num; i++){
bFind = 0;
for (l = lib_ctx.device_list; l; l = l->next){
dev_ins = l->data;
if (dev_ins->handle == (ds_device_handle)array[i]){
bFind = 1;
break;
}
}
if (bFind == 0){
dev = array[i];
break;
}
}
pthread_mutex_unlock(&lib_ctx.mutext);
if (dev != NULL){
sr_info("Found new attached usb device:%p", dev);
}
return dev;
}
static struct libusb_device* get_new_detached_usb_device()
{
struct libusb_device* array[MAX_DEVCIE_LIST_LENGTH];
int num;
int i;
GList *l;
int bFind;
struct libusb_device* dev;
struct sr_dev_inst *dev_ins;
sr_info("To find new detached device.");
dev = NULL;
num = 0;
ds_scan_all_device_list(lib_ctx.sr_ctx->libusb_ctx, &array, MAX_DEVCIE_LIST_LENGTH, &num);
pthread_mutex_lock(&lib_ctx.mutext);
for (l = lib_ctx.device_list; l; l = l->next)
{
bFind = 0;
dev_ins = l->data;
if (dev_ins->dev_type != DEV_TYPE_USB){
continue;
}
for (i = 0; i < num; i++){
if (dev_ins->handle == (ds_device_handle)array[i]){
bFind = 1;
break;
}
}
if (bFind == 0){
dev = (libusb_device*)dev_ins->handle;
break;
}
}
pthread_mutex_unlock(&lib_ctx.mutext);
if (dev != NULL){
sr_info("Found new detached usb device:%p", dev);
}
return dev;
}
/**-------------------private function end---------------*/