First version of asfvolt16 device driver code
Change-Id: I806c2eaeebc7f8df7073c8264a7fdc6011b0d103
diff --git a/src/bal_packet_hdlr.c b/src/bal_packet_hdlr.c
new file mode 100755
index 0000000..ec2129c
--- /dev/null
+++ b/src/bal_packet_hdlr.c
@@ -0,0 +1,118 @@
+/*
+** 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_
+
+/* Includes related to proto buf */
+#include "bal_msg_type.grpc-c.h"
+#include "bal_osmsg.grpc-c.h"
+#include "bal_model_ids.grpc-c.h"
+#include "bal_obj.grpc-c.h"
+#include "bal_model_types.grpc-c.h"
+#include "bal_errno.grpc-c.h"
+#include "bal.grpc-c.h"
+
+#include "asfvolt16_driver.h"
+#include "bal_packet_hdlr.h"
+
+/********************************************************************\
+ * Function : bal_access_terminal_cfg_req *
+ * Description : Configures the PON and NNI interfaces *
+ * of OLT Device *
+ ********************************************************************/
+uint32_t bal_packet_cfg_req(BalPacketCfg *packet)
+{
+ bcmos_errno err = BCM_ERR_OK;
+ switch(packet->key->packet_send_dest->type)
+ {
+ case BAL_DEST_TYPE__BAL_DEST_TYPE_NNI:
+ {
+ ASFVOLT_LOG(ASFVOLT_DEBUG, "\n Send packet msg to NNI not yet implemented\n");
+ }
+ break;
+ case BAL_DEST_TYPE__BAL_DEST_TYPE_SUB_TERM:
+ {
+ ASFVOLT_LOG(ASFVOLT_DEBUG, "\n Send packet msg to ONU not yet implemented\n");
+ }
+ break;
+ case BAL_DEST_TYPE__BAL_DEST_TYPE_SVC_PORT:
+ {
+ ASFVOLT_LOG(ASFVOLT_DEBUG, "\n Send packet msg to PON not yet implemented\n");
+ }
+ break;
+ case BAL_DEST_TYPE__BAL_DEST_TYPE_ITU_OMCI_CHANNEL:
+ {
+ bcmbal_access_term_id aterm_id = 0; /* Assume a single access_terminal instance */
+ bcmbal_u8_list_u32_max_2048 buf; /* A structure with a msg pointer and length value */
+ /* The destination of the OMCI packet is a registered ONU on the OLT PON interface */
+ bcmbal_dest proxy_pkt_dest = { .type = BCMBAL_DEST_TYPE_ITU_OMCI_CHANNEL,
+ .u.itu_omci_channel.sub_term_id = packet->key->packet_send_dest->itu_omci_channel->sub_term_id,
+ .u.itu_omci_channel.intf_id = packet->key->packet_send_dest->itu_omci_channel->intf_id };
+ buf.len = ((strlen((const char *)(packet->data->pkt.data))/2)) > MAX_OMCI_MSG_LENGTH ? MAX_OMCI_MSG_LENGTH : ((strlen((const char *)(packet->data->pkt.data))/2)); /* is the length of your OMCI message */
+ /* Send the OMCI packet using the BAL remote proxy API */
+ uint16_t idx1 = 0;
+ uint16_t idx2 = 0;
+ uint8_t arraySend[buf.len];
+ char str1[MAX_CHAR_LENGTH];
+ char str2[MAX_CHAR_LENGTH];
+ memset(&arraySend,0,buf.len);
+ ASFVOLT_LOG(ASFVOLT_DEBUG,"\nSending omci msg to ONU of length is %d\n",buf.len);
+ for(idx1=0,idx2=0; idx1<((buf.len)*2); idx1++,idx2++)
+ {
+ sprintf(str1,"%c",packet->data->pkt.data[idx1]);
+ sprintf(str2,"%c",packet->data->pkt.data[++idx1]);
+ strcat(str1,str2);
+ arraySend[idx2] = strtol(str1, NULL, 16);
+ }
+ buf.val = (uint8_t *)malloc((buf.len)*sizeof(uint8_t));
+ memcpy(buf.val,(uint8_t *)arraySend,buf.len);
+ ASFVOLT_LOG(ASFVOLT_DEBUG,"\nAfter converting it into hex\n");
+ for(idx2=0; idx2<buf.len; idx2++)
+ {
+ printf("%02x", buf.val[idx2]);
+ }
+ printf("\n");
+ err = bcmbal_pkt_send(aterm_id,
+ proxy_pkt_dest,
+ (const char *)(buf.val),
+ buf.len);
+ ASFVOLT_LOG(ASFVOLT_DEBUG, "\n OMCI request msg of length(%d) sent to ONU(%d) through PON(%d)\n",
+ buf.len,
+ packet->key->packet_send_dest->itu_omci_channel->sub_term_id,
+ packet->key->packet_send_dest->itu_omci_channel->intf_id);
+ bcmos_free(buf.val);
+ }
+ break;
+ case BAL_DEST_TYPE__BAL_DEST_TYPE_IEEE_OAM_CHANNEL:
+ {
+ ASFVOLT_LOG(ASFVOLT_DEBUG, "\n PLOAM msg not yet implemented\n");
+ }
+ break;
+ default:
+ {
+ ASFVOLT_LOG(ASFVOLT_DEBUG, "\n Invalid dest type\n");
+ }
+ break;
+ }
+ if (BCM_ERR_OK != err)
+ {
+ /* recover from any error encountered while sending */
+ }
+ return err;
+}