os/kernelhwsrv/kerneltest/e32test/dma/dmasim.cpp
author sl
Tue, 10 Jun 2014 14:32:02 +0200
changeset 1 260cb5ec6c19
permissions -rw-r--r--
Update contrib.
sl@0
     1
// Copyright (c) 2002-2009 Nokia Corporation and/or its subsidiary(-ies).
sl@0
     2
// All rights reserved.
sl@0
     3
// This component and the accompanying materials are made available
sl@0
     4
// under the terms of the License "Eclipse Public License v1.0"
sl@0
     5
// which accompanies this distribution, and is available
sl@0
     6
// at the URL "http://www.eclipse.org/legal/epl-v10.html".
sl@0
     7
//
sl@0
     8
// Initial Contributors:
sl@0
     9
// Nokia Corporation - initial contribution.
sl@0
    10
//
sl@0
    11
// Contributors:
sl@0
    12
//
sl@0
    13
// Description:
sl@0
    14
// e32test\dma\dmasim.cpp
sl@0
    15
// DMA framework Platform Specific Layer (PSL) for software-emulated
sl@0
    16
// DMA controller used for testing the DMA framework PIL.
sl@0
    17
// 
sl@0
    18
//
sl@0
    19
sl@0
    20
#include <drivers/dma.h>
sl@0
    21
#include <kernel/kern_priv.h>
sl@0
    22
sl@0
    23
sl@0
    24
const char KDmaPanicCat[] = "DMASIM";
sl@0
    25
sl@0
    26
const TInt KMaxTransferSize = 0x1FFF;
sl@0
    27
const TInt KMemAlignMask = 3; // memory addresses passed to DMAC must be multiple of 4
sl@0
    28
const TInt KBurstSize = 0x800;
sl@0
    29
sl@0
    30
typedef void (*TPseudoIsr)();
sl@0
    31
sl@0
    32
const TInt KChannelCount = 4;								// # of channels per controller
sl@0
    33
const TInt KDesCount = 256;									// # of descriptors allocated per controller
sl@0
    34
sl@0
    35
//////////////////////////////////////////////////////////////////////////////
sl@0
    36
// SOFTWARE DMA CONTROLLER SIMULATION
sl@0
    37
//////////////////////////////////////////////////////////////////////////////
sl@0
    38
sl@0
    39
class DmacSb
sl@0
    40
/** Single-buffer DMA controller software simulation */
sl@0
    41
	{
sl@0
    42
public:
sl@0
    43
	enum { ECsRun = 0x80000000 };
sl@0
    44
public:
sl@0
    45
	static void DoTransfer();
sl@0
    46
private:
sl@0
    47
	static void BurstTransfer();
sl@0
    48
private:
sl@0
    49
	static TInt CurrentChannel;
sl@0
    50
public:
sl@0
    51
	// pseudo registers
sl@0
    52
	static TUint8* SrcAddr[KChannelCount];
sl@0
    53
	static TUint8* DestAddr[KChannelCount];
sl@0
    54
	static TInt Count[KChannelCount];
sl@0
    55
	static TUint32 ControlStatus[KChannelCount];
sl@0
    56
	static TUint32 CompletionInt;
sl@0
    57
	static TUint32 ErrorInt;
sl@0
    58
	// hook for pseudo ISR
sl@0
    59
	static TPseudoIsr Isr;
sl@0
    60
	// transfer failure simulation
sl@0
    61
	static TInt FailCount[KChannelCount];
sl@0
    62
	};
sl@0
    63
sl@0
    64
TUint8* DmacSb::SrcAddr[KChannelCount];
sl@0
    65
TUint8* DmacSb::DestAddr[KChannelCount];
sl@0
    66
TInt DmacSb::Count[KChannelCount];
sl@0
    67
TUint32 DmacSb::ControlStatus[KChannelCount];
sl@0
    68
TUint32 DmacSb::CompletionInt;
sl@0
    69
TUint32 DmacSb::ErrorInt;
sl@0
    70
TPseudoIsr DmacSb::Isr;
sl@0
    71
TInt DmacSb::FailCount[KChannelCount];
sl@0
    72
TInt DmacSb::CurrentChannel;
sl@0
    73
sl@0
    74
void DmacSb::DoTransfer()
sl@0
    75
	{
sl@0
    76
	if (ControlStatus[CurrentChannel] & ECsRun)
sl@0
    77
		{
sl@0
    78
		if (FailCount[CurrentChannel] > 0 && --FailCount[CurrentChannel] == 0)
sl@0
    79
			{
sl@0
    80
			ControlStatus[CurrentChannel] &= ~ECsRun;
sl@0
    81
			ErrorInt |= 1 << CurrentChannel;
sl@0
    82
			Isr();
sl@0
    83
			}
sl@0
    84
		else
sl@0
    85
			{
sl@0
    86
			//__KTRACE_OPT(KDMA, Kern::Printf("DmacSb::DoTransfer channel %d", CurrentChannel));
sl@0
    87
			if (Count[CurrentChannel] == 0)
sl@0
    88
				{
sl@0
    89
				//__KTRACE_OPT(KDMA, Kern::Printf("DmacSb::DoTransfer transfer complete"));
sl@0
    90
				ControlStatus[CurrentChannel] &= ~ECsRun;
sl@0
    91
				CompletionInt |= 1 << CurrentChannel;
sl@0
    92
				Isr();
sl@0
    93
				}
sl@0
    94
			else
sl@0
    95
				BurstTransfer();
sl@0
    96
			}
sl@0
    97
		}
sl@0
    98
sl@0
    99
	CurrentChannel++;
sl@0
   100
	if (CurrentChannel >= KChannelCount)
sl@0
   101
		CurrentChannel = 0;
sl@0
   102
	}
sl@0
   103
sl@0
   104
void DmacSb::BurstTransfer()
sl@0
   105
	{
sl@0
   106
	//__KTRACE_OPT(KDMA, Kern::Printf("DmacSb::BurstTransfer"));
sl@0
   107
	TInt s = Min(Count[CurrentChannel], KBurstSize);
sl@0
   108
	memcpy(DestAddr[CurrentChannel], SrcAddr[CurrentChannel], s);
sl@0
   109
	Count[CurrentChannel] -= s;
sl@0
   110
	SrcAddr[CurrentChannel] += s;
sl@0
   111
	DestAddr[CurrentChannel] += s;
sl@0
   112
	}
