1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744 |
- #include "SEGGER_RTT.h"
- #include <string.h> // for memcpy
- #ifndef BUFFER_SIZE_UP
- #define BUFFER_SIZE_UP 1024
- #endif
- #ifndef BUFFER_SIZE_DOWN
- #define BUFFER_SIZE_DOWN 16
- #endif
- #ifndef SEGGER_RTT_MAX_NUM_UP_BUFFERS
- #define SEGGER_RTT_MAX_NUM_UP_BUFFERS 2
- #endif
- #ifndef SEGGER_RTT_MAX_NUM_DOWN_BUFFERS
- #define SEGGER_RTT_MAX_NUM_DOWN_BUFFERS 2
- #endif
- #ifndef SEGGER_RTT_BUFFER_SECTION
- #if defined(SEGGER_RTT_SECTION)
- #define SEGGER_RTT_BUFFER_SECTION SEGGER_RTT_SECTION
- #endif
- #endif
- #ifndef SEGGER_RTT_ALIGNMENT
- #define SEGGER_RTT_ALIGNMENT 0
- #endif
- #ifndef SEGGER_RTT_BUFFER_ALIGNMENT
- #define SEGGER_RTT_BUFFER_ALIGNMENT 0
- #endif
- #ifndef SEGGER_RTT_MODE_DEFAULT
- #define SEGGER_RTT_MODE_DEFAULT SEGGER_RTT_MODE_NO_BLOCK_SKIP
- #endif
- #ifndef SEGGER_RTT_LOCK
- #define SEGGER_RTT_LOCK()
- #endif
- #ifndef SEGGER_RTT_UNLOCK
- #define SEGGER_RTT_UNLOCK()
- #endif
- #ifndef STRLEN
- #define STRLEN(a) strlen((a))
- #endif
- #ifndef SEGGER_RTT_MEMCPY_USE_BYTELOOP
- #define SEGGER_RTT_MEMCPY_USE_BYTELOOP 0
- #endif
- #ifndef SEGGER_RTT_MEMCPY
- #ifdef MEMCPY
- #define SEGGER_RTT_MEMCPY(pDest, pSrc, NumBytes) MEMCPY((pDest), (pSrc), (NumBytes))
- #else
- #define SEGGER_RTT_MEMCPY(pDest, pSrc, NumBytes) memcpy((pDest), (pSrc), (NumBytes))
- #endif
- #endif
- #ifndef MIN
- #define MIN(a, b) (((a) < (b)) ? (a) : (b))
- #endif
- #ifndef MAX
- #define MAX(a, b) (((a) > (b)) ? (a) : (b))
- #endif
- #ifndef NULL
- #define NULL 0
- #endif
- #if (defined __ICCARM__) || (defined __ICCRX__)
- #define RTT_PRAGMA(P) _Pragma(#P)
- #endif
- #if SEGGER_RTT_ALIGNMENT || SEGGER_RTT_BUFFER_ALIGNMENT
- #if (defined __GNUC__)
- #define SEGGER_RTT_ALIGN(Var, Alignment) Var __attribute__ ((aligned (Alignment)))
- #elif (defined __ICCARM__) || (defined __ICCRX__)
- #define PRAGMA(A) _Pragma(#A)
- #define SEGGER_RTT_ALIGN(Var, Alignment) RTT_PRAGMA(data_alignment=Alignment) \
- Var
- #elif (defined __CC_ARM)
- #define SEGGER_RTT_ALIGN(Var, Alignment) Var __attribute__ ((aligned (Alignment)))
- #else
- #error "Alignment not supported for this compiler."
- #endif
- #else
- #define SEGGER_RTT_ALIGN(Var, Alignment) Var
- #endif
- #if defined(SEGGER_RTT_SECTION) || defined (SEGGER_RTT_BUFFER_SECTION)
- #if (defined __GNUC__)
- #define SEGGER_RTT_PUT_SECTION(Var, Section) __attribute__ ((section (Section))) Var
- #elif (defined __ICCARM__) || (defined __ICCRX__)
- #define SEGGER_RTT_PUT_SECTION(Var, Section) RTT_PRAGMA(location=Section) \
- Var
- #elif (defined __CC_ARM)
- #define SEGGER_RTT_PUT_SECTION(Var, Section) __attribute__ ((section (Section), zero_init)) Var
- #else
- #error "Section placement not supported for this compiler."
- #endif
- #else
- #define SEGGER_RTT_PUT_SECTION(Var, Section) Var
- #endif
- #if SEGGER_RTT_ALIGNMENT
- #define SEGGER_RTT_CB_ALIGN(Var) SEGGER_RTT_ALIGN(Var, SEGGER_RTT_ALIGNMENT)
- #else
- #define SEGGER_RTT_CB_ALIGN(Var) Var
- #endif
- #if SEGGER_RTT_BUFFER_ALIGNMENT
- #define SEGGER_RTT_BUFFER_ALIGN(Var) SEGGER_RTT_ALIGN(Var, SEGGER_RTT_BUFFER_ALIGNMENT)
- #else
- #define SEGGER_RTT_BUFFER_ALIGN(Var) Var
- #endif
- #if defined(SEGGER_RTT_SECTION)
- #define SEGGER_RTT_PUT_CB_SECTION(Var) SEGGER_RTT_PUT_SECTION(Var, SEGGER_RTT_SECTION)
- #else
- #define SEGGER_RTT_PUT_CB_SECTION(Var) Var
- #endif
- #if defined(SEGGER_RTT_BUFFER_SECTION)
- #define SEGGER_RTT_PUT_BUFFER_SECTION(Var) SEGGER_RTT_PUT_SECTION(Var, SEGGER_RTT_BUFFER_SECTION)
- #else
- #define SEGGER_RTT_PUT_BUFFER_SECTION(Var) Var
- #endif
- static unsigned char _aTerminalId[16] = { '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', 'A', 'B', 'C', 'D', 'E', 'F' };
- SEGGER_RTT_PUT_CB_SECTION(SEGGER_RTT_CB_ALIGN(SEGGER_RTT_CB _SEGGER_RTT));
- SEGGER_RTT_PUT_BUFFER_SECTION(SEGGER_RTT_BUFFER_ALIGN(static char _acUpBuffer [BUFFER_SIZE_UP]));
- SEGGER_RTT_PUT_BUFFER_SECTION(SEGGER_RTT_BUFFER_ALIGN(static char _acDownBuffer[BUFFER_SIZE_DOWN]));
- static char _ActiveTerminal;
- #define INIT() do { \
- if (_SEGGER_RTT.acID[0] == '\0') { _DoInit(); } \
- } while (0)
- static void _DoInit(void) {
- SEGGER_RTT_CB* p;
-
-
-
- p = &_SEGGER_RTT;
- p->MaxNumUpBuffers = SEGGER_RTT_MAX_NUM_UP_BUFFERS;
- p->MaxNumDownBuffers = SEGGER_RTT_MAX_NUM_DOWN_BUFFERS;
-
-
-
- p->aUp[0].sName = "Terminal";
- p->aUp[0].pBuffer = _acUpBuffer;
- p->aUp[0].SizeOfBuffer = sizeof(_acUpBuffer);
- p->aUp[0].RdOff = 0u;
- p->aUp[0].WrOff = 0u;
- p->aUp[0].Flags = SEGGER_RTT_MODE_DEFAULT;
-
-
-
- p->aDown[0].sName = "Terminal";
- p->aDown[0].pBuffer = _acDownBuffer;
- p->aDown[0].SizeOfBuffer = sizeof(_acDownBuffer);
- p->aDown[0].RdOff = 0u;
- p->aDown[0].WrOff = 0u;
- p->aDown[0].Flags = SEGGER_RTT_MODE_DEFAULT;
-
-
-
-
-
- strcpy(&p->acID[7], "RTT");
- strcpy(&p->acID[0], "SEGGER");
- p->acID[6] = ' ';
- }
- static unsigned _WriteBlocking(SEGGER_RTT_BUFFER_UP* pRing, const char* pBuffer, unsigned NumBytes) {
- unsigned NumBytesToWrite;
- unsigned NumBytesWritten;
- unsigned RdOff;
- unsigned WrOff;
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- char* pDst;
- #endif
-
-
-
- NumBytesWritten = 0u;
- WrOff = pRing->WrOff;
- do {
- RdOff = pRing->RdOff;
- if (RdOff > WrOff) {
- NumBytesToWrite = RdOff - WrOff - 1u;
- } else {
- NumBytesToWrite = pRing->SizeOfBuffer - (WrOff - RdOff + 1u);
- }
- NumBytesToWrite = MIN(NumBytesToWrite, (pRing->SizeOfBuffer - WrOff));
- NumBytesToWrite = MIN(NumBytesToWrite, NumBytes);
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- pDst = pRing->pBuffer + WrOff;
- NumBytesWritten += NumBytesToWrite;
- NumBytes -= NumBytesToWrite;
- WrOff += NumBytesToWrite;
- while (NumBytesToWrite--) {
- *pDst++ = *pBuffer++;
- };
- #else
- SEGGER_RTT_MEMCPY(pRing->pBuffer + WrOff, pBuffer, NumBytesToWrite);
- NumBytesWritten += NumBytesToWrite;
- pBuffer += NumBytesToWrite;
- NumBytes -= NumBytesToWrite;
- WrOff += NumBytesToWrite;
- #endif
- if (WrOff == pRing->SizeOfBuffer) {
- WrOff = 0u;
- }
- pRing->WrOff = WrOff;
- } while (NumBytes);
-
- return NumBytesWritten;
- }
- static void _WriteNoCheck(SEGGER_RTT_BUFFER_UP* pRing, const char* pData, unsigned NumBytes) {
- unsigned NumBytesAtOnce;
- unsigned WrOff;
- unsigned Rem;
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- char* pDst;
- #endif
- WrOff = pRing->WrOff;
- Rem = pRing->SizeOfBuffer - WrOff;
- if (Rem > NumBytes) {
-
-
-
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- pDst = pRing->pBuffer + WrOff;
- WrOff += NumBytes;
- while (NumBytes--) {
- *pDst++ = *pData++;
- };
- pRing->WrOff = WrOff;
- #else
- SEGGER_RTT_MEMCPY(pRing->pBuffer + WrOff, pData, NumBytes);
- pRing->WrOff = WrOff + NumBytes;
- #endif
- } else {
-
-
-
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- pDst = pRing->pBuffer + WrOff;
- NumBytesAtOnce = Rem;
- while (NumBytesAtOnce--) {
- *pDst++ = *pData++;
- };
- pDst = pRing->pBuffer;
- NumBytesAtOnce = NumBytes - Rem;
- while (NumBytesAtOnce--) {
- *pDst++ = *pData++;
- };
- pRing->WrOff = NumBytes - Rem;
- #else
- NumBytesAtOnce = Rem;
- SEGGER_RTT_MEMCPY(pRing->pBuffer + WrOff, pData, NumBytesAtOnce);
- NumBytesAtOnce = NumBytes - Rem;
- SEGGER_RTT_MEMCPY(pRing->pBuffer, pData + Rem, NumBytesAtOnce);
- pRing->WrOff = NumBytesAtOnce;
- #endif
- }
- }
- static void _PostTerminalSwitch(SEGGER_RTT_BUFFER_UP* pRing, unsigned char TerminalId) {
- char ac[2];
- ac[0] = 0xFFu;
- ac[1] = _aTerminalId[TerminalId];
- _WriteBlocking(pRing, ac, 2u);
- }
- static unsigned _GetAvailWriteSpace(SEGGER_RTT_BUFFER_UP* pRing) {
- unsigned RdOff;
- unsigned WrOff;
- unsigned r;
-
-
-
-
- RdOff = pRing->RdOff;
- WrOff = pRing->WrOff;
- if (RdOff <= WrOff) {
- r = pRing->SizeOfBuffer - 1u - WrOff + RdOff;
- } else {
- r = RdOff - WrOff - 1u;
- }
- return r;
- }
- unsigned SEGGER_RTT_ReadNoLock(unsigned BufferIndex, void* pData, unsigned BufferSize) {
- unsigned NumBytesRem;
- unsigned NumBytesRead;
- unsigned RdOff;
- unsigned WrOff;
- unsigned char* pBuffer;
- SEGGER_RTT_BUFFER_DOWN* pRing;
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- const char* pSrc;
- #endif
-
- INIT();
- pRing = &_SEGGER_RTT.aDown[BufferIndex];
- pBuffer = (unsigned char*)pData;
- RdOff = pRing->RdOff;
- WrOff = pRing->WrOff;
- NumBytesRead = 0u;
-
-
-
- if (RdOff > WrOff) {
- NumBytesRem = pRing->SizeOfBuffer - RdOff;
- NumBytesRem = MIN(NumBytesRem, BufferSize);
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- pSrc = pRing->pBuffer + RdOff;
- NumBytesRead += NumBytesRem;
- BufferSize -= NumBytesRem;
- RdOff += NumBytesRem;
- while (NumBytesRem--) {
- *pBuffer++ = *pSrc++;
- };
- #else
- SEGGER_RTT_MEMCPY(pBuffer, pRing->pBuffer + RdOff, NumBytesRem);
- NumBytesRead += NumBytesRem;
- pBuffer += NumBytesRem;
- BufferSize -= NumBytesRem;
- RdOff += NumBytesRem;
- #endif
-
-
-
- if (RdOff == pRing->SizeOfBuffer) {
- RdOff = 0u;
- }
- }
-
-
-
- NumBytesRem = WrOff - RdOff;
- NumBytesRem = MIN(NumBytesRem, BufferSize);
- if (NumBytesRem > 0u) {
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- pSrc = pRing->pBuffer + RdOff;
- NumBytesRead += NumBytesRem;
- BufferSize -= NumBytesRem;
- RdOff += NumBytesRem;
- while (NumBytesRem--) {
- *pBuffer++ = *pSrc++;
- };
- #else
- SEGGER_RTT_MEMCPY(pBuffer, pRing->pBuffer + RdOff, NumBytesRem);
- NumBytesRead += NumBytesRem;
- pBuffer += NumBytesRem;
- BufferSize -= NumBytesRem;
- RdOff += NumBytesRem;
- #endif
- }
- if (NumBytesRead) {
- pRing->RdOff = RdOff;
- }
-
- return NumBytesRead;
- }
- unsigned SEGGER_RTT_Read(unsigned BufferIndex, void* pBuffer, unsigned BufferSize) {
- unsigned NumBytesRead;
-
- SEGGER_RTT_LOCK();
-
-
-
- NumBytesRead = SEGGER_RTT_ReadNoLock(BufferIndex, pBuffer, BufferSize);
-
-
-
- SEGGER_RTT_UNLOCK();
-
- return NumBytesRead;
- }
- void SEGGER_RTT_WriteWithOverwriteNoLock(unsigned BufferIndex, const void* pBuffer, unsigned NumBytes) {
- const char* pData;
- SEGGER_RTT_BUFFER_UP* pRing;
- unsigned Avail;
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- char* pDst;
- #endif
- pData = (const char *)pBuffer;
-
-
-
- pRing = &_SEGGER_RTT.aUp[BufferIndex];
-
-
-
- if (pRing->WrOff == pRing->RdOff) {
- Avail = pRing->SizeOfBuffer - 1u;
- } else if ( pRing->WrOff < pRing->RdOff) {
- Avail = pRing->RdOff - pRing->WrOff - 1u;
- } else {
- Avail = pRing->RdOff - pRing->WrOff - 1u + pRing->SizeOfBuffer;
- }
- if (NumBytes > Avail) {
- pRing->RdOff += (NumBytes - Avail);
- while (pRing->RdOff >= pRing->SizeOfBuffer) {
- pRing->RdOff -= pRing->SizeOfBuffer;
- }
- }
-
-
-
- Avail = pRing->SizeOfBuffer - pRing->WrOff;
- do {
- if (Avail > NumBytes) {
-
-
-
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- pDst = pRing->pBuffer + pRing->WrOff;
- Avail = NumBytes;
- while (NumBytes--) {
- *pDst++ = *pData++;
- };
- pRing->WrOff += Avail;
- #else
- SEGGER_RTT_MEMCPY(pRing->pBuffer + pRing->WrOff, pData, NumBytes);
- pRing->WrOff += NumBytes;
- #endif
- break;
- } else {
-
-
-
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- pDst = pRing->pBuffer + pRing->WrOff;
- NumBytes -= Avail;
- while (Avail--) {
- *pDst++ = *pData++;
- };
- pRing->WrOff = 0;
- #else
- SEGGER_RTT_MEMCPY(pRing->pBuffer + pRing->WrOff, pData, Avail);
- pData += Avail;
- pRing->WrOff = 0;
- NumBytes -= Avail;
- #endif
- Avail = (pRing->SizeOfBuffer - 1);
- }
- } while (NumBytes);
- }
- unsigned SEGGER_RTT_WriteSkipNoLock(unsigned BufferIndex, const void* pBuffer, unsigned NumBytes) {
- const char* pData;
- SEGGER_RTT_BUFFER_UP* pRing;
- unsigned Avail;
- unsigned RdOff;
- unsigned WrOff;
- unsigned Rem;
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- char* pDst;
- #endif
- pData = (const char *)pBuffer;
-
-
-
- pRing = &_SEGGER_RTT.aUp[BufferIndex];
- RdOff = pRing->RdOff;
- WrOff = pRing->WrOff;
-
-
-
-
-
-
-
-
-
-
-
-
-
- if (RdOff <= WrOff) {
-
-
-
- Avail = pRing->SizeOfBuffer - 1u - WrOff ;
- if (Avail >= NumBytes) {
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- pDst = pRing->pBuffer + WrOff;
- WrOff += NumBytes;
- while (NumBytes--) {
- *pDst++ = *pData++;
- };
- pRing->WrOff = WrOff;
- #else
- SEGGER_RTT_MEMCPY(pRing->pBuffer + WrOff, pData, NumBytes);
- pRing->WrOff = WrOff + NumBytes;
- #endif
- return 1;
- }
-
-
-
- Avail += RdOff;
-
-
-
- if (Avail >= NumBytes) {
-
-
-
- Rem = pRing->SizeOfBuffer - WrOff;
- if (Rem > NumBytes) {
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- pDst = pRing->pBuffer + WrOff;
- WrOff += NumBytes;
- while (NumBytes--) {
- *pDst++ = *pData++;
- };
- pRing->WrOff = WrOff;
- #else
- SEGGER_RTT_MEMCPY(pRing->pBuffer + WrOff, pData, NumBytes);
- pRing->WrOff = WrOff + NumBytes;
- #endif
- } else {
-
-
-
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- pDst = pRing->pBuffer + WrOff;
- NumBytes -= Rem;
- WrOff = NumBytes;
- do {
- *pDst++ = *pData++;
- } while (--Rem);
- pDst = pRing->pBuffer;
- do {
- *pDst++ = *pData++;
- } while (--NumBytes);
- pRing->WrOff = WrOff;
- #else
- SEGGER_RTT_MEMCPY(pRing->pBuffer + WrOff, pData, Rem);
- SEGGER_RTT_MEMCPY(pRing->pBuffer, pData + Rem, NumBytes - Rem);
- pRing->WrOff = NumBytes - Rem;
- #endif
- }
- return 1;
- }
- } else {
- Avail = RdOff - WrOff - 1u;
- if (Avail >= NumBytes) {
- #if SEGGER_RTT_MEMCPY_USE_BYTELOOP
- pDst = pRing->pBuffer + WrOff;
- WrOff += NumBytes;
- while (NumBytes--) {
- *pDst++ = *pData++;
- };
- pRing->WrOff = WrOff;
- #else
- SEGGER_RTT_MEMCPY(pRing->pBuffer + WrOff, pData, NumBytes);
- pRing->WrOff = WrOff + NumBytes;
- #endif
- return 1;
- }
- }
-
-
-
- return 0;
- }
- unsigned SEGGER_RTT_WriteNoLock(unsigned BufferIndex, const void* pBuffer, unsigned NumBytes) {
- unsigned Status;
- unsigned Avail;
- const char* pData;
- SEGGER_RTT_BUFFER_UP* pRing;
- pData = (const char *)pBuffer;
-
-
-
- pRing = &_SEGGER_RTT.aUp[BufferIndex];
-
-
-
- switch (pRing->Flags) {
- case SEGGER_RTT_MODE_NO_BLOCK_SKIP:
-
-
-
-
- Avail = _GetAvailWriteSpace(pRing);
- if (Avail < NumBytes) {
- Status = 0u;
- } else {
- Status = NumBytes;
- _WriteNoCheck(pRing, pData, NumBytes);
- }
- break;
- case SEGGER_RTT_MODE_NO_BLOCK_TRIM:
-
-
-
- Avail = _GetAvailWriteSpace(pRing);
- Status = Avail < NumBytes ? Avail : NumBytes;
- _WriteNoCheck(pRing, pData, Status);
- break;
- case SEGGER_RTT_MODE_BLOCK_IF_FIFO_FULL:
-
-
-
- Status = _WriteBlocking(pRing, pData, NumBytes);
- break;
- default:
- Status = 0u;
- break;
- }
-
-
-
- return Status;
- }
- unsigned SEGGER_RTT_Write(unsigned BufferIndex, const void* pBuffer, unsigned NumBytes) {
- unsigned Status;
-
- INIT();
- SEGGER_RTT_LOCK();
-
-
-
- Status = SEGGER_RTT_WriteNoLock(BufferIndex, pBuffer, NumBytes);
-
-
-
- SEGGER_RTT_UNLOCK();
-
- return Status;
- }
- unsigned SEGGER_RTT_WriteString(unsigned BufferIndex, const char* s) {
- unsigned Len;
- Len = STRLEN(s);
- return SEGGER_RTT_Write(BufferIndex, s, Len);
- }
- unsigned SEGGER_RTT_PutCharSkipNoLock(unsigned BufferIndex, char c) {
- SEGGER_RTT_BUFFER_UP* pRing;
- unsigned WrOff;
- unsigned Status;
-
-
-
- pRing = &_SEGGER_RTT.aUp[BufferIndex];
-
-
-
- WrOff = pRing->WrOff + 1;
- if (WrOff == pRing->SizeOfBuffer) {
- WrOff = 0;
- }
-
-
-
- if (WrOff != pRing->RdOff) {
- pRing->pBuffer[pRing->WrOff] = c;
- pRing->WrOff = WrOff;
- Status = 1;
- } else {
- Status = 0;
- }
-
- return Status;
- }
- unsigned SEGGER_RTT_PutCharSkip(unsigned BufferIndex, char c) {
- SEGGER_RTT_BUFFER_UP* pRing;
- unsigned WrOff;
- unsigned Status;
-
-
-
- INIT();
- SEGGER_RTT_LOCK();
-
-
-
- pRing = &_SEGGER_RTT.aUp[BufferIndex];
-
-
-
- WrOff = pRing->WrOff + 1;
- if (WrOff == pRing->SizeOfBuffer) {
- WrOff = 0;
- }
-
-
-
- if (WrOff != pRing->RdOff) {
- pRing->pBuffer[pRing->WrOff] = c;
- pRing->WrOff = WrOff;
- Status = 1;
- } else {
- Status = 0;
- }
-
-
-
- SEGGER_RTT_UNLOCK();
-
- return Status;
- }
-
- unsigned SEGGER_RTT_PutChar(unsigned BufferIndex, char c) {
- SEGGER_RTT_BUFFER_UP* pRing;
- unsigned WrOff;
- unsigned Status;
-
-
-
- INIT();
- SEGGER_RTT_LOCK();
-
-
-
- pRing = &_SEGGER_RTT.aUp[BufferIndex];
-
-
-
- WrOff = pRing->WrOff + 1;
- if (WrOff == pRing->SizeOfBuffer) {
- WrOff = 0;
- }
-
-
-
- if (pRing->Flags == SEGGER_RTT_MODE_BLOCK_IF_FIFO_FULL) {
- while (WrOff == pRing->RdOff) {
- ;
- }
- }
-
-
-
- if (WrOff != pRing->RdOff) {
- pRing->pBuffer[pRing->WrOff] = c;
- pRing->WrOff = WrOff;
- Status = 1;
- } else {
- Status = 0;
- }
-
-
-
- SEGGER_RTT_UNLOCK();
-
- return Status;
- }
- int SEGGER_RTT_GetKey(void) {
- char c;
- int r;
- r = (int)SEGGER_RTT_Read(0u, &c, 1u);
- if (r == 1) {
- r = (int)(unsigned char)c;
- } else {
- r = -1;
- }
- return r;
- }
- int SEGGER_RTT_WaitKey(void) {
- int r;
- do {
- r = SEGGER_RTT_GetKey();
- } while (r < 0);
- return r;
- }
- int SEGGER_RTT_HasKey(void) {
- unsigned RdOff;
- int r;
- INIT();
- RdOff = _SEGGER_RTT.aDown[0].RdOff;
- if (RdOff != _SEGGER_RTT.aDown[0].WrOff) {
- r = 1;
- } else {
- r = 0;
- }
- return r;
- }
- unsigned SEGGER_RTT_HasData(unsigned BufferIndex) {
- SEGGER_RTT_BUFFER_DOWN* pRing;
- unsigned v;
- pRing = &_SEGGER_RTT.aDown[BufferIndex];
- v = pRing->WrOff;
- return v - pRing->RdOff;
- }
- int SEGGER_RTT_AllocDownBuffer(const char* sName, void* pBuffer, unsigned BufferSize, unsigned Flags) {
- int BufferIndex;
- INIT();
- SEGGER_RTT_LOCK();
- BufferIndex = 0;
- do {
- if (_SEGGER_RTT.aDown[BufferIndex].pBuffer == NULL) {
- break;
- }
- BufferIndex++;
- } while (BufferIndex < _SEGGER_RTT.MaxNumDownBuffers);
- if (BufferIndex < _SEGGER_RTT.MaxNumDownBuffers) {
- _SEGGER_RTT.aDown[BufferIndex].sName = sName;
- _SEGGER_RTT.aDown[BufferIndex].pBuffer = (char*)pBuffer;
- _SEGGER_RTT.aDown[BufferIndex].SizeOfBuffer = BufferSize;
- _SEGGER_RTT.aDown[BufferIndex].RdOff = 0u;
- _SEGGER_RTT.aDown[BufferIndex].WrOff = 0u;
- _SEGGER_RTT.aDown[BufferIndex].Flags = Flags;
- } else {
- BufferIndex = -1;
- }
- SEGGER_RTT_UNLOCK();
- return BufferIndex;
- }
- int SEGGER_RTT_AllocUpBuffer(const char* sName, void* pBuffer, unsigned BufferSize, unsigned Flags) {
- int BufferIndex;
- INIT();
- SEGGER_RTT_LOCK();
- BufferIndex = 0;
- do {
- if (_SEGGER_RTT.aUp[BufferIndex].pBuffer == NULL) {
- break;
- }
- BufferIndex++;
- } while (BufferIndex < _SEGGER_RTT.MaxNumUpBuffers);
- if (BufferIndex < _SEGGER_RTT.MaxNumUpBuffers) {
- _SEGGER_RTT.aUp[BufferIndex].sName = sName;
- _SEGGER_RTT.aUp[BufferIndex].pBuffer = (char*)pBuffer;
- _SEGGER_RTT.aUp[BufferIndex].SizeOfBuffer = BufferSize;
- _SEGGER_RTT.aUp[BufferIndex].RdOff = 0u;
- _SEGGER_RTT.aUp[BufferIndex].WrOff = 0u;
- _SEGGER_RTT.aUp[BufferIndex].Flags = Flags;
- } else {
- BufferIndex = -1;
- }
- SEGGER_RTT_UNLOCK();
- return BufferIndex;
- }
- int SEGGER_RTT_ConfigUpBuffer(unsigned BufferIndex, const char* sName, void* pBuffer, unsigned BufferSize, unsigned Flags) {
- int r;
- INIT();
- if (BufferIndex < (unsigned)_SEGGER_RTT.MaxNumUpBuffers) {
- SEGGER_RTT_LOCK();
- if (BufferIndex > 0u) {
- _SEGGER_RTT.aUp[BufferIndex].sName = sName;
- _SEGGER_RTT.aUp[BufferIndex].pBuffer = (char*)pBuffer;
- _SEGGER_RTT.aUp[BufferIndex].SizeOfBuffer = BufferSize;
- _SEGGER_RTT.aUp[BufferIndex].RdOff = 0u;
- _SEGGER_RTT.aUp[BufferIndex].WrOff = 0u;
- }
- _SEGGER_RTT.aUp[BufferIndex].Flags = Flags;
- SEGGER_RTT_UNLOCK();
- r = 0;
- } else {
- r = -1;
- }
- return r;
- }
- int SEGGER_RTT_ConfigDownBuffer(unsigned BufferIndex, const char* sName, void* pBuffer, unsigned BufferSize, unsigned Flags) {
- int r;
- INIT();
- if (BufferIndex < (unsigned)_SEGGER_RTT.MaxNumDownBuffers) {
- SEGGER_RTT_LOCK();
- if (BufferIndex > 0u) {
- _SEGGER_RTT.aDown[BufferIndex].sName = sName;
- _SEGGER_RTT.aDown[BufferIndex].pBuffer = (char*)pBuffer;
- _SEGGER_RTT.aDown[BufferIndex].SizeOfBuffer = BufferSize;
- _SEGGER_RTT.aDown[BufferIndex].RdOff = 0u;
- _SEGGER_RTT.aDown[BufferIndex].WrOff = 0u;
- }
- _SEGGER_RTT.aDown[BufferIndex].Flags = Flags;
- SEGGER_RTT_UNLOCK();
- r = 0;
- } else {
- r = -1;
- }
- return r;
- }
- int SEGGER_RTT_SetNameUpBuffer(unsigned BufferIndex, const char* sName) {
- int r;
- INIT();
- if (BufferIndex < (unsigned)_SEGGER_RTT.MaxNumUpBuffers) {
- SEGGER_RTT_LOCK();
- _SEGGER_RTT.aUp[BufferIndex].sName = sName;
- SEGGER_RTT_UNLOCK();
- r = 0;
- } else {
- r = -1;
- }
- return r;
- }
- int SEGGER_RTT_SetNameDownBuffer(unsigned BufferIndex, const char* sName) {
- int r;
- INIT();
- if (BufferIndex < (unsigned)_SEGGER_RTT.MaxNumDownBuffers) {
- SEGGER_RTT_LOCK();
- _SEGGER_RTT.aDown[BufferIndex].sName = sName;
- SEGGER_RTT_UNLOCK();
- r = 0;
- } else {
- r = -1;
- }
- return r;
- }
- int SEGGER_RTT_SetFlagsUpBuffer(unsigned BufferIndex, unsigned Flags) {
- int r;
- INIT();
- if (BufferIndex < (unsigned)_SEGGER_RTT.MaxNumUpBuffers) {
- SEGGER_RTT_LOCK();
- _SEGGER_RTT.aUp[BufferIndex].Flags = Flags;
- SEGGER_RTT_UNLOCK();
- r = 0;
- } else {
- r = -1;
- }
- return r;
- }
- int SEGGER_RTT_SetFlagsDownBuffer(unsigned BufferIndex, unsigned Flags) {
- int r;
- INIT();
- if (BufferIndex < (unsigned)_SEGGER_RTT.MaxNumDownBuffers) {
- SEGGER_RTT_LOCK();
- _SEGGER_RTT.aDown[BufferIndex].Flags = Flags;
- SEGGER_RTT_UNLOCK();
- r = 0;
- } else {
- r = -1;
- }
- return r;
- }
- void SEGGER_RTT_Init (void) {
- _DoInit();
- }
- int SEGGER_RTT_SetTerminal (char TerminalId) {
- char ac[2];
- SEGGER_RTT_BUFFER_UP* pRing;
- unsigned Avail;
- int r;
-
- INIT();
-
- r = 0;
- ac[0] = 0xFFU;
- if ((unsigned char)TerminalId < (unsigned char)sizeof(_aTerminalId)) {
- ac[1] = _aTerminalId[(unsigned char)TerminalId];
- pRing = &_SEGGER_RTT.aUp[0];
- SEGGER_RTT_LOCK();
- if ((pRing->Flags & SEGGER_RTT_MODE_MASK) == SEGGER_RTT_MODE_BLOCK_IF_FIFO_FULL) {
- _ActiveTerminal = TerminalId;
- _WriteBlocking(pRing, ac, 2u);
- } else {
- Avail = _GetAvailWriteSpace(pRing);
- if (Avail >= 2) {
- _ActiveTerminal = TerminalId;
- _WriteNoCheck(pRing, ac, 2u);
- } else {
- r = -1;
- }
- }
- SEGGER_RTT_UNLOCK();
- } else {
- r = -1;
- }
- return r;
- }
- int SEGGER_RTT_TerminalOut (char TerminalId, const char* s) {
- int Status;
- unsigned FragLen;
- unsigned Avail;
- SEGGER_RTT_BUFFER_UP* pRing;
-
- INIT();
-
-
-
- if (TerminalId < (char)sizeof(_aTerminalId)) {
-
-
-
- pRing = &_SEGGER_RTT.aUp[0];
-
-
-
-
- FragLen = STRLEN(s);
-
-
-
- SEGGER_RTT_LOCK();
- Avail = _GetAvailWriteSpace(pRing);
- switch (pRing->Flags & SEGGER_RTT_MODE_MASK) {
- case SEGGER_RTT_MODE_NO_BLOCK_SKIP:
-
-
-
-
- if (Avail < (FragLen + 4u)) {
- Status = 0;
- } else {
- _PostTerminalSwitch(pRing, TerminalId);
- Status = (int)_WriteBlocking(pRing, s, FragLen);
- _PostTerminalSwitch(pRing, _ActiveTerminal);
- }
- break;
- case SEGGER_RTT_MODE_NO_BLOCK_TRIM:
-
-
-
-
-
- if (Avail < 4u) {
- Status = -1;
- } else {
- _PostTerminalSwitch(pRing, TerminalId);
- Status = (int)_WriteBlocking(pRing, s, (FragLen < (Avail - 4u)) ? FragLen : (Avail - 4u));
- _PostTerminalSwitch(pRing, _ActiveTerminal);
- }
- break;
- case SEGGER_RTT_MODE_BLOCK_IF_FIFO_FULL:
-
-
-
- _PostTerminalSwitch(pRing, TerminalId);
- Status = (int)_WriteBlocking(pRing, s, FragLen);
- _PostTerminalSwitch(pRing, _ActiveTerminal);
- break;
- default:
- Status = -1;
- break;
- }
-
-
-
- SEGGER_RTT_UNLOCK();
- } else {
- Status = -1;
- }
- return Status;
- }
|