MatthiasQuintern/EEPROM-Sim
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

refactor

Browse Source
This commit is contained in:
matthias@arch 2024-01-17 15:10:59 +01:00
parent 43e1ed36d5
commit b7b5a197eb
18 changed files with 379 additions and 388 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

41
Makefile
View File

@ -1,15 +1,38 @@
CFLAGS = -std=c++20 -O2 CXX = g++
LFLAGS = -lbcm2835 CXXFLAGS = -std=c++20 -O3 -MMD -MP -Wall -Wpedantic
LDFLAGS = -lbcm2835
IFLAGS = -Iargparse/include
TOOLS = eeprom_sim #test/test_out test/test_in test/test_edge SRCDIR = src
BUILD_DIR = build
default: $(TOOLS) EXEC = eeprom-sim
.PHONY = test clean SRC = $(wildcard $(SRCDIR)/*.cpp) $(wildcard $(SRCDIR)/*/*.cpp)
test: test.cpp # OBJECTS = $(SRC:%.cpp=$(OBJECT_DIR)/%.o)
OBJECTS = $(patsubst $(SRCDIR)/%,$(BUILD_DIR)/%,$(patsubst %.cpp,%.o,$(SRC)))
DEPENDS = ${OBJECTS:.o=.d}
%: %.cpp CXXFLAGS += $(IFLAGS)
g++ $< -o $@ $(CFLAGS) $(LFLAGS)
.PHONY = default clean
default: $(EXEC)
print:
@echo $(SRC)
@echo $(OBJECTS)
-include $(DEPENDS)
$(BUILD_DIR):
mkdir -p $(BUILD_DIR)
$(EXEC): $(OBJECTS)
$(CXX) $(OBJECTS) -o $@ $(CXXFLAGS) $(LDFLAGS)
$(BUILD_DIR)/%.o: $(SRCDIR)/%.cpp | $(BUILD_DIR)
$(CXX) -c $(CXXFLAGS) $(LDFLAGS) $< -o $@
clean: clean:
rm $(TOOLS) -rm -r $(BUILD_DIR)
-rm $(EXEC)

3
build/eeprom.d Normal file
View File

@ -0,0 +1,3 @@
build/eeprom.o: src/eeprom.cpp src/eeprom.hpp src/util.hpp
src/eeprom.hpp:
src/util.hpp:

BIN
build/eeprom.o Normal file
View File

Binary file not shown.

3
build/main.d Normal file
View File

@ -0,0 +1,3 @@
build/main.o: src/main.cpp src/util.hpp src/6502_opcodes.hpp
src/util.hpp:
src/6502_opcodes.hpp:

BIN
build/main.o Normal file
View File

Binary file not shown.

2
build/util.d Normal file
View File

@ -0,0 +1,2 @@
build/util.o: src/util.cpp src/util.hpp
src/util.hpp:

BIN
build/util.o Normal file
View File

Binary file not shown.

BIN
eeprom-sim Executable file
View File

Binary file not shown.

120
eeprom.cpp
View File

