First version of asfvolt16 device driver code
Change-Id: I806c2eaeebc7f8df7073c8264a7fdc6011b0d103
diff --git a/src/bal_subscriber_terminal_hdlr.c b/src/bal_subscriber_terminal_hdlr.c
new file mode 100755
index 0000000..30d89fa
--- /dev/null
+++ b/src/bal_subscriber_terminal_hdlr.c
@@ -0,0 +1,313 @@
+/*
+** Copyright 2017-present Open Networking Foundation
+**
+** Licensed under the Apache License, Version 2.0 (the "License");
+** you may not use this file except in compliance with the License.
+** You may obtain a copy of the License at
+**
+** http://www.apache.org/licenses/LICENSE-2.0
+**
+** Unless required by applicable law or agreed to in writing, software
+** distributed under the License is distributed on an "AS IS" BASIS,
+** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+** See the License for the specific language governing permissions and
+** limitations under the License.
+*/
+
+#include <stdio.h>
+#include <bal_api.h>
+
+#undef _SYS_QUEUE_H_
+
+#include "asfvolt16_driver.h"
+#include "bal_subscriber_terminal_hdlr.h"
+
+/********************************************************************\
+ * Function : bal_subscriber_terminal_cfg_set *
+ * Description : Configures the subscriber terminal(ONU) *
+ ********************************************************************/
+uint32_t bal_subscriber_terminal_cfg_set(BalSubscriberTerminalCfg *onu_cfg)
+{
+
+ bcmos_errno err = BCM_ERR_OK;
+ bcmbal_subscriber_terminal_cfg sub_term_obj = {};
+ bcmbal_subscriber_terminal_key subs_terminal_key;
+ bcmos_bool skip_onu = BCMOS_FALSE;
+
+ int idx;
+
+ subs_terminal_key.sub_term_id = onu_cfg->key->sub_term_id;
+ subs_terminal_key.intf_id = onu_cfg->key->intf_id;
+
+ ASFVOLT_LOG(ASFVOLT_INFO, "Bringing up the subscriber terminal: %d\n", onu_cfg->key->sub_term_id);
+
+ /*
+ * Set the key in the subscriber terminal object
+ */
+ BCMBAL_CFG_INIT(&sub_term_obj, subscriber_terminal, subs_terminal_key);
+
+ {
+ bcmbal_serial_number serial_num = {} ;
+ bcmbal_serial_number zero_serial_num = {};
+ bcmbal_registration_id registration_id = {};
+ int has_serial_num = BCMOS_FALSE;
+ int has_registration_id = BCMOS_FALSE;
+ char two_digit_buf[3];
+
+ two_digit_buf[2] = 0;
+
+ ASFVOLT_LOG(ASFVOLT_DEBUG, "Before encoding,Vendor Id(%s),Vendor Specific Id(%s), Registration Id(%s)\n",
+ onu_cfg->data->serial_number->vendor_id,
+ onu_cfg->data->serial_number->vendor_specific,
+ onu_cfg->data->registration_id);
+
+ char vendor_id[20];
+ memset(&vendor_id, 0, 20);
+ sprintf(vendor_id,"%2X%2X%2X%2X",
+ onu_cfg->data->serial_number->vendor_id[0],
+ onu_cfg->data->serial_number->vendor_id[1],
+ onu_cfg->data->serial_number->vendor_id[2],
+ onu_cfg->data->serial_number->vendor_id[3]);
+ onu_cfg->data->serial_number->vendor_id = vendor_id;
+ ASFVOLT_LOG(ASFVOLT_DEBUG, "After encoding,Vendor Id(%s),Vendor Specific Id(%s), Registration Id(%s)\n",
+ onu_cfg->data->serial_number->vendor_id,
+ onu_cfg->data->serial_number->vendor_specific,
+ onu_cfg->data->registration_id);
+
+ /* Vendor Id is totally 16 byte string and should be
+ send in hexadecimmal format */
+ for(idx=0; idx<2*sizeof(serial_num.vendor_id); idx+=2)
+ {
+ memcpy(two_digit_buf, &onu_cfg->data->serial_number->vendor_id[idx], 2);
+ serial_num.vendor_id[idx>>1] = strtol(two_digit_buf, NULL, 16);
+ has_serial_num = BCMOS_TRUE;
+ }
+ for(idx=0; idx<2*sizeof(serial_num.vendor_specific); idx+=2)
+ {
+ memcpy(two_digit_buf, &onu_cfg->data->serial_number->vendor_specific[idx], 2);
+ serial_num.vendor_specific[idx>>1] = strtol(two_digit_buf, NULL, 16);
+ }
+
+ ASFVOLT_CFG_PROP_SET(sub_term_obj, subscriber_terminal, serial_number,
+ has_serial_num, serial_num);
+
+ /* Registration ID is a string and should be given in hexadecimal format */
+ for(idx=0; idx<strlen(onu_cfg->data->registration_id) && idx<2*sizeof(registration_id.arr); idx+=2)
+ {
+ memcpy(two_digit_buf, &onu_cfg->data->registration_id[idx], 2);
+ registration_id.arr[idx>>1] = strtol(two_digit_buf, NULL, 16);
+ has_registration_id = BCMOS_TRUE;
+ }
+
+ ASFVOLT_CFG_PROP_SET(sub_term_obj, subscriber_terminal, registration_id,
+ has_registration_id, registration_id);
+
+ if (!memcmp(&serial_num, &zero_serial_num, sizeof(serial_num)))
+ skip_onu = BCMOS_TRUE;
+ }
+
+ ASFVOLT_CFG_PROP_SET(sub_term_obj, subscriber_terminal, admin_state,
+ BCMOS_TRUE, BCMBAL_STATE_UP);
+
+ if (!skip_onu)
+ {
+
+ /*ASFVOLT_LOG(ASFVOLT_DEBUG, "Onu's(%d) Serial number %02x%02x%02x%2x%02x%02x%02x%02x\n",
+ onu_cfg->key->sub_term_id,
+ sub_term_obj.data->serial_number.vendor_id[0], sub_term_obj.data->serial_number.vendor_id[1],
+ sub_term_obj.data->serial_number.vendor_id[2], sub_term_obj.data->serial_number.vendor_id[3],
+ sub_term_obj.data->serial_number.vendor_specific[0], sub_term_obj.data->serial_number.vendor_specific[1],
+ sub_term_obj.data->serial_number.vendor_specific[2], sub_term_obj.data->serial_number.vendor_specific[3]);*/
+
+ err = bcmbal_cfg_set(DEFAULT_ATERM_ID, &(sub_term_obj.hdr));
+
+ ASFVOLT_LOG(ASFVOLT_DEBUG,
+ "\n ....SENT SUBSCRIBER TERMINAL %s UP %d on interface %d...\n",
+ (BCM_ERR_OK != err) ? "NOT" : "\b",
+ subs_terminal_key.sub_term_id,
+ subs_terminal_key.intf_id);
+ }
+ else
+ {
+ ASFVOLT_LOG(ASFVOLT_DEBUG,
+ "Skipping activation of subscriber terminal %d on interface %d\n",
+ subs_terminal_key.sub_term_id,
+ subs_terminal_key.intf_id);
+ err = BAL_ERRNO__BAL_ERR_PARM;
+ }
+
+ return BAL_ERRNO__BAL_ERR_OK;
+}
+
+
+/********************************************************************\
+ * Function : bal_subscriber_terminal_indication_cb *
+ * Description : Call Back indication registered with BAL to handle *
+ * events related to subscriber terminal(ONU) *
+ ********************************************************************/
+bcmos_errno bal_subscriber_terminal_indication_cb(bcmbal_obj *obj)
+{
+ bcmos_errno result = BCM_ERR_OK;
+
+#if 0
+ bcmbal_subscriber_terminal_cfg *cfg = ((bcmbal_subscriber_terminal_cfg *)obj);
+
+ if(BCMBAL_OBJ_ID_SUBSCRIBER_TERMINAL == obj->obj_type)
+ {
+ bcmbal_serial_number *p_serial_number =
+ (((bcmbal_subscriber_terminal_cfg *)obj)->data->serial_number);
+
+ if(BCMBAL_SUB_ID_UNKNOWN == (((bcmbal_subscriber_terminal_cfg *)obj)->key.sub_term_id))
+ {
+ ASFVOLT_LOG(ASFVOLT_INFO, "New ONU Discovered. serial number "
+ "%2X%2X%2X%2X%1X%1X%1X%1X%1X%1X%1X%1X "
+ "on PON %d\n",
+ p_serial_number->vendor_id[0],
+ p_serial_number->vendor_id[1],
+ p_serial_number->vendor_id[2],
+ p_serial_number->vendor_id[3],
+ p_serial_number->vendor_specific[0]>>4 & 0x0f,
+ p_serial_number->vendor_specific[0] & 0x0f,
+ p_serial_number->vendor_specific[1]>>4 & 0x0f,
+ p_serial_number->vendor_specific[1] & 0x0f,
+ p_serial_number->vendor_specific[2]>>4 & 0x0f,
+ p_serial_number->vendor_specific[2] & 0x0f,
+ p_serial_number->vendor_specific[3]>>4 & 0x0f,
+ p_serial_number->vendor_specific[3] & 0x0f,
+
+ ((bcmbal_subscriber_terminal_cfg *)obj)->key.intf_id);
+
+ }
+ else
+ {
+ ASFVOLT_LOG(ASFVOLT_INFO, "Event on existing ONU. serial number "
+ "%2X%2X%2X%2X%1X%1X%1X%1X%1X%1X%1X%1X "
+ "on PON %d\n",
+ p_serial_number->vendor_id[0],
+ p_serial_number->vendor_id[1],
+ p_serial_number->vendor_id[2],
+ p_serial_number->vendor_id[3],
+ p_serial_number->vendor_specific[0]>>4 & 0x0f,
+ p_serial_number->vendor_specific[0] & 0x0f,
+ p_serial_number->vendor_specific[1]>>4 & 0x0f,
+ p_serial_number->vendor_specific[1] & 0x0f,
+ p_serial_number->vendor_specific[2]>>4 & 0x0f,
+ p_serial_number->vendor_specific[2] & 0x0f,
+ p_serial_number->vendor_specific[3]>>4 & 0x0f,
+ p_serial_number->vendor_specific[3] & 0x0f,
+
+ ((bcmbal_subscriber_terminal_cfg *)obj)->key.intf_id);
+
+ }
+ }
+ else
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR,
+ "Invalid object type %d for subscriber terminal indication\n",
+ obj->obj_type);
+
+ }
+
+#endif
+ return result;
+}
+
+/********************************************************************\
+ * Function : bal_subscriber_terminal_cfg_clear *
+ * Description : clears the subscriber terminal(ONU) configuration *
+ ********************************************************************/
+uint32_t bal_subscriber_terminal_cfg_clear(BalSubscriberTerminalKey *terminal_key)
+{
+ bcmos_errno err = BCM_ERR_OK;
+ bcmbal_subscriber_terminal_cfg cfg;
+ bcmbal_subscriber_terminal_key key = { };
+
+ ASFVOLT_LOG(ASFVOLT_INFO,
+ "Processing subscriber terminal cfg clear: %d\n",
+ terminal_key->sub_term_id);
+
+ if (terminal_key->has_sub_term_id &&
+ terminal_key->has_intf_id)
+ {
+ key.sub_term_id = terminal_key->sub_term_id ;
+ key.intf_id = terminal_key->intf_id ;
+ }
+ else
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR,
+ "Invalid Key to handle subscriber terminal clear Req.subscriber_terminal_id(%d), Interface ID(%d)\n",
+ key.sub_term_id, key.intf_id);
+
+ return BAL_ERRNO__BAL_ERR_PARM;
+ }
+
+ err = bcmbal_cfg_clear(DEFAULT_ATERM_ID, &cfg.hdr);
+ err = BAL_ERRNO__BAL_ERR_OK;
+ return err;
+}
+
+/********************************************************************\
+ * Function : bal_subscriber_terminal_cfg_get *
+ * Description : Get the subscriber terminal(ONU) configuration *
+ ********************************************************************/
+uint32_t bal_subscriber_terminal_cfg_get(BalSubscriberTerminalKey *terminal_key,
+ BalSubscriberTerminalCfg *onu_cfg)
+{
+
+ bcmos_errno err = BCM_ERR_OK;
+ bcmbal_subscriber_terminal_cfg cfg; /**< declare main API struct */
+ bcmbal_subscriber_terminal_key key = { }; /**< declare key */
+ uint8_t *list_mem; /**< declare memory buffer for variable-sized lists */
+
+ ASFVOLT_LOG(ASFVOLT_INFO,
+ "Processing subscriber terminal cfg get: %d\n",
+ onu_cfg->key->sub_term_id);
+
+ if (terminal_key->has_sub_term_id &&
+ terminal_key->has_intf_id)
+ {
+ key.sub_term_id = terminal_key->sub_term_id ;
+ key.intf_id = terminal_key->intf_id ;
+ }
+ else
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR,
+ "Invalid Key to handle subscriber terminal Cfg Get subscriber_terminal_id(%d), Interface ID(%d)\n",
+ key.sub_term_id, key.intf_id);
+
+ return BAL_ERRNO__BAL_ERR_PARM;
+ }
+
+ /* init the API struct */
+ BCMBAL_CFG_INIT(&cfg, subscriber_terminal, key);
+
+ BCMBAL_CFG_PROP_GET(&cfg, subscriber_terminal, all_properties);
+
+ /* set memory to use for variable-sized lists */
+ list_mem = malloc(BAL_DYNAMIC_LIST_BUFFER_SIZE);
+ if (list_mem == NULL)
+ {
+
+ ASFVOLT_LOG(ASFVOLT_ERROR,
+ "Memory allocation failed while handling subscriber terminal cfg get subscriber_terminal_id(%d), Interface ID(%d)\n",
+ key.sub_term_id, key.intf_id);
+ return BAL_ERRNO__BAL_ERR_NOMEM;
+ }
+
+ memset(list_mem, 0, BAL_DYNAMIC_LIST_BUFFER_SIZE);
+ BCMBAL_CFG_LIST_BUF_SET(&cfg, subscriber_terminal, list_mem, BAL_DYNAMIC_LIST_BUFFER_SIZE);
+
+ /* call API */
+ err = bcmbal_cfg_get(DEFAULT_ATERM_ID, &cfg.hdr);
+ if (err != BCM_ERR_OK)
+ {
+ ASFVOLT_LOG(ASFVOLT_ERROR,
+ "Failed to get information from BAL subscriber_terminal_id(%d), Interface ID(%d)\n",
+ key.sub_term_id, key.intf_id);
+ return BAL_ERRNO__BAL_ERR_INTERNAL;
+ }
+
+ ASFVOLT_LOG(ASFVOLT_INFO,
+ "To-Do. Send subscriber terminal details to Adapter\n");
+ return BAL_ERRNO__BAL_ERR_OK;
+}