#include <sys/cdefs.h>
#include <dev/pms/config.h>
#include <dev/pms/freebsd/driver/common/osenv.h>
#include <dev/pms/freebsd/driver/common/ostypes.h>
#include <dev/pms/freebsd/driver/common/osdebug.h>
#include <dev/pms/RefTisa/sallsdk/api/sa.h>
#include <dev/pms/RefTisa/sallsdk/api/saapi.h>
#include <dev/pms/RefTisa/sallsdk/api/saosapi.h>
#include <dev/pms/RefTisa/tisa/api/titypes.h>
#include <dev/pms/RefTisa/tisa/api/ostiapi.h>
#include <dev/pms/RefTisa/tisa/api/tiapi.h>
#include <dev/pms/RefTisa/tisa/api/tiglobal.h>
#ifdef FDS_SM
#include <dev/pms/RefTisa/sat/api/sm.h>
#include <dev/pms/RefTisa/sat/api/smapi.h>
#include <dev/pms/RefTisa/sat/api/tdsmapi.h>
#endif
#ifdef FDS_DM
#include <dev/pms/RefTisa/discovery/api/dm.h>
#include <dev/pms/RefTisa/discovery/api/dmapi.h>
#include <dev/pms/RefTisa/discovery/api/tddmapi.h>
#endif
#include <dev/pms/RefTisa/tisa/sassata/sas/common/tdtypes.h>
#include <dev/pms/freebsd/driver/common/osstring.h>
#include <dev/pms/RefTisa/tisa/sassata/common/tdutil.h>
#ifdef INITIATOR_DRIVER
#include <dev/pms/RefTisa/tisa/sassata/sas/ini/itdtypes.h>
#include <dev/pms/RefTisa/tisa/sassata/sas/ini/itddefs.h>
#include <dev/pms/RefTisa/tisa/sassata/sas/ini/itdglobl.h>
#endif
#ifdef TARGET_DRIVER
#include <dev/pms/RefTisa/tisa/sassata/sas/tgt/ttdglobl.h>
#include <dev/pms/RefTisa/tisa/sassata/sas/tgt/ttdxchg.h>
#include <dev/pms/RefTisa/tisa/sassata/sas/tgt/ttdtypes.h>
#endif
#include <dev/pms/RefTisa/tisa/sassata/common/tdsatypes.h>
#include <dev/pms/RefTisa/tisa/sassata/common/tdproto.h>
#ifdef REMOVED
osGLOBAL void
tdsaEsglInit(
tiRoot_t *tiRoot
)
{
tdsaRoot_t *tdsaRoot = (tdsaRoot_t *)tiRoot->tdData;
tdsaContext_t *tdsaAllShared = (tdsaContext_t *)&tdsaRoot->tdsaAllShared;
tdsaEsglAllInfo_t *pEsglAllInfo = (tdsaEsglAllInfo_t *)&(tdsaAllShared->EsglAllInfo);
tdsaEsglPagePool_t *pEsglPagePool;
bit32 pageno;
bit32 PagePhysAddrUpper;
bit32 PagePhysAddrLower;
bit32 prev_PagePhysAddrLower;
tdsaEsglPageInfo_t *pEsglPageInfo;
void *PageVirtAddr;
bit32 PageSizeInBytes;
agsaRoot_t agRoot;
bit32 maxSALocks = 0;
bit32 usecsPerTick = 0;
agsaSwConfig_t SwConfig;
agsaMemoryRequirement_t memRequirement;
agsaQueueConfig_t *QueueConfig;
bit32 i;
TI_DBG6(("tdsaEsglInit: start\n"));
tdsaGetSwConfigParams(tiRoot);
QueueConfig = &tdsaAllShared->QueueConfig;
for(i=0;i<QueueConfig->numInboundQueues;i++)
{
QueueConfig->inboundQueues[i].elementCount = tdsaAllShared->InboundQueueSize;
QueueConfig->inboundQueues[i].elementSize = tdsaAllShared->InboundQueueEleSize;
QueueConfig->inboundQueues[i].priority = tdsaAllShared->InboundQueuePriority[i];
QueueConfig->inboundQueues[i].reserved = 0;
}
for(i=0;i<QueueConfig->numOutboundQueues;i++)
{
QueueConfig->outboundQueues[i].elementCount = tdsaAllShared->OutboundQueueSize;
QueueConfig->outboundQueues[i].elementSize = tdsaAllShared->OutboundQueueEleSize;
QueueConfig->outboundQueues[i].interruptDelay = tdsaAllShared->OutboundQueueInterruptDelay[i];
QueueConfig->outboundQueues[i].interruptCount = tdsaAllShared->OutboundQueueInterruptCount[i];
QueueConfig->outboundQueues[i].interruptVectorIndex = 0;
}
QueueConfig->sasHwEventQueue = 0;
QueueConfig->sataNCQErrorEventQueue = 0;
SwConfig.sizefEventLog1 = HOST_EVENT_LOG_SIZE;
SwConfig.sizefEventLog2 = HOST_EVENT_LOG_SIZE;
SwConfig.eventLog1Option = 0;
SwConfig.eventLog2Option = 0;
SwConfig.fatalErrorInterrtuptEnable = 1;
SwConfig.fatalErrorInterruptVector = 1;
SwConfig.reserved = 0;
SwConfig.param3 = (void *)&(tdsaAllShared->QueueConfig);
saGetRequirements(&agRoot, &SwConfig, &memRequirement, &usecsPerTick, &maxSALocks);
pEsglAllInfo->physAddrUpper = tdsaAllShared->loResource.loLevelMem.mem[memRequirement.count].physAddrUpper;
pEsglAllInfo->physAddrLower = tdsaAllShared->loResource.loLevelMem.mem[memRequirement.count].physAddrLower;
pEsglAllInfo->virtPtr = tdsaAllShared->loResource.loLevelMem.mem[memRequirement.count].virtPtr;
pEsglAllInfo->NumEsglPages = tdsaAllShared->loResource.loLevelMem.mem[memRequirement.count].numElements;
pEsglAllInfo->EsglPageSize = tdsaAllShared->loResource.loLevelMem.mem[memRequirement.count].singleElementLength;
pEsglAllInfo->NumFreeEsglPages = pEsglAllInfo->NumEsglPages;
pEsglPagePool = pEsglAllInfo->EsglPagePool;
TI_DBG6(("tdsaEsglInit: pEsglPagePool %p\n", pEsglPagePool));
TI_DBG6(("tdsaEsglInit: tdsaAllShared->loResource.loLevelMem.mem[18].singleElementLength %d\n", tdsaAllShared->loResource.loLevelMem.mem[18].singleElementLength));
TI_DBG6(("tdsaEsglInit: NumEsglPage %d EsglPageSize %d\n", pEsglAllInfo->NumEsglPages, pEsglAllInfo->EsglPageSize));
TI_DBG6(("tdsaEsglInit: NumFreeEsglPages %d\n", pEsglAllInfo->NumFreeEsglPages));
TDLIST_INIT_HDR(&pEsglAllInfo->freelist);
PageVirtAddr = pEsglAllInfo->virtPtr;
PagePhysAddrUpper = pEsglAllInfo->physAddrUpper;
PagePhysAddrLower = pEsglAllInfo->physAddrLower;
PageSizeInBytes = pEsglAllInfo->EsglPageSize;
TI_DBG6(("tdsaEsglInit: PageSizeInBytes 0x%x\n", PageSizeInBytes));
for (pageno = 0 ; pageno < pEsglAllInfo->NumEsglPages ; pageno++)
{
pEsglPageInfo = &(pEsglPagePool->EsglPages[pageno]);
OSSA_WRITE_LE_32(agRoot, pEsglPageInfo, OSSA_OFFSET_OF(pEsglPageInfo, physAddressUpper), PagePhysAddrUpper);
OSSA_WRITE_LE_32(agRoot, pEsglPageInfo, OSSA_OFFSET_OF(pEsglPageInfo, physAddressLower), PagePhysAddrLower);
pEsglPageInfo->len = PageSizeInBytes;
pEsglPageInfo->id = pageno+123;
pEsglPageInfo->agEsgl = (agsaEsgl_t *)PageVirtAddr;
TI_DBG6(("tdsaEsglInit: index %d upper 0x%8x lower 0x%8x PageVirtAddr %p\n", pageno, PagePhysAddrUpper, PagePhysAddrLower, PageVirtAddr));
prev_PagePhysAddrLower = PagePhysAddrLower;
PagePhysAddrLower += pEsglAllInfo->EsglPageSize;
if (PagePhysAddrLower <= prev_PagePhysAddrLower)
{
PagePhysAddrUpper++;
}
if (pageno == pEsglAllInfo->NumEsglPages - 1)
{
pEsglPageInfo->agEsgl->descriptor[MAX_ESGL_ENTRIES-1].len = 0;
CLEAR_ESGL_EXTEND(pEsglPageInfo->agEsgl->descriptor[MAX_ESGL_ENTRIES-1].extReserved);
}
else
{
pEsglPageInfo->agEsgl->descriptor[MAX_ESGL_ENTRIES-1].sgLower = PagePhysAddrLower;
pEsglPageInfo->agEsgl->descriptor[MAX_ESGL_ENTRIES-1].sgUpper = PagePhysAddrUpper;
pEsglPageInfo->agEsgl->descriptor[MAX_ESGL_ENTRIES-1].len = PageSizeInBytes;
SET_ESGL_EXTEND(pEsglPageInfo->agEsgl->descriptor[MAX_ESGL_ENTRIES-1].extReserved);
}
TDLIST_INIT_ELEMENT(&pEsglPageInfo->tdlist);
tdsaSingleThreadedEnter(tiRoot, TD_ESGL_LOCK);
TDLIST_ENQUEUE_AT_TAIL(&pEsglPageInfo->tdlist, &pEsglAllInfo->freelist);
tdsaSingleThreadedLeave(tiRoot, TD_ESGL_LOCK);
PageVirtAddr = (bit8 *)PageVirtAddr + PageSizeInBytes;
}
#ifdef TD_INTERNAL_DEBUG
for (pageno = 0 ; pageno < pEsglAllInfo->NumEsglPages ; pageno++)
{
TI_DBG6(("tdsaEsglInit: index %d EsglPages %p\n", pageno, &pEsglPagePool->EsglPages[pageno]));
TI_DBG6(("tdsaEsglInit: nextupper 0x%8x nextlower 0x%8x\n", pEsglPagePool->EsglPages[pageno].agEsgl->nextPageUpper, pEsglPagePool->EsglPages[pageno].agEsgl->nextPageLower));
}
TI_DBG6(("tdsaEsglInit: tdsaEsglPageInfo_t size %d 0x%x\n", sizeof(tdsaEsglPageInfo_t), sizeof(tdsaEsglPageInfo_t)));
TI_DBG6(("tdsaEsglInit: sizeof(SASG_DESCRIPTOR) %d 0x%x\n", sizeof(SASG_DESCRIPTOR), sizeof(SASG_DESCRIPTOR)));
#endif
return;
}
osGLOBAL void
tdsaGetEsglPages(
tiRoot_t *tiRoot,
tdList_t *EsglListHdr,
tiSgl_t *ptiSgl,
tiSgl_t *virtSgl
)
{
tdsaRoot_t *tdsaRoot = (tdsaRoot_t *) tiRoot->tdData;
tdsaContext_t *tdsaAllShared = (tdsaContext_t *)&tdsaRoot->tdsaAllShared;
tdsaEsglAllInfo_t *pEsglAllInfo = &(tdsaAllShared->EsglAllInfo);
bit32 numSgElements = ptiSgl->len;
bit32 numEntriesPerPage = MAX_ESGL_ENTRIES;
bit32 numPagesRequired = ((numSgElements - 1) / numEntriesPerPage) + 1;
bit32 i, j;
tdList_t *tdlist_to_fill;
tdsaEsglPageInfo_t *page_to_fill;
tiSgl_t *tmp_tiSgl = (tiSgl_t *)virtSgl;
agsaSgl_t *pDesc;
agsaEsgl_t *agEsgl, *PrevagEsgl = agNULL;
TI_DBG6(("tdsaGetEsglPages: start\n"));
TI_DBG6(("tdsaGetEsglPages: pEsglPagePool %p\n", pEsglAllInfo->EsglPagePool));
TI_DBG6(("tdsaGetEsglPages: &(pEsglAllInfo->freelist) %p\n", &pEsglAllInfo->freelist));
TI_DBG6(("tdsaGetEsglPages: numSgElements %d numEntriesPerPage %d\n", numSgElements, numEntriesPerPage));
TI_DBG6(("tdsaGetEsglPages: numPagesRequired %d NumFreeEsglPages %d\n", numPagesRequired, pEsglAllInfo->NumFreeEsglPages));
TI_DBG6(("tdsaGetEsglPages: free Pages %d\n", pEsglAllInfo->NumFreeEsglPages));
if (numPagesRequired > pEsglAllInfo->NumFreeEsglPages)
{
TI_DBG1(("tdsaGetEsglPages:don't have enough freepages. required %d free %d\n", numPagesRequired, pEsglAllInfo->NumFreeEsglPages));
return;
}
tdsaSingleThreadedEnter(tiRoot, TD_ESGL_LOCK);
pEsglAllInfo->NumFreeEsglPages -= numPagesRequired;
tdsaSingleThreadedLeave(tiRoot, TD_ESGL_LOCK);
#ifdef TD_INTERNAL_DEBUG
for (i=0; i < 2; i++)
{
tdsaSingleThreadedEnter(tiRoot, TD_ESGL_LOCK);
TDLIST_DEQUEUE_FROM_HEAD(&tdlist_to_fill, &pEsglAllInfo->freelist);
tdsaSingleThreadedLeave(tiRoot, TD_ESGL_LOCK);
page_to_fill = TDLIST_OBJECT_BASE(tdsaEsglPageInfo_t, tdlist, tdlist_to_fill);
TI_DBG6(("tdsaGetEsglPages:page ID %d\n", page_to_fill->id));
agEsgl = page_to_fill->agEsgl;
pDesc = (SASG_DESCRIPTOR *)agEsgl;
for (j=0; j <numEntriesPerPage; j++)
{
TI_DBG6(("tdsaGetEsglPages: lower %d upper %d\n", pDesc->sgLower, pDesc->sgUpper));
TI_DBG6(("tdsaGetEsglPages: len %d\n", pDesc->len));
pDesc++;
}
TI_DBG6(("tdsaGetEsglPages: next lower %d next upper %d\n", agEsgl->nextPageLower, agEsgl->nextPageUpper));
}
#endif
for (i = 0 ; i < numPagesRequired; i++)
{
tdsaSingleThreadedEnter(tiRoot, TD_ESGL_LOCK);
TDLIST_DEQUEUE_FROM_HEAD(&tdlist_to_fill, &pEsglAllInfo->freelist);
tdsaSingleThreadedLeave(tiRoot, TD_ESGL_LOCK);
page_to_fill = TDLIST_OBJECT_BASE(tdsaEsglPageInfo_t, tdlist, tdlist_to_fill);
TI_DBG6(("tdsaGetEsglPages:page ID %d\n", page_to_fill->id));
agEsgl = page_to_fill->agEsgl;
pDesc = (agsaSgl_t *)agEsgl;
if (i == numPagesRequired - 1)
{
for (j=0; j < numSgElements; j++)
{
OSSA_WRITE_LE_32(agRoot, pDesc, OSSA_OFFSET_OF(pDesc, sgLower), tmp_tiSgl->lower);
OSSA_WRITE_LE_32(agRoot, pDesc, OSSA_OFFSET_OF(pDesc, sgUpper), tmp_tiSgl->upper);
OSSA_WRITE_LE_32(agRoot, pDesc, OSSA_OFFSET_OF(pDesc, len), tmp_tiSgl->len);
CLEAR_ESGL_EXTEND(pDesc->extReserved);
pDesc++;
tmp_tiSgl++;
}
for (j=numSgElements; j < numEntriesPerPage; j++)
{
pDesc->sgLower = 0x0;
pDesc->sgUpper = 0x0;
pDesc->len = 0x0;
CLEAR_ESGL_EXTEND(pDesc->extReserved);
pDesc++;
}
}
else
{
for (j=0; j <numEntriesPerPage - 1; j++)
{
OSSA_WRITE_LE_32(agRoot, pDesc, OSSA_OFFSET_OF(pDesc, sgLower), tmp_tiSgl->lower);
OSSA_WRITE_LE_32(agRoot, pDesc, OSSA_OFFSET_OF(pDesc, sgUpper), tmp_tiSgl->upper);
OSSA_WRITE_LE_32(agRoot, pDesc, OSSA_OFFSET_OF(pDesc, len), tmp_tiSgl->len);
CLEAR_ESGL_EXTEND(pDesc->extReserved);
pDesc++;
tmp_tiSgl++;
}
numSgElements -= (numEntriesPerPage - 1);
}
if (PrevagEsgl != agNULL)
{
PrevagEsgl->descriptor[MAX_ESGL_ENTRIES-1].sgLower = page_to_fill->physAddressLower;
PrevagEsgl->descriptor[MAX_ESGL_ENTRIES-1].sgUpper = page_to_fill->physAddressUpper;
PrevagEsgl->descriptor[MAX_ESGL_ENTRIES-1].len = numSgElements;
SET_ESGL_EXTEND(PrevagEsgl->descriptor[MAX_ESGL_ENTRIES-1].extReserved);
}
PrevagEsgl = agEsgl;
tdsaSingleThreadedEnter(tiRoot, TD_ESGL_LOCK);
TDLIST_ENQUEUE_AT_TAIL(tdlist_to_fill, EsglListHdr);
tdsaSingleThreadedLeave(tiRoot, TD_ESGL_LOCK);
}
return;
}
osGLOBAL void
tdsaFreeEsglPages(
tiRoot_t *tiRoot,
tdList_t *EsglListHdr
)
{
tdsaRoot_t *tdsaRoot = (tdsaRoot_t *) tiRoot->tdData;
tdsaContext_t *tdsaAllShared = (tdsaContext_t *)&tdsaRoot->tdsaAllShared;
tdsaEsglAllInfo_t *pEsglAllInfo = (tdsaEsglAllInfo_t *)&(tdsaAllShared->EsglAllInfo);
tdList_t *tdlist_to_free;
TI_DBG6(("tdsaFreeEsglPages: start\n"));
if (tiRoot == agNULL)
{
TI_DBG1(("tdsaFreeEsglPages: tiRoot is NULL\n"));
return;
}
if (EsglListHdr == agNULL)
{
TI_DBG1(("tdsaFreeEsglPages: EsglListHdr is NULL\n"));
return;
}
TI_DBG6(("tdsaFreeEsglPages: EsglListHdr %p\n", EsglListHdr));
tdsaSingleThreadedEnter(tiRoot, TD_ESGL_LOCK);
while (TDLIST_NOT_EMPTY(EsglListHdr))
{
TDLIST_DEQUEUE_FROM_HEAD(&tdlist_to_free, EsglListHdr);
TDLIST_ENQUEUE_AT_TAIL(tdlist_to_free, &pEsglAllInfo->freelist);
pEsglAllInfo->NumFreeEsglPages++;
}
tdsaSingleThreadedLeave(tiRoot, TD_ESGL_LOCK);
TI_DBG6(("tdsaFreeEsglPages: NumFreeEsglPages %d\n", pEsglAllInfo->NumFreeEsglPages));
return;
}
osGLOBAL void
tdsaGetEsglPagesInfo(
tiRoot_t *tiRoot,
bit32 *pPageSize,
bit32 *pNumPages
)
{
char *buffer;
bit32 buffLen;
bit32 lenRecv = 0;
char *pLastUsedChar = agNULL;
char globalStr[] = "Global";
char SwParmsStr[] = "ESGLParms";
char tmpBuffer[DEFAULT_KEY_BUFFER_SIZE];
bit32 NumEsglPages = NUM_ESGL_PAGES;
TI_DBG6(("tdsaGetEsglPagesInfo: start \n"));
buffer = tmpBuffer;
buffLen = sizeof(tmpBuffer);
osti_memset(buffer, 0, buffLen);
if ((ostiGetTransportParam(
tiRoot,
globalStr,
SwParmsStr,
agNULL,
agNULL,
agNULL,
agNULL,
"NumESGLPg",
buffer,
buffLen,
&lenRecv
) == tiSuccess) && (lenRecv != 0))
{
NumEsglPages = osti_strtoul(buffer, &pLastUsedChar, 10);
}
osti_memset(buffer, 0, buffLen);
lenRecv = 0;
TI_DBG6(("tdsaGetEsglPagesInfo: esgl page number %d\n",NumEsglPages));
*pPageSize = ESGL_PAGES_SIZE;
*pNumPages = NumEsglPages;
return;
}
#endif