From 005aa22130a1e7e62beb0ddab0dc47642d69b317 Mon Sep 17 00:00:00 2001 From: Jérémy Dufour Date: Wed, 30 Apr 2008 01:35:23 +0200 Subject: * digital/io/src - cleanly remove unhandled bits (thanks to ni) ; --- digital/io/src/getsamples.c | 9 +-------- 1 file changed, 1 insertion(+), 8 deletions(-) (limited to 'digital') diff --git a/digital/io/src/getsamples.c b/digital/io/src/getsamples.c index 10dd0840..ead49ecc 100644 --- a/digital/io/src/getsamples.c +++ b/digital/io/src/getsamples.c @@ -37,19 +37,12 @@ struct getsamples_data_t getsamples_data_; void getsamples_start (int16_t approach_angle, uint8_t sample_bitfield) { - uint8_t count; /* Set parameters */ getsamples_data_.approach_angle = approach_angle; getsamples_data_.sample_bitfield = sample_bitfield; /* Remove unhandled traps */ - /* garbage */ - getsamples_data_.sample_bitfield &= ~_BV (garbage); - /* Trap upper than the trap_count */ - for (count = 7; count >= trap_count; count--) - { - getsamples_data_.sample_bitfield &= ~_BV (count); - } + getsamples_data_.sample_bitfield &= (_BV (trap_count) - 1) & ~_BV (garbage); /* Start the get samples FSM */ fsm_init (&getsamples_fsm); -- cgit v1.2.3