sl@0
   113
sl@0
   114
//////////////////////////////////////////////////////////////////////////////
sl@0
   115
sl@0
   116
class DmacDb
sl@0
   117
/** Double-buffer DMA controller software simulation */
sl@0
   118
	{
sl@0
   119
public:
sl@0
   120
	enum { ECsRun = 0x80000000, ECsPrg = 0x40000000 };
sl@0
   121
public:
sl@0
   122
	static void Enable(TInt aIdx);
sl@0
   123
	static void DoTransfer();
sl@0
   124
private:
sl@0
   125
	static TInt CurrentChannel;
sl@0
   126
private:
sl@0
   127
	// internal pseudo-registers
sl@0
   128
	static TUint8* ActSrcAddr[KChannelCount];
sl@0
   129
	static TUint8* ActDestAddr[KChannelCount];
sl@0
   130
	static TInt ActCount[KChannelCount];
sl@0
   131
public:
sl@0
   132
	// externally accessible pseudo-registers
sl@0
   133
	static TUint32 ControlStatus[KChannelCount];
sl@0
   134
	static TUint8* PrgSrcAddr[KChannelCount];
sl@0
   135
	static TUint8* PrgDestAddr[KChannelCount];
sl@0
   136
	static TInt PrgCount[KChannelCount];
sl@0
   137
	static TUint32 CompletionInt;
sl@0
   138
	static TUint32 ErrorInt;
sl@0
   139
	// hook for pseudo ISR
sl@0
   140
	static TPseudoIsr Isr;
sl@0
   141
	// transfer failure simulation
sl@0
   142
	static TInt FailCount[KChannelCount];
sl@0
   143
	static TInt InterruptsToMiss[KChannelCount];
sl@0
   144
	};
sl@0
   145
sl@0
   146
TUint8* DmacDb::PrgSrcAddr[KChannelCount];
sl@0
   147
TUint8* DmacDb::PrgDestAddr[KChannelCount];
sl@0
   148
TInt DmacDb::PrgCount[KChannelCount];
sl@0
   149
TUint8* DmacDb::ActSrcAddr[KChannelCount];
sl@0
   150
TUint8* DmacDb::ActDestAddr[KChannelCount];
sl@0
   151
TInt DmacDb::ActCount[KChannelCount];
sl@0
   152
TUint32 DmacDb::ControlStatus[KChannelCount];
sl@0
   153
TUint32 DmacDb::CompletionInt;
sl@0
   154
TUint32 DmacDb::ErrorInt;
sl@0
   155
TPseudoIsr DmacDb::Isr;
sl@0
   156
TInt DmacDb::FailCount[KChannelCount];
sl@0
   157
TInt DmacDb::InterruptsToMiss[KChannelCount];
sl@0
   158
TInt DmacDb::CurrentChannel;
sl@0
   159
sl@0
   160
void DmacDb::Enable(TInt aIdx)
sl@0
   161
	{
sl@0
   162
	if (ControlStatus[aIdx] & ECsRun)
sl@0
   163
		ControlStatus[aIdx] |= ECsPrg;
sl@0
   164
	else
sl@0
   165
		{
sl@0
   166
		ActSrcAddr[aIdx] = PrgSrcAddr[aIdx];
sl@0
   167
		ActDestAddr[aIdx] = PrgDestAddr[aIdx];
sl@0
   168
		ActCount[aIdx] = PrgCount[aIdx];
sl@0
   169
		ControlStatus[aIdx] |= ECsRun;
sl@0
   170
		}
sl@0
   171
	}
sl@0
   172
sl@0
   173
void DmacDb::DoTransfer()
sl@0
   174
	{
sl@0
   175
	if (ControlStatus[CurrentChannel] & ECsRun)
sl@0
   176
		{
sl@0
   177
		if (FailCount[CurrentChannel] > 0 && --FailCount[CurrentChannel] == 0)
sl@0
   178
			{
sl@0
   179
			ControlStatus[CurrentChannel] &= ~ECsRun;
sl@0
   180
			ErrorInt |= 1 << CurrentChannel;
sl@0
   181
			Isr();
sl@0
   182
			}
sl@0
   183
		else
sl@0
   184
			{
sl@0
   185
			if (ActCount[CurrentChannel] == 0)
sl@0
   186
				{
sl@0
   187
				if (ControlStatus[CurrentChannel] & ECsPrg)
sl@0
   188
					{
sl@0
   189
					ActSrcAddr[CurrentChannel] = PrgSrcAddr[CurrentChannel];
sl@0
   190
					ActDestAddr[CurrentChannel] = PrgDestAddr[CurrentChannel];
sl@0
   191
					ActCount[CurrentChannel] = PrgCount[CurrentChannel];
sl@0
   192
					ControlStatus[CurrentChannel] &= ~ECsPrg;
sl@0
   193
					}
sl@0
   194
				else
sl@0
   195
					ControlStatus[CurrentChannel] &= ~ECsRun;
sl@0
   196
				if (InterruptsToMiss[CurrentChannel] > 0)
sl@0
   197
					InterruptsToMiss[CurrentChannel]--;
sl@0
   198
				else
sl@0
   199
					{
sl@0
   200
					CompletionInt |= 1 << CurrentChannel;
sl@0
   201
					Isr();
sl@0
   202
					}
sl@0
   203
				}
sl@0
   204
			else
sl@0
   205
				{
sl@0
   206
				TInt s = Min(ActCount[CurrentChannel], KBurstSize);
sl@0
   207
				memcpy(ActDestAddr[CurrentChannel], ActSrcAddr[CurrentChannel], s);
sl@0
   208
				ActCount[CurrentChannel] -= s;
sl@0
   209
				ActSrcAddr[CurrentChannel] += s;
sl@0
   210
				ActDestAddr[CurrentChannel] += s;
sl@0
   211
				}
sl@0
   212
			}
sl@0
   213
		}
sl@0
   214
sl@0
   215
	CurrentChannel++;
sl@0
   216
	if (CurrentChannel >= KChannelCount)
sl@0
   217
		CurrentChannel = 0;
sl@0
   218
	}
sl@0
   219
sl@0
   220
sl@0
   221
//////////////////////////////////////////////////////////////////////////////
sl@0
   222
sl@0
   223
class DmacSg
sl@0
   224
