mirror of
				https://git.proxmox.com/git/qemu
				synced 2025-10-27 17:45:41 +00:00 
			
		
		
		
	 83c9f4ca79
			
		
	
	
		83c9f4ca79
		
	
	
	
	
		
			
			Done with this script: cd hw for i in `find . -name '*.h' | sed 's/^..//'`; do echo '\,^#.*include.*["<]'$i'[">], s,'$i',hw/&,' done | sed -i -f - `find . -type f` This is so that paths remain valid as files are moved. Instead, files in hw/dataplane are referenced with the relative path. We know they are not going to move to include/, and they are the only include files that are in subdirectories _and_ move. Signed-off-by: Paolo Bonzini <pbonzini@redhat.com>
		
			
				
	
	
		
			620 lines
		
	
	
		
			16 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			620 lines
		
	
	
		
			16 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * QEMU GE IP-Octal 232 IndustryPack emulation
 | |
|  *
 | |
|  * Copyright (C) 2012 Igalia, S.L.
 | |
|  * Author: Alberto Garcia <agarcia@igalia.com>
 | |
|  *
 | |
|  * This code is licensed under the GNU GPL v2 or (at your option) any
 | |
|  * later version.
 | |
|  */
 | |
| 
 | |
| #include "hw/ipack.h"
 | |
| #include "qemu/bitops.h"
 | |
| #include "char/char.h"
 | |
| 
 | |
| /* #define DEBUG_IPOCTAL */
 | |
| 
 | |
| #ifdef DEBUG_IPOCTAL
 | |
| #define DPRINTF2(fmt, ...) \
 | |
|     do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
 | |
| #else
 | |
| #define DPRINTF2(fmt, ...) do { } while (0)
 | |
| #endif
 | |
| 
 | |
| #define DPRINTF(fmt, ...) DPRINTF2("IP-Octal: " fmt, ## __VA_ARGS__)
 | |
| 
 | |
| #define RX_FIFO_SIZE 3
 | |
| 
 | |
| /* The IP-Octal has 8 channels (a-h)
 | |
|    divided into 4 blocks (A-D) */
 | |
| #define N_CHANNELS 8
 | |
| #define N_BLOCKS   4
 | |
| 
 | |
| #define REG_MRa  0x01
 | |
| #define REG_MRb  0x11
 | |
| #define REG_SRa  0x03
 | |
| #define REG_SRb  0x13
 | |
| #define REG_CSRa 0x03
 | |
| #define REG_CSRb 0x13
 | |
| #define REG_CRa  0x05
 | |
| #define REG_CRb  0x15
 | |
| #define REG_RHRa 0x07
 | |
| #define REG_RHRb 0x17
 | |
| #define REG_THRa 0x07
 | |
| #define REG_THRb 0x17
 | |
| #define REG_ACR  0x09
 | |
| #define REG_ISR  0x0B
 | |
| #define REG_IMR  0x0B
 | |
| #define REG_OPCR 0x1B
 | |
| 
 | |
| #define CR_ENABLE_RX    BIT(0)
 | |
| #define CR_DISABLE_RX   BIT(1)
 | |
| #define CR_ENABLE_TX    BIT(2)
 | |
| #define CR_DISABLE_TX   BIT(3)
 | |
| #define CR_CMD(cr)      ((cr) >> 4)
 | |
| #define CR_NO_OP        0
 | |
| #define CR_RESET_MR     1
 | |
| #define CR_RESET_RX     2
 | |
| #define CR_RESET_TX     3
 | |
| #define CR_RESET_ERR    4
 | |
| #define CR_RESET_BRKINT 5
 | |
| #define CR_START_BRK    6
 | |
| #define CR_STOP_BRK     7
 | |
| #define CR_ASSERT_RTSN  8
 | |
| #define CR_NEGATE_RTSN  9
 | |
| #define CR_TIMEOUT_ON   10
 | |
| #define CR_TIMEOUT_OFF  12
 | |
| 
 | |
| #define SR_RXRDY   BIT(0)
 | |
| #define SR_FFULL   BIT(1)
 | |
| #define SR_TXRDY   BIT(2)
 | |
| #define SR_TXEMT   BIT(3)
 | |
| #define SR_OVERRUN BIT(4)
 | |
| #define SR_PARITY  BIT(5)
 | |
