mirror of
https://github.com/adtools/clib2.git
synced 2025-12-08 14:59:05 +00:00
85e421feb8
git-svn-id: file:///Users/olsen/Code/migration-svn-zu-git/logical-line-staging/clib2/trunk@14979 87f5fb63-7c3d-0410-a384-fd976d0f7a62
128 lines
2.5 KiB
C
128 lines
2.5 KiB
C
#include <proto/exec.h>
|
|
#include <exec/interrupts.h>
|
|
#include <interfaces/performancemonitor.h>
|
|
#include <resources/performancemonitor.h>
|
|
#include <unistd.h>
|
|
|
|
static struct Interrupt CounterInt;
|
|
static struct PerformanceMonitorIFace *IPM;
|
|
|
|
static struct IntData
|
|
{
|
|
struct PerformanceMonitorIFace *IPM;
|
|
uint16 *Buffer;
|
|
uint32 BufferSize;
|
|
uint32 Offset;
|
|
uint32 Scale;
|
|
uint32 CounterStart;
|
|
} ProfileData;
|
|
|
|
uint32 GetCounterStart(void);
|
|
uint32 CounterIntFn(struct ExceptionContext *, struct ExecBase *, struct IntData *);
|
|
|
|
|
|
uint32
|
|
GetCounterStart(void)
|
|
{
|
|
uint64 fsb;
|
|
double bit0time;
|
|
uint32 count;
|
|
|
|
GetCPUInfoTags(
|
|
GCIT_FrontsideSpeed, &fsb,
|
|
TAG_DONE);
|
|
|
|
/* Timebase ticks at 1/4 of FSB */
|
|
bit0time = 8.0 / (double)fsb;
|
|
count = (uint32)(0.01 / bit0time);
|
|
|
|
return 0x80000000 - count;
|
|
}
|
|
|
|
uint32
|
|
CounterIntFn(struct ExceptionContext *ctx, struct ExecBase *ExecBase,
|
|
struct IntData *ProfileData)
|
|
{
|
|
uint32 sia = (uint32)ProfileData->IPM->GetSampledAddress();
|
|
|
|
/* Silence compiler */
|
|
(void)ExecBase;
|
|
(void)ctx;
|
|
|
|
sia = ((sia - ProfileData->Offset) * ProfileData->Scale) >> 16;
|
|
|
|
if (sia <= (ProfileData->BufferSize>>1))
|
|
{
|
|
//if (ProfileData->Buffer[sia] != 0xffff)
|
|
ProfileData->Buffer[sia]++;
|
|
}
|
|
|
|
IPM->CounterControl(1, ProfileData->CounterStart, PMCI_Transition);
|
|
|
|
return 1;
|
|
}
|
|
|
|
|
|
int
|
|
profil(unsigned short *buffer, size_t bufSize, size_t offset, unsigned int scale)
|
|
{
|
|
APTR Stack;
|
|
|
|
if (buffer == 0)
|
|
{
|
|
Stack = SuperState();
|
|
IPM->EventControlTags(
|
|
PMECT_Disable, PMEC_MasterInterrupt,
|
|
TAG_DONE);
|
|
|
|
IPM->SetInterruptVector(1, 0);
|
|
|
|
IPM->Unmark(0);
|
|
IPM->Release();
|
|
if (Stack) UserState(Stack);
|
|
|
|
return 0;
|
|
}
|
|
|
|
IPM = (struct PerformanceMonitorIFace *)
|
|
OpenResource("performancemonitor.resource");
|
|
|
|
if (!IPM || IPM->Obtain() != 1)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
Stack = SuperState();
|
|
|
|
/* Init IntData */
|
|
ProfileData.IPM = IPM;
|
|
ProfileData.Buffer = buffer;
|
|
ProfileData.BufferSize = bufSize;
|
|
ProfileData.Offset = offset;
|
|
ProfileData.Scale = scale;
|
|
ProfileData.CounterStart = GetCounterStart();
|
|
|
|
/* Set interrupt vector */
|
|
CounterInt.is_Code = (void (*)())CounterIntFn;
|
|
CounterInt.is_Data = &ProfileData;
|
|
IPM->SetInterruptVector(1, &CounterInt);
|
|
|
|
/* Prepare Performance Monitor */
|
|
IPM->MonitorControlTags(
|
|
PMMCT_FreezeCounters, PMMC_Unmarked,
|
|
PMMCT_RTCBitSelect, PMMC_BIT0,
|
|
TAG_DONE);
|
|
IPM->CounterControl(1, ProfileData.CounterStart, PMCI_Transition);
|
|
|
|
IPM->EventControlTags(
|
|
PMECT_Enable, 1,
|
|
PMECT_Enable, PMEC_MasterInterrupt,
|
|
TAG_DONE);
|
|
|
|
IPM->Mark(0);
|
|
|
|
if (Stack) UserState(Stack);
|
|
|
|
return 0;
|
|
}
|