/** Scatter/gather DMA controller software simulation */
sl@0
   225
	{
sl@0
   226
public:
sl@0
   227
	enum { EChannelBitRun = 0x80000000 };
sl@0
   228
	enum { EDesBitInt = 1 };
sl@0
   229
	struct SDes
sl@0
   230
		{
sl@0
   231
		TUint8* iSrcAddr;
sl@0
   232
		TUint8* iDestAddr;
sl@0
   233
		TInt iCount;
sl@0
   234
		TUint iControl;
sl@0
   235
		SDes* iNext;
sl@0
   236
		};
sl@0
   237
public:
sl@0
   238
	static void DoTransfer();
sl@0
   239
	static void Enable(TInt aIdx);
sl@0
   240
private:
sl@0
   241
	static TInt CurrentChannel;
sl@0
   242
	static TBool IsDescriptorLoaded[KChannelCount];
sl@0
   243
public:
sl@0
   244
	// externally accessible pseudo-registers
sl@0
   245
	static TUint32 ChannelControl[KChannelCount];
sl@0
   246
	static TUint8* SrcAddr[KChannelCount];
sl@0
   247
	static TUint8* DestAddr[KChannelCount];
sl@0
   248
	static TInt Count[KChannelCount];
sl@0
   249
	static TUint Control[KChannelCount];
sl@0
   250
	static SDes* NextDes[KChannelCount];
sl@0
   251
	static TUint32 CompletionInt;
sl@0
   252
	static TUint32 ErrorInt;
sl@0
   253
	// hook for pseudo ISR
sl@0
   254
	static TPseudoIsr Isr;
sl@0
   255
	// transfer failure simulation
sl@0
   256
	static TInt FailCount[KChannelCount];
sl@0
   257
	static TInt InterruptsToMiss[KChannelCount];
sl@0
   258
	};
sl@0
   259
sl@0
   260
TUint32 DmacSg::ChannelControl[KChannelCount];
sl@0
   261
TUint8* DmacSg::SrcAddr[KChannelCount];
sl@0
   262
TUint8* DmacSg::DestAddr[KChannelCount];
sl@0
   263
TInt DmacSg::Count[KChannelCount];
sl@0
   264
TUint DmacSg::Control[KChannelCount];
sl@0
   265
DmacSg::SDes* DmacSg::NextDes[KChannelCount];
sl@0
   266
TUint32 DmacSg::CompletionInt;
sl@0
   267
TUint32 DmacSg::ErrorInt;
sl@0
   268
TPseudoIsr DmacSg::Isr;
sl@0
   269
TInt DmacSg::FailCount[KChannelCount];
sl@0
   270
TInt DmacSg::InterruptsToMiss[KChannelCount];
sl@0
   271
TInt DmacSg::CurrentChannel;
sl@0
   272
TBool DmacSg::IsDescriptorLoaded[KChannelCount];
sl@0
   273
sl@0
   274
sl@0
   275
void DmacSg::DoTransfer()
sl@0
   276
	{
sl@0
   277
	if (ChannelControl[CurrentChannel] & EChannelBitRun)
sl@0
   278
		{
sl@0
   279
		if (FailCount[CurrentChannel] > 0 && --FailCount[CurrentChannel] == 0)
sl@0
   280
			{
sl@0
   281
			ChannelControl[CurrentChannel] &= ~EChannelBitRun;
sl@0
   282
			ErrorInt |= 1 << CurrentChannel;
sl@0
   283
			Isr();
sl@0
   284
			}
sl@0
   285
		else
sl@0
   286
			{
sl@0
   287
			if (IsDescriptorLoaded[CurrentChannel])
sl@0
   288
				{
sl@0
   289
				if (Count[CurrentChannel] == 0)
sl@0
   290
					{
sl@0
   291
					IsDescriptorLoaded[CurrentChannel] = EFalse;
sl@0
   292
					if (Control[CurrentChannel] & EDesBitInt)
sl@0
   293
						{
sl@0
   294
						if (InterruptsToMiss[CurrentChannel] > 0)
sl@0
   295
							InterruptsToMiss[CurrentChannel]--;
sl@0
   296
						else
sl@0
   297
							{
sl@0
   298
							CompletionInt |= 1 << CurrentChannel;
sl@0
   299
							Isr();
sl@0
   300
							}
sl@0
   301
						}
sl@0
   302
					}
sl@0
   303
				else
sl@0
   304
					{
sl@0
   305
					TInt s = Min(Count[CurrentChannel], KBurstSize);
sl@0
   306
					memcpy(DestAddr[CurrentChannel], SrcAddr[CurrentChannel], s);
sl@0
   307
					Count[CurrentChannel] -= s;
sl@0
   308
					SrcAddr[CurrentChannel] += s;
sl@0
   309
					DestAddr[CurrentChannel] += s;
sl@0
   310
					}
sl@0
   311
				}
sl@0
   312
			// Need to test again as new descriptor must be loaded if
sl@0
   313
			// completion has just occured.
sl@0
   314
			if (! IsDescriptorLoaded[CurrentChannel])
sl@0
   315
				{
sl@0
   316
				if (NextDes[CurrentChannel] != NULL)
sl@0
   317
					{
sl@0
   318
					SrcAddr[CurrentChannel] = NextDes[CurrentChannel]->iSrcAddr;
sl@0
   319
					DestAddr[CurrentChannel] = NextDes[CurrentChannel]->iDestAddr;
sl@0
   320
					Count[CurrentChannel] = NextDes[CurrentChannel]->iCount;
sl@0
   321
					Control[CurrentChannel] = NextDes[CurrentChannel]->iControl;
sl@0
   322
					NextDes[CurrentChannel] = NextDes[CurrentChannel]->iNext;
sl@0
   323
					IsDescriptorLoaded[CurrentChannel] = ETrue;
sl@0
   324
					}
sl@0
   325
				else
sl@0
   326
					ChannelControl[CurrentChannel] &= ~EChannelBitRun;
sl@0
   327
				}
sl@0
   328
			}
sl@0
   329
		}
sl@0
   330
sl@0
   331
	CurrentChannel++;
sl@0
   332
	if (CurrentChannel >= KChannelCount)
sl@0
   333
		CurrentChannel = 0;
sl@0
   334
	}
sl@0
   335
sl@0
   336
sl@0
   337
