blob: 2f48d3d8c5ebc0af4e12b02929c464f5ecaedd8a [file]
//
// Copyright (c) 2010-2024 Antmicro
//
// This file is licensed under the MIT License.
// Full license text is available in 'licenses/MIT.txt'.
//
#ifndef WishboneInitiator_H
#define WishboneInitiator_H
#include "src/renode.h"
#include "wishbone.h"
template <typename data_t, typename addr_t>
class WishboneInitiator : public WishboneBase, public BaseInitiatorBus
{
public:
WishboneInitiator()
: readState(0), writeState(0)
{
}
void tick(bool countEnable, uint64_t steps) override
{
for (size_t i = 0; i < steps; i++)
{
readHandler();
writeHandler();
*wb_clk = high;
evaluateModel();
*wb_clk = low;
evaluateModel();
}
clearSignals();
if (countEnable)
tickCounter += steps;
}
void timeoutTick(uint8_t* signal, uint8_t expectedValue, int timeout)
{
throw "Unsupported operation";
}
void readWord(uint64_t addr, uint8_t sel)
{
#ifdef DEBUG
agent->log(LOG_LEVEL_NOISY, "Wishbone read from: 0x%" PRIX64 ", sel: %i", addr, int(sel));
#endif
data = agent->requestDoubleWordFromAgent(addr);
constexpr size_t bits = 8;
for (size_t i = 0; i < bits; i++)
{
if ((sel & (1 << i)) == 0)
((uint8_t *)&data)[i] = 0;
}
}
void writeWord(uint64_t addr, uint64_t data, uint8_t sel)
{
#ifdef DEBUG
agent->log(LOG_LEVEL_NOISY, "Wishbone write to: 0x%" PRIX64 ", data: 0x%" PRIX64 ", sel: %i", addr, data, int(sel));
#endif
switch (sel)
{
case 1 << 0:
agent->pushByteToAgent(addr, ((uint8_t *)&data)[0]);
break;
case 1 << 1:
agent->pushByteToAgent(addr + 1, ((uint8_t *)&data)[1]);
break;
case 1 << 2:
agent->pushByteToAgent(addr + 2, ((uint8_t *)&data)[2]);
break;
case 1 << 3:
agent->pushByteToAgent(addr + 3, ((uint8_t *)&data)[3]);
break;
case (1 << 0) | (1 << 1):
agent->pushWordToAgent(addr, data & 0xFFFF);
break;
case (1 << 2) | (1 << 3):
agent->pushWordToAgent(addr + 2, (data >> 16) & 0xFFFF);
break;
case 15:
agent->pushDoubleWordToAgent(addr, data);
break;
default:
{
uint64_t oldData = agent->requestDoubleWordFromAgent(addr);
constexpr size_t bits = 8;
for (size_t i = 0; i < bits; i++)
{
if (sel & (1 << i))
((uint8_t *)&oldData)[i] = ((uint8_t *)&data)[i];
}
agent->pushDoubleWordToAgent(addr, oldData);
break;
}
}
}
void readHandler()
{
switch (readState)
{
case 0:
if (*wb_cyc && *wb_stb && !*wb_we)
{
*wb_stall = low;
*wb_ack = low;
readWord(*wb_addr, *wb_sel);
readState = 1;
}
break;
case 1:
*wb_stall = high;
*wb_ack = high;
*wb_rd_dat = data;
readState = 0;
break;
}
}
void writeHandler()
{
switch (writeState)
{
case 0:
if (*wb_cyc && *wb_stb && *wb_we)
{
*wb_stall = low;
*wb_ack = low;
writeWord(*wb_addr, *wb_wr_dat, *wb_sel);
writeState = 1;
}
break;
case 1:
*wb_stall = high;
*wb_ack = high;
writeState = 0;
break;
}
}
void clearSignals()
{
*wb_stall = high;
*wb_ack = low;
}
void reset()
{
*wb_rst = 1;
tick(true, 1);
*wb_rst = 0;
tick(true, 1);
}
bool hasSpecifiedAdress() override
{
return *wb_cyc && *wb_stb;
}
uint64_t getSpecifiedAdress() override { return *wb_addr; }
addr_t *wb_addr;
data_t *wb_rd_dat;
data_t *wb_wr_dat;
uint8_t readState, writeState;
uint64_t data;
static constexpr uint32_t high = 1, low = 0;
};
#endif