psl_ndx.h

Go to the documentation of this file.

 
#ifndef LIBELUTILS_ELUTILS_PSL_NDX_H_
#define LIBELUTILS_ELUTILS_PSL_NDX_H_
 
#include "elutils/c_decls.h"
__BEGIN_DECLS /* till __END_DECLS */
 
typedef struct _psl_ndx_t {
    int prev;
    int next;
} psl_ndx_t;
static inline void psl_ndx_init(psl_ndx_t *ndx) {ndx->prev = ndx->next = -1;}
 
#define PSL_NDX_ELEM_NEXT(ARR_BASE, LINK_FIELD_NAME, NDX) (ARR_BASE[NDX].LINK_FIELD_NAME.next)
#define PSL_NDX_ELEM_PREV(ARR_BASE, LINK_FIELD_NAME, NDX) (ARR_BASE[NDX].LINK_FIELD_NAME.prev)
 
#define PSL_NDX_ELEM_PREV_PTR(ARR_BASE, LINK_FIELD_NAME, NDX) (ARR_BASE[NDX].LINK_FIELD_NAME.prev != -1? &(ARR_BASE[ARR_BASE[NDX].LINK_FIELD_NAME.prev]) : NULL)
#define PSL_NDX_ELEM_NEXT_PTR(ARR_BASE, LINK_FIELD_NAME, NDX) (ARR_BASE[NDX].LINK_FIELD_NAME.prev != -1? &(ARR_BASE[ARR_BASE[NDX].LINK_FIELD_NAME.next]) : NULL)
 
 
static inline void psl_ndx_add_head(psl_ndx_t *base, psl_ndx_t *new_node, psl_ndx_t *next_node, int new_ndx)
{
    new_node->next = base->next;
    new_node->prev = next_node->prev;
    next_node->prev = new_ndx;
    base->next = new_ndx;
}    //void psl_ndx_add_head(psl_ndx_t *base, psl_ndx_t *new_node, psl_ndx_t *next_node, int new_ndx) =================
 
