1 files changed, 66 insertions, 0 deletions
diff --git a/fesvr/htif_pthread.cc b/fesvr/htif_pthread.cc
new file mode 100644
index 0000000..b9e3832
--- /dev/null
+++ b/fesvr/htif_pthread.cc
@@ -0,0 +1,66 @@
+// See LICENSE for license details.
+
+#include "htif_pthread.h"
+#include <algorithm>
+#include <stdio.h>
+
+void htif_pthread_t::thread_main(void* arg)
+{
+  htif_pthread_t* htif = static_cast<htif_pthread_t*>(arg);
+  htif->run();
+  while (true)
+    htif->target->switch_to();
+}
+
+htif_pthread_t::htif_pthread_t(int argc, char** argv)
+    : htif_t(argc, argv)
+{
+  target = context_t::current();
+  host.init(thread_main, this);
+}
+
+htif_pthread_t::~htif_pthread_t()
+{
+}
+
+ssize_t htif_pthread_t::read(void* buf, size_t max_size)
+{
+  while (th_data.size() == 0)
+    target->switch_to();
+
+  size_t s = std::min(max_size, th_data.size());
+  std::copy(th_data.begin(), th_data.begin() + s, (char*)buf);
+  th_data.erase(th_data.begin(), th_data.begin() + s);
+
+  return s;
+}
+
+ssize_t htif_pthread_t::write(const void* buf, size_t size)
+{
+  ht_data.insert(ht_data.end(), (const char*)buf, (const char*)buf + size);
+  return size;
+}
+
+void htif_pthread_t::send(const void* buf, size_t size)
+{
+  th_data.insert(th_data.end(), (const char*)buf, (const char*)buf + size);
+}
+
+void htif_pthread_t::recv(void* buf, size_t size)
+{
+  while (!this->recv_nonblocking(buf, size))
+    ;
+}
+
+bool htif_pthread_t::recv_nonblocking(void* buf, size_t size)
+{
+  if (ht_data.size() < size)
+  {
+    host.switch_to();
+    return false;
+  }
+
+  std::copy(ht_data.begin(), ht_data.begin() + size, (char*)buf);
+  ht_data.erase(ht_data.begin(), ht_data.begin() + size);
+  return true;
+}