1*17f65170SRuslan Bukin /*
2*17f65170SRuslan Bukin * \file ocsd_code_follower.cpp
3*17f65170SRuslan Bukin * \brief OpenCSD : Instruction Code path follower.
4*17f65170SRuslan Bukin *
5*17f65170SRuslan Bukin * \copyright Copyright (c) 2016, ARM Limited. All Rights Reserved.
6*17f65170SRuslan Bukin */
7*17f65170SRuslan Bukin
8*17f65170SRuslan Bukin
9*17f65170SRuslan Bukin /*
10*17f65170SRuslan Bukin * Redistribution and use in source and binary forms, with or without modification,
11*17f65170SRuslan Bukin * are permitted provided that the following conditions are met:
12*17f65170SRuslan Bukin *
13*17f65170SRuslan Bukin * 1. Redistributions of source code must retain the above copyright notice,
14*17f65170SRuslan Bukin * this list of conditions and the following disclaimer.
15*17f65170SRuslan Bukin *
16*17f65170SRuslan Bukin * 2. Redistributions in binary form must reproduce the above copyright notice,
17*17f65170SRuslan Bukin * this list of conditions and the following disclaimer in the documentation
18*17f65170SRuslan Bukin * and/or other materials provided with the distribution.
19*17f65170SRuslan Bukin *
20*17f65170SRuslan Bukin * 3. Neither the name of the copyright holder nor the names of its contributors
21*17f65170SRuslan Bukin * may be used to endorse or promote products derived from this software without
22*17f65170SRuslan Bukin * specific prior written permission.
23*17f65170SRuslan Bukin *
24*17f65170SRuslan Bukin * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 'AS IS' AND
25*17f65170SRuslan Bukin * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
26*17f65170SRuslan Bukin * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
27*17f65170SRuslan Bukin * IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
28*17f65170SRuslan Bukin * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
29*17f65170SRuslan Bukin * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
30*17f65170SRuslan Bukin * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
31*17f65170SRuslan Bukin * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
32*17f65170SRuslan Bukin * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
33*17f65170SRuslan Bukin * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
34*17f65170SRuslan Bukin */
35*17f65170SRuslan Bukin
36*17f65170SRuslan Bukin #include "common/ocsd_code_follower.h"
37*17f65170SRuslan Bukin
OcsdCodeFollower()38*17f65170SRuslan Bukin OcsdCodeFollower::OcsdCodeFollower()
39*17f65170SRuslan Bukin {
40*17f65170SRuslan Bukin m_instr_info.pe_type.arch = ARCH_UNKNOWN;
41*17f65170SRuslan Bukin m_instr_info.pe_type.profile = profile_Unknown;
42*17f65170SRuslan Bukin m_instr_info.isa = ocsd_isa_unknown;
43*17f65170SRuslan Bukin m_instr_info.dsb_dmb_waypoints = 0;
44*17f65170SRuslan Bukin m_instr_info.instr_addr = 0;
45*17f65170SRuslan Bukin m_instr_info.opcode = 0;
46*17f65170SRuslan Bukin m_pMemAccess = 0;
47*17f65170SRuslan Bukin m_pIDecode = 0;
48*17f65170SRuslan Bukin m_mem_space_csid = 0;
49*17f65170SRuslan Bukin m_st_range_addr = m_en_range_addr = m_next_addr = 0;
50*17f65170SRuslan Bukin m_b_next_valid = false;
51*17f65170SRuslan Bukin m_b_nacc_err = false;
52*17f65170SRuslan Bukin }
53*17f65170SRuslan Bukin
~OcsdCodeFollower()54*17f65170SRuslan Bukin OcsdCodeFollower::~OcsdCodeFollower()
55*17f65170SRuslan Bukin {
56*17f65170SRuslan Bukin }
57*17f65170SRuslan Bukin
initInterfaces(componentAttachPt<ITargetMemAccess> * pMemAccess,componentAttachPt<IInstrDecode> * pIDecode)58*17f65170SRuslan Bukin void OcsdCodeFollower::initInterfaces(componentAttachPt<ITargetMemAccess> *pMemAccess, componentAttachPt<IInstrDecode> *pIDecode)
59*17f65170SRuslan Bukin {
60*17f65170SRuslan Bukin m_pMemAccess = pMemAccess;
61*17f65170SRuslan Bukin m_pIDecode = pIDecode;
62*17f65170SRuslan Bukin }
63*17f65170SRuslan Bukin
initFollowerState()64*17f65170SRuslan Bukin bool OcsdCodeFollower::initFollowerState()
65*17f65170SRuslan Bukin {
66*17f65170SRuslan Bukin bool initDone = false;
67*17f65170SRuslan Bukin
68*17f65170SRuslan Bukin // reset per follow flags
69*17f65170SRuslan Bukin m_b_next_valid = false;
70*17f65170SRuslan Bukin m_b_nacc_err = false;
71*17f65170SRuslan Bukin
72*17f65170SRuslan Bukin // set range addresses
73*17f65170SRuslan Bukin m_en_range_addr = m_next_addr = m_st_range_addr;
74*17f65170SRuslan Bukin
75*17f65170SRuslan Bukin // check initialisation is valid.
76*17f65170SRuslan Bukin
77*17f65170SRuslan Bukin // must have attached memory access and i-decode objects
78*17f65170SRuslan Bukin if(m_pMemAccess && m_pIDecode)
79*17f65170SRuslan Bukin {
80*17f65170SRuslan Bukin initDone = (m_pMemAccess->hasAttachedAndEnabled() && m_pIDecode->hasAttachedAndEnabled());
81*17f65170SRuslan Bukin }
82*17f65170SRuslan Bukin return initDone;
83*17f65170SRuslan Bukin }
84*17f65170SRuslan Bukin
85*17f65170SRuslan Bukin /*!
86*17f65170SRuslan Bukin * Decodes an instruction at a single location, calculates the next address
87*17f65170SRuslan Bukin * if possible according to the instruction type and atom.
88*17f65170SRuslan Bukin *
89*17f65170SRuslan Bukin * @param addrStart : Address of the instruction
90*17f65170SRuslan Bukin * @param A : Atom value - E or N
91*17f65170SRuslan Bukin *
92*17f65170SRuslan Bukin * @return ocsd_err_t : OCSD_OK - decode correct, check flags for next address
93*17f65170SRuslan Bukin * : OCSD_ERR_MEM_NACC - unable to access memory area @ address - need new address in trace packet stream.
94*17f65170SRuslan Bukin * : OCSD_ERR_NOT_INIT - not initialised - fatal.
95*17f65170SRuslan Bukin * : OCSD_<other> - other error occured - fatal.
96*17f65170SRuslan Bukin */
followSingleAtom(const ocsd_vaddr_t addrStart,const ocsd_atm_val A)97*17f65170SRuslan Bukin ocsd_err_t OcsdCodeFollower::followSingleAtom(const ocsd_vaddr_t addrStart, const ocsd_atm_val A)
98*17f65170SRuslan Bukin {
99*17f65170SRuslan Bukin ocsd_err_t err = OCSD_ERR_NOT_INIT;
100*17f65170SRuslan Bukin
101*17f65170SRuslan Bukin if(!initFollowerState())
102*17f65170SRuslan Bukin return err;
103*17f65170SRuslan Bukin
104*17f65170SRuslan Bukin m_en_range_addr = m_st_range_addr = m_instr_info.instr_addr = addrStart;
105*17f65170SRuslan Bukin err = decodeSingleOpCode();
106*17f65170SRuslan Bukin
107*17f65170SRuslan Bukin if(err != OCSD_OK)
108*17f65170SRuslan Bukin return err;
109*17f65170SRuslan Bukin
110*17f65170SRuslan Bukin // set end range - always after the instruction executed.
111*17f65170SRuslan Bukin m_en_range_addr = m_instr_info.instr_addr + m_instr_info.instr_size;
112*17f65170SRuslan Bukin
113*17f65170SRuslan Bukin // assume next addr is the instruction after
114*17f65170SRuslan Bukin m_next_addr = m_en_range_addr;
115*17f65170SRuslan Bukin m_b_next_valid = true;
116*17f65170SRuslan Bukin
117*17f65170SRuslan Bukin // case when next address is different
118*17f65170SRuslan Bukin switch(m_instr_info.type)
119*17f65170SRuslan Bukin {
120*17f65170SRuslan Bukin case OCSD_INSTR_BR:
121*17f65170SRuslan Bukin if(A == ATOM_E) // executed the direct branch
122*17f65170SRuslan Bukin m_next_addr = m_instr_info.branch_addr;
123*17f65170SRuslan Bukin break;
124*17f65170SRuslan Bukin
125*17f65170SRuslan Bukin case OCSD_INSTR_BR_INDIRECT:
126*17f65170SRuslan Bukin if(A == ATOM_E) // executed indirect branch
127*17f65170SRuslan Bukin m_b_next_valid = false;
128*17f65170SRuslan Bukin break;
129*17f65170SRuslan Bukin }
130*17f65170SRuslan Bukin return err;
131*17f65170SRuslan Bukin }
132*17f65170SRuslan Bukin
decodeSingleOpCode()133*17f65170SRuslan Bukin ocsd_err_t OcsdCodeFollower::decodeSingleOpCode()
134*17f65170SRuslan Bukin {
135*17f65170SRuslan Bukin ocsd_err_t err = OCSD_OK;
136*17f65170SRuslan Bukin // request 4 bytes for the opcode - even for Thumb which may be T32
137*17f65170SRuslan Bukin uint32_t bytesReq = 4;
138*17f65170SRuslan Bukin uint32_t opcode; // buffer for opcode
139*17f65170SRuslan Bukin
140*17f65170SRuslan Bukin // read memory location for opcode
141*17f65170SRuslan Bukin err = m_pMemAccess->first()->ReadTargetMemory(m_instr_info.instr_addr,m_mem_space_csid,m_mem_acc_rule,&bytesReq,(uint8_t *)&opcode);
142*17f65170SRuslan Bukin
143*17f65170SRuslan Bukin // operational error (not access problem - that is indicated by 0 bytes returned)
144*17f65170SRuslan Bukin if(err != OCSD_OK)
145*17f65170SRuslan Bukin return err;
146*17f65170SRuslan Bukin
147*17f65170SRuslan Bukin if(bytesReq == 4) // check that we got all memory requested.
148*17f65170SRuslan Bukin {
149*17f65170SRuslan Bukin m_instr_info.opcode = opcode;
150*17f65170SRuslan Bukin err = m_pIDecode->first()->DecodeInstruction(&m_instr_info);
151*17f65170SRuslan Bukin }
152*17f65170SRuslan Bukin else // otherwise memory unavailable.
153*17f65170SRuslan Bukin {
154*17f65170SRuslan Bukin m_b_nacc_err = true;
155*17f65170SRuslan Bukin m_nacc_address = m_instr_info.instr_addr;
156*17f65170SRuslan Bukin err = OCSD_ERR_MEM_NACC;
157*17f65170SRuslan Bukin }
158*17f65170SRuslan Bukin return err;
159*17f65170SRuslan Bukin }
160*17f65170SRuslan Bukin
161*17f65170SRuslan Bukin /* End of File ocsd_code_follower.cpp */
162