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