/*
 *  © 2023 Peter Cole
 *  All rights reserved.
 *  
 *  This file is part of CommandStation-EX
 *
 *  This is free software: you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation, either version 3 of the License, or
 *  (at your option) any later version.
 *
 *  It 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 General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with CommandStation.  If not, see <https://www.gnu.org/licenses/>.
 */

#ifndef TURNTABLES_H
#define TURNTABLES_H

#include <Arduino.h>
#include "IODevice.h"
#include "StringFormatter.h"

// No turntable support without HAL
#ifndef IO_NO_HAL

// Turntable type definitions
// EXTT = EX-Turntable
// DCC = DCC accessory turntables - to be added later
enum {
  TURNTABLE_EXTT = 0,
  TURNTABLE_DCC = 1,
};

/*************************************************************************************
 * Turntable positions.
 * 
 *************************************************************************************/
struct TurntablePosition {
  uint8_t index;
  uint16_t data;
  uint16_t angle;
  TurntablePosition* next;
  
  TurntablePosition(uint8_t idx, uint16_t value, uint16_t angle) : index(idx), data(value), angle(angle), next(nullptr) {}
};

class TurntablePositionList {
public:
  TurntablePositionList() : head(nullptr) {}

  void insert(uint8_t idx, uint16_t value, uint16_t angle) {
    TurntablePosition* newPosition = new TurntablePosition(idx, value, angle);
    if(!head) {
      head = newPosition;
    } else {
      newPosition->next = head;
      head = newPosition;
    }
  }

  TurntablePosition* getHead() {
    return head;
  }

private:
  TurntablePosition* head;

};


/*************************************************************************************
 * Turntable - Base class for turntables.
 * 
 *************************************************************************************/

class Turntable {
protected:
  /*
   * Object data
   */

  //  Data common to all turntable types
  struct TurntableData {
    union {
      struct {
        bool hidden : 1;
        bool turntableType : 1;
        uint8_t position : 6;       // Allows up to 63 positions including 0/home
      };
      uint8_t flags;
    };
    uint16_t id;
  } _turntableData;

  // Pointer to next turntable object
  Turntable *_nextTurntable = 0;

  // Linked list for positions
  TurntablePositionList _turntablePositions;
  
  // Store the previous position to allow checking for changes
  uint8_t _previousPosition = 0;

  // Store the current state of the turntable
  bool _isMoving = false;

  /*
   * Constructor
   */
  Turntable(uint16_t id, uint8_t turntableType) {
    _turntableData.id = id;
    _turntableData.turntableType = turntableType;
    _turntableData.hidden = false;
    _turntableData.position = 0;
    add(this);
  }

  /*
   * Static data
   */
  static Turntable *_firstTurntable;
  static int _turntablelistHash;

  /*
   * Virtual functions
   */
  virtual bool setPositionInternal(uint8_t position, uint8_t activity) = 0;

  /*
   * Static functions
   */
  static void add(Turntable *tto);

public:
  static Turntable *get(uint16_t id);
  static Turntable *getByVpin(VPIN vpin);

  /*
   * Static data
   */
  static int turntablelistHash;

  /*
   * Public base class functions
   */
  inline uint8_t getPosition() { return _turntableData.position; }
  inline bool isHidden() { return _turntableData.hidden; }
  inline void setHidden(bool h) {_turntableData.hidden=h; }
  inline bool isType(uint8_t type) { return _turntableData.turntableType == type; }
  inline bool isEXTT() const { return _turntableData.turntableType == TURNTABLE_EXTT; }
  inline uint16_t getId() { return _turntableData.id; }
  inline Turntable *next() { return _nextTurntable; }
  void printState(Print *stream);
  void addPosition(uint8_t idx, uint16_t value, uint16_t angle);
  uint16_t getPositionValue(uint8_t position);
  uint16_t getPositionAngle(uint8_t position);
  uint8_t getPositionCount();
  bool isMoving() { return _isMoving; }
  void setMoving(bool moving) { _isMoving=moving; }

  /*
   * Virtual functions
   */
  virtual void print(Print *stream) {
    (void)stream; // suppress compiler warnings
  }
  virtual ~Turntable() {} // Destructor
  

  /*
   * Public static functions
   */
  inline static bool exists(uint16_t id) { return get(id) != 0; }
  static bool setPosition(uint16_t id, uint8_t position, uint8_t activity=0);
  static uint8_t getPosition(uint16_t id);
  static bool ttMoving(uint16_t id);
  inline static Turntable *first() { return _firstTurntable; }
  static bool printAll(Print *stream) {
    bool gotOne = false;
    for (Turntable *tto = _firstTurntable; tto != 0; tto = tto->_nextTurntable)
      if (!tto->isHidden()) {
        gotOne = true;
        StringFormatter::send(stream, F("<I %d %d>\n"), tto->getId(), tto->getPosition());
      }
    return gotOne;
  }

};

/*************************************************************************************
 * EXTTTurntable - EX-Turntable device.
 * 
 *************************************************************************************/
class EXTTTurntable : public Turntable {
private:
  // EXTTTurntableData contains device specific data
  struct EXTTTurntableData {
    VPIN vpin;
  } _exttTurntableData;

  // Constructor
  EXTTTurntable(uint16_t id, VPIN vpin);

public:
  // Create function
  static Turntable *create(uint16_t id, VPIN vpin);
  void print(Print *stream) override;
  VPIN getVpin() const { return _exttTurntableData.vpin; }

protected:
  // EX-Turntable specific code for setting position
  bool setPositionInternal(uint8_t position, uint8_t activity) override;

};

/*************************************************************************************
 * DCCTurntable - DCC accessory Turntable device.
 * 
 *************************************************************************************/
class DCCTurntable : public Turntable {
private:
  // Constructor
  DCCTurntable(uint16_t id);

public:
  // Create function
  static Turntable *create(uint16_t id);
  void print(Print *stream) override;

protected:
  // DCC specific code for setting position
  bool setPositionInternal(uint8_t position, uint8_t activity=0) override;

};

#endif

#endif