can_kvaser_pci.c 9.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322
  1. /*
  2. * Kvaser PCI CAN device (SJA1000 based) emulation
  3. *
  4. * Copyright (c) 2013-2014 Jin Yang
  5. * Copyright (c) 2014-2018 Pavel Pisa
  6. *
  7. * Partially based on educational PCIexpress APOHW hardware
  8. * emulator used fro class A0B36APO at CTU FEE course by
  9. * Rostislav Lisovy and Pavel Pisa
  10. *
  11. * Initial development supported by Google GSoC 2013 from RTEMS project slot
  12. *
  13. * Permission is hereby granted, free of charge, to any person obtaining a copy
  14. * of this software and associated documentation files (the "Software"), to deal
  15. * in the Software without restriction, including without limitation the rights
  16. * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  17. * copies of the Software, and to permit persons to whom the Software is
  18. * furnished to do so, subject to the following conditions:
  19. *
  20. * The above copyright notice and this permission notice shall be included in
  21. * all copies or substantial portions of the Software.
  22. *
  23. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  24. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  25. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  26. * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  27. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  28. * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  29. * THE SOFTWARE.
  30. */
  31. #include "qemu/osdep.h"
  32. #include "qemu/event_notifier.h"
  33. #include "qemu/module.h"
  34. #include "qemu/thread.h"
  35. #include "qemu/sockets.h"
  36. #include "qapi/error.h"
  37. #include "chardev/char.h"
  38. #include "hw/irq.h"
  39. #include "hw/pci/pci.h"
  40. #include "hw/qdev-properties.h"
  41. #include "migration/vmstate.h"
  42. #include "net/can_emu.h"
  43. #include "can_sja1000.h"
  44. #define TYPE_CAN_PCI_DEV "kvaser_pci"
  45. #define KVASER_PCI_DEV(obj) \
  46. OBJECT_CHECK(KvaserPCIState, (obj), TYPE_CAN_PCI_DEV)
  47. #ifndef KVASER_PCI_VENDOR_ID1
  48. #define KVASER_PCI_VENDOR_ID1 0x10e8 /* the PCI device and vendor IDs */
  49. #endif
  50. #ifndef KVASER_PCI_DEVICE_ID1
  51. #define KVASER_PCI_DEVICE_ID1 0x8406
  52. #endif
  53. #define KVASER_PCI_S5920_RANGE 0x80
  54. #define KVASER_PCI_SJA_RANGE 0x80
  55. #define KVASER_PCI_XILINX_RANGE 0x8
  56. #define KVASER_PCI_BYTES_PER_SJA 0x20
  57. #define S5920_OMB 0x0C
  58. #define S5920_IMB 0x1C
  59. #define S5920_MBEF 0x34
  60. #define S5920_INTCSR 0x38
  61. #define S5920_RCR 0x3C
  62. #define S5920_PTCR 0x60
  63. #define S5920_INTCSR_ADDON_INTENABLE_M 0x2000
  64. #define S5920_INTCSR_INTERRUPT_ASSERTED_M 0x800000
  65. #define KVASER_PCI_XILINX_VERINT 7 /* Lower nibble simulate interrupts,
  66. high nibble version number. */
  67. #define KVASER_PCI_XILINX_VERSION_NUMBER 13
  68. typedef struct KvaserPCIState {
  69. /*< private >*/
  70. PCIDevice dev;
  71. /*< public >*/
  72. MemoryRegion s5920_io;
  73. MemoryRegion sja_io;
  74. MemoryRegion xilinx_io;
  75. CanSJA1000State sja_state;
  76. qemu_irq irq;
  77. uint32_t s5920_intcsr;
  78. uint32_t s5920_irqstate;
  79. CanBusState *canbus;
  80. } KvaserPCIState;
  81. static void kvaser_pci_irq_handler(void *opaque, int irq_num, int level)
  82. {
  83. KvaserPCIState *d = (KvaserPCIState *)opaque;
  84. d->s5920_irqstate = level;
  85. if (d->s5920_intcsr & S5920_INTCSR_ADDON_INTENABLE_M) {
  86. pci_set_irq(&d->dev, level);
  87. }
  88. }
  89. static void kvaser_pci_reset(DeviceState *dev)
  90. {
  91. KvaserPCIState *d = KVASER_PCI_DEV(dev);
  92. CanSJA1000State *s = &d->sja_state;
  93. can_sja_hardware_reset(s);
  94. }
  95. static uint64_t kvaser_pci_s5920_io_read(void *opaque, hwaddr addr,
  96. unsigned size)
  97. {
  98. KvaserPCIState *d = opaque;
  99. uint64_t val;
  100. switch (addr) {
  101. case S5920_INTCSR:
  102. val = d->s5920_intcsr;
  103. val &= ~S5920_INTCSR_INTERRUPT_ASSERTED_M;
  104. if (d->s5920_irqstate) {
  105. val |= S5920_INTCSR_INTERRUPT_ASSERTED_M;
  106. }
  107. return val;
  108. }
  109. return 0;
  110. }
  111. static void kvaser_pci_s5920_io_write(void *opaque, hwaddr addr, uint64_t data,
  112. unsigned size)
  113. {
  114. KvaserPCIState *d = opaque;
  115. switch (addr) {
  116. case S5920_INTCSR:
  117. if (d->s5920_irqstate &&
  118. ((d->s5920_intcsr ^ data) & S5920_INTCSR_ADDON_INTENABLE_M)) {
  119. pci_set_irq(&d->dev, !!(data & S5920_INTCSR_ADDON_INTENABLE_M));
  120. }
  121. d->s5920_intcsr = data;
  122. break;
  123. }
  124. }
  125. static uint64_t kvaser_pci_sja_io_read(void *opaque, hwaddr addr, unsigned size)
  126. {
  127. KvaserPCIState *d = opaque;
  128. CanSJA1000State *s = &d->sja_state;
  129. if (addr >= KVASER_PCI_BYTES_PER_SJA) {
  130. return 0;
  131. }
  132. return can_sja_mem_read(s, addr, size);
  133. }
  134. static void kvaser_pci_sja_io_write(void *opaque, hwaddr addr, uint64_t data,
  135. unsigned size)
  136. {
  137. KvaserPCIState *d = opaque;
  138. CanSJA1000State *s = &d->sja_state;
  139. if (addr >= KVASER_PCI_BYTES_PER_SJA) {
  140. return;
  141. }
  142. can_sja_mem_write(s, addr, data, size);
  143. }
  144. static uint64_t kvaser_pci_xilinx_io_read(void *opaque, hwaddr addr,
  145. unsigned size)
  146. {
  147. switch (addr) {
  148. case KVASER_PCI_XILINX_VERINT:
  149. return (KVASER_PCI_XILINX_VERSION_NUMBER << 4) | 0;
  150. }
  151. return 0;
  152. }
  153. static void kvaser_pci_xilinx_io_write(void *opaque, hwaddr addr, uint64_t data,
  154. unsigned size)
  155. {
  156. }
  157. static const MemoryRegionOps kvaser_pci_s5920_io_ops = {
  158. .read = kvaser_pci_s5920_io_read,
  159. .write = kvaser_pci_s5920_io_write,
  160. .endianness = DEVICE_LITTLE_ENDIAN,
  161. .impl = {
  162. .min_access_size = 4,
  163. .max_access_size = 4,
  164. },
  165. };
  166. static const MemoryRegionOps kvaser_pci_sja_io_ops = {
  167. .read = kvaser_pci_sja_io_read,
  168. .write = kvaser_pci_sja_io_write,
  169. .endianness = DEVICE_LITTLE_ENDIAN,
  170. .impl = {
  171. .max_access_size = 1,
  172. },
  173. };
  174. static const MemoryRegionOps kvaser_pci_xilinx_io_ops = {
  175. .read = kvaser_pci_xilinx_io_read,
  176. .write = kvaser_pci_xilinx_io_write,
  177. .endianness = DEVICE_LITTLE_ENDIAN,
  178. .impl = {
  179. .max_access_size = 1,
  180. },
  181. };
  182. static void kvaser_pci_realize(PCIDevice *pci_dev, Error **errp)
  183. {
  184. KvaserPCIState *d = KVASER_PCI_DEV(pci_dev);
  185. CanSJA1000State *s = &d->sja_state;
  186. uint8_t *pci_conf;
  187. pci_conf = pci_dev->config;
  188. pci_conf[PCI_INTERRUPT_PIN] = 0x01; /* interrupt pin A */
  189. d->irq = qemu_allocate_irq(kvaser_pci_irq_handler, d, 0);
  190. can_sja_init(s, d->irq);
  191. if (can_sja_connect_to_bus(s, d->canbus) < 0) {
  192. error_setg(errp, "can_sja_connect_to_bus failed");
  193. return;
  194. }
  195. memory_region_init_io(&d->s5920_io, OBJECT(d), &kvaser_pci_s5920_io_ops,
  196. d, "kvaser_pci-s5920", KVASER_PCI_S5920_RANGE);
  197. memory_region_init_io(&d->sja_io, OBJECT(d), &kvaser_pci_sja_io_ops,
  198. d, "kvaser_pci-sja", KVASER_PCI_SJA_RANGE);
  199. memory_region_init_io(&d->xilinx_io, OBJECT(d), &kvaser_pci_xilinx_io_ops,
  200. d, "kvaser_pci-xilinx", KVASER_PCI_XILINX_RANGE);
  201. pci_register_bar(&d->dev, /*BAR*/ 0, PCI_BASE_ADDRESS_SPACE_IO,
  202. &d->s5920_io);
  203. pci_register_bar(&d->dev, /*BAR*/ 1, PCI_BASE_ADDRESS_SPACE_IO,
  204. &d->sja_io);
  205. pci_register_bar(&d->dev, /*BAR*/ 2, PCI_BASE_ADDRESS_SPACE_IO,
  206. &d->xilinx_io);
  207. }
  208. static void kvaser_pci_exit(PCIDevice *pci_dev)
  209. {
  210. KvaserPCIState *d = KVASER_PCI_DEV(pci_dev);
  211. CanSJA1000State *s = &d->sja_state;
  212. can_sja_disconnect(s);
  213. qemu_free_irq(d->irq);
  214. }
  215. static const VMStateDescription vmstate_kvaser_pci = {
  216. .name = "kvaser_pci",
  217. .version_id = 1,
  218. .minimum_version_id = 1,
  219. .minimum_version_id_old = 1,
  220. .fields = (VMStateField[]) {
  221. VMSTATE_PCI_DEVICE(dev, KvaserPCIState),
  222. /* Load this before sja_state. */
  223. VMSTATE_UINT32(s5920_intcsr, KvaserPCIState),
  224. VMSTATE_STRUCT(sja_state, KvaserPCIState, 0, vmstate_can_sja,
  225. CanSJA1000State),
  226. VMSTATE_END_OF_LIST()
  227. }
  228. };
  229. static void kvaser_pci_instance_init(Object *obj)
  230. {
  231. KvaserPCIState *d = KVASER_PCI_DEV(obj);
  232. object_property_add_link(obj, "canbus", TYPE_CAN_BUS,
  233. (Object **)&d->canbus,
  234. qdev_prop_allow_set_link_before_realize,
  235. 0, &error_abort);
  236. }
  237. static void kvaser_pci_class_init(ObjectClass *klass, void *data)
  238. {
  239. DeviceClass *dc = DEVICE_CLASS(klass);
  240. PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);
  241. k->realize = kvaser_pci_realize;
  242. k->exit = kvaser_pci_exit;
  243. k->vendor_id = KVASER_PCI_VENDOR_ID1;
  244. k->device_id = KVASER_PCI_DEVICE_ID1;
  245. k->revision = 0x00;
  246. k->class_id = 0x00ff00;
  247. dc->desc = "Kvaser PCICANx";
  248. dc->vmsd = &vmstate_kvaser_pci;
  249. dc->reset = kvaser_pci_reset;
  250. set_bit(DEVICE_CATEGORY_MISC, dc->categories);
  251. }
  252. static const TypeInfo kvaser_pci_info = {
  253. .name = TYPE_CAN_PCI_DEV,
  254. .parent = TYPE_PCI_DEVICE,
  255. .instance_size = sizeof(KvaserPCIState),
  256. .class_init = kvaser_pci_class_init,
  257. .instance_init = kvaser_pci_instance_init,
  258. .interfaces = (InterfaceInfo[]) {
  259. { INTERFACE_CONVENTIONAL_PCI_DEVICE },
  260. { },
  261. },
  262. };
  263. static void kvaser_pci_register_types(void)
  264. {
  265. type_register_static(&kvaser_pci_info);
  266. }
  267. type_init(kvaser_pci_register_types)