/**
 * @file Nucleo/Actor.cpp
 * @version 1.0
 *
 * @section License
 * Copyright (C) 2014-2015, Mikael Patel
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2.1 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * This file is part of the Arduino Che Cosa project.
 */

#include "Actor.hh"

using namespace Nucleo;

int
Actor::send(uint8_t port, const void* buf, size_t size)
{
  // Do not allow send to the running thread
  if (UNLIKELY(s_running == this)) return (EINVAL);

  // Store message in sender actor
  Actor* sender = (Actor*) s_running;
  sender->m_port = port;
  sender->m_size = size;
  sender->m_buf = buf;

  // And queue in sending. Resume receiver or next thread
  Thread* thread = (m_receiving ? this : (Thread*) sender->succ());
  m_sending.attach(sender);
  sender->resume(thread);
  return (size);
}

int
Actor::recv(Actor*& sender, uint8_t& port, void* buf, size_t size)
{
  // Do not allow receive of other actor queue
  if (UNLIKELY(s_running != this)) return (EINVAL);

  // Check if receiver needs to wait for sending actor
  uint8_t key = lock();
  if (m_sending.is_empty()) {
    m_receiving = true;
    Thread* thread = (Thread*) succ();
    detach();
    unlock(key);
    resume(thread);
    key = lock();
  }

  // Copy sender message parameters
  int res = -2;
  sender = (Actor*) m_sending.succ();
  port = sender->m_port;
  if (size >= sender->m_size) {
    memcpy(buf, sender->m_buf, sender->m_size);
    res = sender->m_size;
  }
  m_receiving = false;

  // Reschedule the sender
  succ()->attach(sender);
  unlock(key);
  return (res);
}