mirror of https://github.com/ARMmbed/mbed-os.git
275 lines
9.0 KiB
C
275 lines
9.0 KiB
C
/*
|
|
* 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_cca_threshold_confirmation_handle(protocol_interface_info_entry_t *info_entry, mlme_get_conf_t *confirmation)
|
|
{
|
|
if (confirmation->value_size < 1) {
|
|
return;
|
|
}
|
|
info_entry->mac_parameters->cca_thr_table.number_of_channels = confirmation->value_size;
|
|
info_entry->mac_parameters->cca_thr_table.cca_threshold_table = (int8_t *)confirmation->value_pointer;
|
|
}
|
|
|
|
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;
|
|
|
|
case macCCAThreshold:
|
|
mac_mlme_cca_threshold_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;
|
|
}
|
|
}
|
|
}
|
|
|