Dependencies:   MMA7660 LM75B

Committer:
MACRUM
Date:
Sat Jun 30 01:40:30 2018 +0000
Revision:
0:119624335925
Initial commit

Who changed what in which revision?

UserRevisionLine numberNew contents of line
MACRUM 0:119624335925 1 /*
MACRUM 0:119624335925 2 * Copyright (c) 2015 ARM Limited. All rights reserved.
MACRUM 0:119624335925 3 * SPDX-License-Identifier: Apache-2.0
MACRUM 0:119624335925 4 * Licensed under the Apache License, Version 2.0 (the License); you may
MACRUM 0:119624335925 5 * not use this file except in compliance with the License.
MACRUM 0:119624335925 6 * You may obtain a copy of the License at
MACRUM 0:119624335925 7 *
MACRUM 0:119624335925 8 * http://www.apache.org/licenses/LICENSE-2.0
MACRUM 0:119624335925 9 *
MACRUM 0:119624335925 10 * Unless required by applicable law or agreed to in writing, software
MACRUM 0:119624335925 11 * distributed under the License is distributed on an AS IS BASIS, WITHOUT
MACRUM 0:119624335925 12 * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
MACRUM 0:119624335925 13 * See the License for the specific language governing permissions and
MACRUM 0:119624335925 14 * limitations under the License.
MACRUM 0:119624335925 15 */
MACRUM 0:119624335925 16 #include "mbed-client/m2mblockmessage.h"
MACRUM 0:119624335925 17 #include "mbed-client/m2mconfig.h"
MACRUM 0:119624335925 18 #include <stdlib.h>
MACRUM 0:119624335925 19 #include <string.h>
MACRUM 0:119624335925 20
MACRUM 0:119624335925 21 M2MBlockMessage::M2MBlockMessage() :
MACRUM 0:119624335925 22 _block_data_ptr(NULL),
MACRUM 0:119624335925 23 _total_message_size(0),
MACRUM 0:119624335925 24 _block_data_len(0),
MACRUM 0:119624335925 25 _block_number(0),
MACRUM 0:119624335925 26 _error_code(M2MBlockMessage::ErrorNone),
MACRUM 0:119624335925 27 _is_last_block(false),
MACRUM 0:119624335925 28 _is_block_message(false)
MACRUM 0:119624335925 29 {
MACRUM 0:119624335925 30 }
MACRUM 0:119624335925 31
MACRUM 0:119624335925 32 M2MBlockMessage::~M2MBlockMessage()
MACRUM 0:119624335925 33 {
MACRUM 0:119624335925 34 free(_block_data_ptr);
MACRUM 0:119624335925 35 _block_data_ptr = NULL;
MACRUM 0:119624335925 36 }
MACRUM 0:119624335925 37
MACRUM 0:119624335925 38 void M2MBlockMessage::set_message_info(sn_coap_hdr_s *coap_header)
MACRUM 0:119624335925 39 {
MACRUM 0:119624335925 40 _is_block_message = (coap_header &&
MACRUM 0:119624335925 41 coap_header->options_list_ptr &&
MACRUM 0:119624335925 42 coap_header->options_list_ptr->block1 != -1) ? true : false;
MACRUM 0:119624335925 43
MACRUM 0:119624335925 44 if (coap_header && coap_header->options_list_ptr) {
MACRUM 0:119624335925 45 // Check total size
MACRUM 0:119624335925 46 if (coap_header->options_list_ptr->use_size1) {
MACRUM 0:119624335925 47 _total_message_size = coap_header->options_list_ptr->size1;
MACRUM 0:119624335925 48 }
MACRUM 0:119624335925 49
MACRUM 0:119624335925 50 // Default value in coap library is 65kb
MACRUM 0:119624335925 51 uint32_t max_size = SN_COAP_MAX_INCOMING_MESSAGE_SIZE;
MACRUM 0:119624335925 52 if (_total_message_size > max_size) {
MACRUM 0:119624335925 53 _error_code = M2MBlockMessage::EntityTooLarge;
MACRUM 0:119624335925 54 } else {
MACRUM 0:119624335925 55 _error_code = M2MBlockMessage::ErrorNone;
MACRUM 0:119624335925 56 }
MACRUM 0:119624335925 57 if (M2MBlockMessage::ErrorNone == _error_code) {
MACRUM 0:119624335925 58 // Is last block
MACRUM 0:119624335925 59 if (coap_header->options_list_ptr->block1 != -1) {
MACRUM 0:119624335925 60 // if (!(*(coap_header->options_list_ptr->block1_ptr + (coap_header->options_list_ptr->block1_len - 1)) & 0x08)) {
MACRUM 0:119624335925 61 if (!((coap_header->options_list_ptr->block1) & 0x08)) {
MACRUM 0:119624335925 62 _is_last_block = true;
MACRUM 0:119624335925 63 } else {
MACRUM 0:119624335925 64 _is_last_block = false;
MACRUM 0:119624335925 65 }
MACRUM 0:119624335925 66 }
MACRUM 0:119624335925 67
MACRUM 0:119624335925 68 _block_number = coap_header->options_list_ptr->block1 >> 4;
MACRUM 0:119624335925 69 // Block number
MACRUM 0:119624335925 70 // if (coap_header->options_list_ptr->block1_len == 3) {
MACRUM 0:119624335925 71 // _block_number = *(coap_header->options_list_ptr->block1_ptr) << 12;
MACRUM 0:119624335925 72 // _block_number |= *(coap_header->options_list_ptr->block1_ptr + 1) << 4;
MACRUM 0:119624335925 73 // _block_number |= (*(coap_header->options_list_ptr->block1_ptr + 2)) >> 4;
MACRUM 0:119624335925 74 // }
MACRUM 0:119624335925 75
MACRUM 0:119624335925 76 // else if (coap_header->options_list_ptr->block1_len == 2) {
MACRUM 0:119624335925 77 // _block_number = *(coap_header->options_list_ptr->block1_ptr) << 4;
MACRUM 0:119624335925 78 // _block_number |= (*(coap_header->options_list_ptr->block1_ptr + 1)) >> 4;
MACRUM 0:119624335925 79 // }
MACRUM 0:119624335925 80 // else if (coap_header->options_list_ptr->block1_len == 1) {
MACRUM 0:119624335925 81 // _block_number = (*coap_header->options_list_ptr->block1_ptr) >> 4;
MACRUM 0:119624335925 82 // }
MACRUM 0:119624335925 83 // else {
MACRUM 0:119624335925 84 // _block_number = 0;
MACRUM 0:119624335925 85 // }
MACRUM 0:119624335925 86
MACRUM 0:119624335925 87 // Payload
MACRUM 0:119624335925 88 free(_block_data_ptr);
MACRUM 0:119624335925 89 _block_data_ptr = NULL;
MACRUM 0:119624335925 90 _block_data_len = coap_header->payload_len;
MACRUM 0:119624335925 91 if(_block_data_len > 0) {
MACRUM 0:119624335925 92 _block_data_ptr = (uint8_t *)malloc(_block_data_len);
MACRUM 0:119624335925 93 if (_block_data_ptr) {
MACRUM 0:119624335925 94 memcpy(_block_data_ptr, coap_header->payload_ptr, _block_data_len);
MACRUM 0:119624335925 95 }
MACRUM 0:119624335925 96 }
MACRUM 0:119624335925 97 }
MACRUM 0:119624335925 98 }
MACRUM 0:119624335925 99 }
MACRUM 0:119624335925 100
MACRUM 0:119624335925 101 void M2MBlockMessage::clear_values()
MACRUM 0:119624335925 102 {
MACRUM 0:119624335925 103 free(_block_data_ptr);
MACRUM 0:119624335925 104 _block_data_ptr = NULL;
MACRUM 0:119624335925 105 _block_data_len = 0;
MACRUM 0:119624335925 106 _block_number = 0;
MACRUM 0:119624335925 107 _total_message_size = 0;
MACRUM 0:119624335925 108 _is_last_block = false;
MACRUM 0:119624335925 109 _error_code = M2MBlockMessage::ErrorNone;
MACRUM 0:119624335925 110 }
MACRUM 0:119624335925 111
MACRUM 0:119624335925 112 bool M2MBlockMessage::is_block_message() const
MACRUM 0:119624335925 113 {
MACRUM 0:119624335925 114 return _is_block_message;
MACRUM 0:119624335925 115 }
MACRUM 0:119624335925 116
MACRUM 0:119624335925 117 uint16_t M2MBlockMessage::block_number() const
MACRUM 0:119624335925 118 {
MACRUM 0:119624335925 119 return _block_number;
MACRUM 0:119624335925 120 }
MACRUM 0:119624335925 121
MACRUM 0:119624335925 122 uint32_t M2MBlockMessage::total_message_size() const
MACRUM 0:119624335925 123 {
MACRUM 0:119624335925 124 return _total_message_size;
MACRUM 0:119624335925 125 }
MACRUM 0:119624335925 126
MACRUM 0:119624335925 127 bool M2MBlockMessage::is_last_block() const
MACRUM 0:119624335925 128 {
MACRUM 0:119624335925 129 return _is_last_block;
MACRUM 0:119624335925 130 }
MACRUM 0:119624335925 131
MACRUM 0:119624335925 132 uint8_t* M2MBlockMessage::block_data() const
MACRUM 0:119624335925 133 {
MACRUM 0:119624335925 134 return _block_data_ptr;
MACRUM 0:119624335925 135 }
MACRUM 0:119624335925 136
MACRUM 0:119624335925 137 uint32_t M2MBlockMessage::block_data_len() const
MACRUM 0:119624335925 138 {
MACRUM 0:119624335925 139 return _block_data_len;
MACRUM 0:119624335925 140 }
MACRUM 0:119624335925 141
MACRUM 0:119624335925 142 M2MBlockMessage::Error M2MBlockMessage::error_code() const
MACRUM 0:119624335925 143 {
MACRUM 0:119624335925 144 return _error_code;
MACRUM 0:119624335925 145 }