void DmacSg::Enable(TInt aIdx)
sl@0
   338
	{
sl@0
   339
	SrcAddr[aIdx] = NextDes[aIdx]->iSrcAddr;
sl@0
   340
	DestAddr[aIdx] = NextDes[aIdx]->iDestAddr;
sl@0
   341
	Count[aIdx] = NextDes[aIdx]->iCount;
sl@0
   342
	Control[aIdx] = NextDes[aIdx]->iControl;
sl@0
   343
	NextDes[aIdx] = NextDes[aIdx]->iNext;
sl@0
   344
	IsDescriptorLoaded[aIdx] = ETrue;
sl@0
   345
	ChannelControl[aIdx] |= EChannelBitRun;
sl@0
   346
	}
sl@0
   347
sl@0
   348
//////////////////////////////////////////////////////////////////////////////
sl@0
   349
sl@0
   350
class DmacSim
sl@0
   351
/** 
sl@0
   352
 Harness calling the various DMA controller simulators periodically.
sl@0
   353
 */
sl@0
   354
	{
sl@0
   355
public:
sl@0
   356
	static void StartEmulation();
sl@0
   357
	static void StopEmulation();
sl@0
   358
private:
sl@0
   359
	enum { KPeriod = 1 }; // in ms
sl@0
   360
	static void TickCB(TAny* aThis);
sl@0
   361
	static NTimer Timer;
sl@0
   362
	};
sl@0
   363
sl@0
   364
NTimer DmacSim::Timer;
sl@0
   365
sl@0
   366
void DmacSim::StartEmulation()
sl@0
   367
	{
sl@0
   368
	new (&Timer) NTimer(&TickCB, 0);
sl@0
   369
	__DMA_ASSERTA(Timer.OneShot(KPeriod, EFalse) == KErrNone);
sl@0
   370
	}
sl@0
   371
sl@0
   372
void DmacSim::StopEmulation()
sl@0
   373
	{
sl@0
   374
	Timer.Cancel();
sl@0
   375
	}
sl@0
   376
sl@0
   377
void DmacSim::TickCB(TAny*)
sl@0
   378
	{
sl@0
   379
	DmacSb::DoTransfer();
sl@0
   380
	DmacDb::DoTransfer();
sl@0
   381
	DmacSg::DoTransfer();
sl@0
   382
	__DMA_ASSERTA(Timer.Again(KPeriod) == KErrNone);
sl@0
   383
	}
sl@0
   384
sl@0
   385
//////////////////////////////////////////////////////////////////////////////
sl@0
   386
// PSL FOR DMA SIMULATION
sl@0
   387
//////////////////////////////////////////////////////////////////////////////
sl@0
   388
sl@0
   389
class DSimSbController : public TDmac
sl@0
   390
	{
sl@0
   391
public:
sl@0
   392
	DSimSbController();
sl@0
   393
private:
sl@0
   394
	static void Isr();
sl@0
   395
	// from TDmac
sl@0
   396
	virtual void Transfer(const TDmaChannel& aChannel, const SDmaDesHdr& aHdr);
sl@0
   397
	virtual void StopTransfer(const TDmaChannel& aChannel);
sl@0
   398
	virtual TInt FailNext(const TDmaChannel& aChannel);
sl@0
   399
	virtual TBool IsIdle(const TDmaChannel& aChannel);
sl@0
   400
	virtual TInt MaxTransferSize(TDmaChannel& aChannel, TUint aFlags, TUint32 aPslInfo);
sl@0
   401
	virtual TUint MemAlignMask(TDmaChannel& aChannel, TUint aFlags, TUint32 aPslInfo);
sl@0
   402
public:
sl@0
   403
	static const SCreateInfo KInfo;
sl@0
   404
	TDmaSbChannel iChannels[KChannelCount];
sl@0
   405
	};
sl@0
   406
sl@0
   407
DSimSbController SbController;
sl@0
   408
sl@0
   409
const TDmac::SCreateInfo DSimSbController::KInfo =
sl@0
   410
	{
sl@0
   411
	KChannelCount,
sl@0
   412
	KDesCount,
sl@0
   413
	0,
sl@0
   414
	sizeof(SDmaPseudoDes),
sl@0
   415
	0,
sl@0
   416
	};
sl@0
   417
sl@0
   418
DSimSbController::DSimSbController()
sl@0
   419
	: TDmac(KInfo)
sl@0
   420
	{
sl@0
   421
	DmacSb::Isr = Isr;
sl@0
   422
	}
sl@0
   423
sl@0
   424
sl@0
   425
void DSimSbController::Transfer(const TDmaChannel& aChannel, const SDmaDesHdr& aHdr)
sl@0
   426
	{
sl@0
   427
	TUint32 i = aChannel.PslId();
sl@0
   428
	const SDmaPseudoDes& des = HdrToDes(aHdr);
sl@0
   429
	DmacSb::SrcAddr[i] = (TUint8*) des.iSrc;
sl@0
   430
	DmacSb::DestAddr[i] = (TUint8*) des.iDest;
sl@0
   431
	DmacSb::Count[i] = des.iCount;
sl@0
   432
	DmacSb::ControlStatus[i] |= DmacSb::ECsRun;
sl@0
   433
	}
sl@0
   434
sl@0
   435
sl@0
   436
void DSimSbController::StopTransfer(const TDmaChannel& aChannel)
sl@0
   437
	{
sl@0
   438
	__e32_atomic_and_ord32(&DmacSb::ControlStatus[aChannel.PslId()], (TUint32)~DmacSb::ECsRun);
sl@0
   439
	}
sl@0
   440
sl@0
   441
sl@0
   442
TInt DSimSbController::FailNext(const TDmaChannel& aChannel)
sl@0
   443
	{
sl@0
   444
	DmacSb::FailCount[aChannel.PslId()] = 1;
sl@0
   445
	return KErrNone;
sl@0
   446
	}
sl@0
   447
sl@0
   448
sl@0
   449
TBool DSimSbController::IsIdle(const TDmaChannel& aChannel)
sl@0
   450
	{
sl@0
   451
	return (DmacSb::ControlStatus[aChannel.PslId()] & DmacSb::ECsRun) == 0;
sl@0
   452
	}
sl@0
   453
sl@0
   454
sl@0
   455
TInt DSimSbController::MaxTransferSize(TDmaChannel& /*aChannel*/, TUint /*aFlags*/, TUint32 /*aPslInfo*/)
sl@0
   456
	{
sl@0
   457
	return KMaxTransferSize;
sl@0
   458
	}