@ -1,120 +0,0 @@
#include <ranges>
#include <bcm2835.h>
#include "util.hpp"
/* ADDRESS SETUP TIME
* depends on clock frequency, see datasheet. max 150@2MHz
* address is set after setup time (tADS) and is being hold for address hold time (tAH)
*
*
*/
constexpr uint64_t addressSetupTimeUS = 1; // 300e-9 s
class EEPROM {
EEPROM(const IOPins& ioPins, const AddressPins& addressPins, const Pin& pinCEb, const Pin& pinWEb, const Pin& pinOEb) {
}
}
void initPins() {
// set to input and pullup
auto setPinsInput = []<std::ranges::forward_range T>(const T& t) {
for (auto it = t.begin(); it != t.end(); it++) {
bcm2835_gpio_fsel(*it, BCM2835_GPIO_FSEL_INPT);
/* bcm2835_gpio_set_pud(*it, BCM2835_GPIO_PUD_UP); */
bcm2835_gpio_set_pud(*it, BCM2835_GPIO_PUD_OFF);
}
};
setPinsInput(addressPins);
setPinsInput(dataPins);
setPinsInput(controlPins);
}
void setIODirection(uint8_t direction) {
for (int i = 0; i < dataPins.size(); i++) {
bcm2835_gpio_fsel(dataPins.at(i), direction);
}
}
bool isChipEnabled() {
return !bcm2835_gpio_lev(CEb);
}
inline bool isRead() {
return bcm2835_gpio_lev(RWb);
}
uint16_t readAddress() {
uint16_t address = 0;
for (int i = 0; i < addressPins.size(); i++) {
address |= (bcm2835_gpio_lev(addressPins.at(i)) << i);
}
return address;
}
uint8_t readData() {
uint8_t address = 0;
for (int i = 0; i < dataPins.size(); i++) {
address |= (bcm2835_gpio_lev(dataPins.at(i)) << i);
}
return address;
}
inline void waitForFallingEdge(uint8_t pin) {
while (bcm2835_gpio_lev(pin) == LOW);
while (bcm2835_gpio_lev(pin) == HIGH);
}
inline void waitForRisingEdge(uint8_t pin) {
while (bcm2835_gpio_lev(pin) == HIGH);
while (bcm2835_gpio_lev(pin) == LOW);
}
inline void waitForEdge(uint8_t pin) {
if (bcm2835_gpio_lev(pin) == HIGH) {
while (bcm2835_gpio_lev(pin) == HIGH);
return;
}
else {
while (bcm2835_gpio_lev(pin) == LOW);
return;
}
}
/**
* @brief Simulate an AT28C256 EEPROM
* @details
* While the CEb is low, constantly read the address and put the corresponding data on the bus.
* While CEb is high, set data pins to input.
*/
void simulateEEPROM(std::stop_token token, std::array<char, UINT16_MAX> data) {
initPins();
printf("Begin EEPROM simulation\n");
uint16_t lastAddress = 0;
bool outputActive = false;
while (!token.stop_requested()) {
uint16_t currentAddress = readAddress();
bool chipEnabled = isChipEnabled();
if (chipEnabled && (!outputActive || (currentAddress != lastAddress))) {
setIODirection(BCM2835_GPIO_FSEL_OUTP);
outputActive = true;
uint32_t valueMask = byteToMask(data.at(currentAddress), dataPins);
bcm2835_gpio_write_mask(valueMask, ioMask);
/* std::cout << ">-" << gz::toBinString(currentAddress) << "[" << gz::toHexString(currentAddress) << "]-" << gz::toBinString(data.at(currentAddress)) << "[" << gz::toHexString(static_cast<uint16_t>(data.at(currentAddress)), 2) << "]"; */
/* std::cout << std::endl; */
}
if (!chipEnabled && outputActive) {
setIODirection(BCM2835_GPIO_FSEL_INPT);
outputActive = false;
}
lastAddress = currentAddress;
}
printf("End EEPROM simulation\n");
}

253
main.cpp
View File

