//#############################################################################
// $TI Release: MotorControl SDK v4.00.00.00 $
// $Release Date: Thu Feb 17 18:05:20 CST 2022 $
// $Copyright:
// Copyright (C) 2017-2020 Texas Instruments Incorporated - http://www.ti.com/
//
// Redistribution and use in source and binary forms, with or without
// modification, are permitted provided that the following conditions
// are met:
// 
//   Redistributions of source code must retain the above copyright
//   notice, this list of conditions and the following disclaimer.
// 
//   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.
// 
//   Neither the name of Texas Instruments Incorporated 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
// OWNER 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.
// $
//#############################################################################

//----------------------------------------------------------------------------------
//	FILE:			dlog_6ch_f.c.c
//
//	Description:	Contains functions for logging debug data
//
//	Version: 		1.0
//
//  Target:  		TMS320F2837x, TMS320F2838x, TMS320F28004x
//
//----------------------------------------------------------------------------------
//  Copyright Texas Instruments © 2004-2017
//----------------------------------------------------------------------------------
//  Revision History:
//----------------------------------------------------------------------------------
//  Date	  | Description / Status
//----------------------------------------------------------------------------------

#include "../../../../../Source/lib_TI/utilities/datalog/include/dlog_6ch_f.h"


//*********** Structure Init Function *****//
void DLOG_6CH_F_init(DLOG_6CH_F *v)
{
	uint16_t cnt;
	
	for(cnt = 0; cnt < DLOG_CH_NUM; cnt++)
	{
		v->input_ptr[cnt] = 0;
		v->output_ptr[cnt] = 0;
	}
	
	v->refValue = 0;
	v->prevValue = 0;
	
	v->status = 0;	

    v->skipCount = 0;
    v->preScalar = 10;

	v->size = DLOG_BUF_SIZE;
	v->count = 0;
}

//*********** Function Definition ********//
void DLOG_6CH_F_FUNC(DLOG_6CH_F *v)
{
	uint16_t cnt;
	
	v->refValue = *v->input_ptr[0];
	
	switch(v->status)
	{
		case 0:
			v->count = 0;
			v->status = 1;		
			break;
			
        case 1: // wait for trigger
            if( v->refValue != v->prevValue)
            {
                v->status = 2;
            }
            break;

        case 2:
            v->skipCount++;

            if(v->skipCount == v->preScalar)
            {
                v->skipCount = 0;

                for(cnt = 0; cnt < DLOG_CH_NUM; cnt++)
                {
                    v->output_ptr[cnt][v->count] = *v->input_ptr[cnt];
                }

                v->count++;
            }

			if(v->count == v->size)
			{
				v->count = 0;
				v->status = 1;
			}
            break;
	}

	v->prevValue = *v->input_ptr[0];
}

