Scott Lahteine 6 år sedan
förälder
incheckning
9e394139e5
1 ändrade filer med 37 tillägg och 41 borttagningar
  1. 37
    41
      Marlin/src/HAL/HAL_LPC1768/HAL_spi.cpp

+ 37
- 41
Marlin/src/HAL/HAL_LPC1768/HAL_spi.cpp Visa fil

62
 
62
 
63
   #include "SoftwareSPI.h"
63
   #include "SoftwareSPI.h"
64
 
64
 
65
-  // --------------------------------------------------------------------------
66
   // Software SPI
65
   // Software SPI
67
-  // --------------------------------------------------------------------------
68
 
66
 
69
   static uint8_t SPI_speed = 0;
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
     return swSpiTransfer(b, SPI_speed, SCK_PIN, MISO_PIN, MOSI_PIN);
70
     return swSpiTransfer(b, SPI_speed, SCK_PIN, MISO_PIN, MOSI_PIN);
73
   }
71
   }
74
 
72
 
75
-  inline void spiBegin() {
73
+  void spiBegin() {
76
     swSpiBegin(SCK_PIN, MISO_PIN, MOSI_PIN);
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
     SPI_speed = swSpiInit(spiRate, SCK_PIN, MOSI_PIN);
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
     (void)spiTransfer(token);
98
     (void)spiTransfer(token);
104
     for (uint16_t i = 0; i < 512; i++)
99
     for (uint16_t i = 0; i < 512; i++)
105
       (void)spiTransfer(buf[i]);
100
       (void)spiTransfer(buf[i]);
107
 
102
 
108
 #else
103
 #else
109
 
104
 
110
-  // hardware SPI
105
+  // Hardware SPI
111
 
106
 
112
   #include <lpc17xx_pinsel.h>
107
   #include <lpc17xx_pinsel.h>
113
   #include <lpc17xx_ssp.h>
108
   #include <lpc17xx_ssp.h>
131
     #define LPC_SSPn LPC_SSP1
126
     #define LPC_SSPn LPC_SSP1
132
   #endif
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
     PINSEL_CFG_Type PinCfg;  // data structure to hold init values
130
     PINSEL_CFG_Type PinCfg;  // data structure to hold init values
136
     PinCfg.Funcnum = 2;
131
     PinCfg.Funcnum = 2;
137
     PinCfg.OpenDrain = 0;
132
     PinCfg.OpenDrain = 0;
156
     SSP_Cmd(LPC_SSPn, ENABLE);  // start SSP running
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
     // table to convert Marlin spiRates (0-5 plus default) into bit rates
155
     // table to convert Marlin spiRates (0-5 plus default) into bit rates
161
     uint32_t Marlin_speed[7]; // CPSR is always 2
156
     uint32_t Marlin_speed[7]; // CPSR is always 2
162
     Marlin_speed[0] = 8333333; //(SCR:  2)  desired: 8,000,000  actual: 8,333,333  +4.2%  SPI_FULL_SPEED
157
     Marlin_speed[0] = 8333333; //(SCR:  2)  desired: 8,000,000  actual: 8,333,333  +4.2%  SPI_FULL_SPEED
174
     SSP_Init(LPC_SSPn, &HW_SPI_init);  // puts the values into the proper bits in the SSP0 registers
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
     /* send and receive a single byte */
173
     /* send and receive a single byte */
179
     SSP_SendData(LPC_SSPn, b & 0x00FF);
174
     SSP_SendData(LPC_SSPn, b & 0x00FF);
180
     while (SSP_GetStatus(LPC_SSPn, SSP_STAT_BUSY));  // wait for it to finish
175
     while (SSP_GetStatus(LPC_SSPn, SSP_STAT_BUSY));  // wait for it to finish
181
     return SSP_ReceiveData(LPC_SSPn) & 0x00FF;
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
   // Read single byte from SPI
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
   // Read from SPI into buffer
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
   // Write from buffer to SPI
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
     for (uint16_t i = 0; i < 512; i++)
210
     for (uint16_t i = 0; i < 512; i++)
215
       (void)spiTransfer(buf[i]);
211
       (void)spiTransfer(buf[i]);
216
   }
212
   }
217
 
213
 
218
   /** Begin SPI transaction, set clock, bit order, data mode */
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
     // TODO: to be implemented
216
     // TODO: to be implemented
221
 
217
 
222
   }
218
   }
225
 
221
 
226
 void SPIClass::begin() { spiBegin(); }
222
 void SPIClass::begin() { spiBegin(); }
227
 
223
 
228
-void SPIClass::beginTransaction(const SPISettings cfg) {
224
+void SPIClass::beginTransaction(SPISettings cfg) {
229
   uint8_t spiRate;
225
   uint8_t spiRate;
230
   switch (cfg.spiRate()) {
226
   switch (cfg.spiRate()) {
231
     case 8000000: spiRate = 0 ;break;
227
     case 8000000: spiRate = 0 ;break;
243
 uint8_t SPIClass::transfer(const uint8_t B) { return spiTransfer(B); }
239
 uint8_t SPIClass::transfer(const uint8_t B) { return spiTransfer(B); }
244
 
240
 
245
 uint16_t SPIClass::transfer16(const uint16_t data) {
241
 uint16_t SPIClass::transfer16(const uint16_t data) {
246
-  return (transfer((data >> 8) & 0xFF) << 8);
242
+  return (transfer((data >> 8) & 0xFF) << 8)
247
        | (transfer(data & 0xFF) & 0xFF);
243
        | (transfer(data & 0xFF) & 0xFF);
248
 }
244
 }
249
 
245
 

Laddar…
Avbryt
Spara