Now the _read() always returns 0
here is the code:
#include "AM9111.h"
#include "WProgram.h"
/////////////////////////////////////////
//
// PUBLIC
//
AM9111::AM9111(uint8_t outputDisablePin, uint8_t writeEnablePin)
{
_odp = outputDisablePin;
_wep = writeEnablePin;
}
int AM9111::setIO(uint8_t IO0, uint8_t IO1, uint8_t IO2, uint8_t IO3)
{
_IO[0] = IO0;
_IO[1] = IO1;
_IO[2] = IO2;
_IO[3] = IO3;
}
int AM9111::read(unsigned int address)
{
int rv = 0;
_setAddress(address);
return rv;
}
int AM9111::write(unsigned int address, uint8_t value)
{
int rv = 0;
_setAddress(address);
rv = _write(value);
return rv;
}
/////////////////////////////////////////
//
// PRIVATE
//
void AM9111::_setAddress(unsigned int address)
{
for(int p=0; p<8; p++)
{
pinMode(p, OUTPUT);
digitalWrite(p, bitRead(address, p));
}
}
int AM9111::_read()
{
digitalWrite(_odp,0);
digitalWrite(_wep,1);
int rv = 0;
bitWrite(rv,0,digitalRead(_IO[0]));
bitWrite(rv,1,digitalRead(_IO[1]));
bitWrite(rv,2,digitalRead(_IO[2]));
bitWrite(rv,3,digitalRead(_IO[3]));
return rv;
}
int AM9111::_write(uint8_t value)
{
digitalWrite(_odp,1);
digitalWrite(_wep,0);
int rv = 0;
digitalWrite(_IO[0],bitRead(0,value));
digitalWrite(_IO[1],bitRead(1,value));
digitalWrite(_IO[2],bitRead(2,value));
digitalWrite(_IO[3],bitRead(3,value));
return rv;
}