static inline void psl_ndx_add_tail(psl_ndx_t *base, psl_ndx_t *new_node, psl_ndx_t *prev_node, int new_ndx)
{
    new_node->prev = base->prev;
    new_node->next = prev_node->next;
    prev_node->next = new_ndx;
    base->prev = new_ndx;
}    //void psl_ndx_add_head(psl_ndx_t *base, psl_ndx_t *new_node, psl_ndx_t *next_node, int new_ndx) =================
 
 
//how to use ndx list
//
// * \brief add sensor <b>sensor_ndx</b> to node <b>node_ndx</b> at head
// *
// * Warning! NO checks.
// */
//void node_sensors_list_add_head(sensors_config_t *sc, int node_ndx, int sensor_ndx)
//{
//    sensor_config_node_t *node = &sc->sensor_config_nodes[node_ndx];
//    if (node->sensors_list_cnt < 1) {
//  MB_DBG("This func work when have at least 1 element in list.");
//  return;
//    }
//
//    io_config_t *add_io = &sc->io_configs[sensor_ndx];
//    io_config_t *t_io = &sc->io_configs[node->sensors_list.next];
//
//#pragma GCC diagnostic push
//#pragma GCC diagnostic ignored "-Waddress-of-packed-member"
//    psl_ndx_add_head(&node->sensors_list, &add_io->node_link, &t_io->node_link, sensor_ndx);
//#pragma GCC diagnostic pop
//    node->sensors_list_cnt++;
//
//    MB_DBG("set node(%i:%i) io[%i](%i:%i) prev io[%i](%i:%i)\n", node->sensors_list.prev, node->sensors_list.next, sensor_ndx, add_io->node_link.prev, add_io->node_link.next, add_io->node_link.prev,
//     t_io->node_link.prev, t_io->node_link.next);
//}    //void node_sensors_list_add_head(sensors_config_t *sc, int node_ndx, int sensor_ndx) =================
//
// * \brief add sensor <b>sensor_ndx</b> to node <b>node_ndx</b> at tail
// *
// * Warning! NO checks.
// */
//void node_sensors_list_add_tail(sensors_config_t *sc, int node_ndx, int sensor_ndx)
//{
//    sensor_config_node_t *node = &sc->sensor_config_nodes[node_ndx];
//    if (node->sensors_list_cnt < 1) {
//  MB_DBG("This func work when have at least 1 element in list.");
//  return;
//    }
//
//    io_config_t *add_io = &sc->io_configs[sensor_ndx];
//    io_config_t *t_io = &sc->io_configs[node->sensors_list.prev];
//
//#pragma GCC diagnostic push
//#pragma GCC diagnostic ignored "-Waddress-of-packed-member"
//    psl_ndx_add_tail(&node->sensors_list, &add_io->node_link, &t_io->node_link, sensor_ndx);
//#pragma GCC diagnostic pop
//    node->sensors_list_cnt++;
//
//    MB_DBG("set node(%i:%i) io[%i](%i:%i) prev io[%i](%i:%i)\n", node->sensors_list.prev, node->sensors_list.next, sensor_ndx, add_io->node_link.prev, add_io->node_link.next, add_io->node_link.prev,
//     t_io->node_link.prev, t_io->node_link.next);
//}    //void node_sensors_list_add_tail(sensors_config_t *sc, int node_ndx, int sensor_ndx) =================
//
// * \brief insert sensor into node's list according address which can be addr_sens_t or addr_disc_t
// * \param sc ptr to global sensors config
// * \return  0 on success
// * \return -1 on error (not insert)
// */
//int node_sensors_list_insert(sensors_config_t *sc, int node_ndx, int io_ndx)
//{
//    if (sc == NULL) {
//  MB_DBG("DBG: sensors confog == NULL\n");
//  return -1;
//    }
//    if (node_ndx < 0 || node_ndx >= sc->sensor_config_nodes_cnt) {
//  MB_DBG("node index exceed limits\n");
//  return -1;
//    }
//
//    if (io_ndx < 0 || io_ndx >= sc->io_configs_cnt) {
//  MB_DBG("io index exceed limits\n");
//  return -1;
//    }
//
//    sensor_config_node_t *node = &sc->sensor_config_nodes[node_ndx];
//    io_config_t *io = &sc->io_configs[io_ndx];
//
//    //io_config_t *t_io;
//    int rcl;
//    cmp_io_addr_t addr_cmper;
//    int is_analog = 0;
//
//    node_addr_t sens_node_addr = ((sens_addr_t*) &io->aio.addr)->addr;
//
//    if (sens_node_addr.value != node->nodeInfo.addr.value) {
//  MB_DBG("DBG: node address of IO not match node address.\n");
//  return -1;
//    }
//
//    if (node->sensors_list_cnt == 0) {
//  io->node_link.next = -1;
//  io->node_link.prev = -1;
//  node->sensors_list.next = io_ndx;
//  node->sensors_list.prev = io_ndx;
//  node->sensors_list_cnt = 1;
//  //sc_print_node_io(sc, node_ndx, "First element");
//  return 0;
//    }
//
//    if (io->type == SN_VAL_ANALOG) {
//  addr_cmper = cmp_addr_sens;
//  is_analog = 1;
//    }
//    else if (io->type == SN_VAL_DISCRETE) {
//  addr_cmper = cmp_addr_disc;
//  is_analog = 0;
//    }
//    else {
//  MB_DBG("WRONG IO type '%i'\n", io->type);
//  return -1;
//    }
//
//    //list_cnt >1 //node->sensors_list_cnt >= 1
//    if (io->type == SN_VAL_ANALOG) {
//  /// search posiotion to insert. 3 variants: put at first,  put between,  put last.
//  int t_ndx;
//  int t_i = node->sensors_list.next;
//  io_config_t *t_io = &sc->io_configs[t_i];
//
//  rcl = cmp_addr_sens(&io->aio.addr, &t_io->aio.addr);
//  if (rcl == 0) {
//      print_addr_sens(&io->aio.addr, "Analog Node already have sensor with this address");
//      return -1;
//  }
//  //if addr of first element in list > io.addr then insert io befor t_io
//  if (rcl < 0) {
//      //node_sensors_list_add_head(sc, node_ndx, io_ndx)
//      psl_ndx_add_head(&node->sensors_list, &io->node_link, &t_io->node_link, io_ndx);
//      node->sensors_list_cnt++;
//      return 0;
//  }
//  //put io in list after current list element (first)
//  //go search
//  //here: node - ptr to node with need addr, io - ptr to new IO, ndx  - index if new IO, t_io current IO
//  while (1) {
//      if (t_io->node_link.next == -1) {
//      //io.addr > t_io.addr of last element in list
//#pragma GCC diagnostic push
//#pragma GCC diagnostic ignored "-Waddress-of-packed-member"
//      psl_ndx_add_tail(&node->sensors_list, &io->node_link, &t_io->node_link, io_ndx);
//      node->sensors_list_cnt++;
//#pragma GCC diagnostic pop
//      return 0;
//      }
//
//      io_config_t *t_ion = &sc->io_configs[t_io->node_link.next];
//      rcl = cmp_addr_sens(&io->aio.addr, &t_ion->aio.addr);
//      if (rcl == 0) {
//      print_addr_sens(&io->aio.addr, "Node already have sensor with this address");
//      return -1;
//      }
//
//      if (rcl < 0) {
//#pragma GCC diagnostic push
//#pragma GCC diagnostic ignored "-Waddress-of-packed-member"
//      psl_ndx_add_head(&t_io->node_link, &io->node_link, &t_ion->node_link, io_ndx);
//      node->sensors_list_cnt++;
//#pragma GCC diagnostic pop
//      return 0;
//      }
//      //step to next element in list
//      t_io = t_ion;
//  }    //walk through IO list in node ===
//  print_addr_sens(&io->aio.addr, "ANALOG IMPOSSIBLE");
//    }    //if (io->type == SN_VAL_ANALOG) =========
//    else if (io->type == SN_VAL_DISCRETE) {
//  /// search posiotion to insert. 3 variants: put at first,  put between,  put last.
//  int t_ndx;
//  int t_i = node->sensors_list.next;
//  io_config_t *t_io = &sc->io_configs[t_i];
//
//  rcl = cmp_addr_disc(&io->dio.addr, &t_io->dio.addr);
//  if (rcl == 0) {
//      print_addr_disc(&io->dio.addr, "Node already have sensor with this address");
//      return -1;
//  }
//  //if addr of first element in list > io.addr then insert io befor t_io
//  if (rcl < 0) {
//      //node_sensors_list_add_head(sc, node_ndx, io_ndx)
//#pragma GCC diagnostic push
//#pragma GCC diagnostic ignored "-Waddress-of-packed-member"
//      psl_ndx_add_head(&node->sensors_list, &io->node_link, &t_io->node_link, io_ndx);
//      node->sensors_list_cnt++;
//#pragma GCC diagnostic pop
//      return 0;
//  }
//  //put io in list after current list element (first)
//  //go search
//  //here: node - ptr to node with need addr, io - ptr to new IO, ndx  - index if new IO, t_io current IO
//  while (1) {
//      if (t_io->node_link.next == -1) {
//      //io.addr > t_io.addr of last element in list
//#pragma GCC diagnostic push
//#pragma GCC diagnostic ignored "-Waddress-of-packed-member"
//      psl_ndx_add_tail(&node->sensors_list, &io->node_link, &t_io->node_link, io_ndx);
//      node->sensors_list_cnt++;
//#pragma GCC diagnostic pop
//      return 0;
//      }
//
//      io_config_t *t_ion = &sc->io_configs[t_io->node_link.next];
//      rcl = cmp_addr_disc(&io->dio.addr, &t_ion->dio.addr);
//      if (rcl == 0) {
//      print_addr_disc(&io->dio.addr, "Node already have sensor with this address");
//      return -1;
//      }
//
//      if (rcl < 0) {
//#pragma GCC diagnostic push
//#pragma GCC diagnostic ignored "-Waddress-of-packed-member"
//      psl_ndx_add_head(&t_io->node_link, &io->node_link, &t_ion->node_link, io_ndx);
//      node->sensors_list_cnt++;
//#pragma GCC diagnostic pop
//      return 0;
//      }
//      //step to next element in list
//      t_io = t_ion;
//  }    //walk through IO list in node ===
//  print_addr_disc(&io->dio.addr, "DISCRETE IMPOSSIBLE");
//    } //if (io->type == SN_VAL_DISCRETE) ==========
//    else {
//  MB_DBG("Once more wrong sensor type\n");
//    }    //if (node->nodeInfo.addr.value != io->)===================================================
//
//    return 0;
//}    //void node_sensors_list_insert(sensors_config_t *sc, int node_ndx, int sensor_ndx) =====================
//
 
__END_DECLS
#endif /* LIBELUTILS_ELUTILS_PSL_NDX_H_ */