195 lines
3.4 KiB
C++
195 lines
3.4 KiB
C++
// (C) 2018-2023 by Folkert van Heusden
|
|
// Released under MIT license
|
|
|
|
#include <errno.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
|
|
#include "tty.h"
|
|
#include "cpu.h"
|
|
#include "gen.h"
|
|
#include "log.h"
|
|
#include "memory.h"
|
|
#include "utils.h"
|
|
|
|
|
|
const char * const regnames[] = {
|
|
"reader status ",
|
|
"reader buffer ",
|
|
"puncher status",
|
|
"puncher buffer"
|
|
};
|
|
|
|
#if defined(BUILD_FOR_RP2040)
|
|
void thread_wrapper_tty(void *p)
|
|
{
|
|
tty *const t = reinterpret_cast<tty *>(p);
|
|
|
|
t->operator()();
|
|
}
|
|
#endif
|
|
|
|
tty::tty(console *const c, bus *const b) :
|
|
c(c),
|
|
b(b)
|
|
{
|
|
reset();
|
|
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xSemaphoreGive(chars_lock); // initialize
|
|
#endif
|
|
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xTaskCreate(&thread_wrapper_tty, "tty", 2048, this, 1, nullptr);
|
|
#else
|
|
th = new std::thread(std::ref(*this));
|
|
#endif
|
|
}
|
|
|
|
tty::~tty()
|
|
{
|
|
stop_flag = true;
|
|
|
|
#if !defined(BUILD_FOR_RP2040)
|
|
th->join();
|
|
delete th;
|
|
#endif
|
|
}
|
|
|
|
void tty::reset()
|
|
{
|
|
memset(registers, 0x00, sizeof registers);
|
|
}
|
|
|
|
uint8_t tty::readByte(const uint16_t addr)
|
|
{
|
|
uint16_t v = readWord(addr & ~1);
|
|
|
|
if (addr & 1)
|
|
return v >> 8;
|
|
|
|
return v;
|
|
}
|
|
|
|
void tty::notify_rx()
|
|
{
|
|
registers[(PDP11TTY_TKS - PDP11TTY_BASE) / 2] |= 128;
|
|
|
|
if (registers[(PDP11TTY_TKS - PDP11TTY_BASE) / 2] & 64)
|
|
b->getCpu()->queue_interrupt(4, 060);
|
|
}
|
|
|
|
uint16_t tty::readWord(const uint16_t addr)
|
|
{
|
|
const int reg = (addr - PDP11TTY_BASE) / 2;
|
|
uint16_t vtemp = registers[reg];
|
|
bool notify = false;
|
|
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xSemaphoreTake(chars_lock, portMAX_DELAY);
|
|
#else
|
|
std::unique_lock<std::mutex> lck(chars_lock);
|
|
#endif
|
|
|
|
if (addr == PDP11TTY_TKS) {
|
|
bool have_char = chars.empty() == false;
|
|
|
|
vtemp &= ~128;
|
|
vtemp |= have_char ? 128 : 0;
|
|
}
|
|
else if (addr == PDP11TTY_TKB) {
|
|
if (chars.empty())
|
|
vtemp = 0;
|
|
else {
|
|
uint8_t ch = chars.front();
|
|
chars.erase(chars.begin());
|
|
|
|
vtemp = ch | (parity(ch) << 7);
|
|
|
|
if (chars.empty() == false)
|
|
notify = true;
|
|
}
|
|
}
|
|
else if (addr == PDP11TTY_TPS) {
|
|
vtemp |= 128;
|
|
}
|
|
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xSemaphoreGive(chars_lock);
|
|
#endif
|
|
|
|
DOLOG(debug, false, "PDP11TTY read addr %o (%s): %d, 7bit: %d", addr, regnames[reg], vtemp, vtemp & 127);
|
|
|
|
registers[reg] = vtemp;
|
|
|
|
if (notify)
|
|
notify_rx();
|
|
|
|
return vtemp;
|
|
}
|
|
|
|
void tty::operator()()
|
|
{
|
|
set_thread_name("kek:tty");
|
|
|
|
while(!stop_flag) {
|
|
if (c->poll_char()) {
|
|
#if defined(BUILD_FOR_RP2040)
|
|
digitalWrite(LED_BUILTIN, !digitalRead(LED_BUILTIN));
|
|
xSemaphoreTake(chars_lock, portMAX_DELAY);
|
|
#else
|
|
std::unique_lock<std::mutex> lck(chars_lock);
|
|
#endif
|
|
|
|
chars.push_back(c->get_char());
|
|
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xSemaphoreGive(chars_lock);
|
|
#endif
|
|
|
|
notify_rx();
|
|
}
|
|
else {
|
|
myusleep(100000);
|
|
}
|
|
}
|
|
}
|
|
|
|
void tty::writeByte(const uint16_t addr, const uint8_t v)
|
|
{
|
|
uint16_t vtemp = registers[(addr - PDP11TTY_BASE) / 2];
|
|
|
|
if (addr & 1) {
|
|
vtemp &= ~0xff00;
|
|
vtemp |= v << 8;
|
|
}
|
|
else {
|
|
vtemp &= ~0x00ff;
|
|
vtemp |= v;
|
|
}
|
|
|
|
writeWord(addr, vtemp);
|
|
}
|
|
|
|
void tty::writeWord(const uint16_t addr, uint16_t v)
|
|
{
|
|
const int reg = (addr - PDP11TTY_BASE) / 2;
|
|
|
|
DOLOG(debug, false, "PDP11TTY write %o (%s): %o", addr, regnames[reg], v);
|
|
|
|
if (addr == PDP11TTY_TPB) {
|
|
char ch = v & 127;
|
|
|
|
DOLOG(debug, false, "PDP11TTY print '%c'", ch);
|
|
|
|
c->put_char(ch);
|
|
|
|
registers[(PDP11TTY_TPS - PDP11TTY_BASE) / 2] |= 128;
|
|
|
|
if (registers[(PDP11TTY_TPS - PDP11TTY_BASE) / 2] & 64)
|
|
b->getCpu()->queue_interrupt(4, 064);
|
|
}
|
|
|
|
DOLOG(debug, false, "set register %o to %o", addr, v);
|
|
registers[(addr - PDP11TTY_BASE) / 2] = v;
|
|
}
|