sl@0
   459
sl@0
   460
sl@0
   461
TUint DSimSbController::MemAlignMask(TDmaChannel& /*aChannel*/, TUint /*aFlags*/, TUint32 /*aPslInfo*/)
sl@0
   462
	{
sl@0
   463
	return KMemAlignMask;
sl@0
   464
	}
sl@0
   465
sl@0
   466
sl@0
   467
void DSimSbController::Isr()
sl@0
   468
	{
sl@0
   469
	for (TInt i = 0; i < KChannelCount; i++)
sl@0
   470
		{
sl@0
   471
		TUint32 mask = (1 << i);
sl@0
   472
		if (DmacSb::CompletionInt & mask)
sl@0
   473
			{
sl@0
   474
			DmacSb::CompletionInt &= ~mask;
sl@0
   475
			HandleIsr(SbController.iChannels[i], ETrue);
sl@0
   476
			}
sl@0
   477
		if (DmacSb::ErrorInt & mask)
sl@0
   478
			{
sl@0
   479
			DmacSb::ErrorInt &= ~mask;
sl@0
   480
			HandleIsr(SbController.iChannels[i], EFalse);
sl@0
   481
			}
sl@0
   482
		}
sl@0
   483
	}
sl@0
   484
sl@0
   485
//////////////////////////////////////////////////////////////////////////////
sl@0
   486
sl@0
   487
class DSimDbController : public TDmac
sl@0
   488
	{
sl@0
   489
public:
sl@0
   490
	DSimDbController();
sl@0
   491
private:
sl@0
   492
	static void Isr();
sl@0
   493
	// from TDmac
sl@0
   494
	virtual void Transfer(const TDmaChannel& aChannel, const SDmaDesHdr& aHdr);
sl@0
   495
	virtual void StopTransfer(const TDmaChannel& aChannel);
sl@0
   496
	virtual TInt FailNext(const TDmaChannel& aChannel);
sl@0
   497
	virtual TInt MissNextInterrupts(const TDmaChannel& aChannel, TInt aInterruptCount);
sl@0
   498
	virtual TBool IsIdle(const TDmaChannel& aChannel);
sl@0
   499
	virtual TInt MaxTransferSize(TDmaChannel& aChannel, TUint aFlags, TUint32 aPslInfo);
sl@0
   500
	virtual TUint MemAlignMask(TDmaChannel& aChannel, TUint aFlags, TUint32 aPslInfo);
sl@0
   501
public:
sl@0
   502
	static const SCreateInfo KInfo;
sl@0
   503
	TDmaDbChannel iChannels[KChannelCount];
sl@0
   504
	};
sl@0
   505
sl@0
   506
DSimDbController DbController;
sl@0
   507
sl@0
   508
const TDmac::SCreateInfo DSimDbController::KInfo =
sl@0
   509
	{
sl@0
   510
	KChannelCount,
sl@0
   511
	KDesCount,
sl@0
   512
	0,
sl@0
   513
	sizeof(SDmaPseudoDes),
sl@0
   514
	0,
sl@0
   515
	};
sl@0
   516
sl@0
   517
sl@0
   518
DSimDbController::DSimDbController()
sl@0
   519
	: TDmac(KInfo)
sl@0
   520
	{
sl@0
   521
	DmacDb::Isr = Isr;
sl@0
   522
	}
sl@0
   523
sl@0
   524
sl@0
   525
void DSimDbController::Transfer(const TDmaChannel& aChannel, const SDmaDesHdr& aHdr)
sl@0
   526
	{
sl@0
   527
	TUint32 i = aChannel.PslId();
sl@0
   528
	const SDmaPseudoDes& des = HdrToDes(aHdr);
sl@0
   529
	DmacDb::PrgSrcAddr[i] = (TUint8*) des.iSrc;
sl@0
   530
	DmacDb::PrgDestAddr[i] = (TUint8*) des.iDest;
sl@0
   531
	DmacDb::PrgCount[i] = des.iCount;
sl@0
   532
	DmacDb::Enable(i);
sl@0
   533
	}
sl@0
   534
sl@0
   535
sl@0
   536
void DSimDbController::StopTransfer(const TDmaChannel& aChannel)
sl@0
   537
	{
sl@0
   538
	__e32_atomic_and_ord32(&DmacDb::ControlStatus[aChannel.PslId()], (TUint32)~(DmacDb::ECsRun|DmacDb::ECsPrg));
sl@0
   539
	}
sl@0
   540
sl@0
   541
sl@0
   542
TInt DSimDbController::FailNext(const TDmaChannel& aChannel)
sl@0
   543
	{
sl@0
   544
	DmacDb::FailCount[aChannel.PslId()] = 1;
sl@0
   545
	return KErrNone;
sl@0
   546
	}
sl@0
   547
sl@0
   548
sl@0
   549
TInt DSimDbController::MissNextInterrupts(const TDmaChannel& aChannel, TInt aInterruptCount)
sl@0
   550
	{
sl@0
   551
	__DMA_ASSERTD((DmacDb::ControlStatus[aChannel.PslId()] & DmacDb::ECsRun) == 0);
sl@0
   552
	__DMA_ASSERTD(aInterruptCount >= 0);
sl@0
   553
	// At most one interrupt can be missed with double-buffer controller
sl@0
   554
	if (aInterruptCount == 1)
sl@0
   555
		{
sl@0
   556
		DmacDb::InterruptsToMiss[aChannel.PslId()] = aInterruptCount;
sl@0
   557
		return KErrNone;
sl@0
   558
		}
sl@0
   559
	else
sl@0
   560
		return KErrNotSupported;
sl@0
   561
	}
sl@0
   562
sl@0
   563
sl@0
   564
TBool DSimDbController::IsIdle(const TDmaChannel& aChannel)
sl@0
   565
	{
sl@0
   566
	return (DmacDb::ControlStatus[aChannel.PslId()] & DmacDb::ECsRun) == 0;
sl@0
   567
	}
sl@0
   568
sl@0
   569
sl@0
   570
TInt DSimDbController::MaxTransferSize(TDmaChannel& /*aChannel*/, TUint /*aFlags*/, TUint32 /*aPslInfo*/)
sl@0
   571
	{
sl@0
   572
	return KMaxTransferSize;
sl@0
   573
	}
sl@0
   574
sl@0
   575
sl@0
   576
