Code from circuits/DispenserMicrocontroller/DispenserMicrocontroller.ino


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44

#include <Servo.h> 
// Note: servo.h library disables analogWrite on pins 9 and 10

#define INPUT_PIN A0
int potValue; // Potentiometer value, will be the input value from the main controller

Servo servos[5];
const int SERVO_PINS[] = {3, 5, 6, 9, 10};

int i; // variable for loops

void zeroOutServos() 
{
  for (i = 0; i < sizeof(servos)/sizeof(*servos); i++) // would've used range-based for loop, but its not supported on C++98
  { 
    servos[i].write(0);
  }
}

void setup() {
  pinMode(INPUT_PIN, INPUT);
  
  for(i = 0; i < sizeof(servos)/sizeof(*servos); i++) 
  {
    pinMode(SERVO_PINS[i], OUTPUT);
    servos[i].attach(SERVO_PINS[i]);
  }
  
  delay(1500);
  zeroOutServos();
}

void dispensePill(int servoIndex) 
{
  servos[servoIndex].write((servos[servoIndex].read() == 180)?0:180);
  delay(1500);
}

void loop() // For demo purposes, continuously rotates selected servo
{ 
  potValue = analogRead(INPUT_PIN) >> 2;
  dispensePill(potValue * 5 / 255);
  delay(100);
}