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
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
|
#include <stdlib.h>
#include <stdint.h>
#include "encoding.h"
#include "platform.h"
#include "eos.h"
#include "msgq.h"
#include "event.h"
#include "board.h"
#include "soc/interrupt.h"
#include "soc/spi.h"
#include "soc/spi_priv.h"
#include "net.h"
#include "egpio.h"
#include "spi.h"
#include "spi_cfg.h"
#ifdef EOS_DEBUG
#include <stdio.h>
#endif
static unsigned char spi_dstack[EOS_SPI_MAX_DSTACK];
static unsigned char spi_dstack_len;
static uint16_t spi_div[EOS_SPI_MAX_DEV];
static uint8_t spi_dev(void) {
return spi_dstack_len ? spi_dstack[spi_dstack_len - 1] : EOS_SPI_DEV_NET;
}
static void spi_stop(unsigned char dev) {
if (dev == EOS_SPI_DEV_NET) {
eos_net_stop();
} else if (spi_cfg[dev].flags & SPI_DEV_FLAG_9BIT) {
eos_spi_enable();
} else {
eos_spi_stop();
}
}
static void spi_start(unsigned char dev) {
if (dev == EOS_SPI_DEV_NET) {
eos_net_start();
} else if (spi_cfg[dev].flags & SPI_DEV_FLAG_9BIT) {
eos_spi_configure(spi_div[dev], spi_cfg[dev].csid, spi_cfg[dev].cspin, spi_cfg[dev].evt);
eos_spi_disable();
} else {
eos_spi_start(spi_div[dev], spi_cfg[dev].csid, spi_cfg[dev].cspin, spi_cfg[dev].evt);
}
}
int eos_spi_dev_init(void) {
int i;
for (i=0; i<EOS_SPI_MAX_DEV; i++) {
spi_div[i] = spi_cfg[i].div;
}
for (i=0; i<EOS_SPI_MAX_DSTACK; i++) {
spi_dstack[i] = 0xff;
}
return EOS_OK;
}
int eos_spi_select(unsigned char dev) {
int rv;
int dsel;
if (eos_spi_cs_get()) rv = EOS_ERR_BUSY;
if (!rv && (spi_dstack_len == EOS_SPI_MAX_DSTACK)) rv = EOS_ERR_FULL;
if (rv) {
#ifdef EOS_DEBUG
printf("SPI SELECT DEV:%d ERR:%d\n", dev, rv);
#endif
return rv;
}
dsel = 1;
if (spi_dev() == dev) {
dev |= EOS_SPI_DEV_FLAG_NDSEL;
dsel = 0;
}
if (dsel) spi_stop(spi_dev());
spi_dstack[spi_dstack_len] = dev;
spi_dstack_len++;
if (dsel) spi_start(dev);
return EOS_OK;
}
void eos_spi_deselect(void) {
int rv;
int dsel;
if (eos_spi_cs_get()) rv = EOS_ERR_BUSY;
if (!rv && (spi_dstack_len == 0)) rv = EOS_ERR_EMPTY;
if (rv) {
#ifdef EOS_DEBUG
printf("SPI DESELECT ERR:%d\n", rv);
#endif
return;
}
dsel = !(spi_dev() & EOS_SPI_DEV_FLAG_NDSEL);
if (dsel) spi_stop(spi_dev());
spi_dstack_len--;
spi_dstack[spi_dstack_len] = 0xff;
if (dsel) spi_start(spi_dev());
}
void eos_spi_dev_configure(unsigned char dev) {
eos_spi_configure(spi_div[dev], spi_cfg[dev].csid, spi_cfg[dev].cspin, spi_cfg[dev].evt);
}
uint8_t eos_spi_dev(void) {
return spi_dev();
}
uint16_t eos_spi_div(unsigned char dev) {
return spi_div[dev];
}
uint8_t eos_spi_csid(unsigned char dev) {
return spi_cfg[dev].csid;
}
uint8_t eos_spi_cspin(unsigned char dev) {
return spi_cfg[dev].cspin;
}
void eos_spi_set_div(unsigned char dev, uint16_t div) {
spi_div[dev] = div;
}
|
