P015_09_V1_0_Encoder.h

Go to the documentation of this file.

//------------------------------------------------------------------------------
//! @file       P015_09_V1_0_Encoder.h
//! @brief      Control board P015.09 CB incremental encoder hardware driver header file.
//! @attention  No special attention requered.
//! @copyright  (C) 2015-2020 ANVILEX LLC
//!             $HeadURL: https://192.168.3.4:8443/svn/P004_07/ConOpSys/Hardware/P015_09_V1_0/P015_09_V1_0_Encoder.h $
//!             $Revision: 2546 $
//!             $Date: 2021-03-25 14:04:50 +0500 (Do, 25 Mrz 2021) $
//!             $Author: minch $
//------------------------------------------------------------------------------
//
// Redistribution and use in source and binary forms, with or without
// modification, are permitted provided that the following conditions are met:
//
// 1. Redistributions of source code must retain the above copyright notice,
//    this list of conditions and the following disclaimer.
//
// 2. Redistributions in binary form must reproduce the above copyright notice,
//    this list of conditions and the following disclaimer in the documentation
//    and/or other materials provided with the distribution.
//
// 3. Neither the name of ANVILEX nor the names of its contributors may be
//    used to endorse or promote products derived from this software without
//    specific prior written permission.
//
// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
// AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
// IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
// ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
// LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
// CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
// SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
// INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
// CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
// ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
// POSSIBILITY OF SUCH DAMAGE.
//
//------------------------------------------------------------------------------
 
//------------------------------------------------------------------------------
// Protecting header files from mutual, recursive inclusion.
//------------------------------------------------------------------------------
 
#pragma once
 
//------------------------------------------------------------------------------
// Include standard libraries header files
//------------------------------------------------------------------------------
 
//------------------------------------------------------------------------------
// Include thrid party header files
//------------------------------------------------------------------------------
 
//------------------------------------------------------------------------------
// Include ConOpSys header files
//------------------------------------------------------------------------------
 
#include "Function_Block_Base.h"
 
//------------------------------------------------------------------------------
// Include ConOpSys application header files
//------------------------------------------------------------------------------
 
//------------------------------------------------------------------------------
//! @brief Encoder board P015.09 V1.0 class
//------------------------------------------------------------------------------
 
class TP015_09_V1_0_Encoder : public TFunction_Block_Base
{
  
  //----------------------------------------------------------------------------
  // Public methods and variables
  //----------------------------------------------------------------------------
  
  public:
 
    // Register structure for generic access
    typedef struct
    {
      
      // Analog value registers
      U16 u16_Status; //!< Status register
      U16 u16_Counter; //!< Counter register
      U16 u16_Counter_Latch;  //!< Counter latch register
      U16 u16_Period; //!< Period in FPGA clocks
      U16 u16_Unused_0x04;  //!< Reserved register
      U16 u16_Unused_0x05;  //!< Reserved register
      U16 u16_Unused_0x06;  //!< Reserved register
      U16 u16_Unused_0x07;  //!< Reserved register
      
    } TP015_09_V1_0_Encoder_Registers;
    
    //--------------------------------------------------------------------------
    // Public methods
    //--------------------------------------------------------------------------
 
    // Constructor and destructor
    TP015_09_V1_0_Encoder();  //!< Constructor method
    virtual ~TP015_09_V1_0_Encoder(); //!< Destructor method
 
    VOID Map( TP015_09_V1_0_Encoder_Registers *struct_Registers_Base_Address );
    virtual VOID Init();    //!< Initialisation method
    virtual VOID Execute(); //!< Execute method
    virtual VOID Send_Information( TProtocol_Base *object_Protocol ); //!< Send information about functional block
 
    //--------------------------------------------------------------------------
    // Block inputs
    //--------------------------------------------------------------------------
    
    TBlock_Input_Connector object_u32_Pulse; //!< [-] Encoder pulse per revolution
    TBlock_Input_Connector object_f32_Counter_Clock_Frequency; //!< [Hz] Counter clock frequency
//    TBlock_Input_Connector object_f32_Theta_Offset;
    TBlock_Input_Connector object_f32_Max_Omega_Change_Rate; //!< [rad/s] Maximal omega change rate
    
    //--------------------------------------------------------------------------
    // Block outputs
    //--------------------------------------------------------------------------
 
    TBlock_Output_Connector object_f32_Counter; //!< Encoder counter
    
    TBlock_Output_Connector object_f32_Theta;  //!< [rad] Rotor theta
    TBlock_Output_Connector object_f32_Omega;  //!< [rad/s] Rotor speed
    TBlock_Output_Connector object_bool_Error; //!< Error flag
            
  //----------------------------------------------------------------------------
  // Protected methods and variables
  //----------------------------------------------------------------------------
  
  protected:
  
  //----------------------------------------------------------------------------
  // Private methods and variables
  //----------------------------------------------------------------------------
 
  private:
    
    volatile TP015_09_V1_0_Encoder_Registers *struct_Registers; //!< Hardware mapped registers
 
    U32 u32_Error_Counter; //!< Error counter
 
    F32 f32_Theta_Gain; //!< Internal variable
    F32 f32_Omega_Gain; //!< Internal variable
    F32 f32_Omega_Magnitude_Storage; //!< Omega magnitude storage
    F32 f32_Max_Omega_Change_Rate; //!< Maximal omega change rate
  
    BOOL bool_First_Iteration; //!< First iteration flag
  
    #ifdef FUNCTIONAL_BLOCK_CREATE_DIAGNOSE_OUTPUTS
    U16 u16_Status; //!< Quadrature encoder status
    U16 u16_Counter; //!< Quadrature counter
    U16 u16_Period; //!< Rotation period in FPGA clocks
    #endif
 
};
 