@ -1,253 +0,0 @@
#include <stdio.h>
#include <bcm2835.h>
#include <signal.h>
#include <array>
#include <fstream>
#include <iostream>
#include <stdexcept>
#include <gz-util/string/conversion.hpp>
#include <cassert>
#include <thread>
#include <functional>
#include "6502_opcodes.hpp"
/* ADDRESS SETUP TIME
* depends on clock frequency, see datasheet. max 150@2MHz
* address is set after setup time (tADS) and is being hold for address hold time (tAH)
*
*
*/
constexpr uint64_t addressSetupTimeUS = 1; // 300e-9 s
constexpr std::array<uint8_t, 15> addressPins {
27, 22, 10, 9, 11, 5, 6, 13, // A0-A7
4, 2, 15, 3, // A8-A11
18, 17, 23 // A12-A14
};
constexpr std::array<uint8_t, 8> dataPins { 24, 25, 8, 7, 12, 16, 20, 21 };
constexpr uint8_t RWb = 19; // Read/Write
constexpr uint8_t CEb = 14; // Chip Enable
constexpr uint8_t PHI2 = 26; // clock
constexpr std::array<uint8_t, 3> controlPins { CEb, RWb, PHI2 };
template<size_t N>
constexpr uint32_t getMask(const std::array<uint8_t, N>& pins) {
uint32_t mask = 0;
for (int i = 0; i < pins.size(); i++) {
/* const uint8_t bit = pins.at(i) - 1; */
mask |= (1 << pins.at(i));
}
return mask;
}
constexpr uint32_t ioMask = getMask(dataPins);
constexpr uint32_t addressMask = getMask(addressPins);
struct CurrentState {
uint16_t addressBus = 0;
uint8_t dataBus = 0;
bool RWb = true;
std::string toString() const {
std::string s;
if (RWb) { s = "R-"; }
else { s = "W-"; }
s += gz::toBinString(addressBus) + "[" + gz::toHexString(addressBus, 4) + "]-"
+ gz::toBinString(dataBus) + "[" + gz::toHexString(static_cast<uint16_t>(dataBus), 2) + "]";
return s;
}
};
uint32_t byteToMask(char byte, const std::array<uint8_t, 8>& pins) {
uint32_t mask = 0;
for (int i = 0; i < 8; i++) {
if ((1 << i) & byte) { // if ith bit is set, set bit of corresponding pin
mask |= (1 << pins.at(i));
}
}
return mask;
}
void initPins() {
// set to input and pullup
auto setPinsInput = []<std::ranges::forward_range T>(const T& t) {
for (auto it = t.begin(); it != t.end(); it++) {
bcm2835_gpio_fsel(*it, BCM2835_GPIO_FSEL_INPT);
/* bcm2835_gpio_set_pud(*it, BCM2835_GPIO_PUD_UP); */
bcm2835_gpio_set_pud(*it, BCM2835_GPIO_PUD_OFF);
}
};
setPinsInput(addressPins);
setPinsInput(dataPins);
setPinsInput(controlPins);
}
void setIODirection(uint8_t direction) {
for (int i = 0; i < dataPins.size(); i++) {
bcm2835_gpio_fsel(dataPins.at(i), direction);
}
}
bool isChipEnabled() {
return !bcm2835_gpio_lev(CEb);
}
inline bool isRead() {
return bcm2835_gpio_lev(RWb);
}
uint16_t readAddress() {
uint16_t address = 0;
for (int i = 0; i < addressPins.size(); i++) {
address |= (bcm2835_gpio_lev(addressPins.at(i)) << i);
}
return address;
}
uint8_t readData() {
uint8_t address = 0;
for (int i = 0; i < dataPins.size(); i++) {
address |= (bcm2835_gpio_lev(dataPins.at(i)) << i);
}
return address;
}
constexpr std::array<const char*, 256> asciiChars {
"␀", "␁", "␂", "␃", "␄", "␅", "␆", "␇", "␈", "␉", "␊", "␋", "␌", "␍", "␎", "␏", "␐", "␑", "␒", "␓", "␔", "␕", "␖", "␗", "␘", "␙", "␚", "␛", "␜", "␝", "␞", "␟", "␠", "!", "\"", "#", "$", "%", "&", "'", "(", ")", "*", "+", ",", "-", ".", "/", "0", "1", "2", "3", "4", "5", "6", "7", "8", "9", ":", ";", "<", "=", ">", "?", "@", "A", "B", "C", "D", "E", "F", "G", "H", "I", "J", "K", "L", "M", "N", "O", "P", "Q", "R", "S", "T", "U", "V", "W", "X", "Y", "Z", "[", "\"", "]", "^", "_", "`", "a", "b", "c", "d", "e", "f", "g", "h", "i", "j", "k", "l", "m", "n", "o", "p", "q", "r", "s", "t", "u", "v", "w", "x", "y", "z", "{", "|", "}", "~", "␡"
};
inline void printData(const char& data) {
std::cout << '\'' << data << asciiChars.at(data) << "' "<< opCodes.at(data).getName();
}
inline void waitForFallingEdge(uint8_t pin) {
while (bcm2835_gpio_lev(pin) == LOW);
while (bcm2835_gpio_lev(pin) == HIGH);
}
inline void waitForRisingEdge(uint8_t pin) {
while (bcm2835_gpio_lev(pin) == HIGH);
while (bcm2835_gpio_lev(pin) == LOW);
}
inline void waitForEdge(uint8_t pin) {
if (bcm2835_gpio_lev(pin) == HIGH) {
while (bcm2835_gpio_lev(pin) == HIGH);
return;
}
else {
while (bcm2835_gpio_lev(pin) == LOW);
return;
}
}
/**
* @brief Simulate an AT28C256 EEPROM
* @details
* While the CEb is low, constantly read the address and put the corresponding data on the bus.
* While CEb is high, set data pins to input.
*/
void simulateEEPROM(std::stop_token token, std::array<char, UINT16_MAX> data) {
initPins();
printf("Begin EEPROM simulation\n");
uint16_t lastAddress = 0;
bool outputActive = false;
while (!token.stop_requested()) {
uint16_t currentAddress = readAddress();
bool chipEnabled = isChipEnabled();
if (chipEnabled && (!outputActive || (currentAddress != lastAddress))) {
setIODirection(BCM2835_GPIO_FSEL_OUTP);
outputActive = true;
uint32_t valueMask = byteToMask(data.at(currentAddress), dataPins);
bcm2835_gpio_write_mask(valueMask, ioMask);
/* std::cout << ">-" << gz::toBinString(currentAddress) << "[" << gz::toHexString(currentAddress) << "]-" << gz::toBinString(data.at(currentAddress)) << "[" << gz::toHexString(static_cast<uint16_t>(data.at(currentAddress)), 2) << "]"; */
/* std::cout << std::endl; */
}
if (!chipEnabled && outputActive) {
setIODirection(BCM2835_GPIO_FSEL_INPT);
outputActive = false;
}
lastAddress = currentAddress;
}
printf("End EEPROM simulation\n");
}
void printBusWithClock(std::stop_token token, uint8_t clockPin, const std::atomic<CurrentState>& currentState) {
printf("Begin bus printing\n");
auto state = currentState.load();
while (!token.stop_requested()) {
waitForRisingEdge(clockPin);
uint8_t chipEnabled = !bcm2835_gpio_lev(CEb);
uint8_t clock = bcm2835_gpio_lev(PHI2);
state.RWb = isRead();
state.addressBus = readAddress();
state.addressBus |= (chipEnabled << 15);
state.dataBus = readData();
if (clock == 0) { std::cout << "L-"; }
else { std::cout << "H-"; }
std::cout << state.toString();
if (chipEnabled) {
std::cout << " " << opCodes.at(state.dataBus).getName();
}
std::cout << std::endl;
}
printf("End bus printing\n");
}
void readFile(const char* filepath, std::array<char, UINT16_MAX>& bytes) {
std::ifstream file(filepath, std::ios_base::binary | std::ios_base::ate);
if (!file.is_open()) {
throw std::runtime_error("Error: Could not open file");
}
auto size = file.tellg();
if (size > UINT16_MAX) {
throw std::runtime_error("File is larger than UINT16_MAX");
}
file.seekg (0, std::ios::beg);
file.read(bytes.data(), size);
file.close();
}
void signalHandler(int signal) {
setIODirection(BCM2835_GPIO_FSEL_INPT);
bcm2835_close();
printf("Caught signal %d, exiting.\n", signal);
exit(0);
}
int main(int argc, const char** argv) {
if (bcm2835_init() != 1) {
printf("Error: Could not initalise gpio libraray\n");
return 1;
}
if (argc != 2) {
printf("Error: Expected exactly one argument (filename), got %d\n", argc);
return 1;
}
/* std::cout << "IOMask=" << gz::toBinString(ioMask) << ", AddressMask=" << gz::toBinString(addressMask) << std::endl; */
std::array<char, UINT16_MAX> bytes{};
readFile(argv[1], bytes);
std::cout << "Reset Vector " << gz::toBinString(bytes.at(0x7ffc)) << " - " << gz::toBinString(0x77fd) << std::endl;
std::jthread eepromT(simulateEEPROM, bytes);
std::atomic<CurrentState> cs;
std::jthread clockT(printBusWithClock, PHI2, std::ref(cs));
/* auto handler = std::bind(signalHandler, std::placeholders::_1, std::move(eepromT)); */
signal(SIGINT, signalHandler);
while(true) {
std::this_thread::sleep_for(std::chrono::seconds(1));
}
}

