183 lines
3.2 KiB
C++
183 lines
3.2 KiB
C++
// (C) 2018-2024 by Folkert van Heusden
|
|
// Released under MIT license
|
|
|
|
#include <unistd.h>
|
|
|
|
#include "console.h"
|
|
#include "cpu.h"
|
|
#include "kw11-l.h"
|
|
#include "log.h"
|
|
#include "utils.h"
|
|
|
|
#if defined(ESP32)
|
|
#include "esp32.h"
|
|
#elif defined(BUILD_FOR_RP2040)
|
|
#include "rp2040.h"
|
|
#endif
|
|
|
|
|
|
#if defined(ESP32) || defined(BUILD_FOR_RP2040)
|
|
void thread_wrapper_kw11(void *p)
|
|
{
|
|
kw11_l *const kw11l = reinterpret_cast<kw11_l *>(p);
|
|
|
|
kw11l->operator()();
|
|
}
|
|
#endif
|
|
|
|
kw11_l::kw11_l(bus *const b): b(b)
|
|
{
|
|
}
|
|
|
|
kw11_l::~kw11_l()
|
|
{
|
|
stop_flag = true;
|
|
|
|
#if !defined(ESP32) && !defined(BUILD_FOR_RP2040)
|
|
if (th) {
|
|
th->join();
|
|
|
|
delete th;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
void kw11_l::begin(console *const cnsl)
|
|
{
|
|
this->cnsl = cnsl;
|
|
|
|
#if defined(ESP32) || defined(BUILD_FOR_RP2040)
|
|
xTaskCreate(&thread_wrapper_kw11, "kw11-l", 2048, this, 1, nullptr);
|
|
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xSemaphoreGive(lf_csr_lock); // initialize
|
|
#endif
|
|
#else
|
|
th = new std::thread(std::ref(*this));
|
|
#endif
|
|
}
|
|
|
|
void kw11_l::reset()
|
|
{
|
|
lf_csr = 0;
|
|
}
|
|
|
|
void kw11_l::operator()()
|
|
{
|
|
set_thread_name("kek:kw-11l");
|
|
|
|
DOLOG(debug, true, "Starting KW11-L thread");
|
|
|
|
while(!stop_flag) {
|
|
if (*cnsl->get_running_flag()) {
|
|
set_lf_crs_b7();
|
|
|
|
if (get_lf_crs() & 64)
|
|
b->getCpu()->queue_interrupt(6, 0100);
|
|
|
|
// TODO: dependant on cpu cycles processed
|
|
myusleep(1000000 / 50); // 20ms
|
|
}
|
|
else {
|
|
myusleep(1000000 / 10); // 100ms
|
|
}
|
|
}
|
|
|
|
DOLOG(debug, true, "KW11-L thread terminating");
|
|
}
|
|
|
|
uint16_t kw11_l::readWord(const uint16_t a)
|
|
{
|
|
if (a != ADDR_LFC) {
|
|
DOLOG(debug, true, "KW11-L readWord not for us (%06o)", a);
|
|
return 0;
|
|
}
|
|
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xSemaphoreTake(lf_csr_lock, portMAX_DELAY);
|
|
#else
|
|
std::unique_lock<std::mutex> lck(lf_csr_lock);
|
|
#endif
|
|
|
|
uint16_t temp = lf_csr;
|
|
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xSemaphoreGive(lf_csr_lock);
|
|
#endif
|
|
|
|
return temp;
|
|
}
|
|
|
|
void kw11_l::writeWord(const uint16_t a, const uint16_t value)
|
|
{
|
|
if (a != ADDR_LFC) {
|
|
DOLOG(debug, true, "KW11-L writeWord not for us (%06o to %06o)", value, a);
|
|
return;
|
|
}
|
|
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xSemaphoreTake(lf_csr_lock, portMAX_DELAY);
|
|
#else
|
|
std::unique_lock<std::mutex> lck(lf_csr_lock);
|
|
#endif
|
|
|
|
DOLOG(debug, false, "WRITE-I/O set line frequency clock/status register: %06o", value);
|
|
lf_csr = value;
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xSemaphoreGive(lf_csr_lock);
|
|
#endif
|
|
}
|
|
|
|
void kw11_l::set_lf_crs_b7()
|
|
{
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xSemaphoreTake(lf_csr_lock, portMAX_DELAY);
|
|
#else
|
|
std::unique_lock<std::mutex> lck(lf_csr_lock);
|
|
#endif
|
|
|
|
lf_csr |= 128;
|
|
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xSemaphoreGive(lf_csr_lock);
|
|
#endif
|
|
}
|
|
|
|
uint8_t kw11_l::get_lf_crs()
|
|
{
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xSemaphoreTake(lf_csr_lock, portMAX_DELAY);
|
|
#else
|
|
std::unique_lock<std::mutex> lck(lf_csr_lock);
|
|
#endif
|
|
|
|
uint8_t rc = lf_csr;
|
|
|
|
#if defined(BUILD_FOR_RP2040)
|
|
xSemaphoreGive(lf_csr_lock);
|
|
#endif
|
|
|
|
return rc;
|
|
}
|
|
|
|
#if IS_POSIX
|
|
json_t *kw11_l::serialize()
|
|
{
|
|
json_t *j = json_object();
|
|
|
|
json_object_set(j, "CSR", json_integer(lf_csr));
|
|
|
|
return j;
|
|
}
|
|
|
|
kw11_l *kw11_l::deserialize(const json_t *const j, bus *const b, console *const cnsl)
|
|
{
|
|
uint16_t CSR = json_integer_value(json_object_get(j, "CSR"));
|
|
|
|
kw11_l *out = new kw11_l(b);
|
|
out->lf_csr = CSR;
|
|
out->begin(cnsl);
|
|
|
|
return out;
|
|
}
|
|
#endif
|