//------------------------------------------------------------------------------
 
//! @brief KG3 digital I/O board (P020.29 / KG3 ENC T1) type 1 class
class TP015_09_V1_0_Encoder_T2 : public TFunction_Block_Base
{
  
  //----------------------------------------------------------------------------
  // Public defines, methods and variables
  //----------------------------------------------------------------------------
 
  public:
 
    //--------------------------------------------------------------------------
    // Public defines
    //--------------------------------------------------------------------------
  
    //! @brief Register structure for digital I/O access
    typedef struct
    {
 
      //! @brief 0x00 : Module identification low register
      U16 u16_Unit_ID_L;        
      
      //! @brief 0x01 : Module identification high register
      U16 u16_Unit_ID_H;
 
      //! @brief 0x02 : Status registers
      U16 u16_Status_Register;
    
    } TP015_09_V1_0_Encoder_Registers;
 
    //--------------------------------------------------------------------------
    // Public methods
    //--------------------------------------------------------------------------
    
    //!-------------------------------------------------------------------------
    //! @brief     Function block class constructor method.
    //! @note      None
    //! \par       Override
    //!            Not allowed
    //! @attention Don't call this method directly.
    //--------------------------------------------------------------------------
    
    TP015_09_V1_0_Encoder_T2(); 
    
    //!-------------------------------------------------------------------------
    //! @brief     Function block class destructor method.
    //! @note      None
    //! \par       Override
    //!            Not allowed
    //! @attention Don't call this method directly.
    //--------------------------------------------------------------------------
 
    virtual ~TP015_09_V1_0_Encoder_T2();
 
    //!-------------------------------------------------------------------------
    //! @brief     Hardware mapping method.
    //! @note      None
    //! @param     [in] *struct_Registers_Base_Address - Base adress to register structure mapping
    //! \par       Override
    //!            Not allowed
    //! @attention None
    //--------------------------------------------------------------------------
 
    VOID Map( TP015_09_V1_0_Encoder_Registers *struct_Registers_Base_Address );
    
    //!-------------------------------------------------------------------------
    //! @brief     Function block initialisation method.
    //! @note      None
    //! \par       Override
    //!            Not allowed
    //! @attention None
    //--------------------------------------------------------------------------
 
    virtual VOID Init();
    
    //!-------------------------------------------------------------------------
    //! @brief     Function block execution method.
    //! @note      None
    //! \par       Override
    //!            Not allowed
    //! @attention None
    //--------------------------------------------------------------------------
 
    virtual VOID Execute();
 
    //--------------------------------------------------------------------------
    // ??? ==> ANVILEX KM: Move to the hardware class
    //--------------------------------------------------------------------------
 
    U32 Get_Module_ID();
 
    //!-------------------------------------------------------------------------
    //! @brief     Send information about digital I/O baortd driver over communication link protocol
    //! @note      This method sends information about digital I/O driver over specified communication link protocol.
    //! @param     [in] *object_Protocol - Pointer to the communication link protocol
    //! @return    None
    //! \par       Override
    //!            Not allowed
    //! @attention None
    //--------------------------------------------------------------------------
 
    virtual VOID Send_Information( TProtocol_Base *object_Protocol );
 
    //--------------------------------------------------------------------------
    // Public variables
    //--------------------------------------------------------------------------
 
    //--------------------------------------------------------------------------
    // Parameters
    //--------------------------------------------------------------------------
 
    //--------------------------------------------------------------------------
    // Input signal connectors
    //--------------------------------------------------------------------------
 
    //--------------------------------------------------------------------------
    // Output signal connectorss
    //--------------------------------------------------------------------------
    
    //! @brief Digital input for channel A
    TBlock_Output_Connector object_bool_Channel_A_Data;
    
    //! @brief Digital input for channel B
    TBlock_Output_Connector object_bool_Channel_B_Data;
 
    //! @brief Digital input for channel Z
    TBlock_Output_Connector object_bool_Channel_Z_Data;
    
  //----------------------------------------------------------------------------
  // Protected defines, mathods and variables
  //----------------------------------------------------------------------------
 
  protected:
 
  //----------------------------------------------------------------------------
  // Private defines, mathods and variables
  //----------------------------------------------------------------------------
 
  private:
 
    //--------------------------------------------------------------------------
    // Private defines
    //--------------------------------------------------------------------------
 
    //! @brief Structure for bit parsing
    typedef union
    {
      
      //! @brief Raw data
      U16 u16_Raw_Data;
      
      //! @brief Structure of the bits
      struct
      {
 
        //! @brief Bit 0 : Channel A input data
        U16 b1_Channel_A_Input:1;
 
        //! @brief Bits 1...3 : Reserved bits
        U16 :3;
 
        //! @brief Bit 4, Channel B input data
        U16 b1_Channel_B_Input:1;
 
        //! @brief Bits 5...7 : Reserved bits
        U16 :3;
        
        //! @brief Bit 8, Channel Z input data
        U16 b1_Channel_Z_Input:1;
 
        //! @brief Bits 9..15 : Reserved bits
        U16 :7;
 
      };
      
    } TStatus_Register;
 
    //--------------------------------------------------------------------------
    // Private variables
    //--------------------------------------------------------------------------
    
    //! @brief Pointer to the memory area in FPGA address space
    volatile TP015_09_V1_0_Encoder_Registers *struct_Registers;
 
};
 
//------------------------------------------------------------------------------
// End of file
//------------------------------------------------------------------------------