riot-ci/RIOT
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Merge pull request #15494 from gdiribarne/bugfix/sfr04-avr-overflow

Browse Source 
drivers/srf04: fix overflow on AVR
This commit is contained in:
Francisco 2020-11-26 11:14:15 +01:00 committed by GitHub
commit 14877443f7
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
3 changed files with 19 additions and 14 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
drivers/include/srf04.h
View File

@ -54,7 +54,7 @@ typedef struct {
*/ */
typedef struct { typedef struct {
srf04_params_t p; /**< GPIO Ports of device */ srf04_params_t p; /**< GPIO Ports of device */
int distance; /**< raw time of flight distance */ int32_t distance; /**< raw time of flight distance */
uint32_t time; /**< timestamp of trigger or echo */ uint32_t time; /**< timestamp of trigger or echo */
} srf04_t; } srf04_t;

12
drivers/srf04/srf04.c
View File

@ -32,10 +32,12 @@ static void _cb(void *arg)
uint32_t t = xtimer_now_usec(); uint32_t t = xtimer_now_usec();
srf04_t *dev = (srf04_t *)arg; srf04_t *dev = (srf04_t *)arg;
if (dev->distance > SRF04_ERR_MEASURING) { if (dev->distance > SRF04_ERR_MEASURING) {
dev->distance = SRF04_ERR_MEASURING; dev->distance = SRF04_ERR_MEASURING;
dev->time = t; dev->time = t;
} else { }
else {
gpio_irq_disable(dev->p.echo); gpio_irq_disable(dev->p.echo);
dev->distance = (t - dev->time); dev->distance = (t - dev->time);
} }
@ -83,11 +85,13 @@ int srf04_read(const srf04_t* dev)
int srf04_get_distance(const srf04_t *dev) int srf04_get_distance(const srf04_t *dev)
{ {
/* trigger new reading */ /* Trigger new reading */
srf04_trigger(dev); srf04_trigger(dev);
/* give the sensor the required time for sampling */
/* Give the sensor the required time for sampling */
xtimer_usleep(SRF04_SAMPLE_PERIOD); xtimer_usleep(SRF04_SAMPLE_PERIOD);
/* get the result */
/* Get the result */
if (dev->distance >= SRF04_OK) { if (dev->distance >= SRF04_OK) {
return ((dev->distance * 100) / SRF04_DISTANCE); return ((dev->distance * 100) / SRF04_DISTANCE);
} }

3
tests/driver_srf04/main.c
View File

@ -39,7 +39,8 @@ int main(void)
int distance = srf04_get_distance(&dev); int distance = srf04_get_distance(&dev);
if (distance < SRF04_OK) { if (distance < SRF04_OK) {
puts("Error: no valid data available"); puts("Error: no valid data available");
} else { }
else {
printf("D: %d mm\n", distance); printf("D: %d mm\n", distance);
} }
} }