+ pwm_ng_set(SERVO_DOOR_PWM, SERVO_DOOR_CLOSED);
+}
+
+void servo_door_block(void)
+{
+ pwm_ng_set(SERVO_DOOR_PWM, SERVO_DOOR_BLOCK);
+}
+
+void cobroller_on(uint8_t side)
+{
+ if (side == I2C_LEFT_SIDE)
+ cobboard.left_cobroller_speed = COBROLLER_SPEED;
+ else
+ cobboard.right_cobroller_speed = -COBROLLER_SPEED;
+}
+
+void cobroller_off(uint8_t side)
+{
+ if (side == I2C_LEFT_SIDE)
+ cobboard.left_cobroller_speed = 0;
+ else
+ cobboard.right_cobroller_speed = 0;
+}
+
+void cobroller_reverse(uint8_t side)
+{
+ if (side == I2C_LEFT_SIDE)
+ cobboard.left_cobroller_speed = -COBROLLER_SPEED;
+ else
+ cobboard.right_cobroller_speed = COBROLLER_SPEED;