Import Mbed OS hard-float snapshot
This commit is contained in:
Beslan
@@ -0,0 +1,261 @@
|
||||
/*
|
||||
* Copyright (c) 2016-2019, Arm Limited and affiliates.
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* 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 "nsconfig.h"
|
||||
#include <string.h>
|
||||
#include "mlme.h"
|
||||
#include "common_functions.h"
|
||||
#include "ns_trace.h"
|
||||
#include "NWK_INTERFACE/Include/protocol_abstract.h"
|
||||
#include "NWK_INTERFACE/Include/protocol_timer.h"
|
||||
#include "Service_Libs/mle_service/mle_service_api.h"
|
||||
#include "Core/include/ns_address_internal.h"
|
||||
#include "Core/include/ns_socket.h"
|
||||
#include "6LoWPAN/Thread/thread_common.h"
|
||||
#include "6LoWPAN/Thread/thread_management_internal.h"
|
||||
#include "6LoWPAN/MAC/mac_helper.h"
|
||||
#include "MLE/mle.h"
|
||||
#include "mac_mcps.h"
|
||||
#include "6LoWPAN/MAC/mac_data_poll.h"
|
||||
#include "6LoWPAN/MAC/mac_response_handler.h"
|
||||
#include "6LoWPAN/MAC/mpx_api.h"
|
||||
#include "6LoWPAN/lowpan_adaptation_interface.h"
|
||||
#include "Service_Libs/mac_neighbor_table/mac_neighbor_table.h"
|
||||
|
||||
#define TRACE_GROUP "MRsH"
|
||||
|
||||
|
||||
static void mac_mlme_device_table_confirmation_handle(protocol_interface_info_entry_t *info_entry, mlme_get_conf_t *confirmation)
|
||||
{
|
||||
if (confirmation->value_size != sizeof(mlme_device_descriptor_t)) {
|
||||
return;
|
||||
}
|
||||
|
||||
mlme_device_descriptor_t *descpription = (mlme_device_descriptor_t *)confirmation->value_pointer;
|
||||
|
||||
tr_debug("Dev stable get confirmation %x", confirmation->status);
|
||||
|
||||
if (confirmation->status == MLME_SUCCESS) {
|
||||
//GET ME table by extended mac64 address
|
||||
mac_neighbor_table_entry_t *entry = mac_neighbor_table_address_discover(mac_neighbor_info(info_entry), descpription->ExtAddress, ADDR_802_15_4_LONG);
|
||||
|
||||
if (!entry) {
|
||||
return;
|
||||
}
|
||||
|
||||
if (entry->mac16 != descpription->ShortAddress) {
|
||||
//Refresh Short ADDRESS
|
||||
mlme_set_t set_request;
|
||||
descpription->ShortAddress = entry->mac16;
|
||||
|
||||
//CALL MLME-SET
|
||||
set_request.attr = macDeviceTable;
|
||||
set_request.attr_index = confirmation->attr_index;
|
||||
set_request.value_pointer = descpription;
|
||||
set_request.value_size = confirmation->value_size;
|
||||
info_entry->mac_api->mlme_req(info_entry->mac_api, MLME_SET, &set_request);
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
static void mac_mlme_frame_counter_confirmation_handle(protocol_interface_info_entry_t *info_entry, mlme_get_conf_t *confirmation)
|
||||
{
|
||||
if (confirmation->value_size != 4) {
|
||||
return;
|
||||
}
|
||||
uint32_t *temp_ptr = (uint32_t *)confirmation->value_pointer;
|
||||
info_entry->mac_parameters->security_frame_counter = *temp_ptr;
|
||||
}
|
||||
|
||||
static void mac_mlme_get_confirmation_handler(protocol_interface_info_entry_t *info_entry, mlme_get_conf_t *confirmation)
|
||||
{
|
||||
|
||||
if (!confirmation) {
|
||||
return;
|
||||
}
|
||||
switch (confirmation->attr) {
|
||||
case macDeviceTable:
|
||||
mac_mlme_device_table_confirmation_handle(info_entry, confirmation);
|
||||
break;
|
||||
|
||||
case macFrameCounter:
|
||||
mac_mlme_frame_counter_confirmation_handle(info_entry, confirmation);
|
||||
break;
|
||||
|
||||
default:
|
||||
|
||||
break;
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
void mcps_data_confirm_handler(const mac_api_t *api, const mcps_data_conf_t *data)
|
||||
{
|
||||
protocol_interface_info_entry_t *info_entry = protocol_stack_interface_info_get_by_id(api->parent_id);
|
||||
//TODO: create buffer_t and call correct function
|
||||
//Update protocol_status
|
||||
lowpan_adaptation_interface_tx_confirm(info_entry, data);
|
||||
}
|
||||
|
||||
void mcps_data_indication_handler(const mac_api_t *api, const mcps_data_ind_t *data_ind)
|
||||
{
|
||||
protocol_interface_info_entry_t *info_entry = protocol_stack_interface_info_get_by_id(api->parent_id);
|
||||
lowpan_adaptation_interface_data_ind(info_entry, data_ind);
|
||||
}
|
||||
|
||||
void mcps_purge_confirm_handler(const mac_api_t *api, mcps_purge_conf_t *data)
|
||||
{
|
||||
(void)api;
|
||||
(void)data;
|
||||
tr_info("MCPS Data Purge confirm status %u, for handle %u", data->status, data->msduHandle);
|
||||
}
|
||||
|
||||
static void stop_bootstrap_timer(protocol_interface_info_entry_t *info_entry)
|
||||
{
|
||||
if (info_entry->bootsrap_mode == ARM_NWK_BOOTSRAP_MODE_6LoWPAN_BORDER_ROUTER) {
|
||||
protocol_timer_stop(PROTOCOL_TIMER_BOOTSTRAP_TIM);
|
||||
}
|
||||
}
|
||||
|
||||
void mlme_confirm_handler(const mac_api_t *api, mlme_primitive id, const void *data)
|
||||
{
|
||||
protocol_interface_info_entry_t *info_entry = protocol_stack_interface_info_get_by_id(api->parent_id);
|
||||
if (!info_entry) {
|
||||
return;
|
||||
}
|
||||
//TODO: create buffer_t and call correct function
|
||||
switch (id) {
|
||||
case MLME_ASSOCIATE: {
|
||||
//Unsupported
|
||||
break;
|
||||
}
|
||||
case MLME_DISASSOCIATE: {
|
||||
//Unsupported
|
||||
break;
|
||||
}
|
||||
case MLME_GET: {
|
||||
mlme_get_conf_t *dat = (mlme_get_conf_t *)data;
|
||||
mac_mlme_get_confirmation_handler(info_entry, dat);
|
||||
break;
|
||||
}
|
||||
case MLME_GTS: {
|
||||
//Unsupported
|
||||
break;
|
||||
}
|
||||
case MLME_RESET: {
|
||||
// mlme_reset_conf_t *dat = (mlme_reset_conf_t*)data;
|
||||
break;
|
||||
}
|
||||
case MLME_RX_ENABLE: {
|
||||
//Unsupported
|
||||
break;
|
||||
}
|
||||
case MLME_SCAN: {
|
||||
const mlme_scan_conf_t *dat = (mlme_scan_conf_t *)data;
|
||||
stop_bootstrap_timer(info_entry);
|
||||
info_entry->scan_cb(api->parent_id, dat);
|
||||
break;
|
||||
}
|
||||
case MLME_SET: {
|
||||
// mlme_set_conf_t *dat = (mlme_set_conf_t*)data;
|
||||
break;
|
||||
}
|
||||
case MLME_START: {
|
||||
// mlme_start_conf_t *dat = (mlme_start_conf_t*)data;
|
||||
stop_bootstrap_timer(info_entry);
|
||||
break;
|
||||
}
|
||||
case MLME_POLL: {
|
||||
const mlme_poll_conf_t *dat = (mlme_poll_conf_t *)data;
|
||||
mac_mlme_poll_confirm(info_entry, dat);
|
||||
break;
|
||||
}
|
||||
case MLME_BEACON_NOTIFY:
|
||||
case MLME_ORPHAN:
|
||||
case MLME_COMM_STATUS:
|
||||
case MLME_SYNC:
|
||||
case MLME_SYNC_LOSS:
|
||||
default: {
|
||||
tr_error("Invalid state in mlme_confirm_handler(): %d", id);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void mlme_indication_handler(const mac_api_t *api, mlme_primitive id, const void *data)
|
||||
{
|
||||
switch (id) {
|
||||
case MLME_ASSOCIATE: {
|
||||
//Unsupported
|
||||
//mlme_associate_ind_t *dat = (mlme_associate_ind_t*)data;
|
||||
break;
|
||||
}
|
||||
case MLME_DISASSOCIATE: {
|
||||
//Unsupported
|
||||
//mlme_disassociate_ind_t *dat = (mlme_disassociate_ind_t*)data;
|
||||
break;
|
||||
}
|
||||
case MLME_BEACON_NOTIFY: {
|
||||
const mlme_beacon_ind_t *dat = (mlme_beacon_ind_t *)data;
|
||||
protocol_interface_info_entry_t *info_entry = protocol_stack_interface_info_get_by_id(api->parent_id);
|
||||
if (info_entry && info_entry->beacon_cb) {
|
||||
info_entry->beacon_cb(api->parent_id, dat);
|
||||
}
|
||||
break;
|
||||
}
|
||||
case MLME_GTS: {
|
||||
//Unsupported
|
||||
break;
|
||||
}
|
||||
case MLME_ORPHAN: {
|
||||
//Unsupported
|
||||
break;
|
||||
}
|
||||
case MLME_COMM_STATUS: {
|
||||
mlme_comm_status_t *dat = (mlme_comm_status_t *)data;
|
||||
protocol_interface_info_entry_t *info_entry = protocol_stack_interface_info_get_by_id(api->parent_id);
|
||||
if (info_entry && info_entry->comm_status_ind_cb) {
|
||||
info_entry->comm_status_ind_cb(api->parent_id, dat);
|
||||
}
|
||||
|
||||
break;
|
||||
}
|
||||
case MLME_SYNC_LOSS: {
|
||||
mlme_sync_loss_t *dat = (mlme_sync_loss_t *)data;
|
||||
protocol_interface_info_entry_t *info_entry = protocol_stack_interface_info_get_by_id(api->parent_id);
|
||||
if (info_entry) {
|
||||
if (dat->LossReason == BEACON_LOST) {
|
||||
nwk_bootsrap_state_update(ARM_NWK_NWK_SCAN_FAIL, info_entry);
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
case MLME_GET:
|
||||
case MLME_RESET:
|
||||
case MLME_RX_ENABLE:
|
||||
case MLME_SCAN:
|
||||
case MLME_SET:
|
||||
case MLME_START:
|
||||
case MLME_SYNC:
|
||||
case MLME_POLL:
|
||||
default: {
|
||||
tr_error("Invalid state in mlme_indication_handler(): %d", id);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user