4
src/.clangd Normal file
View File

@ -0,0 +1,4 @@
CompileFlags: # Tweak the parse settings
Add: [-std=c++20, -Wall, -Wextra, -Wpedantic, -Iargparse/include]
# https://clangd.llvm.org/config

0
6502_opcodes.hpp → src/6502_opcodes.hpp
View File

86
src/eeprom.cpp Normal file
View File

@ -0,0 +1,86 @@
#include <iomanip>
#include <ranges>
#include <bcm2835.h>
#include "eeprom.hpp"
#include "util.hpp"
/* ADDRESS SETUP TIME
* depends on clock frequency, see datasheet. max 150@2MHz
* address is set after setup time (tADS) and is being hold for address hold time (tAH)
*
*
*/
constexpr uint64_t addressSetupTimeUS = 1; // 300e-9 s
EEPROM::EEPROM(const IOPins& ioPins, const AddressPins& addressPins, const Pin& pinCEb, const Pin& pinWEb, const Pin& pinOEb)
: ioPins(ioPins), ioMask(getMask(ioPins)), addressPins(addressPins), pinCEb(pinCEb), pinWEb(pinWEb), pinOEb(pinOEb) {
// set to input and pullup
auto setPinsInput = []<std::ranges::forward_range T>(const T& t) {
for (auto it = t.begin(); it != t.end(); it++) {
bcm2835_gpio_fsel(*it, BCM2835_GPIO_FSEL_INPT);
/* bcm2835_gpio_set_pud(*it, BCM2835_GPIO_PUD_UP); */
bcm2835_gpio_set_pud(*it, BCM2835_GPIO_PUD_OFF);
}
};
setPinsInput(this->addressPins);
setPinsInput(this->ioPins);
setPinsInput(std::array<Pin, 3>{this->pinCEb, this->pinWEb, this->pinOEb});
}
EEPROM::~EEPROM() {
setIODirection(INPUT);
}
void EEPROM::setIODirection(uint8_t direction) {
if (IODirection == direction) { return; }
for (size_t i = 0; i < ioPins.size(); i++) {
bcm2835_gpio_fsel(ioPins.at(i), direction);
}
}
void EEPROM::simulate(std::stop_token token) {
std::println("Begin EEPROM simulation");
using State = uint8_t;
auto getState = [this](){
State state = 0;
state |= !readPin(pinCEb) << 1;
state |= !readPin(pinWEb) << 2;
state |= !readPin(pinOEb) << 3;
return state;
};
auto isChipEnabled = [](State state) { return (state & (1 << 1)) != 0; };
auto isWriteEnabled = [](State state) { return (state & (1 << 2)) != 0; };
auto isOutputEnabled = [](State state) { return (state & (1 << 3)) != 0; };
Address lastAddress = 0;
State lastState = 0xff;
while (!token.stop_requested()) {
uint8_t state = getState();
if (isChipEnabled(state)) {
Address address = readAddress();
if (isOutputEnabled(state) && (address != lastAddress || !isOutputEnabled(lastState))) {
setIODirection(OUTPUT);
uint8_t data = rom.at(address);
uint32_t valueMask = byteToMask(data, ioPins);
bcm2835_gpio_write_mask(valueMask, ioMask);
std::println("[0x{:4x} 0b{:16b}] -> {{0x{:2x} 0b{:8b}}}", address, address, data, data);
}
else if (isWriteEnabled(state) && (address != lastAddress || !isWriteEnabled(lastState))) {
setIODirection(INPUT);
uint8_t data = readData();
rom.at(address) = data;
std::println("[0x{:4x} 0b{:16b}] <- {{0x{:2x} 0b{:8b}}}", address, address, data, data);
}
lastAddress = address;
}
if (!isChipEnabled(state) && !(isOutputEnabled(state) || isWriteEnabled(state))) {
setIODirection(INPUT);
}
}
std::println("End EEPROM simulation");
}

