Implement module dispatcher functions

[platform/core/connectivity/zigbee-manager.git] / zigbee-daemon / zigbee-lib / src / drivers / zblib_driver_mfglib_control.c

diff --git a/zigbee-daemon/zigbee-lib/src/drivers/zblib_driver_mfglib_control.c b/zigbee-daemon/zigbee-lib/src/drivers/zblib_driver_mfglib_control.c
index e8ae16e..95cf751 100644 (file)
--- a/zigbee-daemon/zigbee-lib/src/drivers/zblib_driver_mfglib_control.c
+++ b/zigbee-daemon/zigbee-lib/src/drivers/zblib_driver_mfglib_control.c
@@ -18,6 +18,7 @@
 
 #include <zblib.h>
 #include <zblib_driver.h>
+#include <zblib_request.h>
 
 #include "zblib_driver_mfglib_control.h"
 
@@ -26,31 +27,187 @@ typedef struct {
        ZblibDriverMfglibControlOps_t *ops; /**< Operations */
 } ZblibDriverMfglibControlPrivData_t;
 
-static gboolean __zblib_driver_mfglib_control_dispatcher(ZigBeeDriver *driver)
+static gboolean __zblib_driver_mfglib_control_dispatcher(ZigBeeDriver *driver, guint request_id)
 {
-       if (NULL == driver) {
-               Z_LOGE("driver is NULL");
-               return FALSE;
+       ZigBeeService *service = NULL;
+       ZblibDriverMfglibControlPrivData_t *priv_data = NULL;
+       ZblibDriverMfglibControlOps_t *ops = NULL;
+       guint request_type;
+       guint ops_id;
+       gboolean ret = FALSE;
+
+       zblib_check_null_ret_error("driver", driver, FALSE);
+
+       service = zblib_driver_ref_service(driver);
+       zblib_check_null_ret_error("service", service, FALSE);
+
+       /* Fetch private data */
+       priv_data = zblib_driver_ref_object(driver);
+       zblib_check_null_ret_error("priv_data", priv_data, FALSE);
+
+       ops = priv_data->ops;
+       zblib_check_null_ret_error("ops", ops, FALSE);
+
+       /* Fetch request_type using request_id */
+       request_type = zblib_request_ref_request_type_by_request_id(service, request_id);
+
+       /* Fetch ops ID */
+       ops_id = zblib_request_get_ops_id(request_type);
+       switch (ops_id) {
+       case ZBLIB_MFGLIB_CONTROL_OPS_START: {
+               zblib_check_null_ret_error("ops->start",
+                       ops->start, FALSE);
+
+               ret = ops->start(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_END: {
+               zblib_check_null_ret_error("ops->end",
+                       ops->end, FALSE);
+
+               ret = ops->end(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_START_TONE: {
+               zblib_check_null_ret_error("ops->start_tone",
+                       ops->start_tone, FALSE);
+
+               ret = ops->start_tone(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_STOP_TONE: {
+               zblib_check_null_ret_error("ops->stop_tone",
+                       ops->stop_tone, FALSE);
+
+               ret = ops->stop_tone(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_START_STREAM: {
+               zblib_check_null_ret_error("ops->start_stream",
+                       ops->start_stream, FALSE);
+
+               ret = ops->start_stream(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_STOP_STREAM: {
+               zblib_check_null_ret_error("ops->stop_stream",
+                       ops->stop_stream, FALSE);
+
+               ret = ops->stop_stream(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_SEND_PACKET: {
+               zblib_check_null_ret_error("ops->send_packet",
+                       ops->send_packet, FALSE);
+
+               ret = ops->send_packet(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_SET_CHANNEL: {
+               zblib_check_null_ret_error("ops->set_channel",
+                       ops->set_channel, FALSE);
+
+               ret = ops->set_channel(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_GET_CHANNEL: {
+               zblib_check_null_ret_error("ops->get_channel",
+                       ops->get_channel, FALSE);
+
+               ret = ops->get_channel(driver, request_id);
        }
+       break;
 
-       return TRUE;
+       case ZBLIB_MFGLIB_CONTROL_OPS_SET_POWER: {
+               zblib_check_null_ret_error("ops->set_power",
+                       ops->set_power, FALSE);
+
+               ret = ops->set_power(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_GET_POWER: {
+               zblib_check_null_ret_error("ops->get_power",
+                       ops->get_power, FALSE);
+
+               ret = ops->get_power(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_SET_SYNOFFSET: {
+               zblib_check_null_ret_error("ops->set_synoffset",
+                       ops->set_synoffset, FALSE);
+
+               ret = ops->set_synoffset(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_GET_SYNOFFSET: {
+               zblib_check_null_ret_error("ops->get_synoffset",
+                       ops->get_synoffset, FALSE);
+
+               ret = ops->get_synoffset(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_RX_START: {
+               zblib_check_null_ret_error("ops->rx_start",
+                       ops->rx_start, FALSE);
+
+               ret = ops->rx_start(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_RX_STOP: {
+               zblib_check_null_ret_error("ops->rx_stop",
+                       ops->rx_stop, FALSE);
+
+               ret = ops->rx_stop(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_RX_VERIFY: {
+               zblib_check_null_ret_error("ops->rx_verify",
+                       ops->rx_verify, FALSE);
+
+               ret = ops->rx_verify(driver, request_id);
+       }
+       break;
+
+       case ZBLIB_MFGLIB_CONTROL_OPS_GET_RSSI: {
+               zblib_check_null_ret_error("ops->get_rssi",
+                       ops->get_rssi, FALSE);
+
+               ret = ops->get_rssi(driver, request_id);
+       }
+       break;
+
+       default:
+       break;
+       }
+
+       Z_LOGD("ret: [%d]", ret);
+
+       return ret;
 }
 
 static void __zblib_driver_mfglib_control_free_hook(ZigBeeDriver *driver)
 {
        ZblibDriverMfglibControlPrivData_t *priv_data = NULL;
 
-       if (NULL == driver) {
-               Z_LOGE("driver is NULL");
-               return;
-       }
+       zblib_check_null_ret("driver", driver);
 
        /* Fetch private data */
        priv_data = zblib_driver_ref_object(driver);
-       if (NULL == priv_data) {
-               Z_LOGE("priv_data is NULL");
-               return;
-       }
+       zblib_check_null_ret("priv_data", priv_data);
 
        /* Free resources */
        g_free(priv_data);
@@ -64,17 +221,11 @@ ZigBeeDriver *zblib_driver_mfglib_control_new(ZigBeePlugin *plugin,
        ZblibDriverMfglibControlPrivData_t *priv_data = NULL;
        gboolean ret;
 
-       if (NULL == plugin) {
-               Z_LOGE("plugin is NULL");
-               return NULL;
-       }
+       zblib_check_null_ret_error("plugin", plugin, NULL);
 
        /* Create new driver */
        driver = zblib_driver_new(plugin, driver_name, ZBLIB_DRIVER_TYPE_MFGLIB_CONTROL);
-       if (NULL == driver) {
-               Z_LOGE("driver is NULL");
-               return NULL;
-       }
+       zblib_check_null_ret_error("driver", driver, NULL);
 
        /* Allocate memory for private data */
        priv_data = g_malloc0(sizeof(ZblibDriverMfglibControlPrivData_t));
@@ -123,10 +274,7 @@ ZigBeeDriver *zblib_driver_mfglib_control_new(ZigBeePlugin *plugin,
 
 void zblib_driver_mfglib_control_free(ZigBeeDriver *driver)
 {
-       if (NULL == driver) {
-               Z_LOGE("driver is NULL");
-               return;
-       }
+       zblib_check_null_ret("driver", driver);
 
        /* Free driver */
        zblib_driver_free(driver);