[avr] add macro ENABLED(x) and STATE_POWER_LOCK

This commit is contained in:
Bart Van Der Meerssche 2011-01-28 20:53:18 +01:00
parent 55ecdd3451
commit 13fad26051
4 changed files with 43 additions and 31 deletions

View File

@ -287,7 +287,7 @@ void ctrlCmdGet(uint8_t cmd)
ctrlWriteCharToTxBuffer(version.sw_minor); ctrlWriteCharToTxBuffer(version.sw_minor);
break; break;
case 'e': /* port enabled | disabled */ case 'e': /* sensor enabled | disabled */
ctrlReadCharFromRxBuffer(&i); ctrlReadCharFromRxBuffer(&i);
if (i < MAX_SENSORS) { if (i < MAX_SENSORS) {
@ -340,12 +340,11 @@ void ctrlCmdGet(uint8_t cmd)
cli(); cli();
tmp32 = sensor[i].counter; tmp32 = sensor[i].counter;
tmp32_bis = (i < 3) ? state[i].power : state[i].timestamp; tmp32_bis = (i < 3) ? state[i].power : state[i].timestamp;
state[i].flags &= ~(STATE_PULSE | STATE_POWER);
sei(); sei();
ctrlWriteLongToTxBuffer(tmp32); ctrlWriteLongToTxBuffer(tmp32);
ctrlWriteLongToTxBuffer(tmp32_bis); ctrlWriteLongToTxBuffer(tmp32_bis);
state[i].flags &= ~(STATE_PULSE | STATE_POWER);
} }
} }
break; break;
@ -375,7 +374,7 @@ void ctrlCmdSet(uint8_t cmd)
ctrlWriteCharToTxBuffer(version.sw_minor); ctrlWriteCharToTxBuffer(version.sw_minor);
break; break;
case 'e': /* port enabled | disabled */ case 'e': /* sensor enabled | disabled */
ctrlReadCharFromRxBuffer(&i); ctrlReadCharFromRxBuffer(&i);
if (i < MAX_SENSORS) { if (i < MAX_SENSORS) {

View File

@ -39,8 +39,14 @@
#define CYCLES_PER_US ((F_CPU+500000)/1000000) // cpu cycles per microsecond #define CYCLES_PER_US ((F_CPU+500000)/1000000) // cpu cycles per microsecond
#define DISABLE_PORT 0xff
#define MAX_SENSORS 6 #define MAX_SENSORS 6
#define ENABLE_ALL_SENSORS ((1 << MAX_SENSORS) - 1) #define ENABLE_ALL_SENSORS ((1 << MAX_SENSORS) - 1)
#define DISABLE_ALL_SENSORS 0x00 #define DISABLE_ALL_SENSORS 0x00
/* 0xff is the default sensor id for non-assigned ports and is disabled by default
a further check is done against the 'enabled' bitfield */
#define ENABLED(x) (x != 0xff) && (enabled & (1 << x))
#endif #endif

View File

@ -50,13 +50,14 @@ struct event_struct event;
uint8_t EEMEM EEPROM_enabled = DISABLE_ALL_SENSORS; uint8_t EEMEM EEPROM_enabled = DISABLE_ALL_SENSORS;
uint8_t enabled; uint8_t enabled;
uint8_t EEMEM EEPROM_phy_to_log[MAX_SENSORS] = {0, 1, 2, 3, 4, 5}; uint8_t EEMEM EEPROM_phy_to_log[MAX_SENSORS] =
{DISABLE_PORT, DISABLE_PORT, DISABLE_PORT, DISABLE_PORT, DISABLE_PORT, DISABLE_PORT};
uint8_t phy_to_log[MAX_SENSORS]; uint8_t phy_to_log[MAX_SENSORS];
struct sensor_struct EEMEM EEPROM_sensor[MAX_SENSORS]; struct sensor_struct EEMEM EEPROM_sensor[MAX_SENSORS];
struct sensor_struct sensor[MAX_SENSORS]; volatile struct sensor_struct sensor[MAX_SENSORS];
struct state_struct state[MAX_SENSORS]; volatile struct state_struct state[MAX_SENSORS];
uint8_t muxn = 0; uint8_t muxn = 0;
uint16_t timer = 0; uint16_t timer = 0;
@ -163,10 +164,10 @@ ISR(INT0_vect)
{ {
DBG_ISR_BEGIN(); DBG_ISR_BEGIN();
uint8_t muxn_l = phy_to_log[PORT_PULSE_1]; uint8_t sensor_id = phy_to_log[PORT_PULSE_1];
if (enabled & (1 << PORT_PULSE_1)) if (ENABLED(sensor_id))
register_pulse(&sensor[muxn_l], &state[muxn_l]); register_pulse(&sensor[sensor_id], &state[sensor_id]);
DBG_ISR_END(); DBG_ISR_END();
} }
@ -175,10 +176,10 @@ ISR(INT1_vect)
{ {
DBG_ISR_BEGIN(); DBG_ISR_BEGIN();
uint8_t muxn_l = phy_to_log[PORT_PULSE_2]; uint8_t sensor_id = phy_to_log[PORT_PULSE_2];
if (enabled & (1 << PORT_PULSE_2)) if (ENABLED(sensor_id))
register_pulse(&sensor[muxn_l], &state[muxn_l]); register_pulse(&sensor[sensor_id], &state[sensor_id]);
DBG_ISR_END(); DBG_ISR_END();
} }
@ -194,25 +195,30 @@ ISR(TIMER1_COMPA_vect)
{ {
DBG_ISR_BEGIN(); DBG_ISR_BEGIN();
if (enabled & (1 << muxn)) { uint8_t sensor_id = phy_to_log[muxn];
uint8_t muxn_l = phy_to_log[muxn];
MacU16X16to32(state[muxn_l].nano, sensor[muxn_l].meterconst, ADC); if (ENABLED(sensor_id)) {
/* clear the power calculation lock when starting a new 1sec cycle */
if (timer == 0)
state[sensor_id].flags &= ~STATE_POWER_LOCK;
if (state[muxn_l].nano > WATT) {
sensor[muxn_l].counter++;
state[muxn_l].flags |= STATE_PULSE; MacU16X16to32(state[sensor_id].nano, sensor[sensor_id].meterconst, ADC);
state[muxn_l].nano -= WATT;
state[muxn_l].pulse_count++; if (state[sensor_id].nano > WATT) {
sensor[sensor_id].counter++;
state[sensor_id].flags |= STATE_PULSE;
state[sensor_id].nano -= WATT;
state[sensor_id].pulse_count++;
} }
if ((timer == SECOND) && !(state[muxn_l].flags & STATE_POWER_CALC)) { if ((timer == SECOND) && !(state[sensor_id].flags & STATE_POWER_LOCK)) {
state[muxn_l].nano_start = state[muxn_l].nano_end; state[sensor_id].nano_start = state[sensor_id].nano_end;
state[muxn_l].nano_end = state[muxn_l].nano; state[sensor_id].nano_end = state[sensor_id].nano;
state[muxn_l].pulse_count_final = state[muxn_l].pulse_count; state[sensor_id].pulse_count_final = state[sensor_id].pulse_count;
state[muxn_l].pulse_count = 0; state[sensor_id].pulse_count = 0;
state[muxn_l].flags |= STATE_POWER_CALC; state[sensor_id].flags |= STATE_POWER_CALC | STATE_POWER_LOCK;
} }
} }

View File

@ -34,10 +34,11 @@ struct sensor_struct {
# define WATT 1000000000 # define WATT 1000000000
# define SECOND 665 // 666Hz - 1 # define SECOND 665 // 666Hz - 1
#define STATE_PULSE 1 #define STATE_PULSE 0x01
#define STATE_SKIP 2 #define STATE_SKIP 0x02
#define STATE_POWER_CALC 4 #define STATE_POWER_LOCK 0x04
#define STATE_POWER 8 #define STATE_POWER_CALC 0x08
#define STATE_POWER 0x10
struct state_struct { struct state_struct {
uint8_t flags; uint8_t flags;