mainscnt/mains-frequency-counter-rpi
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

use spaces

Browse Source
This commit is contained in:
Wolfgang Hottgenroth
2019-10-04 13:28:56 +02:00
parent 7352065ace
commit a1b5070416
1 changed files with 31 additions and 31 deletions
Download Patch File Download Diff File Expand all files Collapse all files

62
snippets/test1/test1.c
View File

@ -63,64 +63,64 @@ const uint8_t MDR1_F_CY = 0b10000000;
volatile uint32_t ec = 0; volatile uint32_t ec = 0;
void isr() { void isr() {
ec++; ec++;
} }
void writeCmd(uint8_t c) { void writeCmd(uint8_t c) {
uint8_t buf[1]; uint8_t buf[1];
buf[0] = c; buf[0] = c;
wiringPiSPIDataRW(SPI_CHAN, buf, 1); wiringPiSPIDataRW(SPI_CHAN, buf, 1);
} }
void writeCmdData(uint8_t c, uint8_t d) { void writeCmdData(uint8_t c, uint8_t d) {
uint8_t buf[2]; uint8_t buf[2];
buf[0] = c; buf[0] = c;
buf[1] = d; buf[1] = d;
wiringPiSPIDataRW(SPI_CHAN, buf, 2); wiringPiSPIDataRW(SPI_CHAN, buf, 2);
} }
uint8_t read8(uint8_t c) { uint8_t read8(uint8_t c) {
uint8_t buf[2]; uint8_t buf[2];
buf[0] = c; buf[0] = c;
wiringPiSPIDataRW(SPI_CHAN, buf, 2); wiringPiSPIDataRW(SPI_CHAN, buf, 2);
return buf[1]; return buf[1];
} }
uint32_t read32(uint8_t c) { uint32_t read32(uint8_t c) {
uint8_t buf[5]; uint8_t buf[5];
buf[0] = c; buf[0] = c;
wiringPiSPIDataRW(SPI_CHAN, buf, 5); 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]); uint32_t r = ((uint32_t)buf[1] << 24) | ((uint32_t)buf[2] << 16) | ((uint32_t)buf[3] << 8) | ((uint32_t)buf[4]);
return r; return r;
} }
void init() { void init() {
wiringPiSetupGpio(); wiringPiSetupGpio();
wiringPiSPISetup(SPI_CHAN, SPI_SPEED); wiringPiSPISetup(SPI_CHAN, SPI_SPEED);
pinMode(CTRL_OUT, OUTPUT); pinMode(CTRL_OUT, OUTPUT);
digitalWrite(CTRL_OUT, 0); digitalWrite(CTRL_OUT, 0);
pinMode(INTR_IN, INPUT); pinMode(INTR_IN, INPUT);
wiringPiISR(INTR_IN, INT_EDGE_FALLING, isr); wiringPiISR(INTR_IN, INT_EDGE_FALLING, isr);
} }
void initCounter() { void initCounter() {
writeCmd(CMD_CLR | REG_STR); writeCmd(CMD_CLR | REG_STR);
writeCmd(CMD_CLR | REG_CNTR); writeCmd(CMD_CLR | REG_CNTR);
} }
int main (void) { int main (void) {
init(); init();
initCounter(); initCounter();
while (1) { while (1) {
uint8_t str = read8(CMD_RD | REG_STR); uint8_t str = read8(CMD_RD | REG_STR);
uint32_t cntr = read32(CMD_RD | REG_CNTR); 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);
} }
} }