#ifndef __MSMW_H__
#define __MSMW_H__

#pragma systemFile

//**********************************************************//
//*                                                                                                     *//
//*  Magic Wand                                                                                   *//
//*                                                                                                     *//
//**********************************************************//

// Xander Soldaat's driver suite
#include "drivers/PCF8574-driver.h"     // mindsensors magic wand

void MWsetLED(short ledToChange, bool on)
{
    ubyte c;
    PCF8574readBytes(MAGICWAND, c);
    PCF8574sendBytes(MAGICWAND, (on ? c & ~(1 << ledToChange) : c | (1 << ledToChange)) );
}

void MWtoggleLED(short ledToChange)
{
    ubyte c;
    PCF8574readBytes(MAGICWAND, c);
    PCF8574sendBytes(MAGICWAND, c ^ (1 << ledToChange));
}

void MWflashAndClear(int count)
{
    int countr = 0;
    PCF8574sendBytes(MAGICWAND, 0xff);    // all off
    while (countr++ < count)
    {
        for (int i = 0; i < 8; i++) {
            MWsetLED(i, true);
            wait1Msec(30);
        }
        for (int i = 0; i < 8; i++) {
            MWsetLED(i, false);
            wait1Msec(30);
        }
        PCF8574sendBytes(MAGICWAND, 0xff);   // should not be needed, but just in case
    }
}

#endif

// make sure it works without bothering other LEDS
        for (int j = 1; j < 10; j++)
        {
            int r = random(7);
            MSMWsetLED(MAGICWAND, r, true);
            for (int i = 0; i < 10; i++)
            {
                MSMWtoggleLED(MAGICWAND, 4);
                wait1Msec(200);
            }
            MSMWsetLED(MAGICWAND, r, false);
        }