|
@@ -62,44 +62,39 @@
|
62
|
62
|
|
63
|
63
|
#include "SoftwareSPI.h"
|
64
|
64
|
|
65
|
|
- // --------------------------------------------------------------------------
|
66
|
65
|
// Software SPI
|
67
|
|
- // --------------------------------------------------------------------------
|
68
|
66
|
|
69
|
67
|
static uint8_t SPI_speed = 0;
|
70
|
68
|
|
71
|
|
- static inline uint8_t spiTransfer(const uint8_t b) {
|
|
69
|
+ static uint8_t spiTransfer(uint8_t b) {
|
72
|
70
|
return swSpiTransfer(b, SPI_speed, SCK_PIN, MISO_PIN, MOSI_PIN);
|
73
|
71
|
}
|
74
|
72
|
|
75
|
|
- inline void spiBegin() {
|
|
73
|
+ void spiBegin() {
|
76
|
74
|
swSpiBegin(SCK_PIN, MISO_PIN, MOSI_PIN);
|
77
|
75
|
}
|
78
|
76
|
|
79
|
|
- inline void spiInit(const uint8_t spiRate) {
|
|
77
|
+ void spiInit(uint8_t spiRate) {
|
80
|
78
|
SPI_speed = swSpiInit(spiRate, SCK_PIN, MOSI_PIN);
|
81
|
79
|
}
|
82
|
80
|
|
83
|
|
- inline uint8_t spiRec() { return spiTransfer(0xFF); }
|
|
81
|
+ uint8_t spiRec() { return spiTransfer(0xFF); }
|
84
|
82
|
|
85
|
|
- inline void spiRead(uint8_t * const buf, const uint16_t nbyte) {
|
86
|
|
- if (nbyte == 0) return;
|
87
|
|
- for (int i = 0; i < nbyte; i++)
|
88
|
|
- buf[i] = spiTransfer(0xFF);
|
|
83
|
+ void spiRead(uint8_t*buf, uint16_t nbyte) {
|
|
84
|
+ if (nbyte)
|
|
85
|
+ for (int i = 0; i < nbyte; i++)
|
|
86
|
+ buf[i] = spiTransfer(0xFF);
|
89
|
87
|
}
|
90
|
88
|
|
91
|
|
- inline void spiSend(const uint8_t b) {
|
92
|
|
- uint8_t response = spiTransfer(b);
|
93
|
|
- UNUSED(response);
|
94
|
|
- }
|
|
89
|
+ void spiSend(uint8_t b) { (void)spiTransfer(b); }
|
95
|
90
|
|
96
|
|
- inline void spiSend(const uint8_t* buf, const size_t n) {
|
97
|
|
- if (n == 0) return;
|
98
|
|
- for (uint16_t i = 0; i < n; i++)
|
99
|
|
- (void)spiTransfer(buf[i]);
|
|
91
|
+ void spiSend(const uint8_t* buf, size_t n) {
|
|
92
|
+ if (n)
|
|
93
|
+ for (uint16_t i = 0; i < n; i++)
|
|
94
|
+ (void)spiTransfer(buf[i]);
|
100
|
95
|
}
|
101
|
96
|
|
102
|
|
- inline void spiSendBlock(const uint8_t token, const uint8_t * const buf) {
|
|
97
|
+ void spiSendBlock(uint8_t token, const uint8_t* buf) {
|
103
|
98
|
(void)spiTransfer(token);
|
104
|
99
|
for (uint16_t i = 0; i < 512; i++)
|
105
|
100
|
(void)spiTransfer(buf[i]);
|
|
@@ -107,7 +102,7 @@
|
107
|
102
|
|
108
|
103
|
#else
|
109
|
104
|
|
110
|
|
- // hardware SPI
|
|
105
|
+ // Hardware SPI
|
111
|
106
|
|
112
|
107
|
#include <lpc17xx_pinsel.h>
|
113
|
108
|
#include <lpc17xx_ssp.h>
|
|
@@ -131,7 +126,7 @@
|
131
|
126
|
#define LPC_SSPn LPC_SSP1
|
132
|
127
|
#endif
|
133
|
128
|
|
134
|
|
- inline void spiBegin() { // setup SCK, MOSI & MISO pins for SSP0
|
|
129
|
+ void spiBegin() { // setup SCK, MOSI & MISO pins for SSP0
|
135
|
130
|
PINSEL_CFG_Type PinCfg; // data structure to hold init values
|
136
|
131
|
PinCfg.Funcnum = 2;
|
137
|
132
|
PinCfg.OpenDrain = 0;
|
|
@@ -156,7 +151,7 @@
|
156
|
151
|
SSP_Cmd(LPC_SSPn, ENABLE); // start SSP running
|
157
|
152
|
}
|
158
|
153
|
|
159
|
|
- inline void spiInit(const uint8_t spiRate) {
|
|
154
|
+ void spiInit(uint8_t spiRate) {
|
160
|
155
|
// table to convert Marlin spiRates (0-5 plus default) into bit rates
|
161
|
156
|
uint32_t Marlin_speed[7]; // CPSR is always 2
|
162
|
157
|
Marlin_speed[0] = 8333333; //(SCR: 2) desired: 8,000,000 actual: 8,333,333 +4.2% SPI_FULL_SPEED
|
|
@@ -174,49 +169,50 @@
|
174
|
169
|
SSP_Init(LPC_SSPn, &HW_SPI_init); // puts the values into the proper bits in the SSP0 registers
|
175
|
170
|
}
|
176
|
171
|
|
177
|
|
- static inline uint8_t doio(const uint8_t b) {
|
|
172
|
+ static uint8_t doio(uint8_t b) {
|
178
|
173
|
/* send and receive a single byte */
|
179
|
174
|
SSP_SendData(LPC_SSPn, b & 0x00FF);
|
180
|
175
|
while (SSP_GetStatus(LPC_SSPn, SSP_STAT_BUSY)); // wait for it to finish
|
181
|
176
|
return SSP_ReceiveData(LPC_SSPn) & 0x00FF;
|
182
|
177
|
}
|
183
|
178
|
|
184
|
|
- inline void spiSend(const uint8_t b) { doio(b); }
|
|
179
|
+ void spiSend(uint8_t b) { doio(b); }
|
185
|
180
|
|
186
|
|
- inline void spiSend(const uint8_t* buf, const size_t n) {
|
187
|
|
- if (n == 0) return;
|
188
|
|
- for (uint16_t i = 0; i < n; i++) doio(buf[i]);
|
|
181
|
+ void spiSend(const uint8_t* buf, size_t n) {
|
|
182
|
+ if (n)
|
|
183
|
+ for (uint16_t i = 0; i < n; i++) doio(buf[i]);
|
189
|
184
|
}
|
190
|
185
|
|
191
|
|
- inline void spiSend(const uint32_t chan, const byte b) {
|
|
186
|
+ void spiSend(uint32_t chan, byte b) {
|
192
|
187
|
}
|
193
|
188
|
|
194
|
|
- inline void spiSend(const uint32_t chan, const uint8_t * const buf, const size_t n) {
|
|
189
|
+ void spiSend(uint32_t chan, const uint8_t* buf, size_t n) {
|
195
|
190
|
}
|
196
|
191
|
|
197
|
192
|
// Read single byte from SPI
|
198
|
|
- inline uint8_t spiRec() { return doio(0xFF); }
|
|
193
|
+ uint8_t spiRec() { return doio(0xFF); }
|
199
|
194
|
|
200
|
|
- inline uint8_t spiRec(const uint32_t chan) { return 0; }
|
|
195
|
+ uint8_t spiRec(uint32_t chan) { return 0; }
|
201
|
196
|
|
202
|
197
|
// Read from SPI into buffer
|
203
|
|
- inline void spiRead(uint8_t * const buf, const uint16_t nbyte) {
|
204
|
|
- if (nbyte == 0) return;
|
205
|
|
- for (int i = 0; i < nbyte; i++)
|
206
|
|
- buf[i] = doio(0xFF);
|
|
198
|
+ void spiRead(uint8_t*buf, uint16_t nbyte) {
|
|
199
|
+ if (nbyte)
|
|
200
|
+ for (int i = 0; i < nbyte; i++) buf[i] = doio(0xff);
|
207
|
201
|
}
|
208
|
202
|
|
209
|
|
- static uint8_t spiTransfer(const uint8_t b) { return doio(b); }
|
|
203
|
+ static uint8_t spiTransfer(uint8_t b) {
|
|
204
|
+ return doio(b);
|
|
205
|
+ }
|
210
|
206
|
|
211
|
207
|
// Write from buffer to SPI
|
212
|
|
- inline void spiSendBlock(const uint8_t token, const uint8_t * const buf) {
|
213
|
|
- (void)spiTransfer(token);
|
|
208
|
+ void spiSendBlock(uint8_t token, const uint8_t* buf) {
|
|
209
|
+ (void)spiTransfer(token);
|
214
|
210
|
for (uint16_t i = 0; i < 512; i++)
|
215
|
211
|
(void)spiTransfer(buf[i]);
|
216
|
212
|
}
|
217
|
213
|
|
218
|
214
|
/** Begin SPI transaction, set clock, bit order, data mode */
|
219
|
|
- inline void spiBeginTransaction(const uint32_t spiClock, const uint8_t bitOrder, const uint8_t dataMode) {
|
|
215
|
+ void spiBeginTransaction(uint32_t spiClock, uint8_t bitOrder, uint8_t dataMode) {
|
220
|
216
|
// TODO: to be implemented
|
221
|
217
|
|
222
|
218
|
}
|
|
@@ -225,7 +221,7 @@
|
225
|
221
|
|
226
|
222
|
void SPIClass::begin() { spiBegin(); }
|
227
|
223
|
|
228
|
|
-void SPIClass::beginTransaction(const SPISettings cfg) {
|
|
224
|
+void SPIClass::beginTransaction(SPISettings cfg) {
|
229
|
225
|
uint8_t spiRate;
|
230
|
226
|
switch (cfg.spiRate()) {
|
231
|
227
|
case 8000000: spiRate = 0 ;break;
|
|
@@ -243,7 +239,7 @@ void SPIClass::beginTransaction(const SPISettings cfg) {
|
243
|
239
|
uint8_t SPIClass::transfer(const uint8_t B) { return spiTransfer(B); }
|
244
|
240
|
|
245
|
241
|
uint16_t SPIClass::transfer16(const uint16_t data) {
|
246
|
|
- return (transfer((data >> 8) & 0xFF) << 8);
|
|
242
|
+ return (transfer((data >> 8) & 0xFF) << 8)
|
247
|
243
|
| (transfer(data & 0xFF) & 0xFF);
|
248
|
244
|
}
|
249
|
245
|
|