TUint DSimDbController::MemAlignMask(TDmaChannel& /*aChannel*/, TUint /*aFlags*/, TUint32 /*aPslInfo*/)
sl@0
   577
	{
sl@0
   578
	return KMemAlignMask;
sl@0
   579
	}
sl@0
   580
sl@0
   581
sl@0
   582
void DSimDbController::Isr()
sl@0
   583
	{
sl@0
   584
	for (TInt i = 0; i < KChannelCount; i++)
sl@0
   585
		{
sl@0
   586
		TUint32 mask = (1 << i);
sl@0
   587
		if (DmacDb::CompletionInt & mask)
sl@0
   588
			{
sl@0
   589
			DmacDb::CompletionInt &= ~mask;
sl@0
   590
			HandleIsr(DbController.iChannels[i], ETrue);
sl@0
   591
			}
sl@0
   592
		if (DmacDb::ErrorInt & mask)
sl@0
   593
			{
sl@0
   594
			DmacDb::ErrorInt &= ~mask;
sl@0
   595
			HandleIsr(DbController.iChannels[i], EFalse);
sl@0
   596
			}
sl@0
   597
		}
sl@0
   598
	}
sl@0
   599
sl@0
   600
//////////////////////////////////////////////////////////////////////////////
sl@0
   601
sl@0
   602
class DSimSgController : public TDmac
sl@0
   603
	{
sl@0
   604
public:
sl@0
   605
	DSimSgController();
sl@0
   606
private:
sl@0
   607
	static void Isr();
sl@0
   608
	// from TDmac
sl@0
   609
	virtual void Transfer(const TDmaChannel& aChannel, const SDmaDesHdr& aHdr);
sl@0
   610
	virtual void StopTransfer(const TDmaChannel& aChannel);
sl@0
   611
	virtual TBool IsIdle(const TDmaChannel& aChannel);
sl@0
   612
	virtual TInt MaxTransferSize(TDmaChannel& aChannel, TUint aFlags, TUint32 aPslInfo);
sl@0
   613
	virtual TUint MemAlignMask(TDmaChannel& aChannel, TUint aFlags, TUint32 aPslInfo);
sl@0
   614
	virtual void InitHwDes(const SDmaDesHdr& aHdr, TUint32 aSrc, TUint32 aDest, TInt aCount,
sl@0
   615
						   TUint aFlags, TUint32 aPslInfo, TUint32 aCookie);
sl@0
   616
	virtual void ChainHwDes(const SDmaDesHdr& aHdr, const SDmaDesHdr& aNextHdr);
sl@0
   617
	virtual void AppendHwDes(const TDmaChannel& aChannel, const SDmaDesHdr& aLastHdr,
sl@0
   618
							 const SDmaDesHdr& aNewHdr);
sl@0
   619
	virtual void UnlinkHwDes(const TDmaChannel& aChannel, SDmaDesHdr& aHdr);
sl@0
   620
	virtual TInt FailNext(const TDmaChannel& aChannel);
sl@0
   621
	virtual TInt MissNextInterrupts(const TDmaChannel& aChannel, TInt aInterruptCount);
sl@0
   622
private:
sl@0
   623
	inline DmacSg::SDes* HdrToHwDes(const SDmaDesHdr& aHdr);
sl@0
   624
public:
sl@0
   625
	static const SCreateInfo KInfo;
sl@0
   626
	TDmaSgChannel iChannels[KChannelCount];
sl@0
   627
	};
sl@0
   628
sl@0
   629
DSimSgController SgController;
sl@0
   630
sl@0
   631
const TDmac::SCreateInfo DSimSgController::KInfo =
sl@0
   632
	{
sl@0
   633
	KChannelCount,
sl@0
   634
	KDesCount,
sl@0
   635
	KCapsBitHwDes,
sl@0
   636
	sizeof(DmacSg::SDes),
sl@0
   637
#ifdef __WINS__
sl@0
   638
	0,
sl@0
   639
#else
sl@0
   640
	EMapAttrSupRw|EMapAttrFullyBlocking,
sl@0
   641
#endif
sl@0
   642
	};
sl@0
   643
sl@0
   644
sl@0
   645
inline DmacSg::SDes* DSimSgController::HdrToHwDes(const SDmaDesHdr& aHdr)
sl@0
   646
	{
sl@0
   647
	return static_cast<DmacSg::SDes*>(TDmac::HdrToHwDes(aHdr));
sl@0
   648
	}
sl@0
   649
sl@0
   650
sl@0
   651
DSimSgController::DSimSgController()
sl@0
   652
	: TDmac(KInfo)
sl@0
   653
	{
sl@0
   654
	DmacSg::Isr = Isr;
sl@0
   655
	}
sl@0
   656
sl@0
   657
sl@0
   658
void DSimSgController::Transfer(const TDmaChannel& aChannel, const SDmaDesHdr& aHdr)
sl@0
   659
	{
sl@0
   660
	TUint32 i = aChannel.PslId();
sl@0
   661
	DmacSg::NextDes[i] = HdrToHwDes(aHdr);
sl@0
   662
	DmacSg::Enable(i);
sl@0
   663
	}
sl@0
   664
sl@0
   665
sl@0
   666
void DSimSgController::StopTransfer(const TDmaChannel& aChannel)
sl@0
   667
	{
sl@0
   668
	__e32_atomic_and_ord32(&DmacSg::ChannelControl[aChannel.PslId()], (TUint32)~DmacSg::EChannelBitRun);
sl@0
   669
	}
sl@0
   670
sl@0
   671
sl@0
   672
void DSimSgController::InitHwDes(const SDmaDesHdr& aHdr, TUint32 aSrc, TUint32 aDest, TInt aCount,
sl@0
   673
								 TUint /*aFlags*/, TUint32 /*aPslInfo*/, TUint32 /*aCookie*/)
sl@0
   674
	{
sl@0
   675
	DmacSg::SDes& des = *HdrToHwDes(aHdr);
sl@0
   676
	des.iSrcAddr = reinterpret_cast<TUint8*>(aSrc);
sl@0
   677
	des.iDestAddr = reinterpret_cast<TUint8*>(aDest);
sl@0
   678
	des.iCount = static_cast<TInt16>(aCount);
sl@0
   679
	des.iControl |= DmacSg::EDesBitInt;
sl@0
   680
	des.iNext = NULL;
sl@0
   681
	}
