KEK/console.cpp
folkert van heusden 6e17f4b747 The disassembler uses peekWord() which would do a real read on i/o
devices. That is now replaced by a return 012345 so that the (emulated)
devices don't get confused (e.g. the tty would miss characters).
2022-06-12 21:00:26 +02:00

243 lines
3.9 KiB
C++

#include <chrono>
#include <stdarg.h>
#include <stdio.h>
#include <stdlib.h>
#include <string>
#include <string.h>
#include "console.h"
#include "gen.h"
#include "log.h"
#include "utils.h"
console::console(std::atomic_uint32_t *const stop_event, bus *const b) :
stop_event(stop_event),
b(b)
{
memset(screen_buffer, ' ', sizeof screen_buffer);
}
console::~console()
{
// done as well in subclasses but also here to
// stop lgtm.com complaining about it
stop_thread();
}
void console::start_thread()
{
stop_thread_flag = false;
#if !defined(ESP32)
th = new std::thread(std::ref(*this));
#endif
}
void console::stop_thread()
{
if (th) {
stop_thread_flag = true;
th->join();
delete th;
th = nullptr;
}
}
bool console::poll_char()
{
std::unique_lock<std::mutex> lck(input_lock);
return input_buffer.empty() == false;
}
int console::get_char()
{
std::unique_lock<std::mutex> lck(input_lock);
if (input_buffer.empty())
return -1;
char c = input_buffer.at(0);
input_buffer.erase(input_buffer.begin() + 0);
return c;
}
int console::wait_char(const int timeout_ms)
{
std::unique_lock<std::mutex> lck(input_lock);
using namespace std::chrono_literals;
if (input_buffer.empty() == false || have_data.wait_for(lck, timeout_ms * 1ms) == std::cv_status::no_timeout) {
if (input_buffer.empty() == false) {
int c = input_buffer.at(0);
input_buffer.erase(input_buffer.begin() + 0);
return c;
}
}
return -1;
}
void console::flush_input()
{
std::unique_lock<std::mutex> lck(input_lock);
input_buffer.clear();
}
void console::emit_backspace()
{
put_char(8);
put_char(' ');
put_char(8);
}
std::string console::read_line(const std::string & prompt)
{
put_string(prompt);
put_string(">");
std::string str;
for(;;) {
char c = wait_char(500);
if (*stop_event == EVENT_TERMINATE)
return "";
if (c == -1 || c == 255 /* ESP32 has unsigned char? */)
continue;
if (c == 13 || c == 10)
break;
if (c == 8 || c == 127) { // backspace
if (!str.empty()) {
str = str.substr(0, str.size() - 1);
emit_backspace();
}
}
else if (c == 21) { // ^u
for(size_t i=0; i<str.size(); i++)
emit_backspace();
str.clear();
}
else if (c >= 32) {
str += c;
put_char(c);
}
}
put_string_lf("");
return str;
}
void console::debug(const std::string fmt, ...)
{
char *buffer = nullptr;
va_list ap;
va_start(ap, fmt);
vasprintf(&buffer, fmt.c_str(), ap);
va_end(ap);
put_string_lf(buffer);
free(buffer);
}
void console::put_char(const char c)
{
put_char_ll(c);
if (c == 0) {
// ignore these
}
else if (c == 13)
tx = 0;
else if (c == 10) {
if (debug_buffer.empty() == false) {
DOLOG(::debug, true, "TTY: %s", debug_buffer.c_str());
debug_buffer.clear();
}
ty++;
}
else if (c == 8) { // backspace
if (tx > 0)
tx--;
}
else {
screen_buffer[ty][tx++] = c;
if (tx == t_width) {
tx = 0;
ty++;
}
if (debug_buffer.size() < 4096)
debug_buffer += c;
}
if (ty == t_height) {
memmove(&screen_buffer[0], &screen_buffer[1], sizeof(char) * t_width * (t_height - 1));
ty--;
memset(screen_buffer[t_height - 1], ' ', t_width);
}
}
void console::put_string(const std::string & what)
{
for(size_t x=0; x<what.size(); x++)
put_char(what.at(x));
}
void console::operator()()
{
DOLOG(::info, true, "Console thread started");
set_thread_name("kek::console");
while(*stop_event != EVENT_TERMINATE && !stop_thread_flag) {
int c = wait_for_char_ll(500);
if (c == -1)
continue;
bool running_flag = *get_running_flag();
if (running_flag == false && c == 3) // ^c
*stop_event = EVENT_TERMINATE;
else if (running_flag == true && c == 5) // ^e
*stop_event = EVENT_INTERRUPT;
else if (running_flag == false && c == 12) // ^l
refresh_virtual_terminal();
else {
std::unique_lock<std::mutex> lck(input_lock);
input_buffer.push_back(c);
have_data.notify_all();
}
}
DOLOG(::info, true, "Console thread terminating");
}