| #define SR_FRAMING BIT(6)
 | |
| #define SR_BREAK   BIT(7)
 | |
| 
 | |
| #define ISR_TXRDYA BIT(0)
 | |
| #define ISR_RXRDYA BIT(1)
 | |
| #define ISR_BREAKA BIT(2)
 | |
| #define ISR_CNTRDY BIT(3)
 | |
| #define ISR_TXRDYB BIT(4)
 | |
| #define ISR_RXRDYB BIT(5)
 | |
| #define ISR_BREAKB BIT(6)
 | |
| #define ISR_MPICHG BIT(7)
 | |
| #define ISR_TXRDY(CH) (((CH) & 1) ? BIT(4) : BIT(0))
 | |
| #define ISR_RXRDY(CH) (((CH) & 1) ? BIT(5) : BIT(1))
 | |
| #define ISR_BREAK(CH) (((CH) & 1) ? BIT(6) : BIT(2))
 | |
| 
 | |
| typedef struct IPOctalState IPOctalState;
 | |
| typedef struct SCC2698Channel SCC2698Channel;
 | |
| typedef struct SCC2698Block SCC2698Block;
 | |
| 
 | |
| struct SCC2698Channel {
 | |
|     IPOctalState *ipoctal;
 | |
|     CharDriverState *dev;
 | |
|     char *devpath;
 | |
|     bool rx_enabled;
 | |
|     uint8_t mr[2];
 | |
|     uint8_t mr_idx;
 | |
|     uint8_t sr;
 | |
|     uint8_t rhr[RX_FIFO_SIZE];
 | |
|     uint8_t rhr_idx;
 | |
|     uint8_t rx_pending;
 | |
| };
 | |
| 
 | |
| struct SCC2698Block {
 | |
|     uint8_t imr;
 | |
|     uint8_t isr;
 | |
| };
 | |
| 
 | |
| struct IPOctalState {
 | |
|     IPackDevice dev;
 | |
|     SCC2698Channel ch[N_CHANNELS];
 | |
|     SCC2698Block blk[N_BLOCKS];
 | |
|     uint8_t irq_vector;
 | |
| };
 | |
| 
 | |
| #define TYPE_IPOCTAL "ipoctal232"
 | |
| 
 | |
| #define IPOCTAL(obj) \
 | |
|     OBJECT_CHECK(IPOctalState, (obj), TYPE_IPOCTAL)
 | |
| 
 | |
| static const VMStateDescription vmstate_scc2698_channel = {
 | |
|     .name = "scc2698_channel",
 | |
|     .version_id = 1,
 | |
|     .minimum_version_id = 1,
 | |
|     .minimum_version_id_old = 1,
 | |
|     .fields      = (VMStateField[]) {
 | |
|         VMSTATE_BOOL(rx_enabled, SCC2698Channel),
 | |
|         VMSTATE_UINT8_ARRAY(mr, SCC2698Channel, 2),
 | |
|         VMSTATE_UINT8(mr_idx, SCC2698Channel),
 | |
|         VMSTATE_UINT8(sr, SCC2698Channel),
 | |
|         VMSTATE_UINT8_ARRAY(rhr, SCC2698Channel, RX_FIFO_SIZE),
 | |
|         VMSTATE_UINT8(rhr_idx, SCC2698Channel),
 | |
|         VMSTATE_UINT8(rx_pending, SCC2698Channel),
 | |
|         VMSTATE_END_OF_LIST()
 | |
|     }
 | |
| };
 | |
| 
 | |
| static const VMStateDescription vmstate_scc2698_block = {
 | |
|     .name = "scc2698_block",
 | |
|     .version_id = 1,
 | |
|     .minimum_version_id = 1,
 | |
|     .minimum_version_id_old = 1,
 | |
|     .fields      = (VMStateField[]) {
 | |
|         VMSTATE_UINT8(imr, SCC2698Block),
 | |
|         VMSTATE_UINT8(isr, SCC2698Block),
 | |
|         VMSTATE_END_OF_LIST()
 | |
|     }
 | |
| };
 | |
| 
 | |