sl@0
   682
sl@0
   683
sl@0
   684
void DSimSgController::ChainHwDes(const SDmaDesHdr& aHdr, const SDmaDesHdr& aNextHdr)
sl@0
   685
	{
sl@0
   686
	DmacSg::SDes& des = *HdrToHwDes(aHdr);
sl@0
   687
	des.iControl &= ~DmacSg::EDesBitInt;
sl@0
   688
	des.iNext = HdrToHwDes(aNextHdr);
sl@0
   689
	}
sl@0
   690
sl@0
   691
sl@0
   692
void DSimSgController::AppendHwDes(const TDmaChannel& aChannel, const SDmaDesHdr& aLastHdr,
sl@0
   693
								   const SDmaDesHdr& aNewHdr)
sl@0
   694
	{
sl@0
   695
	TUint32 i = aChannel.PslId();
sl@0
   696
	DmacSg::SDes* pNewDes = HdrToHwDes(aNewHdr);
sl@0
   697
	TInt prevLevel = NKern::DisableAllInterrupts();
sl@0
   698
sl@0
   699
	if ((DmacSg::ChannelControl[i] & DmacSg::EChannelBitRun) == 0)
sl@0
   700
		{
sl@0
   701
		DmacSg::NextDes[i] = pNewDes;
sl@0
   702
		DmacSg::Enable(i);
sl@0
   703
		}
sl@0
   704
	else if (DmacSg::NextDes[i] == NULL)
sl@0
   705
		DmacSg::NextDes[i] = pNewDes;
sl@0
   706
	else
sl@0
   707
		HdrToHwDes(aLastHdr)->iNext = pNewDes;
sl@0
   708
sl@0
   709
	NKern::RestoreInterrupts(prevLevel);
sl@0
   710
	}
sl@0
   711
sl@0
   712
sl@0
   713
void DSimSgController::UnlinkHwDes(const TDmaChannel& /*aChannel*/, SDmaDesHdr& aHdr)
sl@0
   714
	{
sl@0
   715
  	DmacSg::SDes* pD = HdrToHwDes(aHdr);
sl@0
   716
	pD->iNext = NULL;
sl@0
   717
	pD->iControl |= DmacSg::EDesBitInt;
sl@0
   718
	}
sl@0
   719
sl@0
   720
sl@0
   721
TInt DSimSgController::FailNext(const TDmaChannel& aChannel)
sl@0
   722
	{
sl@0
   723
	__DMA_ASSERTD((DmacSg::ChannelControl[aChannel.PslId()] & DmacSg::EChannelBitRun) == 0);
sl@0
   724
	DmacSg::FailCount[aChannel.PslId()] = 1;
sl@0
   725
	return KErrNone;
sl@0
   726
	}
sl@0
   727
sl@0
   728
sl@0
   729
TInt DSimSgController::MissNextInterrupts(const TDmaChannel& aChannel, TInt aInterruptCount)
sl@0
   730
	{
sl@0
   731
	__DMA_ASSERTD((DmacSg::ChannelControl[aChannel.PslId()] & DmacSg::EChannelBitRun) == 0);
sl@0
   732
	__DMA_ASSERTD(aInterruptCount >= 0);
sl@0
   733
	DmacSg::InterruptsToMiss[aChannel.PslId()] = aInterruptCount;
sl@0
   734
	return KErrNone;
sl@0
   735
	}
sl@0
   736
sl@0
   737
sl@0
   738
TBool DSimSgController::IsIdle(const TDmaChannel& aChannel)
sl@0
   739
	{
sl@0
   740
	return (DmacSg::ChannelControl[aChannel.PslId()] & DmacSg::EChannelBitRun) == 0;
sl@0
   741
	}
sl@0
   742
sl@0
   743
sl@0
   744
TInt DSimSgController::MaxTransferSize(TDmaChannel& /*aChannel*/, TUint /*aFlags*/, TUint32 /*aPslInfo*/)
sl@0
   745
	{
sl@0
   746
	return KMaxTransferSize;
sl@0
   747
	}
sl@0
   748
sl@0
   749
sl@0
   750
TUint DSimSgController::MemAlignMask(TDmaChannel& /*aChannel*/, TUint /*aFlags*/, TUint32 /*aPslInfo*/)
sl@0
   751
	{
sl@0
   752
	return KMemAlignMask;
sl@0
   753
	}
sl@0
   754
sl@0
   755
sl@0
   756
void DSimSgController::Isr()
sl@0
   757
	{
sl@0
   758
	for (TInt i = 0; i < KChannelCount; i++)
sl@0
   759
		{
sl@0
   760
		TUint32 mask = (1 << i);
sl@0
   761
		if (DmacSg::CompletionInt & mask)
sl@0
   762
			{
sl@0
   763
			DmacSg::CompletionInt &= ~mask;
sl@0
   764
			HandleIsr(SgController.iChannels[i], ETrue);
sl@0
   765
			}
sl@0
   766
		if (DmacSg::ErrorInt & mask)
sl@0
   767
			{
sl@0
   768
			DmacSg::ErrorInt &= ~mask;
sl@0
   769
			HandleIsr(SgController.iChannels[i], EFalse);
sl@0
   770
			}
sl@0
   771
		}
sl@0
   772
	}
sl@0
   773
sl@0
   774
sl@0
   775
//////////////////////////////////////////////////////////////////////////////
sl@0
   776
// Channel opening/closing
sl@0
   777
sl@0
   778
enum TController { ESb=0, EDb=1, ESg=2 };
sl@0
   779
sl@0
   780
const TUint32 KControllerMask = 0x30;
sl@0
   781
const TUint32 KControllerShift = 4;
sl@0
   782
const TUint32 KChannelIdxMask = 3;
sl@0
   783
sl@0
   784
#define MKCHN(type, idx) (((type)<<KControllerShift)|idx)
sl@0
   785
sl@0
   786
static TUint32 TestSbChannels[] = { MKCHN(ESb,0), MKCHN(ESb,1), MKCHN(ESb,2), MKCHN(ESb,3) };
sl@0
   787
static TUint32 TestDbChannels[] = { MKCHN(EDb,0), MKCHN(EDb,1), MKCHN(EDb,2), MKCHN(EDb,3) };
sl@0
   788
static TUint32 TestSgChannels[] = { MKCHN(ESg,0), MKCHN(ESg,1), MKCHN(ESg,2), MKCHN(ESg,3) };
sl@0
   789
