/* Copyright (c) 2001-2009 by SoftIntegration, Inc. All Rights Reserved */
#include<ch.h>
#include<stdio.h>
/* ... */

/* function pointer type which points the function with argument */
typedef void (*funcHandle)(data_type2); 

static ChInterp_t interp;
/* C function to replace the Ch function pointer */
static void setFunction3_chdl_funarg(data_type2 arg2); 

/* save the function pointer from the Ch space */
static void *setFunction3_chdl_funptr; 

EXPORTCH void setFunction3_chdl(void *varg) {
  ChVaList_t ap;
  data_type1 arg1;
  funcHandle handle_ch, handle_c = NULL;

  Ch_VaStart(interp, ap, varg);
  arg1 = Ch_VaArg(interp, ap, data_type1);   /* get 1st argument  */
  /* get and save Ch function pointer */
  handle_ch = Ch_VaArg(interp, ap, funcHandle);   
  setFunction3_chdl_funptr = (void *)handle_ch;

  /* replace the Ch function pointer with the C one,
     the NULL pointer can't be replaced */
  if(handle_ch != NULL) { 
    handle_c = (funcHandle)setFunction3_chdl_funarg;
  }

  setFunction3(arg1, handle_c);

  Ch_VaEnd(interp, ap);
}

static void setFunction3_chdl_funarg(data_type2 arg2) {
  /* Call Ch callback function by its address */
  Ch_CallFuncByAddr(interp, setFunction3_chdl_funptr, NULL, arg2);
}
