Subversion Repositories tv80

#include "it_cfg_driver.h"
 
void it_cfg_driver::add_queue (uint32_t d)
{
  send_queue.push (d);
}
 
void it_cfg_driver::event()
{
  if (reset_n == 0) {
    cfgi_irdy = 0;
    cfgi_addr = 0;
    cfgi_write = 0;
    cfgi_wr_data = 0;
  } else {
    if (cfgi_irdy == 0) {
      // check the send queue
      if (!send_queue.empty()) {
        cfgi_irdy = 1;
        cfgi_addr = addr++;
        cfgi_wr_data = send_queue.front();
        send_queue.pop();
        cfgi_write = 1;
      }
    } else {
      if (cfgi_trdy == 1) {
        // check the send queue and send data
        if (!send_queue.empty()) {
          cfgi_irdy = 1;
          cfgi_addr = addr++;
          cfgi_wr_data = send_queue.front();
          send_queue.pop();
          cfgi_write = 1;
        } else {
          cfgi_irdy = 0;
        }
      }
    }
 
    while (!send_queue.empty() && (send_queue.front() == 0)) {
      send_queue.pop();
      addr++;
    }
  }
}