JeeLabs Café

//>>> The latest version of this code can be found at https://github.com/jcw/ !!

// Demo for the DC Motor Plug

// 2010-11-18 <jcw@equi4.com> http://opensource.org/licenses/mit-license.php

// $Id: dcmotor_demo.pde 7763 2011-12-11 01:28:16Z jcw $

#include <Ports.h>

#include <RF12.h> // needed to avoid a linker error :(

PortI2C myport (1 /*, PortI2C::KHZ400 */);

DeviceI2C expander (myport, 0x26);

enum {

  MCP_IODIR, MCP_IPOL, MCP_GPINTEN, MCP_DEFVAL, MCP_INTCON, 

  MCP_IOCON, MCP_GPPU, MCP_INTF, MCP_INTCAP, MCP_GPIO, MCP_OLAT

};

static void exp_setup () {

    expander.send();

    expander.write(MCP_IODIR);

    expander.write(0); // all outputs

    expander.stop();

}

static void exp_write (byte value) {

    expander.send();

    expander.write(MCP_GPIO);

    expander.write(value);

    expander.stop();

}

void setup () {

    Serial.begin(57600);

    Serial.println("\n[dcmotor_demo]");

    Serial.println((int) expander.isPresent());

    exp_setup();

}

void loop () {

    // turn each motor in either direction for one second

    for (byte i = 0; i < 4; ++i) {

        exp_write(1 << i);

        delay(1000);

        exp_write(0x0);

        delay(1000);

    }

}