xref: /freebsd/contrib/opencsd/decoder/source/pkt_printers/raw_frame_printer.cpp (revision c120c5646da1a1d2c4d90fd069a7e2a8d559eb46)
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 
TraceRawFrameIn(const ocsd_datapath_op_t op,const ocsd_trc_index_t index,const ocsd_rawframe_elem_t frame_element,const int dataBlockSize,const uint8_t * pDataBlock,const uint8_t traceID)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 
createDataString(const int dataSize,const uint8_t * pData,int bytesPerLine,std::string & dataStr)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 */
105