using System;
using System.Diagnostics;
using System.Threading;
using CommandMessenger;
using CommandMessenger.Transport.Serial;

namespace VTExperiment1
{

    // This is the list of recognized commands. These can be commands that can either be sent or received. 
    // In order to receive, attach a callback function to these events
    // 
    // Default commands
    // Note that commands work both directions:
    // - All commands can be sent
    // - Commands that have callbacks attached can be received
    // 
    // This means that both sides should have an identical command list:
    // one side can either send it or receive it (sometimes both)

    // Commands



    enum Command
    {
        SetLed,
        SetMotor,// Command to request led to be set in specific state
    };

    public class Receive
    {
        public bool RunLoop { get; set; }
        private SerialTransport _serialTransport;
        private CmdMessenger _cmdMessenger;
        private bool _ledState;

        public int portID;

        // Setup function
        public void Setup()
        {
            _ledState = false;

            // Create Serial Port object
            _serialTransport = new SerialTransport();
            _serialTransport.CurrentSerialSettings.PortName = "COM" + portID;    // Set com port
            _serialTransport.CurrentSerialSettings.BaudRate = 115200;     // Set baud rate
            _serialTransport.CurrentSerialSettings.DtrEnable = false;     // For some boards (e.g. Sparkfun Pro Micro) DtrEnable may need to be true.



            // Initialize the command messenger with the Serial Port transport layer
            _cmdMessenger = new CmdMessenger(_serialTransport, BoardType.Bit16);

            // Attach the callbacks to the Command Messenger
            AttachCommandCallBacks();

            // Start listening
            _cmdMessenger.Connect();
        }

        // Loop function
        public void Loop()
        {
            // Create command
            var command = new SendCommand((int)Command.SetLed, _ledState);

            // Send command
            _cmdMessenger.SendCommand(command);

            Console.Write("Turning led ");
            Console.WriteLine(_ledState ? "on" : "off");

            // Wait for 1 second and repeat
            Thread.Sleep(100);
            _ledState = !_ledState;   // Toggle led state            
        }

        public void toggleLed(bool b)
        {
            var command = new SendCommand((int)Command.SetLed, b);
            _cmdMessenger.SendCommand(command);

            Console.Write("Turning led ");
            Console.WriteLine(b ? "on" : "off");
        }

        public void setMotor(int number, int intensity)
        {
            var command = new SendCommand((int)Command.SetMotor, number +"");
            command.AddArgument(intensity);
            _cmdMessenger.SendCommand(command);
        }

        public void setMotor(int number, int intensity, int duration)
        {
            var command = new SendCommand((int)Command.SetMotor, number + "");
            command.AddArgument(intensity);
            command.AddArgument(duration);
            _cmdMessenger.SendCommand(command);
        }

        // Exit function
        public void Exit()
        {
            // We will never exit the application
        }

        /// Attach command call backs. 
        private void AttachCommandCallBacks()
        {
            // No callbacks are currently needed
        }
    }
}