31
src/eeprom.hpp Normal file
View File

@ -0,0 +1,31 @@
#pragma once
#include <stop_token>
#include <thread>
#include "util.hpp"
class EEPROM {
public:
EEPROM(const IOPins& ioPins, const AddressPins& addressPins, const Pin& pinCEb, const Pin& pinWEb, const Pin& pinOEb);
inline void setRom(const std::array<uint8_t, AddressSize>& v) { rom = v; }
inline void setRom(std::array<uint8_t, AddressSize>&& v) { rom = std::move(v); }
inline const std::array<uint8_t, AddressSize>& getRom() const { return rom; }
void simulate(std::stop_token token);
~EEPROM();
private:
std::array<uint8_t, AddressSize> rom;
const IOPins& ioPins;
const uint32_t ioMask;
const AddressPins& addressPins;
const Pin& pinCEb;
const Pin& pinWEb;
const Pin& pinOEb;
void simulateThread(std::stop_token token);
void setIODirection(uint8_t direction);
uint8_t IODirection = INPUT;
inline Address readAddress() { return readPins<Address>(this->addressPins); };
inline uint8_t readData() { return readPins<uint8_t>(this->ioPins); };
};

136
src/main.cpp Normal file
View File

@ -0,0 +1,136 @@
#include <bcm2835.h>
#include <csignal>
#include <signal.h>
#include <array>
#include <fstream>
#include <iostream>
#include <stdexcept>
#include <cassert>
#include <thread>
#include <functional>
#include "util.hpp"
#include "6502_opcodes.hpp"
/* ADDRESS SETUP TIME
* depends on clock frequency, see datasheet. max 150@2MHz
* address is set after setup time (tADS) and is being hold for address hold time (tAH)
*
*
*/
constexpr uint64_t addressSetupTimeUS = 1; // 300e-9 s
constexpr std::array<uint8_t, 15> addressPins {
27, 22, 10, 9, 11, 5, 6, 13, // A0-A7
4, 2, 15, 3, // A8-A11
18, 17, 23 // A12-A14
};
constexpr std::array<uint8_t, 8> dataPins { 24, 25, 8, 7, 12, 16, 20, 21 };
constexpr uint8_t RWb = 19; // Read/Write
constexpr uint8_t CEb = 14; // Chip Enable
constexpr uint8_t PHI2 = 26; // clock
constexpr std::array<uint8_t, 3> controlPins { CEb, RWb, PHI2 };
constexpr uint32_t ioMask = getMask(dataPins);
constexpr uint32_t addressMask = getMask(addressPins);
std::atomic_bool stop = false;
/* struct CurrentState { */
/* uint16_t addressBus = 0; */
/* uint8_t dataBus = 0; */
/* bool RWb = true; */
/* std::string toString() const { */
/* std::string s; */
/* if (RWb) { s = "R-"; } */
/* else { s = "W-"; } */
/* /1* s += gz::toBinString(addressBus) + "[" + gz::toHexString(addressBus, 4) + "]-" *1/ */
/* /1* + gz::toBinString(dataBus) + "[" + gz::toHexString(static_cast<uint16_t>(dataBus), 2) + "]"; *1/ */
/* return s; */
/* } */
/* }; */
constexpr std::array<const char*, 256> asciiChars {
"␀", "␁", "␂", "␃", "␄", "␅", "␆", "␇", "␈", "␉", "␊", "␋", "␌", "␍", "␎", "␏", "␐", "␑", "␒", "␓", "␔", "␕", "␖", "␗", "␘", "␙", "␚", "␛", "␜", "␝", "␞", "␟", "␠", "!", "\"", "#", "$", "%", "&", "'", "(", ")", "*", "+", ",", "-", ".", "/", "0", "1", "2", "3", "4", "5", "6", "7", "8", "9", ":", ";", "<", "=", ">", "?", "@", "A", "B", "C", "D", "E", "F", "G", "H", "I", "J", "K", "L", "M", "N", "O", "P", "Q", "R", "S", "T", "U", "V", "W", "X", "Y", "Z", "[", "\"", "]", "^", "_", "`", "a", "b", "c", "d", "e", "f", "g", "h", "i", "j", "k", "l", "m", "n", "o", "p", "q", "r", "s", "t", "u", "v", "w", "x", "y", "z", "{", "|", "}", "~", "␡"
};
inline void printData(const char& data) {
std::cout << '\'' << data << asciiChars.at(data) << "' "<< opCodes.at(data).getName();
}
/* void printBusWithClock(std::stop_token token, uint8_t clockPin, const std::atomic<CurrentState>& currentState) { */
/* printf("Begin bus printing\n"); */
/* auto state = currentState.load(); */
/* while (!token.stop_requested()) { */
/* waitForRisingEdge(clockPin); */
/* uint8_t chipEnabled = !bcm2835_gpio_lev(CEb); */
/* uint8_t clock = bcm2835_gpio_lev(PHI2); */
/* state.RWb = isRead(); */
/* state.addressBus = readAddress(); */
/* state.addressBus |= (chipEnabled << 15); */
/* state.dataBus = readData(); */
/* if (clock == 0) { std::cout << "L-"; } */
/* else { std::cout << "H-"; } */
/* std::cout << state.toString(); */
/* if (chipEnabled) { */
/* std::cout << " " << opCodes.at(state.dataBus).getName(); */
/* } */
/* std::cout << std::endl; */
/* } */
/* printf("End bus printing\n"); */
/* } */
void readFile(const char* filepath, std::array<char, UINT16_MAX>& bytes) {
std::ifstream file(filepath, std::ios_base::binary | std::ios_base::ate);
if (!file.is_open()) {
throw std::runtime_error("Error: Could not open file");
}
auto size = file.tellg();
if (size > UINT16_MAX) {
throw std::runtime_error("File is larger than UINT16_MAX");
}
file.seekg (0, std::ios::beg);
file.read(bytes.data(), size);
file.close();
}
void signalHandler(int signal) {
stop = true;
}
int main(int argc, const char** argv) {
if (bcm2835_init() != 1) {
printf("Error: Could not initalise gpio libraray\n");
return 1;
}
if (argc != 2) {
printf("Error: Expected exactly one argument (filename), got %d\n", argc);
return 1;
}
/* std::cout << "IOMask=" << gz::toBinString(ioMask) << ", AddressMask=" << gz::toBinString(addressMask) << std::endl; */
std::array<char, UINT16_MAX> bytes{};
readFile(argv[1], bytes);
/* std::cout << "Reset Vector " << gz::toBinString(bytes.at(0x7ffc)) << " - " << gz::toBinString(0x77fd) << std::endl; */
/* std::jthread eepromT(simulateEEPROM, bytes); */
/* std::atomic<CurrentState> cs; */
/* std::jthread clockT(printBusWithClock, PHI2, std::ref(cs)); */
/* auto handler = std::bind(signalHandler, std::placeholders::_1, std::move(eepromT)); */
std::signal(SIGINT, signalHandler);
while (!stop) {
std::this_thread::sleep_for(std::chrono::milliseconds(10));
}
bcm2835_close();
/* printf("Caught signal %d, exiting.\n", signal); */
exit(0);
}

