/* IBM_PROLOG_BEGIN_TAG                                                   */
/* This is an automatically generated prolog.                             */
/*                                                                        */
/* $Source: import/chips/p9/procedures/ppe_closed/pgpe/pstate_gpe/p9_pgpe_optrace.c $ */
/*                                                                        */
/* OpenPOWER HCODE Project                                                */
/*                                                                        */
/* COPYRIGHT 2016,2017                                                    */
/* [+] International Business Machines Corp.                              */
/*                                                                        */
/*                                                                        */
/* Licensed under the Apache License, Version 2.0 (the "License");        */
/* you may not use this file except in compliance with the License.       */
/* You may obtain a copy of the License at                                */
/*                                                                        */
/*     http://www.apache.org/licenses/LICENSE-2.0                         */
/*                                                                        */
/* Unless required by applicable law or agreed to in writing, software    */
/* distributed under the License is distributed on an "AS IS" BASIS,      */
/* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or        */
/* implied. See the License for the specific language governing           */
/* permissions and limitations under the License.                         */
/*                                                                        */
/* IBM_PROLOG_END_TAG                                                     */
#include "pk.h"
#include "p9_pgpe.h"
#include "p9_pgpe_optrace.h"
#include "p9_hcd_memmap_occ_sram.H"

#define ADDRESS_MAX OCC_SRAM_PGPE_OPTRACE_ADDR + OCC_SRAM_PGPE_OPTRACE_SIZE - 0x8

TraceData_t G_pgpe_optrace_data;
uint32_t G_address;
uint32_t G_data;
uint32_t G_lastDisable;
uint32_t G_last_sync_op;

void p9_pgpe_optrace_init() //sets up address and initializes buffer to 0's
{
    G_lastDisable = 0;
    G_address = OCC_SRAM_PGPE_OPTRACE_ADDR;

    do
    {
        out32(G_address, 0);
        G_address += 4;
    }
    while(G_address <= ADDRESS_MAX);

    G_address = OCC_SRAM_PGPE_OPTRACE_ADDR;
}
void p9_pgpe_optrace(uint32_t mark)
{
    if(in32(OCB_OCCS2) & PGPE_OP_TRACE_DISABLE) //Check to see if tracing is enabled
    {
        G_lastDisable = 1;
    }
    else
    {
        if(G_lastDisable) //Place start trace mark at when first enabled
        {
            G_lastDisable = 0;
            p9_pgpe_optrace(ACK_START_TRACE);
        }

        uint32_t word_count = ((mark >> 4) & 0x3) + 1;
        uint32_t word;

        if((mark & 0x40))//If bit 1 of Mark is set there is a timestamp
        {
            G_pgpe_optrace_data.word[(word_count - 1)] = (mark << 24) | (in32(OCB_OTBR) & 0xFFFFFF);
        }

        if(G_last_sync_op)
        {
            TraceData_t pgpe_optrace_buffer;
            pgpe_optrace_buffer  = G_pgpe_optrace_data;
            G_pgpe_optrace_data.word[0] = (FIT_TB_RESYNC << 24) | G_last_sync_op;
            G_last_sync_op = 0;
            p9_pgpe_optrace(FIT_TB_RESYNC);
            G_pgpe_optrace_data  = pgpe_optrace_buffer;
        }

        for(word = 0; word < word_count; word++) //write out all words to  buffer
        {
            out32(G_address, G_pgpe_optrace_data.word[word]);

            if(G_address == ADDRESS_MAX)
            {
                G_address =  OCC_SRAM_PGPE_OPTRACE_ADDR;
            }
            else
            {
                G_address += 0x4;
            }
        }

        out32(ADDRESS_MAX + 0x4, G_address); //this address contains the oldest entry in the buffer

    }
}