| static const VMStateDescription vmstate_ipoctal = {
 | |
|     .name = "ipoctal232",
 | |
|     .version_id = 1,
 | |
|     .minimum_version_id = 1,
 | |
|     .minimum_version_id_old = 1,
 | |
|     .fields      = (VMStateField[]) {
 | |
|         VMSTATE_IPACK_DEVICE(dev, IPOctalState),
 | |
|         VMSTATE_STRUCT_ARRAY(ch, IPOctalState, N_CHANNELS, 1,
 | |
|                              vmstate_scc2698_channel, SCC2698Channel),
 | |
|         VMSTATE_STRUCT_ARRAY(blk, IPOctalState, N_BLOCKS, 1,
 | |
|                              vmstate_scc2698_block, SCC2698Block),
 | |
|         VMSTATE_UINT8(irq_vector, IPOctalState),
 | |
|         VMSTATE_END_OF_LIST()
 | |
|     }
 | |
| };
 | |
| 
 | |
| /* data[10] is 0x0C, not 0x0B as the doc says */
 | |
| static const uint8_t id_prom_data[] = {
 | |
|     0x49, 0x50, 0x41, 0x43, 0xF0, 0x22,
 | |
|     0xA1, 0x00, 0x00, 0x00, 0x0C, 0xCC
 | |
| };
 | |
| 
 | |
| static void update_irq(IPOctalState *dev, unsigned block)
 | |