sl@0
   790
static TDmaTestInfo TestInfo =
sl@0
   791
	{
sl@0
   792
	KMaxTransferSize,
sl@0
   793
	KMemAlignMask,
sl@0
   794
	0,
sl@0
   795
	KChannelCount,
sl@0
   796
	TestSbChannels,
sl@0
   797
	KChannelCount,
sl@0
   798
	TestDbChannels,
sl@0
   799
	KChannelCount,
sl@0
   800
	TestSgChannels,
sl@0
   801
	};
sl@0
   802
sl@0
   803
EXPORT_C const TDmaTestInfo& DmaTestInfo()
sl@0
   804
	{
sl@0
   805
	return TestInfo;
sl@0
   806
	}
sl@0
   807
sl@0
   808
// Keep track of opened channels so Tick callback used to fake DMA
sl@0
   809
// transfers is enabled only when necessary.
sl@0
   810
static TInt OpenChannelCount = 0;
sl@0
   811
sl@0
   812
sl@0
   813
TDmaChannel* DmaChannelMgr::Open(TUint32 aOpenId)
sl@0
   814
	{
sl@0
   815
	TInt dmac = (aOpenId & KControllerMask) >> KControllerShift;
sl@0
   816
	__DMA_ASSERTD(dmac < 3);
sl@0
   817
	TInt i = aOpenId & KChannelIdxMask;
sl@0
   818
	TDmaChannel* pC = NULL;
sl@0
   819
	TDmac* controller = NULL;
sl@0
   820
	switch (dmac)
sl@0
   821
		{
sl@0
   822
	case ESb:
sl@0
   823
		pC = SbController.iChannels + i;
sl@0
   824
		controller = &SbController;
sl@0
   825
		break;
sl@0
   826
	case EDb:
sl@0
   827
		pC = DbController.iChannels + i;
sl@0
   828
		controller = &DbController;
sl@0
   829
		break;
sl@0
   830
	case ESg:
sl@0
   831
		pC = SgController.iChannels + i;
sl@0
   832
		controller = &SgController;
sl@0
   833
		break;
sl@0
   834
	default:
sl@0
   835
		__DMA_CANT_HAPPEN();
sl@0
   836
		}
sl@0
   837
sl@0
   838
	if (++OpenChannelCount == 1)
sl@0
   839
		{
sl@0
   840
		__KTRACE_OPT(KDMA, Kern::Printf("Enabling DMA simulation"));
sl@0
   841
		DmacSim::StartEmulation();
sl@0
   842
		}
sl@0
   843
	if (pC->IsOpened())
sl@0
   844
		return NULL;
sl@0
   845
	pC->iController = controller;
sl@0
   846
	pC->iPslId = i;
sl@0
   847
	return pC;
sl@0
   848
	}
sl@0
   849
sl@0
   850
sl@0
   851
void DmaChannelMgr::Close(TDmaChannel* /*aChannel*/)
sl@0
   852
	{
sl@0
   853
	if (--OpenChannelCount == 0)
sl@0
   854
		{
sl@0
   855
		DmacSim::StopEmulation();
sl@0
   856
		__KTRACE_OPT(KDMA, Kern::Printf("Stopping DMA simulation"));
sl@0
   857
		}
sl@0
   858
	}
sl@0
   859
sl@0
   860
TInt DmaChannelMgr::StaticExtension(TInt /*aCmd*/, TAny* /*aArg*/)
sl@0
   861
	{
sl@0
   862
	return KErrNotSupported;
sl@0
   863
	}
sl@0
   864
sl@0
   865
//////////////////////////////////////////////////////////////////////////////
sl@0
   866
sl@0
   867
//
sl@0
   868
// On hardware, this code is inside a kernel extension.
sl@0
   869
//
sl@0
   870
sl@0
   871
DECLARE_STANDARD_EXTENSION()
sl@0
   872
	{
sl@0
   873
	__KTRACE_OPT(KDMA, Kern::Printf("Starting DMA simulator..."));
sl@0
   874
	TInt r;
sl@0
   875
	r = SbController.Create(DSimSbController::KInfo);
sl@0
   876
	if (r != KErrNone)
sl@0
   877
		return r;
sl@0
   878
	r = DbController.Create(DSimDbController::KInfo);
sl@0
   879
	if (r != KErrNone)
sl@0
   880
		return r;
sl@0
   881
	r = SgController.Create(DSimSgController::KInfo);
sl@0
   882
	if (r != KErrNone)
sl@0
   883
		return r;
sl@0
   884
sl@0
   885
	return KErrNone;
sl@0
   886
	}
sl@0
   887
sl@0
   888
//
sl@0
   889
// On WINS, this code is inside a LDD (see mmp file) so we need some
sl@0
   890
// bootstrapping code to call the kernel extension entry point.
sl@0
   891
//
sl@0
   892
sl@0
   893
class DDummyLdd : public DLogicalDevice
sl@0
   894
	{
sl@0
   895
public:
sl@0
   896
	// from DLogicalDevice
sl@0
   897
	TInt Install();
sl@0
   898
	void GetCaps(TDes8& aDes) const;
sl@0
   899
	TInt Create(DLogicalChannelBase*& aChannel);
sl@0
   900
	};
sl@0
   901
sl@0
   902
TInt DDummyLdd::Create(DLogicalChannelBase*& aChannel)
sl@0
   903
    {
sl@0
   904
	aChannel=NULL;
sl@0
   905
	return KErrNone;
sl@0
   906
    }
sl@0
   907
sl@0
   908
TInt DDummyLdd::Install()
sl@0
   909
    {
sl@0
   910
	_LIT(KLddName, "DmaSim");
sl@0
   911
    TInt r = SetName(&KLddName);
sl@0
   912
	if (r == KErrNone)
sl@0
   913
		r = InitExtension();
sl@0
   914
	return r;
sl@0
   915
    }
sl@0
   916
sl@0
   917
void DDummyLdd::GetCaps(TDes8& /*aDes*/) const
sl@0
   918
    {
sl@0
   919
    }
sl@0
   920
sl@0
   921
EXPORT_C DLogicalDevice* CreateLogicalDevice()
sl@0
   922
	{
sl@0
   923
    return new DDummyLdd;
sl@0
   924
	}
sl@0
   925
sl@0
   926
sl@0
   927
//---