/**
 * @file CosaAnalyzerPulse.ino
 * @version 1.0
 *
 * @section License
 * Copyright (C) 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.
 *
 * @section Description
 * Logic Analyzer based analysis of Job Scheduler; generate 160 ms
 * pulse width [10..90%], simulate servo control pulse.
 *
 * @section Circuit
 * Trigger on CHAN0/D7 rising.
 *
 * +-------+
 * | CHAN0 |-------------------------------> D13
 * | CHAN1 |-------------------------------> D12
 * | CHAN2 |-------------------------------> D11
 * |       |
 * | GND   |-------------------------------> GND
 * +-------+
 *
 * This file is part of the Arduino Che Cosa project.
 */

#include "Cosa/Job.hh"
#include "Cosa/RTT.hh"
#include "Cosa/Power.hh"
#include "Cosa/Watchdog.hh"
#include "Cosa/OutputPin.hh"
#include "Cosa/Trace.hh"
#include "Cosa/UART.hh"

// Use the RTT or Watchdog Job Scheduler
// #define USE_RTT
#define USE_WATCHDOG

// Call directly from interrupt service routine
// #define USE_ISR_DISPATCH

#if defined(USE_RTT)
#define TIMER RTT
#define SCALE(x) (x) * 1000UL
#endif

#if defined(USE_WATCHDOG)
#define TIMER Watchdog
#define SCALE(x) (x)
#endif

class Pulse : public Job {
public:
  static const uint32_t WIDTH = SCALE(160);

  Pulse(Job::Scheduler* scheduler, uint16_t percent,
	Board::DigitalPin pin) :
    Job(scheduler),
    m_pin(pin)
  {
    width(percent);
  }

#if defined(USE_ISR_DISPATCH)
  virtual void on_expired()
  {
    run();
  }
#endif

  virtual void run()
  {
    m_pin.toggle();
    if (m_pin.is_set())
      expire_after(m_pulse);
    else
      expire_after(WIDTH - m_pulse);
    start();
  }

  void width(uint16_t percent)
  {
    if (percent < 10) percent = 10;
    else if (percent > 90) percent = 90;
    m_pulse = (WIDTH * percent) / 100UL;
  }

private:
  OutputPin m_pin;
  uint32_t m_pulse;
};

// The job scheduler
TIMER::Scheduler scheduler;

// Pulse generators with 20, 50 and 80% pulse width (32, 80, 128 ms)
Pulse p1(&scheduler, 20, Board::D13);
Pulse p2(&scheduler, 50, Board::D12);
Pulse p3(&scheduler, 80, Board::D11);

void setup()
{
  // Print Info about the logic analyser probe channels
  uart.begin(9600);
  trace.begin(&uart, PSTR("CosaAnalyzerPulse: started"));
  trace << PSTR("CHAN0 - D13 [^]") << endl;
  trace << PSTR("CHAN1 - D12") << endl;
  trace << PSTR("CHAN2 - D11") << endl;
#if defined(USE_RTT)
  trace << PSTR("RTT Job Scheduler") << endl;
#endif
#if defined(USE_WATCHDOG)
  trace << PSTR("Watchdog Job Scheduler") << endl;
#endif
#if defined(USE_ISR_DISPATCH)
  trace << PSTR("ISR dispatch") << endl;
#else
  trace << PSTR("Event dispatch") << endl;
#endif
  trace.flush();

  // Start the pulse width generators
  p1.start();
  p2.start();
  p3.start();

  // Start the timer (Watchdog: 13/5 mA, RTT: 13/7 mA)
  TIMER::begin();
  // Power::set(SLEEP_MODE_PWR_DOWN);
  Power::set(SLEEP_MODE_EXT_STANDBY);
}

void loop()
{
  Event::service();
}