f6a8e1df9d
M910 - tmc2130_init M911 - set holding currents M912 - set running currents M913 - print currents
108 lines
2.1 KiB
C++
Executable File
108 lines
2.1 KiB
C++
Executable File
#include "swspi.h"
|
|
|
|
|
|
#ifdef SWSPI_RPI
|
|
#include <bcm2835.h>
|
|
#define GPIO_INP(gpio) bcm2835_gpio_fsel(gpio, BCM2835_GPIO_FSEL_INPT)
|
|
#define GPIO_OUT(gpio) bcm2835_gpio_fsel(gpio, BCM2835_GPIO_FSEL_OUTP)
|
|
#define GPIO_SET(gpio) bcm2835_gpio_write(gpio, HIGH)
|
|
#define GPIO_CLR(gpio) bcm2835_gpio_write(gpio, LOW)
|
|
#define GPIO_GET(gpio) (bcm2835_gpio_lev(gpio) != LOW)
|
|
#define DELAY(delay) usleep(delay)
|
|
#endif //SWSPI_RPI
|
|
|
|
#ifdef SWSPI_AVR
|
|
#include "Arduino.h"
|
|
#define GPIO_INP(gpio) pinMode(gpio, INPUT)
|
|
#define GPIO_OUT(gpio) pinMode(gpio, OUTPUT)
|
|
#define GPIO_SET(gpio) digitalWrite(gpio, HIGH)
|
|
#define GPIO_CLR(gpio) digitalWrite(gpio, LOW)
|
|
#define GPIO_GET(gpio) (digitalRead(gpio) != LOW)
|
|
#define DELAY(delay) delayMicroseconds(delay)
|
|
#endif //SWSPI_AVR
|
|
|
|
#if (SWSPI_POL != 0)
|
|
#define SWSPI_SCK_UP GPIO_CLR(SWSPI_SCK)
|
|
#define SWSPI_SCK_DN GPIO_SET(SWSPI_SCK)
|
|
#else
|
|
#define SWSPI_SCK_UP GPIO_SET(SWSPI_SCK)
|
|
#define SWSPI_SCK_DN GPIO_CLR(SWSPI_SCK)
|
|
#endif
|
|
|
|
|
|
void swspi_init()
|
|
{
|
|
GPIO_INP(SWSPI_MISO);
|
|
GPIO_OUT(SWSPI_MOSI);
|
|
GPIO_OUT(SWSPI_SCK);
|
|
GPIO_OUT(SWSPI_CS);
|
|
GPIO_CLR(SWSPI_MOSI);
|
|
SWSPI_SCK_DN;
|
|
GPIO_SET(SWSPI_CS);
|
|
}
|
|
|
|
#if (SWSPI_MOSI == SWSPI_MISO)
|
|
|
|
void swspi_tx(unsigned char tx)
|
|
{
|
|
GPIO_OUT(SWSPI_MOSI);
|
|
unsigned char i = 0; for (; i < 8; i++)
|
|
{
|
|
if (tx & 0x80) GPIO_SET(SWSPI_MOSI);
|
|
else GPIO_CLR(SWSPI_MOSI);
|
|
DELAY(SWSPI_DEL);
|
|
SWSPI_SCK_UP;
|
|
DELAY(SWSPI_DEL);
|
|
SWSPI_SCK_DN;
|
|
tx <<= 1;
|
|
}
|
|
}
|
|
|
|
unsigned char swspi_rx()
|
|
{
|
|
GPIO_INP(SWSPI_MISO);
|
|
unsigned char rx = 0;
|
|
unsigned char i = 0; for (; i < 8; i++)
|
|
{
|
|
rx <<= 1;
|
|
DELAY(SWSPI_DEL);
|
|
SWSPI_SCK_UP;
|
|
DELAY(SWSPI_DEL);
|
|
rx |= GPIO_GET(SWSPI_MISO)?1:0;
|
|
SWSPI_SCK_DN;
|
|
}
|
|
return rx;
|
|
}
|
|
|
|
#else //(SWSPI_MOSI == SWSPI_MISO)
|
|
|
|
unsigned char swspi_txrx(unsigned char tx)
|
|
{
|
|
unsigned char rx = 0;
|
|
unsigned char i = 0; for (; i < 8; i++)
|
|
{
|
|
rx <<= 1;
|
|
if (tx & 0x80) GPIO_SET(SWSPI_MOSI);
|
|
else GPIO_CLR(SWSPI_MOSI);
|
|
DELAY(SWSPI_DEL);
|
|
SWSPI_SCK_UP;
|
|
DELAY(SWSPI_DEL);
|
|
rx |= GPIO_GET(SWSPI_MISO)?1:0;
|
|
SWSPI_SCK_DN;
|
|
tx <<= 1;
|
|
}
|
|
return rx;
|
|
}
|
|
|
|
#endif //(SWSPI_MOSI == SWSPI_MISO)
|
|
|
|
void swspi_start()
|
|
{
|
|
GPIO_CLR(SWSPI_CS);
|
|
}
|
|
|
|
void swspi_stop()
|
|
{
|
|
GPIO_SET(SWSPI_CS);
|
|
}
|