i2cmem: fix page write logic [O. Galibert]

This commit is contained in:
Olivier Galibert 2019-03-07 15:22:24 +01:00
parent ed341b1c1b
commit 023d907486
2 changed files with 24 additions and 12 deletions

View File

@ -98,7 +98,10 @@ i2cmem_device::i2cmem_device(
m_sdar(1), m_sdar(1),
m_state(STATE_IDLE), m_state(STATE_IDLE),
m_shift(0), m_shift(0),
m_byteaddr(0) m_byteaddr(0),
m_page_offset(0),
m_page_written_size(0),
m_in_write(false)
{ {
// these memories work off the I2C clock only // these memories work off the I2C clock only
assert(!clock); assert(!clock);
@ -165,6 +168,9 @@ void i2cmem_device::device_start()
save_item( NAME(m_shift) ); save_item( NAME(m_shift) );
save_item( NAME(m_devsel) ); save_item( NAME(m_devsel) );
save_item( NAME(m_byteaddr) ); save_item( NAME(m_byteaddr) );
save_item( NAME(m_in_write) );
save_item( NAME(m_page_offset) );
save_item( NAME(m_page_written_size) );
save_pointer( &m_data[0], "m_data", m_data_size ); save_pointer( &m_data[0], "m_data", m_data_size );
if ( m_page_size > 0 ) if ( m_page_size > 0 )
{ {
@ -179,6 +185,7 @@ void i2cmem_device::device_start()
void i2cmem_device::device_reset() void i2cmem_device::device_reset()
{ {
m_in_write = false;
} }
@ -280,6 +287,15 @@ WRITE_LINE_MEMBER( i2cmem_device::write_sda )
{ {
if( m_sdaw ) if( m_sdaw )
{ {
if( m_in_write )
{
int base = data_offset();
int root = base & ~( m_page_size - 1);
for( int i=0; i < m_page_written_size; i++)
m_data[root | ((base + i) & (m_page_size - 1))] = m_page[i];
m_in_write = false;
verboselog( this, 1, "data[ %04x to %04x ] = %x bytes\n", base, root | ((base + m_page_written_size - 1) & (m_page_size - 1)), m_page_written_size );
}
verboselog( this, 1, "stop\n" ); verboselog( this, 1, "stop\n" );
m_state = STATE_IDLE; m_state = STATE_IDLE;
} }
@ -344,6 +360,7 @@ WRITE_LINE_MEMBER( i2cmem_device::write_scl )
case STATE_BYTEADDR: case STATE_BYTEADDR:
m_byteaddr = m_shift; m_byteaddr = m_shift;
m_page_offset = 0; m_page_offset = 0;
m_page_written_size = 0;
verboselog( this, 1, "byteaddr %02x\n", m_byteaddr ); verboselog( this, 1, "byteaddr %02x\n", m_byteaddr );
@ -358,23 +375,16 @@ WRITE_LINE_MEMBER( i2cmem_device::write_scl )
} }
else if( m_page_size > 0 ) else if( m_page_size > 0 )
{ {
m_in_write = true;
m_page[ m_page_offset ] = m_shift; m_page[ m_page_offset ] = m_shift;
verboselog( this, 1, "page[ %04x ] <- %02x\n", m_page_offset, m_page[ m_page_offset ] ); verboselog( this, 1, "page[ %04x ] <- %02x\n", m_page_offset, m_page[ m_page_offset ] );
m_page_offset++; m_page_offset++;
if( m_page_offset == m_page_size ) if( m_page_offset == m_page_size )
{
int offset = data_offset() & ~( m_page_size - 1 );
verboselog( this, 1, "data[ %04x to %04x ] = page\n", offset, offset + m_page_size - 1 );
for( int i = 0; i < m_page_size; i++ )
{
m_data[offset + i] = m_page[ i ];
}
m_page_offset = 0; m_page_offset = 0;
} m_page_written_size++;
if( m_page_written_size > m_page_size)
m_page_written_size = m_page_size;
} }
else else
{ {

View File

@ -92,6 +92,8 @@ protected:
int m_byteaddr; int m_byteaddr;
std::vector<uint8_t> m_page; std::vector<uint8_t> m_page;
int m_page_offset; int m_page_offset;
int m_page_written_size;
bool m_in_write;
}; };
#define DECLARE_I2C_DEVICE(name) \ #define DECLARE_I2C_DEVICE(name) \