]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - contrib/opencsd/decoder/source/pkt_printers/raw_frame_printer.cpp
Re-add opencsd as a vendor import from the dist directory
[FreeBSD/FreeBSD.git] / contrib / opencsd / decoder / source / pkt_printers / raw_frame_printer.cpp
1 /*
2  * \file       raw_frame_printer.cpp
3  * \brief      OpenCSD : 
4  * 
5  * \copyright  Copyright (c) 2015, ARM Limited. All Rights Reserved.
6  */
7
8 /* 
9  * Redistribution and use in source and binary forms, with or without modification, 
10  * are permitted provided that the following conditions are met:
11  * 
12  * 1. Redistributions of source code must retain the above copyright notice, 
13  * this list of conditions and the following disclaimer.
14  * 
15  * 2. Redistributions in binary form must reproduce the above copyright notice, 
16  * this list of conditions and the following disclaimer in the documentation 
17  * and/or other materials provided with the distribution. 
18  * 
19  * 3. Neither the name of the copyright holder nor the names of its contributors 
20  * may be used to endorse or promote products derived from this software without 
21  * specific prior written permission. 
22  * 
23  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 'AS IS' AND 
24  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 
25  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 
26  * IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, 
27  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 
28  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 
29  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 
30  * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 
31  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 
32  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 
33  */ 
34
35 #include <string>
36 #include <sstream>
37 #include <iomanip>
38
39 #include "opencsd.h"
40
41
42 ocsd_err_t RawFramePrinter::TraceRawFrameIn(  const ocsd_datapath_op_t op, 
43                                                 const ocsd_trc_index_t index, 
44                                                 const ocsd_rawframe_elem_t frame_element, 
45                                                 const int dataBlockSize, 
46                                                 const uint8_t *pDataBlock,
47                                                 const uint8_t traceID)
48 {
49
50     if(op == OCSD_OP_DATA) // only interested in actual frame data.
51     {
52         std::string strData;
53         std::ostringstream oss;
54         int printDataSize = dataBlockSize;
55
56         oss << "Frame Data; Index" << std::setw(7) << index << "; ";
57         
58         switch(frame_element) 
59         {
60         case OCSD_FRM_PACKED: oss << std::setw(15) << "RAW_PACKED; "; break;
61         case OCSD_FRM_HSYNC:  oss << std::setw(15) << "HSYNC; "; break;
62         case OCSD_FRM_FSYNC:  oss << std::setw(15)  << "FSYNC; "; break;  
63         case OCSD_FRM_ID_DATA: 
64             oss << std::setw(10) << "ID_DATA[";
65             if (traceID == OCSD_BAD_CS_SRC_ID)
66                 oss << "????";
67             else
68                 oss << "0x" << std::hex << std::setw(2) << std::setfill('0') << (uint16_t)traceID;
69             oss << "]; ";
70             break;
71         default: oss << std::setw(15) << "UNKNOWN; "; break;
72         }
73
74         if(printDataSize)
75         {
76             createDataString(printDataSize,pDataBlock,16,strData);
77             oss << strData;
78         }
79         oss << std::endl;
80         itemPrintLine(oss.str());
81     }
82     return OCSD_OK;
83 }
84
85 void RawFramePrinter::createDataString(const int dataSize, const uint8_t *pData, int bytesPerLine, std::string &dataStr)
86 {
87     int lineBytes = 0;
88     std::ostringstream oss;
89
90     for(int i = 0; i < dataSize; i++)
91     {
92         if(lineBytes == bytesPerLine)
93         {
94             oss << std::endl;
95             lineBytes = 0;
96         }
97         oss << std::hex << std::setw(2) << std::setfill('0') << (uint32_t)pData[i] << " ";
98         lineBytes ++;
99     }
100     dataStr = oss.str();
101 }
102
103
104 /* End of File raw_frame_printer.cpp */