|
|
@ -26,11 +26,10 @@
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
/**
|
|
|
|
*
|
|
|
|
|
|
|
|
* For TARGET_LPC1768
|
|
|
|
* For TARGET_LPC1768
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
|
#include "src/inc/MarlinConfig.h"
|
|
|
|
#include "../../inc/MarlinConfig.h"
|
|
|
|
|
|
|
|
|
|
|
|
#ifdef TARGET_LPC1768
|
|
|
|
#ifdef TARGET_LPC1768
|
|
|
|
|
|
|
|
|
|
|
@ -49,68 +48,43 @@
|
|
|
|
* 6 - about 125 kHz peak
|
|
|
|
* 6 - about 125 kHz peak
|
|
|
|
*/
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
|
|
uint8_t swSpiTransfer(uint8_t b, uint8_t spi_speed, pin_t sck_pin, pin_t miso_pin, pin_t mosi_pin) {
|
|
|
|
uint8_t swSpiTransfer(uint8_t b, const uint8_t spi_speed, const pin_t sck_pin, const pin_t miso_pin, const pin_t mosi_pin) {
|
|
|
|
for (uint8_t i = 0; i < 8; i++) {
|
|
|
|
for (uint8_t i = 0; i < 8; i++) {
|
|
|
|
if (spi_speed == 0) {
|
|
|
|
if (spi_speed == 0) {
|
|
|
|
if (b & 0x80)
|
|
|
|
WRITE(mosi_pin, !!(b & 0x80));
|
|
|
|
WRITE(mosi_pin, HIGH);
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
WRITE(mosi_pin, LOW);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
WRITE(sck_pin, HIGH);
|
|
|
|
WRITE(sck_pin, HIGH);
|
|
|
|
|
|
|
|
|
|
|
|
b <<= 1;
|
|
|
|
b <<= 1;
|
|
|
|
|
|
|
|
if (miso_pin >= 0 && READ(miso_pin)) b |= 1;
|
|
|
|
if (miso_pin >= 0)
|
|
|
|
|
|
|
|
if (READ(miso_pin)) b |= 1;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
WRITE(sck_pin, LOW);
|
|
|
|
WRITE(sck_pin, LOW);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
else {
|
|
|
|
else {
|
|
|
|
if (b & 0x80)
|
|
|
|
const uint8_t state = (b & 0x80) ? HIGH : LOW;
|
|
|
|
for (uint8_t j = 0; j < spi_speed; j++)
|
|
|
|
for (uint8_t j = 0; j < spi_speed; j++)
|
|
|
|
WRITE(mosi_pin, HIGH);
|
|
|
|
WRITE(mosi_pin, state);
|
|
|
|
else
|
|
|
|
|
|
|
|
for (uint8_t j = 0; j < spi_speed; j++)
|
|
|
|
|
|
|
|
WRITE(mosi_pin, LOW);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
for (uint8_t j = 0; j < spi_speed + (miso_pin >= 0 ? 0 : 1); j++)
|
|
|
|
for (uint8_t j = 0; j < spi_speed + (miso_pin >= 0 ? 0 : 1); j++)
|
|
|
|
WRITE(sck_pin, HIGH);
|
|
|
|
WRITE(sck_pin, HIGH);
|
|
|
|
|
|
|
|
|
|
|
|
b <<= 1;
|
|
|
|
b <<= 1;
|
|
|
|
|
|
|
|
if (miso_pin >= 0 && READ(miso_pin)) b |= 1;
|
|
|
|
if (miso_pin >= 0)
|
|
|
|
|
|
|
|
if (READ(miso_pin)) b |= 1;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
for (uint8_t j = 0; j < spi_speed; j++)
|
|
|
|
for (uint8_t j = 0; j < spi_speed; j++)
|
|
|
|
WRITE(sck_pin, LOW);
|
|
|
|
WRITE(sck_pin, LOW);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
return b;
|
|
|
|
return b;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void swSpiBegin(pin_t sck_pin, pin_t miso_pin, pin_t mosi_pin) {
|
|
|
|
void swSpiBegin(const pin_t sck_pin, const pin_t miso_pin, const pin_t mosi_pin) {
|
|
|
|
SET_OUTPUT(sck_pin);
|
|
|
|
SET_OUTPUT(sck_pin);
|
|
|
|
if (VALID_PIN(miso_pin))
|
|
|
|
if (VALID_PIN(miso_pin)) SET_INPUT(miso_pin);
|
|
|
|
SET_INPUT(miso_pin);
|
|
|
|
|
|
|
|
SET_OUTPUT(mosi_pin);
|
|
|
|
SET_OUTPUT(mosi_pin);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
uint8_t swSpiInit(uint8_t spiRate, pin_t sck_pin, pin_t mosi_pin) {
|
|
|
|
uint8_t swSpiInit(const uint8_t spiRate, const pin_t sck_pin, const pin_t mosi_pin) {
|
|
|
|
uint8_t spi_speed = 0;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
spiRate = MIN(spiRate, 6);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (SystemCoreClock == 120000000)
|
|
|
|
|
|
|
|
spi_speed = 44 / POW(2, 6 - spiRate);
|
|
|
|
|
|
|
|
else
|
|
|
|
|
|
|
|
spi_speed = 38 / POW(2, 6 - spiRate);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
WRITE(mosi_pin, HIGH);
|
|
|
|
WRITE(mosi_pin, HIGH);
|
|
|
|
WRITE(sck_pin, LOW);
|
|
|
|
WRITE(sck_pin, LOW);
|
|
|
|
|
|
|
|
return (SystemCoreClock == 120000000 ? 44 : 38) / POW(2, 6 - min(spiRate, 6));
|
|
|
|
return spi_speed;
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
#endif // TARGET_LPC1768
|
|
|
|
#endif // TARGET_LPC1768
|
|
|
|