KaCanOpen
 All Classes Functions Variables Typedefs Enumerations Pages
message.cpp
1 /*
2  * Copyright (c) 2015, Thomas Keh
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions are met:
7  *
8  * 1. Redistributions of source code must retain the above copyright
9  * notice, this list of conditions and the following disclaimer.
10  *
11  * 2. Redistributions in binary form must reproduce the above copyright
12  * notice, this list of conditions and the following disclaimer in the
13  * documentation and/or other materials provided with the distribution.
14  *
15  * 3. Neither the name of the copyright holder nor the names of its
16  * contributors may be used to endorse or promote products derived from
17  * this software without specific prior written permission.
18  *
19  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
20  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
23  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29  * POSSIBILITY OF SUCH DAMAGE.
30  */
31 
32 #include "message.h"
33 #include "logger.h"
34 
35 #include <iostream>
36 #include <cstdint>
37 
38 namespace kaco {
39 
40 uint8_t Message::get_node_id() const {
41  return cob_id & 0x7F;
42 }
43 
44 uint8_t Message::get_function_code() const {
45  return cob_id >> 7;
46 }
47 
48 void Message::print() const {
49 
50  DUMP_HEX(cob_id);
51  DUMP_HEX(rtr);
52  DUMP_HEX(len);
53  DUMP_HEX(get_function_code());
54  DUMP_HEX(get_node_id());
55 
56  for (unsigned i=0;i<len;++i) {
57  //if (data[i]>0) {
58  PRINT("data["<<i<<"] = 0x"<<std::hex<<(unsigned)data[i]);
59  //}
60  }
61 
62 }
63 
64 }
uint16_t cob_id
Message ID aka COB-ID.
Definition: message.h:42
uint8_t len
Message's length (0 to 8)
Definition: message.h:48
uint8_t get_function_code() const
Extracts the function code from the COB-ID.
Definition: message.cpp:44
uint8_t get_node_id() const
Extracts the node id from the COB-ID.
Definition: message.cpp:40
uint8_t rtr
Remote transmission request (0 if it's not an RTR message, 1 if it is an RTR message) ...
Definition: message.h:45
uint8_t data[8]
Data bytes.
Definition: message.h:51
void print() const
Prints the message to command line.
Definition: message.cpp:48