13
src/util.cpp Normal file
View File

@ -0,0 +1,13 @@
#include "util.hpp"
#include <type_traits>
uint32_t byteToMask(char byte, const std::array<uint8_t, 8>& pins) {
uint32_t mask = 0;
for (int i = 0; i < 8; i++) {
if ((1 << i) & byte) { // if ith bit is set, set bit of corresponding pin
mask |= (1 << pins.at(i));
}
}
return mask;
}

69
src/util.hpp Normal file
View File

@ -0,0 +1,69 @@
#pragma once
#include <cstdint>
#include <array>
#include <format>
#include <iostream>
#include <bcm2835.h>
const size_t AddressSize = 15;
using Pin = uint8_t;
using IOPins = std::array<Pin, 8>;
using AddressPins = std::array<Pin, AddressSize>;
using Address = uint16_t;
// TODO: remove when c++23 is used
namespace std {
template <typename... Args>
inline void println(const std::format_string<Args...> fmt, Args&&... args) {
std::cout << std::vformat(fmt.get(), std::make_format_args(args...)) << std::endl;
}
}
inline void waitForFallingEdge(uint8_t pin) {
while (bcm2835_gpio_lev(pin) == LOW);
while (bcm2835_gpio_lev(pin) == HIGH);
}
inline void waitForRisingEdge(uint8_t pin) {
while (bcm2835_gpio_lev(pin) == HIGH);
while (bcm2835_gpio_lev(pin) == LOW);
}
inline void waitForEdge(uint8_t pin) {
if (bcm2835_gpio_lev(pin) == HIGH) {
while (bcm2835_gpio_lev(pin) == HIGH);
return;
}
else {
while (bcm2835_gpio_lev(pin) == LOW);
return;
}
}
uint32_t byteToMask(char byte, const std::array<uint8_t, 8>& dataPins);
template<size_t N>
constexpr uint32_t getMask(const std::array<Pin, N>& pins) {
uint32_t mask = 0;
for (size_t i = 0; i < pins.size(); i++) {
/* const uint8_t bit = pins.at(i) - 1; */
mask |= (1 << pins.at(i));
}
return mask;
}
inline uint8_t readPin(Pin pin) {
return bcm2835_gpio_lev(pin);
}
template<typename T, size_t N>
T readPins(const std::array<Pin, N>& pins) {
static_assert(sizeof(T) * 8 >= N);
T t = 0;
for (size_t i = 0; i < pins.size(); i++) {
t |= (bcm2835_gpio_lev(pins.at(i)) << i);
}
return t;
}
const uint8_t OUTPUT = BCM2835_GPIO_FSEL_OUTP;
const uint8_t INPUT = BCM2835_GPIO_FSEL_INPT;

6
util.hpp
View File

@ -1,6 +0,0 @@
#include <cstdint>
#include <array>
using Pin = uint8_t;
using IOPins = std::array<Pin, 8>;
using AddressPins = std::array<Pin, 15>;