Fix potential memory leak. #73

Chernov Dmitriy

2016-03-02 3344d1a728d37f0fb3e82a6a945eee0c780eb734

 libscpi/src/error.c

@@ -41,16 +41,12 @@
#include "scpi/error.h"
#include "fifo_private.h"

/* basic FIFO */
static scpi_fifo_t local_error_queue;

/**
 * Initialize error queue
 * @param context - scpi context
 */
void SCPI_ErrorInit(scpi_t * context) {
    context->error_queue = (scpi_error_queue_t) & local_error_queue;
    fifo_init((scpi_fifo_t *) context->error_queue);
void SCPI_ErrorInit(scpi_t * context, scpi_error_t * data, int16_t size) {
    fifo_init(&context->error_queue, data, size);
}

/**
@@ -85,7 +81,13 @@
 * @param context - scpi context
 */
void SCPI_ErrorClear(scpi_t * context) {
    fifo_clear((scpi_fifo_t *) context->error_queue);
#if USE_DEVICE_DEPENDENT_ERROR_INFORMATION
   scpi_error_t error;
   while(fifo_remove(&context->error_queue, &error)){
      SCPIDEFINE_free(&context->error_info_heap, error.device_dependent_info, false);
   }
#endif	
    fifo_clear(&context->error_queue);

    SCPI_ErrorEmitEmpty(context);
}
@@ -93,16 +95,18 @@
/**
 * Pop error from queue
 * @param context - scpi context
 * @return error number
 * @param error
 * @return 
 */
int16_t SCPI_ErrorPop(scpi_t * context) {
    int16_t result = 0;
scpi_bool_t SCPI_ErrorPop(scpi_t * context, scpi_error_t * error) {
   if(!error || !context) return FALSE;
   error->error_code = 0;
   error->device_dependent_info = NULL;
   fifo_remove(&context->error_queue, error);

    fifo_remove((scpi_fifo_t *) context->error_queue, &result);
   SCPI_ErrorEmitEmpty(context);

    SCPI_ErrorEmitEmpty(context);

    return result;
   return TRUE;
}

/**
@@ -113,16 +117,18 @@
int32_t SCPI_ErrorCount(scpi_t * context) {
    int16_t result = 0;

    fifo_count((scpi_fifo_t *) context->error_queue, &result);
    fifo_count(&context->error_queue, &result);

    return result;
}

static void SCPI_ErrorAddInternal(scpi_t * context, int16_t err) {
    if (!fifo_add((scpi_fifo_t *) context->error_queue, err)) {
        fifo_remove_last((scpi_fifo_t *) context->error_queue, NULL);
        fifo_add((scpi_fifo_t *) context->error_queue, SCPI_ERROR_QUEUE_OVERFLOW);
static scpi_bool_t SCPI_ErrorAddInternal(scpi_t * context, int16_t err, char * info) {
    if (!fifo_add(&context->error_queue, err, info)) {
        fifo_remove_last(&context->error_queue, NULL);
        fifo_add(&context->error_queue, SCPI_ERROR_QUEUE_OVERFLOW, NULL);
        return FALSE;
    }
    return TRUE;
}

struct error_reg {
@@ -150,23 +156,45 @@
 * @param context - scpi context
 * @param err - error number
 */
void SCPI_ErrorPushEx(scpi_t * context, int16_t err, char * info) {
   int i;
   char * info_ptr = NULL;
	
#if USE_DEVICE_DEPENDENT_ERROR_INFORMATION
   if (info){
      info_ptr = SCPIDEFINE_strdup(&context->error_info_heap, info);
   }
#endif

   scpi_bool_t queue_overflow = !SCPI_ErrorAddInternal(context, err, info_ptr);

   for (i = 0; i < ERROR_DEFS_N; i++) {
      if ((err <= errs[i].from) && (err >= errs[i].to)) {
         SCPI_RegSetBits(context, SCPI_REG_ESR, errs[i].bit);
      }
   }

   SCPI_ErrorEmit(context, err);
   if (queue_overflow) {
      SCPI_ErrorEmit(context, SCPI_ERROR_QUEUE_OVERFLOW);
#if USE_DEVICE_DEPENDENT_ERROR_INFORMATION		
      SCPIDEFINE_free(&context->error_info_heap, info_ptr, true);
#endif
   }

   if (context) {
      context->cmd_error = TRUE;
   }
}

/**
 * Push error to queue
 * @param context - scpi context
 * @param err - error number
 */
void SCPI_ErrorPush(scpi_t * context, int16_t err) {

    int i;

    SCPI_ErrorAddInternal(context, err);

    for (i = 0; i < ERROR_DEFS_N; i++) {
        if ((err <= errs[i].from) && (err >= errs[i].to)) {
            SCPI_RegSetBits(context, SCPI_REG_ESR, errs[i].bit);
        }
    }

    SCPI_ErrorEmit(context, err);

    if (context) {
        context->cmd_error = TRUE;
    }
   SCPI_ErrorPushEx(context, err, NULL);
   return;
}

/**
@@ -183,14 +211,14 @@
#else
#define XE(def, val, str)
#endif
            LIST_OF_ERRORS
        LIST_OF_ERRORS

#if USE_USER_ERROR_LIST
                    LIST_OF_USER_ERRORS
        LIST_OF_USER_ERRORS
#endif
#undef X
#undef XE
                default: return "Unknown error";
        default: return "Unknown error";
    }
}