pcnet.c 55 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765
  1. /*
  2. * QEMU AMD PC-Net II (Am79C970A) emulation
  3. *
  4. * Copyright (c) 2004 Antony T Curtis
  5. *
  6. * Permission is hereby granted, free of charge, to any person obtaining a copy
  7. * of this software and associated documentation files (the "Software"), to deal
  8. * in the Software without restriction, including without limitation the rights
  9. * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  10. * copies of the Software, and to permit persons to whom the Software is
  11. * furnished to do so, subject to the following conditions:
  12. *
  13. * The above copyright notice and this permission notice shall be included in
  14. * all copies or substantial portions of the Software.
  15. *
  16. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  17. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  18. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  19. * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  20. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  21. * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  22. * THE SOFTWARE.
  23. */
  24. /* This software was written to be compatible with the specification:
  25. * AMD Am79C970A PCnet-PCI II Ethernet Controller Data-Sheet
  26. * AMD Publication# 19436 Rev:E Amendment/0 Issue Date: June 2000
  27. */
  28. /*
  29. * On Sparc32, this is the Lance (Am7990) part of chip STP2000 (Master I/O), also
  30. * produced as NCR89C100. See
  31. * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR89C100.txt
  32. * and
  33. * http://www.ibiblio.org/pub/historic-linux/early-ports/Sparc/NCR/NCR92C990.txt
  34. */
  35. #include "qdev.h"
  36. #include "net.h"
  37. #include "qemu-timer.h"
  38. #include "qemu_socket.h"
  39. #include "sysemu.h"
  40. #include "pcnet.h"
  41. //#define PCNET_DEBUG
  42. //#define PCNET_DEBUG_IO
  43. //#define PCNET_DEBUG_BCR
  44. //#define PCNET_DEBUG_CSR
  45. //#define PCNET_DEBUG_RMD
  46. //#define PCNET_DEBUG_TMD
  47. //#define PCNET_DEBUG_MATCH
  48. struct qemu_ether_header {
  49. uint8_t ether_dhost[6];
  50. uint8_t ether_shost[6];
  51. uint16_t ether_type;
  52. };
  53. /* BUS CONFIGURATION REGISTERS */
  54. #define BCR_MSRDA 0
  55. #define BCR_MSWRA 1
  56. #define BCR_MC 2
  57. #define BCR_LNKST 4
  58. #define BCR_LED1 5
  59. #define BCR_LED2 6
  60. #define BCR_LED3 7
  61. #define BCR_FDC 9
  62. #define BCR_BSBC 18
  63. #define BCR_EECAS 19
  64. #define BCR_SWS 20
  65. #define BCR_PLAT 22
  66. #define BCR_DWIO(S) !!((S)->bcr[BCR_BSBC] & 0x0080)
  67. #define BCR_SSIZE32(S) !!((S)->bcr[BCR_SWS ] & 0x0100)
  68. #define BCR_SWSTYLE(S) ((S)->bcr[BCR_SWS ] & 0x00FF)
  69. #define CSR_INIT(S) !!(((S)->csr[0])&0x0001)
  70. #define CSR_STRT(S) !!(((S)->csr[0])&0x0002)
  71. #define CSR_STOP(S) !!(((S)->csr[0])&0x0004)
  72. #define CSR_TDMD(S) !!(((S)->csr[0])&0x0008)
  73. #define CSR_TXON(S) !!(((S)->csr[0])&0x0010)
  74. #define CSR_RXON(S) !!(((S)->csr[0])&0x0020)
  75. #define CSR_INEA(S) !!(((S)->csr[0])&0x0040)
  76. #define CSR_BSWP(S) !!(((S)->csr[3])&0x0004)
  77. #define CSR_LAPPEN(S) !!(((S)->csr[3])&0x0020)
  78. #define CSR_DXSUFLO(S) !!(((S)->csr[3])&0x0040)
  79. #define CSR_ASTRP_RCV(S) !!(((S)->csr[4])&0x0800)
  80. #define CSR_DPOLL(S) !!(((S)->csr[4])&0x1000)
  81. #define CSR_SPND(S) !!(((S)->csr[5])&0x0001)
  82. #define CSR_LTINTEN(S) !!(((S)->csr[5])&0x4000)
  83. #define CSR_TOKINTD(S) !!(((S)->csr[5])&0x8000)
  84. #define CSR_DRX(S) !!(((S)->csr[15])&0x0001)
  85. #define CSR_DTX(S) !!(((S)->csr[15])&0x0002)
  86. #define CSR_LOOP(S) !!(((S)->csr[15])&0x0004)
  87. #define CSR_DXMTFCS(S) !!(((S)->csr[15])&0x0008)
  88. #define CSR_DRCVPA(S) !!(((S)->csr[15])&0x2000)
  89. #define CSR_DRCVBC(S) !!(((S)->csr[15])&0x4000)
  90. #define CSR_PROM(S) !!(((S)->csr[15])&0x8000)
  91. #define CSR_CRBC(S) ((S)->csr[40])
  92. #define CSR_CRST(S) ((S)->csr[41])
  93. #define CSR_CXBC(S) ((S)->csr[42])
  94. #define CSR_CXST(S) ((S)->csr[43])
  95. #define CSR_NRBC(S) ((S)->csr[44])
  96. #define CSR_NRST(S) ((S)->csr[45])
  97. #define CSR_POLL(S) ((S)->csr[46])
  98. #define CSR_PINT(S) ((S)->csr[47])
  99. #define CSR_RCVRC(S) ((S)->csr[72])
  100. #define CSR_XMTRC(S) ((S)->csr[74])
  101. #define CSR_RCVRL(S) ((S)->csr[76])
  102. #define CSR_XMTRL(S) ((S)->csr[78])
  103. #define CSR_MISSC(S) ((S)->csr[112])
  104. #define CSR_IADR(S) ((S)->csr[ 1] | ((uint32_t)(S)->csr[ 2] << 16))
  105. #define CSR_CRBA(S) ((S)->csr[18] | ((uint32_t)(S)->csr[19] << 16))
  106. #define CSR_CXBA(S) ((S)->csr[20] | ((uint32_t)(S)->csr[21] << 16))
  107. #define CSR_NRBA(S) ((S)->csr[22] | ((uint32_t)(S)->csr[23] << 16))
  108. #define CSR_BADR(S) ((S)->csr[24] | ((uint32_t)(S)->csr[25] << 16))
  109. #define CSR_NRDA(S) ((S)->csr[26] | ((uint32_t)(S)->csr[27] << 16))
  110. #define CSR_CRDA(S) ((S)->csr[28] | ((uint32_t)(S)->csr[29] << 16))
  111. #define CSR_BADX(S) ((S)->csr[30] | ((uint32_t)(S)->csr[31] << 16))
  112. #define CSR_NXDA(S) ((S)->csr[32] | ((uint32_t)(S)->csr[33] << 16))
  113. #define CSR_CXDA(S) ((S)->csr[34] | ((uint32_t)(S)->csr[35] << 16))
  114. #define CSR_NNRD(S) ((S)->csr[36] | ((uint32_t)(S)->csr[37] << 16))
  115. #define CSR_NNXD(S) ((S)->csr[38] | ((uint32_t)(S)->csr[39] << 16))
  116. #define CSR_PXDA(S) ((S)->csr[60] | ((uint32_t)(S)->csr[61] << 16))
  117. #define CSR_NXBA(S) ((S)->csr[64] | ((uint32_t)(S)->csr[65] << 16))
  118. #define PHYSADDR(S,A) \
  119. (BCR_SSIZE32(S) ? (A) : (A) | ((0xff00 & (uint32_t)(S)->csr[2])<<16))
  120. struct pcnet_initblk16 {
  121. uint16_t mode;
  122. uint16_t padr[3];
  123. uint16_t ladrf[4];
  124. uint32_t rdra;
  125. uint32_t tdra;
  126. };
  127. struct pcnet_initblk32 {
  128. uint16_t mode;
  129. uint8_t rlen;
  130. uint8_t tlen;
  131. uint16_t padr[3];
  132. uint16_t _res;
  133. uint16_t ladrf[4];
  134. uint32_t rdra;
  135. uint32_t tdra;
  136. };
  137. struct pcnet_TMD {
  138. uint32_t tbadr;
  139. int16_t length;
  140. int16_t status;
  141. uint32_t misc;
  142. uint32_t res;
  143. };
  144. #define TMDL_BCNT_MASK 0x0fff
  145. #define TMDL_BCNT_SH 0
  146. #define TMDL_ONES_MASK 0xf000
  147. #define TMDL_ONES_SH 12
  148. #define TMDS_BPE_MASK 0x0080
  149. #define TMDS_BPE_SH 7
  150. #define TMDS_ENP_MASK 0x0100
  151. #define TMDS_ENP_SH 8
  152. #define TMDS_STP_MASK 0x0200
  153. #define TMDS_STP_SH 9
  154. #define TMDS_DEF_MASK 0x0400
  155. #define TMDS_DEF_SH 10
  156. #define TMDS_ONE_MASK 0x0800
  157. #define TMDS_ONE_SH 11
  158. #define TMDS_LTINT_MASK 0x1000
  159. #define TMDS_LTINT_SH 12
  160. #define TMDS_NOFCS_MASK 0x2000
  161. #define TMDS_NOFCS_SH 13
  162. #define TMDS_ADDFCS_MASK TMDS_NOFCS_MASK
  163. #define TMDS_ADDFCS_SH TMDS_NOFCS_SH
  164. #define TMDS_ERR_MASK 0x4000
  165. #define TMDS_ERR_SH 14
  166. #define TMDS_OWN_MASK 0x8000
  167. #define TMDS_OWN_SH 15
  168. #define TMDM_TRC_MASK 0x0000000f
  169. #define TMDM_TRC_SH 0
  170. #define TMDM_TDR_MASK 0x03ff0000
  171. #define TMDM_TDR_SH 16
  172. #define TMDM_RTRY_MASK 0x04000000
  173. #define TMDM_RTRY_SH 26
  174. #define TMDM_LCAR_MASK 0x08000000
  175. #define TMDM_LCAR_SH 27
  176. #define TMDM_LCOL_MASK 0x10000000
  177. #define TMDM_LCOL_SH 28
  178. #define TMDM_EXDEF_MASK 0x20000000
  179. #define TMDM_EXDEF_SH 29
  180. #define TMDM_UFLO_MASK 0x40000000
  181. #define TMDM_UFLO_SH 30
  182. #define TMDM_BUFF_MASK 0x80000000
  183. #define TMDM_BUFF_SH 31
  184. struct pcnet_RMD {
  185. uint32_t rbadr;
  186. int16_t buf_length;
  187. int16_t status;
  188. uint32_t msg_length;
  189. uint32_t res;
  190. };
  191. #define RMDL_BCNT_MASK 0x0fff
  192. #define RMDL_BCNT_SH 0
  193. #define RMDL_ONES_MASK 0xf000
  194. #define RMDL_ONES_SH 12
  195. #define RMDS_BAM_MASK 0x0010
  196. #define RMDS_BAM_SH 4
  197. #define RMDS_LFAM_MASK 0x0020
  198. #define RMDS_LFAM_SH 5
  199. #define RMDS_PAM_MASK 0x0040
  200. #define RMDS_PAM_SH 6
  201. #define RMDS_BPE_MASK 0x0080
  202. #define RMDS_BPE_SH 7
  203. #define RMDS_ENP_MASK 0x0100
  204. #define RMDS_ENP_SH 8
  205. #define RMDS_STP_MASK 0x0200
  206. #define RMDS_STP_SH 9
  207. #define RMDS_BUFF_MASK 0x0400
  208. #define RMDS_BUFF_SH 10
  209. #define RMDS_CRC_MASK 0x0800
  210. #define RMDS_CRC_SH 11
  211. #define RMDS_OFLO_MASK 0x1000
  212. #define RMDS_OFLO_SH 12
  213. #define RMDS_FRAM_MASK 0x2000
  214. #define RMDS_FRAM_SH 13
  215. #define RMDS_ERR_MASK 0x4000
  216. #define RMDS_ERR_SH 14
  217. #define RMDS_OWN_MASK 0x8000
  218. #define RMDS_OWN_SH 15
  219. #define RMDM_MCNT_MASK 0x00000fff
  220. #define RMDM_MCNT_SH 0
  221. #define RMDM_ZEROS_MASK 0x0000f000
  222. #define RMDM_ZEROS_SH 12
  223. #define RMDM_RPC_MASK 0x00ff0000
  224. #define RMDM_RPC_SH 16
  225. #define RMDM_RCC_MASK 0xff000000
  226. #define RMDM_RCC_SH 24
  227. #define SET_FIELD(regp, name, field, value) \
  228. (*(regp) = (*(regp) & ~(name ## _ ## field ## _MASK)) \
  229. | ((value) << name ## _ ## field ## _SH))
  230. #define GET_FIELD(reg, name, field) \
  231. (((reg) & name ## _ ## field ## _MASK) >> name ## _ ## field ## _SH)
  232. #define PRINT_TMD(T) printf( \
  233. "TMD0 : TBADR=0x%08x\n" \
  234. "TMD1 : OWN=%d, ERR=%d, FCS=%d, LTI=%d, " \
  235. "ONE=%d, DEF=%d, STP=%d, ENP=%d,\n" \
  236. " BPE=%d, BCNT=%d\n" \
  237. "TMD2 : BUF=%d, UFL=%d, EXD=%d, LCO=%d, " \
  238. "LCA=%d, RTR=%d,\n" \
  239. " TDR=%d, TRC=%d\n", \
  240. (T)->tbadr, \
  241. GET_FIELD((T)->status, TMDS, OWN), \
  242. GET_FIELD((T)->status, TMDS, ERR), \
  243. GET_FIELD((T)->status, TMDS, NOFCS), \
  244. GET_FIELD((T)->status, TMDS, LTINT), \
  245. GET_FIELD((T)->status, TMDS, ONE), \
  246. GET_FIELD((T)->status, TMDS, DEF), \
  247. GET_FIELD((T)->status, TMDS, STP), \
  248. GET_FIELD((T)->status, TMDS, ENP), \
  249. GET_FIELD((T)->status, TMDS, BPE), \
  250. 4096-GET_FIELD((T)->length, TMDL, BCNT), \
  251. GET_FIELD((T)->misc, TMDM, BUFF), \
  252. GET_FIELD((T)->misc, TMDM, UFLO), \
  253. GET_FIELD((T)->misc, TMDM, EXDEF), \
  254. GET_FIELD((T)->misc, TMDM, LCOL), \
  255. GET_FIELD((T)->misc, TMDM, LCAR), \
  256. GET_FIELD((T)->misc, TMDM, RTRY), \
  257. GET_FIELD((T)->misc, TMDM, TDR), \
  258. GET_FIELD((T)->misc, TMDM, TRC))
  259. #define PRINT_RMD(R) printf( \
  260. "RMD0 : RBADR=0x%08x\n" \
  261. "RMD1 : OWN=%d, ERR=%d, FRAM=%d, OFLO=%d, " \
  262. "CRC=%d, BUFF=%d, STP=%d, ENP=%d,\n " \
  263. "BPE=%d, PAM=%d, LAFM=%d, BAM=%d, ONES=%d, BCNT=%d\n" \
  264. "RMD2 : RCC=%d, RPC=%d, MCNT=%d, ZEROS=%d\n", \
  265. (R)->rbadr, \
  266. GET_FIELD((R)->status, RMDS, OWN), \
  267. GET_FIELD((R)->status, RMDS, ERR), \
  268. GET_FIELD((R)->status, RMDS, FRAM), \
  269. GET_FIELD((R)->status, RMDS, OFLO), \
  270. GET_FIELD((R)->status, RMDS, CRC), \
  271. GET_FIELD((R)->status, RMDS, BUFF), \
  272. GET_FIELD((R)->status, RMDS, STP), \
  273. GET_FIELD((R)->status, RMDS, ENP), \
  274. GET_FIELD((R)->status, RMDS, BPE), \
  275. GET_FIELD((R)->status, RMDS, PAM), \
  276. GET_FIELD((R)->status, RMDS, LFAM), \
  277. GET_FIELD((R)->status, RMDS, BAM), \
  278. GET_FIELD((R)->buf_length, RMDL, ONES), \
  279. 4096-GET_FIELD((R)->buf_length, RMDL, BCNT), \
  280. GET_FIELD((R)->msg_length, RMDM, RCC), \
  281. GET_FIELD((R)->msg_length, RMDM, RPC), \
  282. GET_FIELD((R)->msg_length, RMDM, MCNT), \
  283. GET_FIELD((R)->msg_length, RMDM, ZEROS))
  284. static inline void pcnet_tmd_load(PCNetState *s, struct pcnet_TMD *tmd,
  285. target_phys_addr_t addr)
  286. {
  287. if (!BCR_SSIZE32(s)) {
  288. struct {
  289. uint32_t tbadr;
  290. int16_t length;
  291. int16_t status;
  292. } xda;
  293. s->phys_mem_read(s->dma_opaque, addr, (void *)&xda, sizeof(xda), 0);
  294. tmd->tbadr = le32_to_cpu(xda.tbadr) & 0xffffff;
  295. tmd->length = le16_to_cpu(xda.length);
  296. tmd->status = (le32_to_cpu(xda.tbadr) >> 16) & 0xff00;
  297. tmd->misc = le16_to_cpu(xda.status) << 16;
  298. tmd->res = 0;
  299. } else {
  300. s->phys_mem_read(s->dma_opaque, addr, (void *)tmd, sizeof(*tmd), 0);
  301. le32_to_cpus(&tmd->tbadr);
  302. le16_to_cpus((uint16_t *)&tmd->length);
  303. le16_to_cpus((uint16_t *)&tmd->status);
  304. le32_to_cpus(&tmd->misc);
  305. le32_to_cpus(&tmd->res);
  306. if (BCR_SWSTYLE(s) == 3) {
  307. uint32_t tmp = tmd->tbadr;
  308. tmd->tbadr = tmd->misc;
  309. tmd->misc = tmp;
  310. }
  311. }
  312. }
  313. static inline void pcnet_tmd_store(PCNetState *s, const struct pcnet_TMD *tmd,
  314. target_phys_addr_t addr)
  315. {
  316. if (!BCR_SSIZE32(s)) {
  317. struct {
  318. uint32_t tbadr;
  319. int16_t length;
  320. int16_t status;
  321. } xda;
  322. xda.tbadr = cpu_to_le32((tmd->tbadr & 0xffffff) |
  323. ((tmd->status & 0xff00) << 16));
  324. xda.length = cpu_to_le16(tmd->length);
  325. xda.status = cpu_to_le16(tmd->misc >> 16);
  326. s->phys_mem_write(s->dma_opaque, addr, (void *)&xda, sizeof(xda), 0);
  327. } else {
  328. struct {
  329. uint32_t tbadr;
  330. int16_t length;
  331. int16_t status;
  332. uint32_t misc;
  333. uint32_t res;
  334. } xda;
  335. xda.tbadr = cpu_to_le32(tmd->tbadr);
  336. xda.length = cpu_to_le16(tmd->length);
  337. xda.status = cpu_to_le16(tmd->status);
  338. xda.misc = cpu_to_le32(tmd->misc);
  339. xda.res = cpu_to_le32(tmd->res);
  340. if (BCR_SWSTYLE(s) == 3) {
  341. uint32_t tmp = xda.tbadr;
  342. xda.tbadr = xda.misc;
  343. xda.misc = tmp;
  344. }
  345. s->phys_mem_write(s->dma_opaque, addr, (void *)&xda, sizeof(xda), 0);
  346. }
  347. }
  348. static inline void pcnet_rmd_load(PCNetState *s, struct pcnet_RMD *rmd,
  349. target_phys_addr_t addr)
  350. {
  351. if (!BCR_SSIZE32(s)) {
  352. struct {
  353. uint32_t rbadr;
  354. int16_t buf_length;
  355. int16_t msg_length;
  356. } rda;
  357. s->phys_mem_read(s->dma_opaque, addr, (void *)&rda, sizeof(rda), 0);
  358. rmd->rbadr = le32_to_cpu(rda.rbadr) & 0xffffff;
  359. rmd->buf_length = le16_to_cpu(rda.buf_length);
  360. rmd->status = (le32_to_cpu(rda.rbadr) >> 16) & 0xff00;
  361. rmd->msg_length = le16_to_cpu(rda.msg_length);
  362. rmd->res = 0;
  363. } else {
  364. s->phys_mem_read(s->dma_opaque, addr, (void *)rmd, sizeof(*rmd), 0);
  365. le32_to_cpus(&rmd->rbadr);
  366. le16_to_cpus((uint16_t *)&rmd->buf_length);
  367. le16_to_cpus((uint16_t *)&rmd->status);
  368. le32_to_cpus(&rmd->msg_length);
  369. le32_to_cpus(&rmd->res);
  370. if (BCR_SWSTYLE(s) == 3) {
  371. uint32_t tmp = rmd->rbadr;
  372. rmd->rbadr = rmd->msg_length;
  373. rmd->msg_length = tmp;
  374. }
  375. }
  376. }
  377. static inline void pcnet_rmd_store(PCNetState *s, struct pcnet_RMD *rmd,
  378. target_phys_addr_t addr)
  379. {
  380. if (!BCR_SSIZE32(s)) {
  381. struct {
  382. uint32_t rbadr;
  383. int16_t buf_length;
  384. int16_t msg_length;
  385. } rda;
  386. rda.rbadr = cpu_to_le32((rmd->rbadr & 0xffffff) |
  387. ((rmd->status & 0xff00) << 16));
  388. rda.buf_length = cpu_to_le16(rmd->buf_length);
  389. rda.msg_length = cpu_to_le16(rmd->msg_length);
  390. s->phys_mem_write(s->dma_opaque, addr, (void *)&rda, sizeof(rda), 0);
  391. } else {
  392. struct {
  393. uint32_t rbadr;
  394. int16_t buf_length;
  395. int16_t status;
  396. uint32_t msg_length;
  397. uint32_t res;
  398. } rda;
  399. rda.rbadr = cpu_to_le32(rmd->rbadr);
  400. rda.buf_length = cpu_to_le16(rmd->buf_length);
  401. rda.status = cpu_to_le16(rmd->status);
  402. rda.msg_length = cpu_to_le32(rmd->msg_length);
  403. rda.res = cpu_to_le32(rmd->res);
  404. if (BCR_SWSTYLE(s) == 3) {
  405. uint32_t tmp = rda.rbadr;
  406. rda.rbadr = rda.msg_length;
  407. rda.msg_length = tmp;
  408. }
  409. s->phys_mem_write(s->dma_opaque, addr, (void *)&rda, sizeof(rda), 0);
  410. }
  411. }
  412. #define TMDLOAD(TMD,ADDR) pcnet_tmd_load(s,TMD,ADDR)
  413. #define TMDSTORE(TMD,ADDR) pcnet_tmd_store(s,TMD,ADDR)
  414. #define RMDLOAD(RMD,ADDR) pcnet_rmd_load(s,RMD,ADDR)
  415. #define RMDSTORE(RMD,ADDR) pcnet_rmd_store(s,RMD,ADDR)
  416. #if 1
  417. #define CHECK_RMD(ADDR,RES) do { \
  418. struct pcnet_RMD rmd; \
  419. RMDLOAD(&rmd,(ADDR)); \
  420. (RES) |= (GET_FIELD(rmd.buf_length, RMDL, ONES) != 15) \
  421. || (GET_FIELD(rmd.msg_length, RMDM, ZEROS) != 0); \
  422. } while (0)
  423. #define CHECK_TMD(ADDR,RES) do { \
  424. struct pcnet_TMD tmd; \
  425. TMDLOAD(&tmd,(ADDR)); \
  426. (RES) |= (GET_FIELD(tmd.length, TMDL, ONES) != 15); \
  427. } while (0)
  428. #else
  429. #define CHECK_RMD(ADDR,RES) do { \
  430. switch (BCR_SWSTYLE(s)) { \
  431. case 0x00: \
  432. do { \
  433. uint16_t rda[4]; \
  434. s->phys_mem_read(s->dma_opaque, (ADDR), \
  435. (void *)&rda[0], sizeof(rda), 0); \
  436. (RES) |= (rda[2] & 0xf000)!=0xf000; \
  437. (RES) |= (rda[3] & 0xf000)!=0x0000; \
  438. } while (0); \
  439. break; \
  440. case 0x01: \
  441. case 0x02: \
  442. do { \
  443. uint32_t rda[4]; \
  444. s->phys_mem_read(s->dma_opaque, (ADDR), \
  445. (void *)&rda[0], sizeof(rda), 0); \
  446. (RES) |= (rda[1] & 0x0000f000L)!=0x0000f000L; \
  447. (RES) |= (rda[2] & 0x0000f000L)!=0x00000000L; \
  448. } while (0); \
  449. break; \
  450. case 0x03: \
  451. do { \
  452. uint32_t rda[4]; \
  453. s->phys_mem_read(s->dma_opaque, (ADDR), \
  454. (void *)&rda[0], sizeof(rda), 0); \
  455. (RES) |= (rda[0] & 0x0000f000L)!=0x00000000L; \
  456. (RES) |= (rda[1] & 0x0000f000L)!=0x0000f000L; \
  457. } while (0); \
  458. break; \
  459. } \
  460. } while (0)
  461. #define CHECK_TMD(ADDR,RES) do { \
  462. switch (BCR_SWSTYLE(s)) { \
  463. case 0x00: \
  464. do { \
  465. uint16_t xda[4]; \
  466. s->phys_mem_read(s->dma_opaque, (ADDR), \
  467. (void *)&xda[0], sizeof(xda), 0); \
  468. (RES) |= (xda[2] & 0xf000)!=0xf000; \
  469. } while (0); \
  470. break; \
  471. case 0x01: \
  472. case 0x02: \
  473. case 0x03: \
  474. do { \
  475. uint32_t xda[4]; \
  476. s->phys_mem_read(s->dma_opaque, (ADDR), \
  477. (void *)&xda[0], sizeof(xda), 0); \
  478. (RES) |= (xda[1] & 0x0000f000L)!=0x0000f000L; \
  479. } while (0); \
  480. break; \
  481. } \
  482. } while (0)
  483. #endif
  484. #define PRINT_PKTHDR(BUF) do { \
  485. struct qemu_ether_header *hdr = (void *)(BUF); \
  486. printf("packet dhost=%02x:%02x:%02x:%02x:%02x:%02x, " \
  487. "shost=%02x:%02x:%02x:%02x:%02x:%02x, " \
  488. "type=0x%04x\n", \
  489. hdr->ether_dhost[0],hdr->ether_dhost[1],hdr->ether_dhost[2], \
  490. hdr->ether_dhost[3],hdr->ether_dhost[4],hdr->ether_dhost[5], \
  491. hdr->ether_shost[0],hdr->ether_shost[1],hdr->ether_shost[2], \
  492. hdr->ether_shost[3],hdr->ether_shost[4],hdr->ether_shost[5], \
  493. be16_to_cpu(hdr->ether_type)); \
  494. } while (0)
  495. #define MULTICAST_FILTER_LEN 8
  496. static inline uint32_t lnc_mchash(const uint8_t *ether_addr)
  497. {
  498. #define LNC_POLYNOMIAL 0xEDB88320UL
  499. uint32_t crc = 0xFFFFFFFF;
  500. int idx, bit;
  501. uint8_t data;
  502. for (idx = 0; idx < 6; idx++) {
  503. for (data = *ether_addr++, bit = 0; bit < MULTICAST_FILTER_LEN; bit++) {
  504. crc = (crc >> 1) ^ (((crc ^ data) & 1) ? LNC_POLYNOMIAL : 0);
  505. data >>= 1;
  506. }
  507. }
  508. return crc;
  509. #undef LNC_POLYNOMIAL
  510. }
  511. #define CRC(crc, ch) (crc = (crc >> 8) ^ crctab[(crc ^ (ch)) & 0xff])
  512. /* generated using the AUTODIN II polynomial
  513. * x^32 + x^26 + x^23 + x^22 + x^16 +
  514. * x^12 + x^11 + x^10 + x^8 + x^7 + x^5 + x^4 + x^2 + x^1 + 1
  515. */
  516. static const uint32_t crctab[256] = {
  517. 0x00000000, 0x77073096, 0xee0e612c, 0x990951ba,
  518. 0x076dc419, 0x706af48f, 0xe963a535, 0x9e6495a3,
  519. 0x0edb8832, 0x79dcb8a4, 0xe0d5e91e, 0x97d2d988,
  520. 0x09b64c2b, 0x7eb17cbd, 0xe7b82d07, 0x90bf1d91,
  521. 0x1db71064, 0x6ab020f2, 0xf3b97148, 0x84be41de,
  522. 0x1adad47d, 0x6ddde4eb, 0xf4d4b551, 0x83d385c7,
  523. 0x136c9856, 0x646ba8c0, 0xfd62f97a, 0x8a65c9ec,
  524. 0x14015c4f, 0x63066cd9, 0xfa0f3d63, 0x8d080df5,
  525. 0x3b6e20c8, 0x4c69105e, 0xd56041e4, 0xa2677172,
  526. 0x3c03e4d1, 0x4b04d447, 0xd20d85fd, 0xa50ab56b,
  527. 0x35b5a8fa, 0x42b2986c, 0xdbbbc9d6, 0xacbcf940,
  528. 0x32d86ce3, 0x45df5c75, 0xdcd60dcf, 0xabd13d59,
  529. 0x26d930ac, 0x51de003a, 0xc8d75180, 0xbfd06116,
  530. 0x21b4f4b5, 0x56b3c423, 0xcfba9599, 0xb8bda50f,
  531. 0x2802b89e, 0x5f058808, 0xc60cd9b2, 0xb10be924,
  532. 0x2f6f7c87, 0x58684c11, 0xc1611dab, 0xb6662d3d,
  533. 0x76dc4190, 0x01db7106, 0x98d220bc, 0xefd5102a,
  534. 0x71b18589, 0x06b6b51f, 0x9fbfe4a5, 0xe8b8d433,
  535. 0x7807c9a2, 0x0f00f934, 0x9609a88e, 0xe10e9818,
  536. 0x7f6a0dbb, 0x086d3d2d, 0x91646c97, 0xe6635c01,
  537. 0x6b6b51f4, 0x1c6c6162, 0x856530d8, 0xf262004e,
  538. 0x6c0695ed, 0x1b01a57b, 0x8208f4c1, 0xf50fc457,
  539. 0x65b0d9c6, 0x12b7e950, 0x8bbeb8ea, 0xfcb9887c,
  540. 0x62dd1ddf, 0x15da2d49, 0x8cd37cf3, 0xfbd44c65,
  541. 0x4db26158, 0x3ab551ce, 0xa3bc0074, 0xd4bb30e2,
  542. 0x4adfa541, 0x3dd895d7, 0xa4d1c46d, 0xd3d6f4fb,
  543. 0x4369e96a, 0x346ed9fc, 0xad678846, 0xda60b8d0,
  544. 0x44042d73, 0x33031de5, 0xaa0a4c5f, 0xdd0d7cc9,
  545. 0x5005713c, 0x270241aa, 0xbe0b1010, 0xc90c2086,
  546. 0x5768b525, 0x206f85b3, 0xb966d409, 0xce61e49f,
  547. 0x5edef90e, 0x29d9c998, 0xb0d09822, 0xc7d7a8b4,
  548. 0x59b33d17, 0x2eb40d81, 0xb7bd5c3b, 0xc0ba6cad,
  549. 0xedb88320, 0x9abfb3b6, 0x03b6e20c, 0x74b1d29a,
  550. 0xead54739, 0x9dd277af, 0x04db2615, 0x73dc1683,
  551. 0xe3630b12, 0x94643b84, 0x0d6d6a3e, 0x7a6a5aa8,
  552. 0xe40ecf0b, 0x9309ff9d, 0x0a00ae27, 0x7d079eb1,
  553. 0xf00f9344, 0x8708a3d2, 0x1e01f268, 0x6906c2fe,
  554. 0xf762575d, 0x806567cb, 0x196c3671, 0x6e6b06e7,
  555. 0xfed41b76, 0x89d32be0, 0x10da7a5a, 0x67dd4acc,
  556. 0xf9b9df6f, 0x8ebeeff9, 0x17b7be43, 0x60b08ed5,
  557. 0xd6d6a3e8, 0xa1d1937e, 0x38d8c2c4, 0x4fdff252,
  558. 0xd1bb67f1, 0xa6bc5767, 0x3fb506dd, 0x48b2364b,
  559. 0xd80d2bda, 0xaf0a1b4c, 0x36034af6, 0x41047a60,
  560. 0xdf60efc3, 0xa867df55, 0x316e8eef, 0x4669be79,
  561. 0xcb61b38c, 0xbc66831a, 0x256fd2a0, 0x5268e236,
  562. 0xcc0c7795, 0xbb0b4703, 0x220216b9, 0x5505262f,
  563. 0xc5ba3bbe, 0xb2bd0b28, 0x2bb45a92, 0x5cb36a04,
  564. 0xc2d7ffa7, 0xb5d0cf31, 0x2cd99e8b, 0x5bdeae1d,
  565. 0x9b64c2b0, 0xec63f226, 0x756aa39c, 0x026d930a,
  566. 0x9c0906a9, 0xeb0e363f, 0x72076785, 0x05005713,
  567. 0x95bf4a82, 0xe2b87a14, 0x7bb12bae, 0x0cb61b38,
  568. 0x92d28e9b, 0xe5d5be0d, 0x7cdcefb7, 0x0bdbdf21,
  569. 0x86d3d2d4, 0xf1d4e242, 0x68ddb3f8, 0x1fda836e,
  570. 0x81be16cd, 0xf6b9265b, 0x6fb077e1, 0x18b74777,
  571. 0x88085ae6, 0xff0f6a70, 0x66063bca, 0x11010b5c,
  572. 0x8f659eff, 0xf862ae69, 0x616bffd3, 0x166ccf45,
  573. 0xa00ae278, 0xd70dd2ee, 0x4e048354, 0x3903b3c2,
  574. 0xa7672661, 0xd06016f7, 0x4969474d, 0x3e6e77db,
  575. 0xaed16a4a, 0xd9d65adc, 0x40df0b66, 0x37d83bf0,
  576. 0xa9bcae53, 0xdebb9ec5, 0x47b2cf7f, 0x30b5ffe9,
  577. 0xbdbdf21c, 0xcabac28a, 0x53b39330, 0x24b4a3a6,
  578. 0xbad03605, 0xcdd70693, 0x54de5729, 0x23d967bf,
  579. 0xb3667a2e, 0xc4614ab8, 0x5d681b02, 0x2a6f2b94,
  580. 0xb40bbe37, 0xc30c8ea1, 0x5a05df1b, 0x2d02ef8d,
  581. };
  582. static inline int padr_match(PCNetState *s, const uint8_t *buf, int size)
  583. {
  584. struct qemu_ether_header *hdr = (void *)buf;
  585. uint8_t padr[6] = {
  586. s->csr[12] & 0xff, s->csr[12] >> 8,
  587. s->csr[13] & 0xff, s->csr[13] >> 8,
  588. s->csr[14] & 0xff, s->csr[14] >> 8
  589. };
  590. int result = (!CSR_DRCVPA(s)) && !memcmp(hdr->ether_dhost, padr, 6);
  591. #ifdef PCNET_DEBUG_MATCH
  592. printf("packet dhost=%02x:%02x:%02x:%02x:%02x:%02x, "
  593. "padr=%02x:%02x:%02x:%02x:%02x:%02x\n",
  594. hdr->ether_dhost[0],hdr->ether_dhost[1],hdr->ether_dhost[2],
  595. hdr->ether_dhost[3],hdr->ether_dhost[4],hdr->ether_dhost[5],
  596. padr[0],padr[1],padr[2],padr[3],padr[4],padr[5]);
  597. printf("padr_match result=%d\n", result);
  598. #endif
  599. return result;
  600. }
  601. static inline int padr_bcast(PCNetState *s, const uint8_t *buf, int size)
  602. {
  603. static const uint8_t BCAST[6] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
  604. struct qemu_ether_header *hdr = (void *)buf;
  605. int result = !CSR_DRCVBC(s) && !memcmp(hdr->ether_dhost, BCAST, 6);
  606. #ifdef PCNET_DEBUG_MATCH
  607. printf("padr_bcast result=%d\n", result);
  608. #endif
  609. return result;
  610. }
  611. static inline int ladr_match(PCNetState *s, const uint8_t *buf, int size)
  612. {
  613. struct qemu_ether_header *hdr = (void *)buf;
  614. if ((*(hdr->ether_dhost)&0x01) &&
  615. ((uint64_t *)&s->csr[8])[0] != 0LL) {
  616. uint8_t ladr[8] = {
  617. s->csr[8] & 0xff, s->csr[8] >> 8,
  618. s->csr[9] & 0xff, s->csr[9] >> 8,
  619. s->csr[10] & 0xff, s->csr[10] >> 8,
  620. s->csr[11] & 0xff, s->csr[11] >> 8
  621. };
  622. int index = lnc_mchash(hdr->ether_dhost) >> 26;
  623. return !!(ladr[index >> 3] & (1 << (index & 7)));
  624. }
  625. return 0;
  626. }
  627. static inline target_phys_addr_t pcnet_rdra_addr(PCNetState *s, int idx)
  628. {
  629. while (idx < 1) idx += CSR_RCVRL(s);
  630. return s->rdra + ((CSR_RCVRL(s) - idx) * (BCR_SWSTYLE(s) ? 16 : 8));
  631. }
  632. static inline int64_t pcnet_get_next_poll_time(PCNetState *s, int64_t current_time)
  633. {
  634. int64_t next_time = current_time +
  635. muldiv64(65536 - (CSR_SPND(s) ? 0 : CSR_POLL(s)),
  636. get_ticks_per_sec(), 33000000L);
  637. if (next_time <= current_time)
  638. next_time = current_time + 1;
  639. return next_time;
  640. }
  641. static void pcnet_poll(PCNetState *s);
  642. static void pcnet_poll_timer(void *opaque);
  643. static uint32_t pcnet_csr_readw(PCNetState *s, uint32_t rap);
  644. static void pcnet_csr_writew(PCNetState *s, uint32_t rap, uint32_t new_value);
  645. static void pcnet_bcr_writew(PCNetState *s, uint32_t rap, uint32_t val);
  646. static void pcnet_s_reset(PCNetState *s)
  647. {
  648. #ifdef PCNET_DEBUG
  649. printf("pcnet_s_reset\n");
  650. #endif
  651. s->lnkst = 0x40;
  652. s->rdra = 0;
  653. s->tdra = 0;
  654. s->rap = 0;
  655. s->bcr[BCR_BSBC] &= ~0x0080;
  656. s->csr[0] = 0x0004;
  657. s->csr[3] = 0x0000;
  658. s->csr[4] = 0x0115;
  659. s->csr[5] = 0x0000;
  660. s->csr[6] = 0x0000;
  661. s->csr[8] = 0;
  662. s->csr[9] = 0;
  663. s->csr[10] = 0;
  664. s->csr[11] = 0;
  665. s->csr[12] = le16_to_cpu(((uint16_t *)&s->prom[0])[0]);
  666. s->csr[13] = le16_to_cpu(((uint16_t *)&s->prom[0])[1]);
  667. s->csr[14] = le16_to_cpu(((uint16_t *)&s->prom[0])[2]);
  668. s->csr[15] &= 0x21c4;
  669. s->csr[72] = 1;
  670. s->csr[74] = 1;
  671. s->csr[76] = 1;
  672. s->csr[78] = 1;
  673. s->csr[80] = 0x1410;
  674. s->csr[88] = 0x1003;
  675. s->csr[89] = 0x0262;
  676. s->csr[94] = 0x0000;
  677. s->csr[100] = 0x0200;
  678. s->csr[103] = 0x0105;
  679. s->csr[103] = 0x0105;
  680. s->csr[112] = 0x0000;
  681. s->csr[114] = 0x0000;
  682. s->csr[122] = 0x0000;
  683. s->csr[124] = 0x0000;
  684. s->tx_busy = 0;
  685. }
  686. static void pcnet_update_irq(PCNetState *s)
  687. {
  688. int isr = 0;
  689. s->csr[0] &= ~0x0080;
  690. #if 1
  691. if (((s->csr[0] & ~s->csr[3]) & 0x5f00) ||
  692. (((s->csr[4]>>1) & ~s->csr[4]) & 0x0115) ||
  693. (((s->csr[5]>>1) & s->csr[5]) & 0x0048))
  694. #else
  695. if ((!(s->csr[3] & 0x4000) && !!(s->csr[0] & 0x4000)) /* BABL */ ||
  696. (!(s->csr[3] & 0x1000) && !!(s->csr[0] & 0x1000)) /* MISS */ ||
  697. (!(s->csr[3] & 0x0100) && !!(s->csr[0] & 0x0100)) /* IDON */ ||
  698. (!(s->csr[3] & 0x0200) && !!(s->csr[0] & 0x0200)) /* TINT */ ||
  699. (!(s->csr[3] & 0x0400) && !!(s->csr[0] & 0x0400)) /* RINT */ ||
  700. (!(s->csr[3] & 0x0800) && !!(s->csr[0] & 0x0800)) /* MERR */ ||
  701. (!(s->csr[4] & 0x0001) && !!(s->csr[4] & 0x0002)) /* JAB */ ||
  702. (!(s->csr[4] & 0x0004) && !!(s->csr[4] & 0x0008)) /* TXSTRT */ ||
  703. (!(s->csr[4] & 0x0010) && !!(s->csr[4] & 0x0020)) /* RCVO */ ||
  704. (!(s->csr[4] & 0x0100) && !!(s->csr[4] & 0x0200)) /* MFCO */ ||
  705. (!!(s->csr[5] & 0x0040) && !!(s->csr[5] & 0x0080)) /* EXDINT */ ||
  706. (!!(s->csr[5] & 0x0008) && !!(s->csr[5] & 0x0010)) /* MPINT */)
  707. #endif
  708. {
  709. isr = CSR_INEA(s);
  710. s->csr[0] |= 0x0080;
  711. }
  712. if (!!(s->csr[4] & 0x0080) && CSR_INEA(s)) { /* UINT */
  713. s->csr[4] &= ~0x0080;
  714. s->csr[4] |= 0x0040;
  715. s->csr[0] |= 0x0080;
  716. isr = 1;
  717. #ifdef PCNET_DEBUG
  718. printf("pcnet user int\n");
  719. #endif
  720. }
  721. #if 1
  722. if (((s->csr[5]>>1) & s->csr[5]) & 0x0500)
  723. #else
  724. if ((!!(s->csr[5] & 0x0400) && !!(s->csr[5] & 0x0800)) /* SINT */ ||
  725. (!!(s->csr[5] & 0x0100) && !!(s->csr[5] & 0x0200)) /* SLPINT */ )
  726. #endif
  727. {
  728. isr = 1;
  729. s->csr[0] |= 0x0080;
  730. }
  731. if (isr != s->isr) {
  732. #ifdef PCNET_DEBUG
  733. printf("pcnet: INTA=%d\n", isr);
  734. #endif
  735. }
  736. qemu_set_irq(s->irq, isr);
  737. s->isr = isr;
  738. }
  739. static void pcnet_init(PCNetState *s)
  740. {
  741. int rlen, tlen;
  742. uint16_t padr[3], ladrf[4], mode;
  743. uint32_t rdra, tdra;
  744. #ifdef PCNET_DEBUG
  745. printf("pcnet_init init_addr=0x%08x\n", PHYSADDR(s,CSR_IADR(s)));
  746. #endif
  747. if (BCR_SSIZE32(s)) {
  748. struct pcnet_initblk32 initblk;
  749. s->phys_mem_read(s->dma_opaque, PHYSADDR(s,CSR_IADR(s)),
  750. (uint8_t *)&initblk, sizeof(initblk), 0);
  751. mode = le16_to_cpu(initblk.mode);
  752. rlen = initblk.rlen >> 4;
  753. tlen = initblk.tlen >> 4;
  754. ladrf[0] = le16_to_cpu(initblk.ladrf[0]);
  755. ladrf[1] = le16_to_cpu(initblk.ladrf[1]);
  756. ladrf[2] = le16_to_cpu(initblk.ladrf[2]);
  757. ladrf[3] = le16_to_cpu(initblk.ladrf[3]);
  758. padr[0] = le16_to_cpu(initblk.padr[0]);
  759. padr[1] = le16_to_cpu(initblk.padr[1]);
  760. padr[2] = le16_to_cpu(initblk.padr[2]);
  761. rdra = le32_to_cpu(initblk.rdra);
  762. tdra = le32_to_cpu(initblk.tdra);
  763. } else {
  764. struct pcnet_initblk16 initblk;
  765. s->phys_mem_read(s->dma_opaque, PHYSADDR(s,CSR_IADR(s)),
  766. (uint8_t *)&initblk, sizeof(initblk), 0);
  767. mode = le16_to_cpu(initblk.mode);
  768. ladrf[0] = le16_to_cpu(initblk.ladrf[0]);
  769. ladrf[1] = le16_to_cpu(initblk.ladrf[1]);
  770. ladrf[2] = le16_to_cpu(initblk.ladrf[2]);
  771. ladrf[3] = le16_to_cpu(initblk.ladrf[3]);
  772. padr[0] = le16_to_cpu(initblk.padr[0]);
  773. padr[1] = le16_to_cpu(initblk.padr[1]);
  774. padr[2] = le16_to_cpu(initblk.padr[2]);
  775. rdra = le32_to_cpu(initblk.rdra);
  776. tdra = le32_to_cpu(initblk.tdra);
  777. rlen = rdra >> 29;
  778. tlen = tdra >> 29;
  779. rdra &= 0x00ffffff;
  780. tdra &= 0x00ffffff;
  781. }
  782. #if defined(PCNET_DEBUG)
  783. printf("rlen=%d tlen=%d\n", rlen, tlen);
  784. #endif
  785. CSR_RCVRL(s) = (rlen < 9) ? (1 << rlen) : 512;
  786. CSR_XMTRL(s) = (tlen < 9) ? (1 << tlen) : 512;
  787. s->csr[ 6] = (tlen << 12) | (rlen << 8);
  788. s->csr[15] = mode;
  789. s->csr[ 8] = ladrf[0];
  790. s->csr[ 9] = ladrf[1];
  791. s->csr[10] = ladrf[2];
  792. s->csr[11] = ladrf[3];
  793. s->csr[12] = padr[0];
  794. s->csr[13] = padr[1];
  795. s->csr[14] = padr[2];
  796. s->rdra = PHYSADDR(s, rdra);
  797. s->tdra = PHYSADDR(s, tdra);
  798. CSR_RCVRC(s) = CSR_RCVRL(s);
  799. CSR_XMTRC(s) = CSR_XMTRL(s);
  800. #ifdef PCNET_DEBUG
  801. printf("pcnet ss32=%d rdra=0x%08x[%d] tdra=0x%08x[%d]\n",
  802. BCR_SSIZE32(s),
  803. s->rdra, CSR_RCVRL(s), s->tdra, CSR_XMTRL(s));
  804. #endif
  805. s->csr[0] |= 0x0101;
  806. s->csr[0] &= ~0x0004; /* clear STOP bit */
  807. }
  808. static void pcnet_start(PCNetState *s)
  809. {
  810. #ifdef PCNET_DEBUG
  811. printf("pcnet_start\n");
  812. #endif
  813. if (!CSR_DTX(s))
  814. s->csr[0] |= 0x0010; /* set TXON */
  815. if (!CSR_DRX(s))
  816. s->csr[0] |= 0x0020; /* set RXON */
  817. s->csr[0] &= ~0x0004; /* clear STOP bit */
  818. s->csr[0] |= 0x0002;
  819. pcnet_poll_timer(s);
  820. }
  821. static void pcnet_stop(PCNetState *s)
  822. {
  823. #ifdef PCNET_DEBUG
  824. printf("pcnet_stop\n");
  825. #endif
  826. s->csr[0] &= ~0x7feb;
  827. s->csr[0] |= 0x0014;
  828. s->csr[4] &= ~0x02c2;
  829. s->csr[5] &= ~0x0011;
  830. pcnet_poll_timer(s);
  831. }
  832. static void pcnet_rdte_poll(PCNetState *s)
  833. {
  834. s->csr[28] = s->csr[29] = 0;
  835. if (s->rdra) {
  836. int bad = 0;
  837. #if 1
  838. target_phys_addr_t crda = pcnet_rdra_addr(s, CSR_RCVRC(s));
  839. target_phys_addr_t nrda = pcnet_rdra_addr(s, -1 + CSR_RCVRC(s));
  840. target_phys_addr_t nnrd = pcnet_rdra_addr(s, -2 + CSR_RCVRC(s));
  841. #else
  842. target_phys_addr_t crda = s->rdra +
  843. (CSR_RCVRL(s) - CSR_RCVRC(s)) *
  844. (BCR_SWSTYLE(s) ? 16 : 8 );
  845. int nrdc = CSR_RCVRC(s)<=1 ? CSR_RCVRL(s) : CSR_RCVRC(s)-1;
  846. target_phys_addr_t nrda = s->rdra +
  847. (CSR_RCVRL(s) - nrdc) *
  848. (BCR_SWSTYLE(s) ? 16 : 8 );
  849. int nnrc = nrdc<=1 ? CSR_RCVRL(s) : nrdc-1;
  850. target_phys_addr_t nnrd = s->rdra +
  851. (CSR_RCVRL(s) - nnrc) *
  852. (BCR_SWSTYLE(s) ? 16 : 8 );
  853. #endif
  854. CHECK_RMD(crda, bad);
  855. if (!bad) {
  856. CHECK_RMD(nrda, bad);
  857. if (bad || (nrda == crda)) nrda = 0;
  858. CHECK_RMD(nnrd, bad);
  859. if (bad || (nnrd == crda)) nnrd = 0;
  860. s->csr[28] = crda & 0xffff;
  861. s->csr[29] = crda >> 16;
  862. s->csr[26] = nrda & 0xffff;
  863. s->csr[27] = nrda >> 16;
  864. s->csr[36] = nnrd & 0xffff;
  865. s->csr[37] = nnrd >> 16;
  866. #ifdef PCNET_DEBUG
  867. if (bad) {
  868. printf("pcnet: BAD RMD RECORDS AFTER 0x" TARGET_FMT_plx "\n",
  869. crda);
  870. }
  871. } else {
  872. printf("pcnet: BAD RMD RDA=0x" TARGET_FMT_plx "\n",
  873. crda);
  874. #endif
  875. }
  876. }
  877. if (CSR_CRDA(s)) {
  878. struct pcnet_RMD rmd;
  879. RMDLOAD(&rmd, PHYSADDR(s,CSR_CRDA(s)));
  880. CSR_CRBC(s) = GET_FIELD(rmd.buf_length, RMDL, BCNT);
  881. CSR_CRST(s) = rmd.status;
  882. #ifdef PCNET_DEBUG_RMD_X
  883. printf("CRDA=0x%08x CRST=0x%04x RCVRC=%d RMDL=0x%04x RMDS=0x%04x RMDM=0x%08x\n",
  884. PHYSADDR(s,CSR_CRDA(s)), CSR_CRST(s), CSR_RCVRC(s),
  885. rmd.buf_length, rmd.status, rmd.msg_length);
  886. PRINT_RMD(&rmd);
  887. #endif
  888. } else {
  889. CSR_CRBC(s) = CSR_CRST(s) = 0;
  890. }
  891. if (CSR_NRDA(s)) {
  892. struct pcnet_RMD rmd;
  893. RMDLOAD(&rmd, PHYSADDR(s,CSR_NRDA(s)));
  894. CSR_NRBC(s) = GET_FIELD(rmd.buf_length, RMDL, BCNT);
  895. CSR_NRST(s) = rmd.status;
  896. } else {
  897. CSR_NRBC(s) = CSR_NRST(s) = 0;
  898. }
  899. }
  900. static int pcnet_tdte_poll(PCNetState *s)
  901. {
  902. s->csr[34] = s->csr[35] = 0;
  903. if (s->tdra) {
  904. target_phys_addr_t cxda = s->tdra +
  905. (CSR_XMTRL(s) - CSR_XMTRC(s)) *
  906. (BCR_SWSTYLE(s) ? 16 : 8);
  907. int bad = 0;
  908. CHECK_TMD(cxda, bad);
  909. if (!bad) {
  910. if (CSR_CXDA(s) != cxda) {
  911. s->csr[60] = s->csr[34];
  912. s->csr[61] = s->csr[35];
  913. s->csr[62] = CSR_CXBC(s);
  914. s->csr[63] = CSR_CXST(s);
  915. }
  916. s->csr[34] = cxda & 0xffff;
  917. s->csr[35] = cxda >> 16;
  918. #ifdef PCNET_DEBUG_X
  919. printf("pcnet: BAD TMD XDA=0x%08x\n", cxda);
  920. #endif
  921. }
  922. }
  923. if (CSR_CXDA(s)) {
  924. struct pcnet_TMD tmd;
  925. TMDLOAD(&tmd, PHYSADDR(s,CSR_CXDA(s)));
  926. CSR_CXBC(s) = GET_FIELD(tmd.length, TMDL, BCNT);
  927. CSR_CXST(s) = tmd.status;
  928. } else {
  929. CSR_CXBC(s) = CSR_CXST(s) = 0;
  930. }
  931. return !!(CSR_CXST(s) & 0x8000);
  932. }
  933. int pcnet_can_receive(VLANClientState *nc)
  934. {
  935. PCNetState *s = DO_UPCAST(NICState, nc, nc)->opaque;
  936. if (CSR_STOP(s) || CSR_SPND(s))
  937. return 0;
  938. return sizeof(s->buffer)-16;
  939. }
  940. #define MIN_BUF_SIZE 60
  941. ssize_t pcnet_receive(VLANClientState *nc, const uint8_t *buf, size_t size_)
  942. {
  943. PCNetState *s = DO_UPCAST(NICState, nc, nc)->opaque;
  944. int is_padr = 0, is_bcast = 0, is_ladr = 0;
  945. uint8_t buf1[60];
  946. int remaining;
  947. int crc_err = 0;
  948. int size = size_;
  949. if (CSR_DRX(s) || CSR_STOP(s) || CSR_SPND(s) || !size ||
  950. (CSR_LOOP(s) && !s->looptest)) {
  951. return -1;
  952. }
  953. #ifdef PCNET_DEBUG
  954. printf("pcnet_receive size=%d\n", size);
  955. #endif
  956. /* if too small buffer, then expand it */
  957. if (size < MIN_BUF_SIZE) {
  958. memcpy(buf1, buf, size);
  959. memset(buf1 + size, 0, MIN_BUF_SIZE - size);
  960. buf = buf1;
  961. size = MIN_BUF_SIZE;
  962. }
  963. if (CSR_PROM(s)
  964. || (is_padr=padr_match(s, buf, size))
  965. || (is_bcast=padr_bcast(s, buf, size))
  966. || (is_ladr=ladr_match(s, buf, size))) {
  967. pcnet_rdte_poll(s);
  968. if (!(CSR_CRST(s) & 0x8000) && s->rdra) {
  969. struct pcnet_RMD rmd;
  970. int rcvrc = CSR_RCVRC(s)-1,i;
  971. target_phys_addr_t nrda;
  972. for (i = CSR_RCVRL(s)-1; i > 0; i--, rcvrc--) {
  973. if (rcvrc <= 1)
  974. rcvrc = CSR_RCVRL(s);
  975. nrda = s->rdra +
  976. (CSR_RCVRL(s) - rcvrc) *
  977. (BCR_SWSTYLE(s) ? 16 : 8 );
  978. RMDLOAD(&rmd, nrda);
  979. if (GET_FIELD(rmd.status, RMDS, OWN)) {
  980. #ifdef PCNET_DEBUG_RMD
  981. printf("pcnet - scan buffer: RCVRC=%d PREV_RCVRC=%d\n",
  982. rcvrc, CSR_RCVRC(s));
  983. #endif
  984. CSR_RCVRC(s) = rcvrc;
  985. pcnet_rdte_poll(s);
  986. break;
  987. }
  988. }
  989. }
  990. if (!(CSR_CRST(s) & 0x8000)) {
  991. #ifdef PCNET_DEBUG_RMD
  992. printf("pcnet - no buffer: RCVRC=%d\n", CSR_RCVRC(s));
  993. #endif
  994. s->csr[0] |= 0x1000; /* Set MISS flag */
  995. CSR_MISSC(s)++;
  996. } else {
  997. uint8_t *src = s->buffer;
  998. target_phys_addr_t crda = CSR_CRDA(s);
  999. struct pcnet_RMD rmd;
  1000. int pktcount = 0;
  1001. if (!s->looptest) {
  1002. memcpy(src, buf, size);
  1003. /* no need to compute the CRC */
  1004. src[size] = 0;
  1005. src[size + 1] = 0;
  1006. src[size + 2] = 0;
  1007. src[size + 3] = 0;
  1008. size += 4;
  1009. } else if (s->looptest == PCNET_LOOPTEST_CRC ||
  1010. !CSR_DXMTFCS(s) || size < MIN_BUF_SIZE+4) {
  1011. uint32_t fcs = ~0;
  1012. uint8_t *p = src;
  1013. while (p != &src[size])
  1014. CRC(fcs, *p++);
  1015. *(uint32_t *)p = htonl(fcs);
  1016. size += 4;
  1017. } else {
  1018. uint32_t fcs = ~0;
  1019. uint8_t *p = src;
  1020. while (p != &src[size-4])
  1021. CRC(fcs, *p++);
  1022. crc_err = (*(uint32_t *)p != htonl(fcs));
  1023. }
  1024. #ifdef PCNET_DEBUG_MATCH
  1025. PRINT_PKTHDR(buf);
  1026. #endif
  1027. RMDLOAD(&rmd, PHYSADDR(s,crda));
  1028. /*if (!CSR_LAPPEN(s))*/
  1029. SET_FIELD(&rmd.status, RMDS, STP, 1);
  1030. #define PCNET_RECV_STORE() do { \
  1031. int count = MIN(4096 - GET_FIELD(rmd.buf_length, RMDL, BCNT),remaining); \
  1032. target_phys_addr_t rbadr = PHYSADDR(s, rmd.rbadr); \
  1033. s->phys_mem_write(s->dma_opaque, rbadr, src, count, CSR_BSWP(s)); \
  1034. src += count; remaining -= count; \
  1035. SET_FIELD(&rmd.status, RMDS, OWN, 0); \
  1036. RMDSTORE(&rmd, PHYSADDR(s,crda)); \
  1037. pktcount++; \
  1038. } while (0)
  1039. remaining = size;
  1040. PCNET_RECV_STORE();
  1041. if ((remaining > 0) && CSR_NRDA(s)) {
  1042. target_phys_addr_t nrda = CSR_NRDA(s);
  1043. #ifdef PCNET_DEBUG_RMD
  1044. PRINT_RMD(&rmd);
  1045. #endif
  1046. RMDLOAD(&rmd, PHYSADDR(s,nrda));
  1047. if (GET_FIELD(rmd.status, RMDS, OWN)) {
  1048. crda = nrda;
  1049. PCNET_RECV_STORE();
  1050. #ifdef PCNET_DEBUG_RMD
  1051. PRINT_RMD(&rmd);
  1052. #endif
  1053. if ((remaining > 0) && (nrda=CSR_NNRD(s))) {
  1054. RMDLOAD(&rmd, PHYSADDR(s,nrda));
  1055. if (GET_FIELD(rmd.status, RMDS, OWN)) {
  1056. crda = nrda;
  1057. PCNET_RECV_STORE();
  1058. }
  1059. }
  1060. }
  1061. }
  1062. #undef PCNET_RECV_STORE
  1063. RMDLOAD(&rmd, PHYSADDR(s,crda));
  1064. if (remaining == 0) {
  1065. SET_FIELD(&rmd.msg_length, RMDM, MCNT, size);
  1066. SET_FIELD(&rmd.status, RMDS, ENP, 1);
  1067. SET_FIELD(&rmd.status, RMDS, PAM, !CSR_PROM(s) && is_padr);
  1068. SET_FIELD(&rmd.status, RMDS, LFAM, !CSR_PROM(s) && is_ladr);
  1069. SET_FIELD(&rmd.status, RMDS, BAM, !CSR_PROM(s) && is_bcast);
  1070. if (crc_err) {
  1071. SET_FIELD(&rmd.status, RMDS, CRC, 1);
  1072. SET_FIELD(&rmd.status, RMDS, ERR, 1);
  1073. }
  1074. } else {
  1075. SET_FIELD(&rmd.status, RMDS, OFLO, 1);
  1076. SET_FIELD(&rmd.status, RMDS, BUFF, 1);
  1077. SET_FIELD(&rmd.status, RMDS, ERR, 1);
  1078. }
  1079. RMDSTORE(&rmd, PHYSADDR(s,crda));
  1080. s->csr[0] |= 0x0400;
  1081. #ifdef PCNET_DEBUG
  1082. printf("RCVRC=%d CRDA=0x%08x BLKS=%d\n",
  1083. CSR_RCVRC(s), PHYSADDR(s,CSR_CRDA(s)), pktcount);
  1084. #endif
  1085. #ifdef PCNET_DEBUG_RMD
  1086. PRINT_RMD(&rmd);
  1087. #endif
  1088. while (pktcount--) {
  1089. if (CSR_RCVRC(s) <= 1)
  1090. CSR_RCVRC(s) = CSR_RCVRL(s);
  1091. else
  1092. CSR_RCVRC(s)--;
  1093. }
  1094. pcnet_rdte_poll(s);
  1095. }
  1096. }
  1097. pcnet_poll(s);
  1098. pcnet_update_irq(s);
  1099. return size_;
  1100. }
  1101. static void pcnet_transmit(PCNetState *s)
  1102. {
  1103. target_phys_addr_t xmit_cxda = 0;
  1104. int count = CSR_XMTRL(s)-1;
  1105. int add_crc = 0;
  1106. s->xmit_pos = -1;
  1107. if (!CSR_TXON(s)) {
  1108. s->csr[0] &= ~0x0008;
  1109. return;
  1110. }
  1111. s->tx_busy = 1;
  1112. txagain:
  1113. if (pcnet_tdte_poll(s)) {
  1114. struct pcnet_TMD tmd;
  1115. TMDLOAD(&tmd, PHYSADDR(s,CSR_CXDA(s)));
  1116. #ifdef PCNET_DEBUG_TMD
  1117. printf(" TMDLOAD 0x%08x\n", PHYSADDR(s,CSR_CXDA(s)));
  1118. PRINT_TMD(&tmd);
  1119. #endif
  1120. if (GET_FIELD(tmd.status, TMDS, STP)) {
  1121. s->xmit_pos = 0;
  1122. xmit_cxda = PHYSADDR(s,CSR_CXDA(s));
  1123. if (BCR_SWSTYLE(s) != 1)
  1124. add_crc = GET_FIELD(tmd.status, TMDS, ADDFCS);
  1125. }
  1126. if (!GET_FIELD(tmd.status, TMDS, ENP)) {
  1127. int bcnt = 4096 - GET_FIELD(tmd.length, TMDL, BCNT);
  1128. s->phys_mem_read(s->dma_opaque, PHYSADDR(s, tmd.tbadr),
  1129. s->buffer + s->xmit_pos, bcnt, CSR_BSWP(s));
  1130. s->xmit_pos += bcnt;
  1131. } else if (s->xmit_pos >= 0) {
  1132. int bcnt = 4096 - GET_FIELD(tmd.length, TMDL, BCNT);
  1133. s->phys_mem_read(s->dma_opaque, PHYSADDR(s, tmd.tbadr),
  1134. s->buffer + s->xmit_pos, bcnt, CSR_BSWP(s));
  1135. s->xmit_pos += bcnt;
  1136. #ifdef PCNET_DEBUG
  1137. printf("pcnet_transmit size=%d\n", s->xmit_pos);
  1138. #endif
  1139. if (CSR_LOOP(s)) {
  1140. if (BCR_SWSTYLE(s) == 1)
  1141. add_crc = !GET_FIELD(tmd.status, TMDS, NOFCS);
  1142. s->looptest = add_crc ? PCNET_LOOPTEST_CRC : PCNET_LOOPTEST_NOCRC;
  1143. pcnet_receive(&s->nic->nc, s->buffer, s->xmit_pos);
  1144. s->looptest = 0;
  1145. } else
  1146. if (s->nic)
  1147. qemu_send_packet(&s->nic->nc, s->buffer, s->xmit_pos);
  1148. s->csr[0] &= ~0x0008; /* clear TDMD */
  1149. s->csr[4] |= 0x0004; /* set TXSTRT */
  1150. s->xmit_pos = -1;
  1151. }
  1152. SET_FIELD(&tmd.status, TMDS, OWN, 0);
  1153. TMDSTORE(&tmd, PHYSADDR(s,CSR_CXDA(s)));
  1154. if (!CSR_TOKINTD(s) || (CSR_LTINTEN(s) && GET_FIELD(tmd.status, TMDS, LTINT)))
  1155. s->csr[0] |= 0x0200; /* set TINT */
  1156. if (CSR_XMTRC(s)<=1)
  1157. CSR_XMTRC(s) = CSR_XMTRL(s);
  1158. else
  1159. CSR_XMTRC(s)--;
  1160. if (count--)
  1161. goto txagain;
  1162. } else
  1163. if (s->xmit_pos >= 0) {
  1164. struct pcnet_TMD tmd;
  1165. TMDLOAD(&tmd, xmit_cxda);
  1166. SET_FIELD(&tmd.misc, TMDM, BUFF, 1);
  1167. SET_FIELD(&tmd.misc, TMDM, UFLO, 1);
  1168. SET_FIELD(&tmd.status, TMDS, ERR, 1);
  1169. SET_FIELD(&tmd.status, TMDS, OWN, 0);
  1170. TMDSTORE(&tmd, xmit_cxda);
  1171. s->csr[0] |= 0x0200; /* set TINT */
  1172. if (!CSR_DXSUFLO(s)) {
  1173. s->csr[0] &= ~0x0010;
  1174. } else
  1175. if (count--)
  1176. goto txagain;
  1177. }
  1178. s->tx_busy = 0;
  1179. }
  1180. static void pcnet_poll(PCNetState *s)
  1181. {
  1182. if (CSR_RXON(s)) {
  1183. pcnet_rdte_poll(s);
  1184. }
  1185. if (CSR_TDMD(s) ||
  1186. (CSR_TXON(s) && !CSR_DPOLL(s) && pcnet_tdte_poll(s)))
  1187. {
  1188. /* prevent recursion */
  1189. if (s->tx_busy)
  1190. return;
  1191. pcnet_transmit(s);
  1192. }
  1193. }
  1194. static void pcnet_poll_timer(void *opaque)
  1195. {
  1196. PCNetState *s = opaque;
  1197. qemu_del_timer(s->poll_timer);
  1198. if (CSR_TDMD(s)) {
  1199. pcnet_transmit(s);
  1200. }
  1201. pcnet_update_irq(s);
  1202. if (!CSR_STOP(s) && !CSR_SPND(s) && !CSR_DPOLL(s)) {
  1203. uint64_t now = qemu_get_clock_ns(vm_clock) * 33;
  1204. if (!s->timer || !now)
  1205. s->timer = now;
  1206. else {
  1207. uint64_t t = now - s->timer + CSR_POLL(s);
  1208. if (t > 0xffffLL) {
  1209. pcnet_poll(s);
  1210. CSR_POLL(s) = CSR_PINT(s);
  1211. } else
  1212. CSR_POLL(s) = t;
  1213. }
  1214. qemu_mod_timer(s->poll_timer,
  1215. pcnet_get_next_poll_time(s,qemu_get_clock_ns(vm_clock)));
  1216. }
  1217. }
  1218. static void pcnet_csr_writew(PCNetState *s, uint32_t rap, uint32_t new_value)
  1219. {
  1220. uint16_t val = new_value;
  1221. #ifdef PCNET_DEBUG_CSR
  1222. printf("pcnet_csr_writew rap=%d val=0x%04x\n", rap, val);
  1223. #endif
  1224. switch (rap) {
  1225. case 0:
  1226. s->csr[0] &= ~(val & 0x7f00); /* Clear any interrupt flags */
  1227. s->csr[0] = (s->csr[0] & ~0x0040) | (val & 0x0048);
  1228. val = (val & 0x007f) | (s->csr[0] & 0x7f00);
  1229. /* IFF STOP, STRT and INIT are set, clear STRT and INIT */
  1230. if ((val&7) == 7)
  1231. val &= ~3;
  1232. if (!CSR_STOP(s) && (val & 4))
  1233. pcnet_stop(s);
  1234. if (!CSR_INIT(s) && (val & 1))
  1235. pcnet_init(s);
  1236. if (!CSR_STRT(s) && (val & 2))
  1237. pcnet_start(s);
  1238. if (CSR_TDMD(s))
  1239. pcnet_transmit(s);
  1240. return;
  1241. case 1:
  1242. case 2:
  1243. case 8:
  1244. case 9:
  1245. case 10:
  1246. case 11:
  1247. case 12:
  1248. case 13:
  1249. case 14:
  1250. case 15:
  1251. case 18: /* CRBAL */
  1252. case 19: /* CRBAU */
  1253. case 20: /* CXBAL */
  1254. case 21: /* CXBAU */
  1255. case 22: /* NRBAU */
  1256. case 23: /* NRBAU */
  1257. case 24:
  1258. case 25:
  1259. case 26:
  1260. case 27:
  1261. case 28:
  1262. case 29:
  1263. case 30:
  1264. case 31:
  1265. case 32:
  1266. case 33:
  1267. case 34:
  1268. case 35:
  1269. case 36:
  1270. case 37:
  1271. case 38:
  1272. case 39:
  1273. case 40: /* CRBC */
  1274. case 41:
  1275. case 42: /* CXBC */
  1276. case 43:
  1277. case 44:
  1278. case 45:
  1279. case 46: /* POLL */
  1280. case 47: /* POLLINT */
  1281. case 72:
  1282. case 74:
  1283. case 76: /* RCVRL */
  1284. case 78: /* XMTRL */
  1285. case 112:
  1286. if (CSR_STOP(s) || CSR_SPND(s))
  1287. break;
  1288. return;
  1289. case 3:
  1290. break;
  1291. case 4:
  1292. s->csr[4] &= ~(val & 0x026a);
  1293. val &= ~0x026a; val |= s->csr[4] & 0x026a;
  1294. break;
  1295. case 5:
  1296. s->csr[5] &= ~(val & 0x0a90);
  1297. val &= ~0x0a90; val |= s->csr[5] & 0x0a90;
  1298. break;
  1299. case 16:
  1300. pcnet_csr_writew(s,1,val);
  1301. return;
  1302. case 17:
  1303. pcnet_csr_writew(s,2,val);
  1304. return;
  1305. case 58:
  1306. pcnet_bcr_writew(s,BCR_SWS,val);
  1307. break;
  1308. default:
  1309. return;
  1310. }
  1311. s->csr[rap] = val;
  1312. }
  1313. static uint32_t pcnet_csr_readw(PCNetState *s, uint32_t rap)
  1314. {
  1315. uint32_t val;
  1316. switch (rap) {
  1317. case 0:
  1318. pcnet_update_irq(s);
  1319. val = s->csr[0];
  1320. val |= (val & 0x7800) ? 0x8000 : 0;
  1321. break;
  1322. case 16:
  1323. return pcnet_csr_readw(s,1);
  1324. case 17:
  1325. return pcnet_csr_readw(s,2);
  1326. case 58:
  1327. return pcnet_bcr_readw(s,BCR_SWS);
  1328. case 88:
  1329. val = s->csr[89];
  1330. val <<= 16;
  1331. val |= s->csr[88];
  1332. break;
  1333. default:
  1334. val = s->csr[rap];
  1335. }
  1336. #ifdef PCNET_DEBUG_CSR
  1337. printf("pcnet_csr_readw rap=%d val=0x%04x\n", rap, val);
  1338. #endif
  1339. return val;
  1340. }
  1341. static void pcnet_bcr_writew(PCNetState *s, uint32_t rap, uint32_t val)
  1342. {
  1343. rap &= 127;
  1344. #ifdef PCNET_DEBUG_BCR
  1345. printf("pcnet_bcr_writew rap=%d val=0x%04x\n", rap, val);
  1346. #endif
  1347. switch (rap) {
  1348. case BCR_SWS:
  1349. if (!(CSR_STOP(s) || CSR_SPND(s)))
  1350. return;
  1351. val &= ~0x0300;
  1352. switch (val & 0x00ff) {
  1353. case 0:
  1354. val |= 0x0200;
  1355. break;
  1356. case 1:
  1357. val |= 0x0100;
  1358. break;
  1359. case 2:
  1360. case 3:
  1361. val |= 0x0300;
  1362. break;
  1363. default:
  1364. printf("Bad SWSTYLE=0x%02x\n", val & 0xff);
  1365. val = 0x0200;
  1366. break;
  1367. }
  1368. #ifdef PCNET_DEBUG
  1369. printf("BCR_SWS=0x%04x\n", val);
  1370. #endif
  1371. case BCR_LNKST:
  1372. case BCR_LED1:
  1373. case BCR_LED2:
  1374. case BCR_LED3:
  1375. case BCR_MC:
  1376. case BCR_FDC:
  1377. case BCR_BSBC:
  1378. case BCR_EECAS:
  1379. case BCR_PLAT:
  1380. s->bcr[rap] = val;
  1381. break;
  1382. default:
  1383. break;
  1384. }
  1385. }
  1386. uint32_t pcnet_bcr_readw(PCNetState *s, uint32_t rap)
  1387. {
  1388. uint32_t val;
  1389. rap &= 127;
  1390. switch (rap) {
  1391. case BCR_LNKST:
  1392. case BCR_LED1:
  1393. case BCR_LED2:
  1394. case BCR_LED3:
  1395. val = s->bcr[rap] & ~0x8000;
  1396. val |= (val & 0x017f & s->lnkst) ? 0x8000 : 0;
  1397. break;
  1398. default:
  1399. val = rap < 32 ? s->bcr[rap] : 0;
  1400. break;
  1401. }
  1402. #ifdef PCNET_DEBUG_BCR
  1403. printf("pcnet_bcr_readw rap=%d val=0x%04x\n", rap, val);
  1404. #endif
  1405. return val;
  1406. }
  1407. void pcnet_h_reset(void *opaque)
  1408. {
  1409. PCNetState *s = opaque;
  1410. s->bcr[BCR_MSRDA] = 0x0005;
  1411. s->bcr[BCR_MSWRA] = 0x0005;
  1412. s->bcr[BCR_MC ] = 0x0002;
  1413. s->bcr[BCR_LNKST] = 0x00c0;
  1414. s->bcr[BCR_LED1 ] = 0x0084;
  1415. s->bcr[BCR_LED2 ] = 0x0088;
  1416. s->bcr[BCR_LED3 ] = 0x0090;
  1417. s->bcr[BCR_FDC ] = 0x0000;
  1418. s->bcr[BCR_BSBC ] = 0x9001;
  1419. s->bcr[BCR_EECAS] = 0x0002;
  1420. s->bcr[BCR_SWS ] = 0x0200;
  1421. s->bcr[BCR_PLAT ] = 0xff06;
  1422. pcnet_s_reset(s);
  1423. pcnet_update_irq(s);
  1424. pcnet_poll_timer(s);
  1425. }
  1426. void pcnet_ioport_writew(void *opaque, uint32_t addr, uint32_t val)
  1427. {
  1428. PCNetState *s = opaque;
  1429. pcnet_poll_timer(s);
  1430. #ifdef PCNET_DEBUG_IO
  1431. printf("pcnet_ioport_writew addr=0x%08x val=0x%04x\n", addr, val);
  1432. #endif
  1433. if (!BCR_DWIO(s)) {
  1434. switch (addr & 0x0f) {
  1435. case 0x00: /* RDP */
  1436. pcnet_csr_writew(s, s->rap, val);
  1437. break;
  1438. case 0x02:
  1439. s->rap = val & 0x7f;
  1440. break;
  1441. case 0x06:
  1442. pcnet_bcr_writew(s, s->rap, val);
  1443. break;
  1444. }
  1445. }
  1446. pcnet_update_irq(s);
  1447. }
  1448. uint32_t pcnet_ioport_readw(void *opaque, uint32_t addr)
  1449. {
  1450. PCNetState *s = opaque;
  1451. uint32_t val = -1;
  1452. pcnet_poll_timer(s);
  1453. if (!BCR_DWIO(s)) {
  1454. switch (addr & 0x0f) {
  1455. case 0x00: /* RDP */
  1456. val = pcnet_csr_readw(s, s->rap);
  1457. break;
  1458. case 0x02:
  1459. val = s->rap;
  1460. break;
  1461. case 0x04:
  1462. pcnet_s_reset(s);
  1463. val = 0;
  1464. break;
  1465. case 0x06:
  1466. val = pcnet_bcr_readw(s, s->rap);
  1467. break;
  1468. }
  1469. }
  1470. pcnet_update_irq(s);
  1471. #ifdef PCNET_DEBUG_IO
  1472. printf("pcnet_ioport_readw addr=0x%08x val=0x%04x\n", addr, val & 0xffff);
  1473. #endif
  1474. return val;
  1475. }
  1476. void pcnet_ioport_writel(void *opaque, uint32_t addr, uint32_t val)
  1477. {
  1478. PCNetState *s = opaque;
  1479. pcnet_poll_timer(s);
  1480. #ifdef PCNET_DEBUG_IO
  1481. printf("pcnet_ioport_writel addr=0x%08x val=0x%08x\n", addr, val);
  1482. #endif
  1483. if (BCR_DWIO(s)) {
  1484. switch (addr & 0x0f) {
  1485. case 0x00: /* RDP */
  1486. pcnet_csr_writew(s, s->rap, val & 0xffff);
  1487. break;
  1488. case 0x04:
  1489. s->rap = val & 0x7f;
  1490. break;
  1491. case 0x0c:
  1492. pcnet_bcr_writew(s, s->rap, val & 0xffff);
  1493. break;
  1494. }
  1495. } else
  1496. if ((addr & 0x0f) == 0) {
  1497. /* switch device to dword i/o mode */
  1498. pcnet_bcr_writew(s, BCR_BSBC, pcnet_bcr_readw(s, BCR_BSBC) | 0x0080);
  1499. #ifdef PCNET_DEBUG_IO
  1500. printf("device switched into dword i/o mode\n");
  1501. #endif
  1502. }
  1503. pcnet_update_irq(s);
  1504. }
  1505. uint32_t pcnet_ioport_readl(void *opaque, uint32_t addr)
  1506. {
  1507. PCNetState *s = opaque;
  1508. uint32_t val = -1;
  1509. pcnet_poll_timer(s);
  1510. if (BCR_DWIO(s)) {
  1511. switch (addr & 0x0f) {
  1512. case 0x00: /* RDP */
  1513. val = pcnet_csr_readw(s, s->rap);
  1514. break;
  1515. case 0x04:
  1516. val = s->rap;
  1517. break;
  1518. case 0x08:
  1519. pcnet_s_reset(s);
  1520. val = 0;
  1521. break;
  1522. case 0x0c:
  1523. val = pcnet_bcr_readw(s, s->rap);
  1524. break;
  1525. }
  1526. }
  1527. pcnet_update_irq(s);
  1528. #ifdef PCNET_DEBUG_IO
  1529. printf("pcnet_ioport_readl addr=0x%08x val=0x%08x\n", addr, val);
  1530. #endif
  1531. return val;
  1532. }
  1533. static bool is_version_2(void *opaque, int version_id)
  1534. {
  1535. return version_id == 2;
  1536. }
  1537. const VMStateDescription vmstate_pcnet = {
  1538. .name = "pcnet",
  1539. .version_id = 3,
  1540. .minimum_version_id = 2,
  1541. .minimum_version_id_old = 2,
  1542. .fields = (VMStateField []) {
  1543. VMSTATE_INT32(rap, PCNetState),
  1544. VMSTATE_INT32(isr, PCNetState),
  1545. VMSTATE_INT32(lnkst, PCNetState),
  1546. VMSTATE_UINT32(rdra, PCNetState),
  1547. VMSTATE_UINT32(tdra, PCNetState),
  1548. VMSTATE_BUFFER(prom, PCNetState),
  1549. VMSTATE_UINT16_ARRAY(csr, PCNetState, 128),
  1550. VMSTATE_UINT16_ARRAY(bcr, PCNetState, 32),
  1551. VMSTATE_UINT64(timer, PCNetState),
  1552. VMSTATE_INT32(xmit_pos, PCNetState),
  1553. VMSTATE_BUFFER(buffer, PCNetState),
  1554. VMSTATE_UNUSED_TEST(is_version_2, 4),
  1555. VMSTATE_INT32(tx_busy, PCNetState),
  1556. VMSTATE_TIMER(poll_timer, PCNetState),
  1557. VMSTATE_END_OF_LIST()
  1558. }
  1559. };
  1560. void pcnet_common_cleanup(PCNetState *d)
  1561. {
  1562. d->nic = NULL;
  1563. }
  1564. int pcnet_common_init(DeviceState *dev, PCNetState *s, NetClientInfo *info)
  1565. {
  1566. int i;
  1567. uint16_t checksum;
  1568. s->poll_timer = qemu_new_timer_ns(vm_clock, pcnet_poll_timer, s);
  1569. qemu_macaddr_default_if_unset(&s->conf.macaddr);
  1570. s->nic = qemu_new_nic(info, &s->conf, dev->info->name, dev->id, s);
  1571. qemu_format_nic_info_str(&s->nic->nc, s->conf.macaddr.a);
  1572. add_boot_device_path(s->conf.bootindex, dev, "/ethernet-phy@0");
  1573. /* Initialize the PROM */
  1574. /*
  1575. Datasheet: http://pdfdata.datasheetsite.com/web/24528/AM79C970A.pdf
  1576. page 95
  1577. */
  1578. memcpy(s->prom, s->conf.macaddr.a, 6);
  1579. /* Reserved Location: must be 00h */
  1580. s->prom[6] = s->prom[7] = 0x00;
  1581. /* Reserved Location: must be 00h */
  1582. s->prom[8] = 0x00;
  1583. /* Hardware ID: must be 11h if compatibility to AMD drivers is desired */
  1584. s->prom[9] = 0x11;
  1585. /* User programmable space, init with 0 */
  1586. s->prom[10] = s->prom[11] = 0x00;
  1587. /* LSByte of two-byte checksum, which is the sum of bytes 00h-0Bh
  1588. and bytes 0Eh and 0Fh, must therefore be initialized with 0! */
  1589. s->prom[12] = s->prom[13] = 0x00;
  1590. /* Must be ASCII W (57h) if compatibility to AMD
  1591. driver software is desired */
  1592. s->prom[14] = s->prom[15] = 0x57;
  1593. for (i = 0, checksum = 0; i < 16; i++) {
  1594. checksum += s->prom[i];
  1595. }
  1596. *(uint16_t *)&s->prom[12] = cpu_to_le16(checksum);
  1597. return 0;
  1598. }