epirawwrite.c
2.08 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
#include "osint.h"
#include "piint.h"
#include "rcp.h"
#include "assert.h"
/*
* Name: __osEPiRawWriteIo
*
* Description:
* Perform a 32-bit programmed IO write to the PI device address space.
* If the interface is busy, return a "-1" and abort the operation.
* Note that address must be 32-bit aligned.
*
*/
s32
__osEPiRawWriteIo(OSPiHandle *pihandle, u32 devAddr, u32 data)
{
register u32 stat;
register u32 domain;
#ifdef _DEBUG
/* Ensure that address is 32-bit aligned */
if (devAddr & 0x3) {
__osError(ERR_OSPIRAWWRITEIO, 1, devAddr);
return(-1);
}
#endif
stat = IO_READ(PI_STATUS_REG);
while (stat & (PI_STATUS_IO_BUSY | PI_STATUS_DMA_BUSY)) {
stat = IO_READ(PI_STATUS_REG);
}
/* Configuring the PI if needed */
domain = (u32)pihandle->domain;
if (__osCurrentHandle[domain]->type != pihandle->type) {
OSPiHandle *cHandle = __osCurrentHandle[domain];
if (domain == PI_DOMAIN1) {
if (cHandle->latency != pihandle->latency)
IO_WRITE(PI_BSD_DOM1_LAT_REG,pihandle->latency);
if (cHandle->pageSize != pihandle->pageSize)
IO_WRITE(PI_BSD_DOM1_PGS_REG,pihandle->pageSize);
if (cHandle->relDuration != pihandle->relDuration)
IO_WRITE(PI_BSD_DOM1_RLS_REG,
pihandle->relDuration);
if (cHandle->pulse != pihandle->pulse)
IO_WRITE(PI_BSD_DOM1_PWD_REG,pihandle->pulse);
} else {
if (cHandle->latency != pihandle->latency)
IO_WRITE(PI_BSD_DOM2_LAT_REG,pihandle->latency);
if (cHandle->pageSize != pihandle->pageSize)
IO_WRITE(PI_BSD_DOM2_PGS_REG,pihandle->pageSize);
if (cHandle->relDuration != pihandle->relDuration)
IO_WRITE(PI_BSD_DOM2_RLS_REG,
pihandle->relDuration);
if (cHandle->pulse != pihandle->pulse)
IO_WRITE(PI_BSD_DOM2_PWD_REG,pihandle->pulse);
}
cHandle->type = pihandle->type;
cHandle->latency = pihandle->latency;
cHandle->pageSize = pihandle->pageSize;
cHandle->relDuration = pihandle->relDuration;
cHandle->pulse = pihandle->pulse;
}
IO_WRITE((u32)pihandle->baseAddress | devAddr, data);
return(0);
} /* __osEPiRawWriteIo */