From fd8ce8373abf81f5d6781b577a0f50906f2f4ff8 Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Fri, 27 May 2011 08:15:52 +0200 Subject: digital/io-hub: add offset to back bay too --- digital/io-hub/src/robospierre/clamp.c | 10 ++++++---- 1 file changed, 6 insertions(+), 4 deletions(-) (limited to 'digital/io-hub/src/robospierre/clamp.c') diff --git a/digital/io-hub/src/robospierre/clamp.c b/digital/io-hub/src/robospierre/clamp.c index 0c01e468..71cb2dfb 100644 --- a/digital/io-hub/src/robospierre/clamp.c +++ b/digital/io-hub/src/robospierre/clamp.c @@ -291,9 +291,11 @@ clamp_openclose (uint8_t open) pwm_set_timed (BOT_PWM_CLAMP, BOT_PWM_CLAMP_OPEN); else pwm_set_timed (BOT_PWM_CLAMP, BOT_PWM_CLAMP_CLOSE); - if (ctx.controled && CLAMP_IS_SLOT_IN_FRONT_BAY (ctx.pos_current)) + if (ctx.controled && (CLAMP_IS_SLOT_IN_FRONT_BAY (ctx.pos_current) + || CLAMP_IS_SLOT_IN_BACK_BAY (ctx.pos_current))) { - int16_t offset = open ? 0 : BOT_CLAMP_CLOSED_ROTATION_OFFSET; + int16_t offset = open ? 0 + : BOT_CLAMP_CLOSED_ROTATION_OFFSET (ctx.pos_current); mimot_move_motor1_absolute (clamp_pos[ctx.pos_current][1] + offset, BOT_CLAMP_ROTATION_OFFSET_SPEED); } @@ -361,8 +363,8 @@ clamp_route (void) /* Run motors. */ mimot_move_motor0_absolute (clamp_pos[pos_new][0], BOT_CLAMP_ELEVATION_SPEED); - int16_t offset = !ctx.open && CLAMP_IS_SLOT_IN_FRONT_BAY (pos_new) - ? BOT_CLAMP_CLOSED_ROTATION_OFFSET : 0; + int16_t offset = ctx.open ? 0 + : BOT_CLAMP_CLOSED_ROTATION_OFFSET (pos_new); mimot_move_motor1_absolute (clamp_pos[pos_new][1] + offset, BOT_CLAMP_ROTATION_SPEED); ctx.controled = 1; -- cgit v1.2.3