| {
 | |
|     /* Blocks A and B interrupt on INT0#, C and D on INT1#.
 | |
|        Thus, to get the status we have to check two blocks. */
 | |
|     SCC2698Block *blk0 = &dev->blk[block];
 | |
|     SCC2698Block *blk1 = &dev->blk[block^1];
 | |
|     unsigned intno = block / 2;
 | |
| 
 | |
|     if ((blk0->isr & blk0->imr) || (blk1->isr & blk1->imr)) {
 | |
|         qemu_irq_raise(dev->dev.irq[intno]);
 | |
|     } else {
 | |
|         qemu_irq_lower(dev->dev.irq[intno]);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void write_cr(IPOctalState *dev, unsigned channel, uint8_t val)
 | |
| {
 | |
|     SCC2698Channel *ch = &dev->ch[channel];
 | |
|     SCC2698Block *blk = &dev->blk[channel / 2];
 | |
| 
 | |
|     DPRINTF("Write CR%c %u: ", channel + 'a', val);
 | |
| 
 | |
|     /* The lower 4 bits are used to enable and disable Tx and Rx */
 | |
|     if (val & CR_ENABLE_RX) {
 | |
|         DPRINTF2("Rx on, ");
 | |
|         ch->rx_enabled = true;
 | |
|     }
 | |
|     if (val & CR_DISABLE_RX) {
 | |
|         DPRINTF2("Rx off, ");
 | |
|         ch->rx_enabled = false;
 | |
|     }
 | |
|     if (val & CR_ENABLE_TX) {
 | |
|         DPRINTF2("Tx on, ");
 | |
|         ch->sr |= SR_TXRDY | SR_TXEMT;
 | |
|         blk->isr |= ISR_TXRDY(channel);
 | |
|     }
 | |
|     if (val & CR_DISABLE_TX) {
 | |
|         DPRINTF2("Tx off, ");
 | |
|         ch->sr &= ~(SR_TXRDY | SR_TXEMT);
 | |
|         blk->isr &= ~ISR_TXRDY(channel);
 | |
|     }
 | |
| 
 | |
|     DPRINTF2("cmd: ");
 | |
| 
 | |
|     /* The rest of the bits implement different commands */
 | |
|     switch (CR_CMD(val)) {
 | |
|     case CR_NO_OP:
 | |
|         DPRINTF2("none");
 | |
|         break;
 | |
|     case CR_RESET_MR:
 | |
|         DPRINTF2("reset MR");
 | |
|         ch->mr_idx = 0;
 | |
|         break;
 | |
|     case CR_RESET_RX:
 | |
|         DPRINTF2("reset Rx");
 | |
|         ch->rx_enabled = false;
 | |
|         ch->rx_pending = 0;
 | |
|         ch->sr &= ~SR_RXRDY;
 | |
|         blk->isr &= ~ISR_RXRDY(channel);
 | |
|         break;
 | |
|     case CR_RESET_TX:
 | |
|         DPRINTF2("reset Tx");
 | |
|         ch->sr &= ~(SR_TXRDY | SR_TXEMT);
 | |
|         blk->isr &= ~ISR_TXRDY(channel);
 | |
|         break;
 | |
|     case CR_RESET_ERR:
 | |
|         DPRINTF2("reset err");
 | |
|         ch->sr &= ~(SR_OVERRUN | SR_PARITY | SR_FRAMING | SR_BREAK);
 | |
|         break;
 | |
|     case CR_RESET_BRKINT:
 | |
|         DPRINTF2("reset brk ch int");
 | |
|         blk->isr &= ~(ISR_BREAKA | ISR_BREAKB);
 | |
|         break;
 | |
|     default:
 | |
|         DPRINTF2("unsupported 0x%x", CR_CMD(val));
 | |
|     }
 | |
| 
 | |
|     DPRINTF2("\n");
 | |
| }
 | |
| 
 | |
| static uint16_t io_read(IPackDevice *ip, uint8_t addr)
 | |
| {
 | |
|     IPOctalState *dev = IPOCTAL(ip);
 | |
|     uint16_t ret = 0;
 | |
|     /* addr[7:6]: block   (A-D)
 | |
|        addr[7:5]: channel (a-h)
 | |
|        addr[5:0]: register */
 | |
|     unsigned block = addr >> 5;
 | |
|     unsigned channel = addr >> 4;
 | |
|     /* Big endian, accessed using 8-bit bytes at odd locations */
 | |
|     unsigned offset = (addr & 0x1F) ^ 1;
 | |
|     SCC2698Channel *ch = &dev->ch[channel];
 | |
|     SCC2698Block *blk = &dev->blk[block];
 | |
|     uint8_t old_isr = blk->isr;
 | |
| 
 | |
|     switch (offset) {
 | |
| 
 | |
|     case REG_MRa:
 | |
|     case REG_MRb:
 | |
|         ret = ch->mr[ch->mr_idx];
 | |
|         DPRINTF("Read MR%u%c: 0x%x\n", ch->mr_idx + 1, channel + 'a', ret);
 | |
|         ch->mr_idx = 1;
 | |
|         break;
 | |
| 
 | |
|     case REG_SRa:
 | |
|     case REG_SRb:
 | |
|         ret = ch->sr;
 | |
|         DPRINTF("Read SR%c: 0x%x\n", channel + 'a', ret);
 | |
|         break;
 | |
| 
 | |
|     case REG_RHRa:
 | |
|     case REG_RHRb:
 | |
|         ret = ch->rhr[ch->rhr_idx];
 | |
|         if (ch->rx_pending > 0) {
 | |
|             ch->rx_pending--;
 | |
|             if (ch->rx_pending == 0) {
 | |
|                 ch->sr &= ~SR_RXRDY;
 | |
|                 blk->isr &= ~ISR_RXRDY(channel);
 | |
|                 if (ch->dev) {
 | |
|                     qemu_chr_accept_input(ch->dev);
 | |
|                 }
 | |
|             } else {
 | |
|                 ch->rhr_idx = (ch->rhr_idx + 1) % RX_FIFO_SIZE;
 | |
|             }
 | |
|             if (ch->sr & SR_BREAK) {
 | |
|                 ch->sr &= ~SR_BREAK;
 | |
|                 blk->isr |= ISR_BREAK(channel);
 | |
|             }
 | |
|         }
 | |
|         DPRINTF("Read RHR%c (0x%x)\n", channel + 'a', ret);
 | |
|         break;
 | |
| 
 | |
|     case REG_ISR:
 | |
|         ret = blk->isr;
 | |
|         DPRINTF("Read ISR%c: 0x%x\n", block + 'A', ret);
 | |
|         break;
 | |
| 
 | |
|     default:
 | |
|         DPRINTF("Read unknown/unsupported register 0x%02x\n", offset);
 | |
|     }
 | |
| 
 | |
|     if (old_isr != blk->isr) {
 | |
|         update_irq(dev, block);
 | |
|     }
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| static void io_write(IPackDevice *ip, uint8_t addr, uint16_t val)
 | |
| {
 | |
|     IPOctalState *dev = IPOCTAL(ip);
 | |
|     unsigned reg = val & 0xFF;
 | |
|     /* addr[7:6]: block   (A-D)
 | |
|        addr[7:5]: channel (a-h)
 | |
|        addr[5:0]: register */
 | |
|     unsigned block = addr >> 5;
 | |
|     unsigned channel = addr >> 4;
 | |
|     /* Big endian, accessed using 8-bit bytes at odd locations */
 | |
|     unsigned offset = (addr & 0x1F) ^ 1;
 | |
|     SCC2698Channel *ch = &dev->ch[channel];
 | |
|     SCC2698Block *blk = &dev->blk[block];
 | |
|     uint8_t old_isr = blk->isr;
 | |
|     uint8_t old_imr = blk->imr;
 | |
| 
 | |
|     switch (offset) {
 | |
| 
 | |
|     case REG_MRa:
 | |
|     case REG_MRb:
 | |
|         ch->mr[ch->mr_idx] = reg;
 | |
|         DPRINTF("Write MR%u%c 0x%x\n", ch->mr_idx + 1, channel + 'a', reg);
 | |
|         ch->mr_idx = 1;
 | |
|         break;
 | |
| 
 | |
|     /* Not implemented */
 | |
|     case REG_CSRa:
 | |
|     case REG_CSRb:
 | |
|         DPRINTF("Write CSR%c: 0x%x\n", channel + 'a', reg);
 | |
|         break;
 | |
| 
 | |
|     case REG_CRa:
 | |
|     case REG_CRb:
 | |
|         write_cr(dev, channel, reg);
 | |
|         break;
 | |
| 
 | |
|     case REG_THRa:
 | |
|     case REG_THRb:
 | |
|         if (ch->sr & SR_TXRDY) {
 | |
|             DPRINTF("Write THR%c (0x%x)\n", channel + 'a', reg);
 | |
|             if (ch->dev) {
 | |
|                 uint8_t thr = reg;
 | |
|                 qemu_chr_fe_write(ch->dev, &thr, 1);
 | |
|             }
 | |
|         } else {
 | |
|             DPRINTF("Write THR%c (0x%x), Tx disabled\n", channel + 'a', reg);
 | |
|         }
 | |
|         break;
 | |
| 
 | |
|     /* Not implemented */
 | |
|     case REG_ACR:
 | |
|         DPRINTF("Write ACR%c 0x%x\n", block + 'A', val);
 | |
|         break;
 | |
| 
 | |
|     case REG_IMR:
 | |
|         DPRINTF("Write IMR%c 0x%x\n", block + 'A', val);
 | |
|         blk->imr = reg;
 | |
|         break;
 | |
| 
 | |
|     /* Not implemented */
 | |
|     case REG_OPCR:
 | |
|         DPRINTF("Write OPCR%c 0x%x\n", block + 'A', val);
 | |
|         break;
 | |
| 
 | |
|     default:
 | |
|         DPRINTF("Write unknown/unsupported register 0x%02x %u\n", offset, val);
 | |
|     }
 | |
| 
 | |
|     if (old_isr != blk->isr || old_imr != blk->imr) {
 | |
|         update_irq(dev, block);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static uint16_t id_read(IPackDevice *ip, uint8_t addr)
 | |
| {
 | |
|     uint16_t ret = 0;
 | |
|     unsigned pos = addr / 2; /* The ID PROM data is stored every other byte */
 | |
| 
 | |
|     if (pos < ARRAY_SIZE(id_prom_data)) {
 | |
|         ret = id_prom_data[pos];
 | |
|     } else {
 | |
|         DPRINTF("Attempt to read unavailable PROM data at 0x%x\n",  addr);
 | |
|     }
 | |
| 
 | |
|     return ret;
 | |
| }
 | |
| 
 | |
| static void id_write(IPackDevice *ip, uint8_t addr, uint16_t val)
 | |
| {
 | |
|     IPOctalState *dev = IPOCTAL(ip);
 | |
|     if (addr == 1) {
 | |
|         DPRINTF("Write IRQ vector: %u\n", (unsigned) val);
 | |
|         dev->irq_vector = val; /* Undocumented, but the hw works like that */
 | |
|     } else {
 | |
|         DPRINTF("Attempt to write 0x%x to 0x%x\n", val, addr);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static uint16_t int_read(IPackDevice *ip, uint8_t addr)
 | |
| {
 | |
|     IPOctalState *dev = IPOCTAL(ip);
 | |
|     /* Read address 0 to ACK INT0# and address 2 to ACK INT1# */
 | |
|     if (addr != 0 && addr != 2) {
 | |
|         DPRINTF("Attempt to read from 0x%x\n", addr);
 | |
|         return 0;
 | |
|     } else {
 | |
|         /* Update interrupts if necessary */
 | |
|         update_irq(dev, addr);
 | |
|         return dev->irq_vector;
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void int_write(IPackDevice *ip, uint8_t addr, uint16_t val)
 | |
| {
 | |
|     DPRINTF("Attempt to write 0x%x to 0x%x\n", val, addr);
 | |
| }
 | |
| 
 | |
| static uint16_t mem_read16(IPackDevice *ip, uint32_t addr)
 | |
| {
 | |
|     DPRINTF("Attempt to read from 0x%x\n", addr);
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static void mem_write16(IPackDevice *ip, uint32_t addr, uint16_t val)
 | |
| {
 | |
|     DPRINTF("Attempt to write 0x%x to 0x%x\n", val, addr);
 | |
| }
 | |
| 
 | |
| static uint8_t mem_read8(IPackDevice *ip, uint32_t addr)
 | |
| {
 | |
|     DPRINTF("Attempt to read from 0x%x\n", addr);
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static void mem_write8(IPackDevice *ip, uint32_t addr, uint8_t val)
 | |
| {
 | |
|     IPOctalState *dev = IPOCTAL(ip);
 | |
|     if (addr == 1) {
 | |
|         DPRINTF("Write IRQ vector: %u\n", (unsigned) val);
 | |
|         dev->irq_vector = val;
 | |
|     } else {
 | |
|         DPRINTF("Attempt to write 0x%x to 0x%x\n", val, addr);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static int hostdev_can_receive(void *opaque)
 | |
| {
 | |
|     SCC2698Channel *ch = opaque;
 | |
|     int available_bytes = RX_FIFO_SIZE - ch->rx_pending;
 | |
|     return ch->rx_enabled ? available_bytes : 0;
 | |
| }
 | |
| 
 | |
| static void hostdev_receive(void *opaque, const uint8_t *buf, int size)
 | |
| {
 | |
|     SCC2698Channel *ch = opaque;
 | |
|     IPOctalState *dev = ch->ipoctal;
 | |
|     unsigned pos = ch->rhr_idx + ch->rx_pending;
 | |
|     int i;
 | |
| 
 | |
|     assert(size + ch->rx_pending <= RX_FIFO_SIZE);
 | |
| 
 | |
|     /* Copy data to the RxFIFO */
 | |
|     for (i = 0; i < size; i++) {
 | |
|         pos %= RX_FIFO_SIZE;
 | |
|         ch->rhr[pos++] = buf[i];
 | |
|     }
 | |
| 
 | |
|     ch->rx_pending += size;
 | |
| 
 | |
|     /* If the RxFIFO was empty raise an interrupt */
 | |
|     if (!(ch->sr & SR_RXRDY)) {
 | |
|         unsigned block, channel = 0;
 | |
|         /* Find channel number to update the ISR register */
 | |
|         while (&dev->ch[channel] != ch) {
 | |
|             channel++;
 | |
|         }
 | |
|         block = channel / 2;
 | |
|         dev->blk[block].isr |= ISR_RXRDY(channel);
 | |
|         ch->sr |= SR_RXRDY;
 | |
|         update_irq(dev, block);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static void hostdev_event(void *opaque, int event)
 | |
| {
 | |
|     SCC2698Channel *ch = opaque;
 | |
|     switch (event) {
 | |
|     case CHR_EVENT_OPENED:
 | |
|         DPRINTF("Device %s opened\n", ch->dev->label);
 | |
|         break;
 | |
|     case CHR_EVENT_BREAK: {
 | |
|         uint8_t zero = 0;
 | |
|         DPRINTF("Device %s received break\n", ch->dev->label);
 | |
| 
 | |
|         if (!(ch->sr & SR_BREAK)) {
 | |
|             IPOctalState *dev = ch->ipoctal;
 | |
|             unsigned block, channel = 0;
 | |
| 
 | |
|             while (&dev->ch[channel] != ch) {
 | |
|                 channel++;
 | |
|             }
 | |
|             block = channel / 2;
 | |
| 
 | |
|             ch->sr |= SR_BREAK;
 | |
|             dev->blk[block].isr |= ISR_BREAK(channel);
 | |
|         }
 | |
| 
 | |
|         /* Put a zero character in the buffer */
 | |
|         hostdev_receive(ch, &zero, 1);
 | |
|     }
 | |
|         break;
 | |
|     default:
 | |
|         DPRINTF("Device %s received event %d\n", ch->dev->label, event);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static int ipoctal_init(IPackDevice *ip)
 | |
| {
 | |
|     IPOctalState *s = IPOCTAL(ip);
 | |
|     unsigned i;
 | |
| 
 | |
|     for (i = 0; i < N_CHANNELS; i++) {
 | |
|         SCC2698Channel *ch = &s->ch[i];
 | |
|         ch->ipoctal = s;
 | |
| 
 | |
|         /* Redirect IP-Octal channels to host character devices */
 | |
|         if (ch->devpath) {
 | |
|             const char chr_name[] = "ipoctal";
 | |
|             char label[ARRAY_SIZE(chr_name) + 2];
 | |
|             static int index;
 | |
| 
 | |
|             snprintf(label, sizeof(label), "%s%d", chr_name, index);
 | |
| 
 | |
|             ch->dev = qemu_chr_new(label, ch->devpath, NULL);
 | |
| 
 | |
|             if (ch->dev) {
 | |
|                 index++;
 | |
|                 qemu_chr_add_handlers(ch->dev, hostdev_can_receive,
 | |
|                                       hostdev_receive, hostdev_event, ch);
 | |
|                 DPRINTF("Redirecting channel %u to %s (%s)\n",
 | |
|                         i, ch->devpath, label);
 | |
|             } else {
 | |
|                 DPRINTF("Could not redirect channel %u to %s\n",
 | |
|                         i, ch->devpath);
 | |
|             }
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static Property ipoctal_properties[] = {
 | |
|     DEFINE_PROP_STRING("serial0", IPOctalState, ch[0].devpath),
 | |
|     DEFINE_PROP_STRING("serial1", IPOctalState, ch[1].devpath),
 | |
|     DEFINE_PROP_STRING("serial2", IPOctalState, ch[2].devpath),
 | |
|     DEFINE_PROP_STRING("serial3", IPOctalState, ch[3].devpath),
 | |
|     DEFINE_PROP_STRING("serial4", IPOctalState, ch[4].devpath),
 | |
|     DEFINE_PROP_STRING("serial5", IPOctalState, ch[5].devpath),
 | |
|     DEFINE_PROP_STRING("serial6", IPOctalState, ch[6].devpath),
 | |
|     DEFINE_PROP_STRING("serial7", IPOctalState, ch[7].devpath),
 | |
|     DEFINE_PROP_END_OF_LIST(),
 | |
| };
 | |
| 
 | |
| static void ipoctal_class_init(ObjectClass *klass, void *data)
 | |
| {
 | |
|     DeviceClass *dc = DEVICE_CLASS(klass);
 | |
|     IPackDeviceClass *ic = IPACK_DEVICE_CLASS(klass);
 | |
| 
 | |
|     ic->init        = ipoctal_init;
 | |
|     ic->io_read     = io_read;
 | |
|     ic->io_write    = io_write;
 | |
|     ic->id_read     = id_read;
 | |
|     ic->id_write    = id_write;
 | |
|     ic->int_read    = int_read;
 | |
|     ic->int_write   = int_write;
 | |
|     ic->mem_read16  = mem_read16;
 | |
|     ic->mem_write16 = mem_write16;
 | |
|     ic->mem_read8   = mem_read8;
 | |
|     ic->mem_write8  = mem_write8;
 | |
| 
 | |
|     dc->desc    = "GE IP-Octal 232 8-channel RS-232 IndustryPack";
 | |
|     dc->props   = ipoctal_properties;
 | |
|     dc->vmsd    = &vmstate_ipoctal;
 | |
| }
 | |
| 
 | |
| static const TypeInfo ipoctal_info = {
 | |
|     .name          = TYPE_IPOCTAL,
 | |
|     .parent        = TYPE_IPACK_DEVICE,
 | |
|     .instance_size = sizeof(IPOctalState),
 | |
|     .class_init    = ipoctal_class_init,
 | |
| };
 | |
| 
 | |
| static void ipoctal_register_types(void)
 | |
| {
 | |
|     type_register_static(&ipoctal_info);
 | |
| }
 | |
| 
 | |
| type_init(ipoctal_register_types)
 |