use spaces
This commit is contained in:
@ -63,64 +63,64 @@ const uint8_t MDR1_F_CY = 0b10000000;
|
||||
volatile uint32_t ec = 0;
|
||||
|
||||
void isr() {
|
||||
ec++;
|
||||
ec++;
|
||||
}
|
||||
|
||||
void writeCmd(uint8_t c) {
|
||||
uint8_t buf[1];
|
||||
buf[0] = c;
|
||||
wiringPiSPIDataRW(SPI_CHAN, buf, 1);
|
||||
uint8_t buf[1];
|
||||
buf[0] = c;
|
||||
wiringPiSPIDataRW(SPI_CHAN, buf, 1);
|
||||
}
|
||||
|
||||
void writeCmdData(uint8_t c, uint8_t d) {
|
||||
uint8_t buf[2];
|
||||
buf[0] = c;
|
||||
buf[1] = d;
|
||||
wiringPiSPIDataRW(SPI_CHAN, buf, 2);
|
||||
uint8_t buf[2];
|
||||
buf[0] = c;
|
||||
buf[1] = d;
|
||||
wiringPiSPIDataRW(SPI_CHAN, buf, 2);
|
||||
}
|
||||
|
||||
uint8_t read8(uint8_t c) {
|
||||
uint8_t buf[2];
|
||||
buf[0] = c;
|
||||
buf[0] = c;
|
||||
wiringPiSPIDataRW(SPI_CHAN, buf, 2);
|
||||
return buf[1];
|
||||
return buf[1];
|
||||
}
|
||||
|
||||
uint32_t read32(uint8_t c) {
|
||||
uint8_t buf[5];
|
||||
buf[0] = c;
|
||||
wiringPiSPIDataRW(SPI_CHAN, buf, 5);
|
||||
uint32_t r = ((uint32_t)buf[1] << 24) | ((uint32_t)buf[2] << 16) | ((uint32_t)buf[3] << 8) | ((uint32_t)buf[4]);
|
||||
return r;
|
||||
uint8_t buf[5];
|
||||
buf[0] = c;
|
||||
wiringPiSPIDataRW(SPI_CHAN, buf, 5);
|
||||
uint32_t r = ((uint32_t)buf[1] << 24) | ((uint32_t)buf[2] << 16) | ((uint32_t)buf[3] << 8) | ((uint32_t)buf[4]);
|
||||
return r;
|
||||
}
|
||||
|
||||
void init() {
|
||||
wiringPiSetupGpio();
|
||||
wiringPiSetupGpio();
|
||||
|
||||
wiringPiSPISetup(SPI_CHAN, SPI_SPEED);
|
||||
wiringPiSPISetup(SPI_CHAN, SPI_SPEED);
|
||||
|
||||
pinMode(CTRL_OUT, OUTPUT);
|
||||
digitalWrite(CTRL_OUT, 0);
|
||||
pinMode(CTRL_OUT, OUTPUT);
|
||||
digitalWrite(CTRL_OUT, 0);
|
||||
|
||||
pinMode(INTR_IN, INPUT);
|
||||
wiringPiISR(INTR_IN, INT_EDGE_FALLING, isr);
|
||||
pinMode(INTR_IN, INPUT);
|
||||
wiringPiISR(INTR_IN, INT_EDGE_FALLING, isr);
|
||||
}
|
||||
|
||||
void initCounter() {
|
||||
writeCmd(CMD_CLR | REG_STR);
|
||||
writeCmd(CMD_CLR | REG_CNTR);
|
||||
writeCmd(CMD_CLR | REG_STR);
|
||||
writeCmd(CMD_CLR | REG_CNTR);
|
||||
}
|
||||
|
||||
int main (void) {
|
||||
init();
|
||||
initCounter();
|
||||
init();
|
||||
initCounter();
|
||||
|
||||
while (1) {
|
||||
uint8_t str = read8(CMD_RD | REG_STR);
|
||||
uint32_t cntr = read32(CMD_RD | REG_CNTR);
|
||||
while (1) {
|
||||
uint8_t str = read8(CMD_RD | REG_STR);
|
||||
uint32_t cntr = read32(CMD_RD | REG_CNTR);
|
||||
|
||||
printf("%02x %d %d\n", str, ec, cntr);
|
||||
printf("%02x %d %d\n", str, ec, cntr);
|
||||
|
||||
sleep(1);
|
||||
}
|
||||
sleep(1);
|
||||
}
|
||||
}
|
||||
|
Reference in New Issue
Block a user