use spaces

This commit is contained in:
2019-10-04 13:28:56 +02:00
parent 7352065ace
commit a1b5070416

View File

@ -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);
}
}