hw_eeprom.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839
  1. /* This file is part of the program psim.
  2. Copyright (C) 1994-1996, Andrew Cagney <cagney@highland.com.au>
  3. This program is free software; you can redistribute it and/or modify
  4. it under the terms of the GNU General Public License as published by
  5. the Free Software Foundation; either version 3 of the License, or
  6. (at your option) any later version.
  7. This program is distributed in the hope that it will be useful,
  8. but WITHOUT ANY WARRANTY; without even the implied warranty of
  9. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  10. GNU General Public License for more details.
  11. You should have received a copy of the GNU General Public License
  12. along with this program; if not, see <http://www.gnu.org/licenses/>.
  13. */
  14. #ifndef _HW_EEPROM_C_
  15. #define _HW_EEPROM_C_
  16. #include "device_table.h"
  17. #ifdef HAVE_STRING_H
  18. #include <string.h>
  19. #else
  20. #ifdef HAVE_STRINGS_H
  21. #include <strings.h>
  22. #endif
  23. #endif
  24. /* DEVICE
  25. eeprom - JEDEC? compatible electricaly erasable programable device
  26. DESCRIPTION
  27. This device implements a small byte addressable EEPROM.
  28. Programming is performed using the same write sequences as used by
  29. standard modern EEPROM components. Writes occure in real time, the
  30. device returning a progress value until the programing has been
  31. completed.
  32. It is based on the AMD 29F040 component.
  33. PROPERTIES
  34. reg = <address> <size> (required)
  35. Determine where the device lives in the parents address space.
  36. nr-sectors = <integer> (required)
  37. When erasing an entire sector is cleared at a time. This specifies
  38. the number of sectors in the EEPROM component.
  39. sector-size = <integer> (required)
  40. The number of bytes in a sector. When erasing, memory chunks of
  41. this size are cleared.
  42. NOTE: The product nr-sectors * sector-size does not need to map the
  43. size specified in the reg property. If the specified size is
  44. smaller part of the eeprom will not be accessible while if it is
  45. larger the addresses will wrap.
  46. byte-write-delay = <integer> (required)
  47. Number of clock ticks before the programming of a single byte
  48. completes.
  49. sector-start-delay = <integer> (required)
  50. When erasing sectors, the number of clock ticks after the sector
  51. has been specified that the actual erase process commences.
  52. erase-delay = <intger> (required)
  53. Number of clock ticks before an erase program completes
  54. manufacture-code = <integer> (required)
  55. The one byte value returned when the auto-select manufacturer code
  56. is read.
  57. device-code = <integer> (required)
  58. The one byte value returned when the auto-select device code is
  59. read.
  60. input-file = <file-name> (optional)
  61. Initialize the eeprom using the specified binary file.
  62. output-file = <file-name> (optional)
  63. When ever the eeprom is updated, save the modified image into the
  64. specified file.
  65. EXAMPLES
  66. Enable tracing of the eeprom:
  67. | bash$ psim -t eeprom-device \
  68. Configure something very like the Amd Am29F040 - 512byte EEPROM
  69. (but a bit faster):
  70. | -o '/eeprom@0xfff00000/reg 0xfff00000 0x80000' \
  71. | -o '/eeprom@0xfff00000/nr-sectors 8' \
  72. | -o '/eeprom@0xfff00000/sector-size 0x10000' \
  73. | -o '/eeprom@0xfff00000/byte-write-delay 1000' \
  74. | -o '/eeprom@0xfff00000/sector-start-delay 100' \
  75. | -o '/eeprom@0xfff00000/erase-delay 1000' \
  76. | -o '/eeprom@0xfff00000/manufacture-code 0x01' \
  77. | -o '/eeprom@0xfff00000/device-code 0xa4' \
  78. Initialize the eeprom from the file <</dev/zero>>:
  79. | -o '/eeprom@0xfff00000/input-file /dev/zero'
  80. BUGS
  81. */
  82. typedef enum {
  83. read_reset,
  84. write_nr_2,
  85. write_nr_3,
  86. write_nr_4,
  87. write_nr_5,
  88. write_nr_6,
  89. byte_program,
  90. byte_programming,
  91. chip_erase,
  92. sector_erase,
  93. sector_erase_suspend,
  94. autoselect,
  95. } hw_eeprom_states;
  96. static const char *
  97. state2a(hw_eeprom_states state)
  98. {
  99. switch (state) {
  100. case read_reset: return "read_reset";
  101. case write_nr_2: return "write_nr_2";
  102. case write_nr_3: return "write_nr_3";
  103. case write_nr_4: return "write_nr_4";
  104. case write_nr_5: return "write_nr_5";
  105. case write_nr_6: return "write_nr_6";
  106. case byte_program: return "byte_program";
  107. case byte_programming: return "byte_programming";
  108. case chip_erase: return "chip_erase";
  109. case sector_erase: return "sector_erase";
  110. case sector_erase_suspend: return "sector_erase_suspend";
  111. case autoselect: return "autoselect";
  112. }
  113. return NULL;
  114. }
  115. typedef struct _hw_eeprom_device {
  116. /* general */
  117. hw_eeprom_states state;
  118. unsigned8 *memory;
  119. unsigned sizeof_memory;
  120. unsigned erase_delay;
  121. signed64 program_start_time;
  122. signed64 program_finish_time;
  123. unsigned8 manufacture_code;
  124. unsigned8 device_code;
  125. unsigned8 toggle_bit;
  126. /* initialization */
  127. const char *input_file_name;
  128. const char *output_file_name;
  129. /* for sector and sector programming */
  130. hw_eeprom_states sector_state;
  131. unsigned8 *sectors;
  132. unsigned nr_sectors;
  133. unsigned sizeof_sector;
  134. unsigned sector_start_delay;
  135. unsigned sector_start_time;
  136. /* byte and byte programming */
  137. unsigned byte_write_delay;
  138. unsigned_word byte_program_address;
  139. unsigned8 byte_program_byte;
  140. } hw_eeprom_device;
  141. typedef struct _hw_eeprom_reg_spec {
  142. unsigned32 base;
  143. unsigned32 size;
  144. } hw_eeprom_reg_spec;
  145. static void
  146. hw_eeprom_init_data(device *me)
  147. {
  148. hw_eeprom_device *eeprom = (hw_eeprom_device*)device_data(me);
  149. /* have we any input or output files */
  150. if (device_find_property(me, "input-file") != NULL)
  151. eeprom->input_file_name = device_find_string_property(me, "input-file");
  152. if (device_find_property(me, "output-file") != NULL)
  153. eeprom->input_file_name = device_find_string_property(me, "output-file");
  154. /* figure out the sectors in the eeprom */
  155. if (eeprom->sectors == NULL) {
  156. eeprom->nr_sectors = device_find_integer_property(me, "nr-sectors");
  157. eeprom->sizeof_sector = device_find_integer_property(me, "sector-size");
  158. eeprom->sectors = zalloc(eeprom->nr_sectors);
  159. }
  160. else
  161. memset(eeprom->sectors, 0, eeprom->nr_sectors);
  162. /* initialize the eeprom */
  163. if (eeprom->memory == NULL) {
  164. eeprom->sizeof_memory = eeprom->sizeof_sector * eeprom->nr_sectors;
  165. eeprom->memory = zalloc(eeprom->sizeof_memory);
  166. }
  167. else
  168. memset(eeprom->memory, 0, eeprom->sizeof_memory);
  169. if (eeprom->input_file_name != NULL) {
  170. int i;
  171. FILE *input_file = fopen(eeprom->input_file_name, "r");
  172. if (input_file == NULL) {
  173. perror("eeprom");
  174. device_error(me, "Failed to open input file %s\n", eeprom->input_file_name);
  175. }
  176. for (i = 0; i < eeprom->sizeof_memory; i++) {
  177. if (fread(&eeprom->memory[i], 1, 1, input_file) != 1)
  178. break;
  179. }
  180. fclose(input_file);
  181. }
  182. /* timing */
  183. eeprom->byte_write_delay = device_find_integer_property(me, "byte-write-delay");
  184. eeprom->sector_start_delay = device_find_integer_property(me, "sector-start-delay");
  185. eeprom->erase_delay = device_find_integer_property(me, "erase-delay");
  186. /* misc */
  187. eeprom->manufacture_code = device_find_integer_property(me, "manufacture-code");
  188. eeprom->device_code = device_find_integer_property(me, "device-code");
  189. }
  190. static void
  191. invalid_read(device *me,
  192. hw_eeprom_states state,
  193. unsigned_word address,
  194. const char *reason)
  195. {
  196. DTRACE(eeprom, ("Invalid read to 0x%lx while in state %s (%s)\n",
  197. (unsigned long)address,
  198. state2a(state),
  199. reason));
  200. }
  201. static void
  202. invalid_write(device *me,
  203. hw_eeprom_states state,
  204. unsigned_word address,
  205. unsigned8 data,
  206. const char *reason)
  207. {
  208. DTRACE(eeprom, ("Invalid write of 0x%lx to 0x%lx while in state %s (%s)\n",
  209. (unsigned long)data,
  210. (unsigned long)address,
  211. state2a(state),
  212. reason));
  213. }
  214. static void
  215. dump_eeprom(device *me,
  216. hw_eeprom_device *eeprom)
  217. {
  218. if (eeprom->output_file_name != NULL) {
  219. int i;
  220. FILE *output_file = fopen(eeprom->output_file_name, "w");
  221. if (output_file == NULL) {
  222. perror("eeprom");
  223. device_error(me, "Failed to open output file %s\n",
  224. eeprom->output_file_name);
  225. }
  226. for (i = 0; i < eeprom->sizeof_memory; i++) {
  227. if (fwrite(&eeprom->memory[i], 1, 1, output_file) != 1)
  228. break;
  229. }
  230. fclose(output_file);
  231. }
  232. }
  233. /* program a single byte of eeprom */
  234. static void
  235. start_programming_byte(device *me,
  236. hw_eeprom_device *eeprom,
  237. unsigned_word address,
  238. unsigned8 new_byte)
  239. {
  240. unsigned8 old_byte = eeprom->memory[address];
  241. DTRACE(eeprom, ("start-programing-byte - address 0x%lx, new 0x%lx, old 0x%lx\n",
  242. (unsigned long)address,
  243. (unsigned long)new_byte,
  244. (unsigned long)old_byte));
  245. eeprom->byte_program_address = address;
  246. /* : old new : ~old : new&~old
  247. : 0 0 : 1 : 0
  248. : 0 1 : 1 : 1 -- can not set a bit
  249. : 1 0 : 0 : 0
  250. : 1 1 : 0 : 0 */
  251. if (~old_byte & new_byte)
  252. invalid_write(me, eeprom->state, address, new_byte, "setting cleared bit");
  253. /* : old new : old&new
  254. : 0 0 : 0
  255. : 0 1 : 0
  256. : 1 0 : 0
  257. : 1 1 : 1 */
  258. eeprom->byte_program_byte = new_byte & old_byte;
  259. eeprom->memory[address] = ~new_byte & ~0x24; /* LE-bits 5:3 zero */
  260. eeprom->program_start_time = device_event_queue_time(me);
  261. eeprom->program_finish_time = (eeprom->program_start_time
  262. + eeprom->byte_write_delay);
  263. }
  264. static void
  265. finish_programming_byte(device *me,
  266. hw_eeprom_device *eeprom)
  267. {
  268. DTRACE(eeprom, ("finish-programming-byte - address 0x%lx, byte 0x%lx\n",
  269. (unsigned long)eeprom->byte_program_address,
  270. (unsigned long)eeprom->byte_program_byte));
  271. eeprom->memory[eeprom->byte_program_address] = eeprom->byte_program_byte;
  272. dump_eeprom(me, eeprom);
  273. }
  274. /* erase the eeprom completly */
  275. static void
  276. start_erasing_chip(device *me,
  277. hw_eeprom_device *eeprom)
  278. {
  279. DTRACE(eeprom, ("start-erasing-chip\n"));
  280. memset(eeprom->memory, 0, eeprom->sizeof_memory);
  281. eeprom->program_start_time = device_event_queue_time(me);
  282. eeprom->program_finish_time = (eeprom->program_start_time
  283. + eeprom->erase_delay);
  284. }
  285. static void
  286. finish_erasing_chip(device *me,
  287. hw_eeprom_device *eeprom)
  288. {
  289. DTRACE(eeprom, ("finish-erasing-chip\n"));
  290. memset(eeprom->memory, 0xff, eeprom->sizeof_memory);
  291. dump_eeprom(me, eeprom);
  292. }
  293. /* erase a single sector of the eeprom */
  294. static void
  295. start_erasing_sector(device *me,
  296. hw_eeprom_device *eeprom,
  297. unsigned_word address)
  298. {
  299. int sector = address / eeprom->sizeof_sector;
  300. DTRACE(eeprom, ("start-erasing-sector - address 0x%lx, sector %d\n",
  301. (unsigned long)address, sector));
  302. ASSERT(sector < eeprom->nr_sectors);
  303. eeprom->sectors[sector] = 1;
  304. memset(eeprom->memory + sector * eeprom->sizeof_sector,
  305. 0x4, eeprom->sizeof_sector);
  306. eeprom->program_start_time = device_event_queue_time(me);
  307. eeprom->sector_start_time = (eeprom->program_start_time
  308. + eeprom->sector_start_delay);
  309. eeprom->program_finish_time = (eeprom->sector_start_time
  310. + eeprom->erase_delay);
  311. }
  312. static void
  313. finish_erasing_sector(device *me,
  314. hw_eeprom_device *eeprom)
  315. {
  316. int sector;
  317. DTRACE(eeprom, ("finish-erasing-sector\n"));
  318. for (sector = 0; sector < eeprom->nr_sectors; sector++) {
  319. if (eeprom->sectors[sector]) {
  320. eeprom->sectors[sector] = 0;
  321. memset(eeprom->memory + sector * eeprom->sizeof_sector,
  322. 0xff, eeprom->sizeof_sector);
  323. }
  324. }
  325. dump_eeprom(me, eeprom);
  326. }
  327. /* eeprom reads */
  328. static unsigned8
  329. toggle(hw_eeprom_device *eeprom,
  330. unsigned8 byte)
  331. {
  332. eeprom->toggle_bit = eeprom->toggle_bit ^ 0x40; /* le-bit 6 */
  333. return eeprom->toggle_bit ^ byte;
  334. }
  335. static unsigned8
  336. read_byte(device *me,
  337. hw_eeprom_device *eeprom,
  338. unsigned_word address)
  339. {
  340. /* may need multiple iterations of this */
  341. while (1) {
  342. switch (eeprom->state) {
  343. case read_reset:
  344. return eeprom->memory[address];
  345. case autoselect:
  346. if ((address & 0xff) == 0x00)
  347. return eeprom->manufacture_code;
  348. else if ((address & 0xff) == 0x01)
  349. return eeprom->device_code;
  350. else
  351. return 0; /* not certain about this */
  352. case byte_programming:
  353. if (device_event_queue_time(me) > eeprom->program_finish_time) {
  354. finish_programming_byte(me, eeprom);
  355. eeprom->state = read_reset;
  356. continue;
  357. }
  358. else if (address == eeprom->byte_program_address) {
  359. return toggle(eeprom, eeprom->memory[address]);
  360. }
  361. else {
  362. /* trash that memory location */
  363. invalid_read(me, eeprom->state, address, "not byte program address");
  364. eeprom->memory[address] = (eeprom->memory[address]
  365. & eeprom->byte_program_byte);
  366. return toggle(eeprom, eeprom->memory[eeprom->byte_program_address]);
  367. }
  368. case chip_erase:
  369. if (device_event_queue_time(me) > eeprom->program_finish_time) {
  370. finish_erasing_chip(me, eeprom);
  371. eeprom->state = read_reset;
  372. continue;
  373. }
  374. else {
  375. return toggle(eeprom, eeprom->memory[address]);
  376. }
  377. case sector_erase:
  378. if (device_event_queue_time(me) > eeprom->program_finish_time) {
  379. finish_erasing_sector(me, eeprom);
  380. eeprom->state = read_reset;
  381. continue;
  382. }
  383. else if (!eeprom->sectors[address / eeprom->sizeof_sector]) {
  384. /* read to wrong sector */
  385. invalid_read(me, eeprom->state, address, "sector not being erased");
  386. return toggle(eeprom, eeprom->memory[address]) & ~0x8;
  387. }
  388. else if (device_event_queue_time(me) > eeprom->sector_start_time) {
  389. return toggle(eeprom, eeprom->memory[address]) | 0x8;
  390. }
  391. else {
  392. return toggle(eeprom, eeprom->memory[address]) & ~0x8;
  393. }
  394. case sector_erase_suspend:
  395. if (!eeprom->sectors[address / eeprom->sizeof_sector]) {
  396. return eeprom->memory[address];
  397. }
  398. else {
  399. invalid_read(me, eeprom->state, address, "sector being erased");
  400. return eeprom->memory[address];
  401. }
  402. default:
  403. invalid_read(me, eeprom->state, address, "invalid state");
  404. return eeprom->memory[address];
  405. }
  406. }
  407. return 0;
  408. }
  409. static unsigned
  410. hw_eeprom_io_read_buffer(device *me,
  411. void *dest,
  412. int space,
  413. unsigned_word addr,
  414. unsigned nr_bytes,
  415. cpu *processor,
  416. unsigned_word cia)
  417. {
  418. hw_eeprom_device *eeprom = (hw_eeprom_device*)device_data(me);
  419. int i;
  420. for (i = 0; i < nr_bytes; i++) {
  421. unsigned_word address = (addr + i) % eeprom->sizeof_memory;
  422. unsigned8 byte = read_byte(me, eeprom, address);
  423. ((unsigned8*)dest)[i] = byte;
  424. }
  425. return nr_bytes;
  426. }
  427. /* eeprom writes */
  428. static void
  429. write_byte(device *me,
  430. hw_eeprom_device *eeprom,
  431. unsigned_word address,
  432. unsigned8 data)
  433. {
  434. /* may need multiple transitions to process a write */
  435. while (1) {
  436. switch (eeprom->state) {
  437. case read_reset:
  438. if (address == 0x5555 && data == 0xaa)
  439. eeprom->state = write_nr_2;
  440. else if (data == 0xf0)
  441. eeprom->state = read_reset;
  442. else {
  443. invalid_write(me, eeprom->state, address, data, "unexpected");
  444. eeprom->state = read_reset;
  445. }
  446. return;
  447. case write_nr_2:
  448. if (address == 0x2aaa && data == 0x55)
  449. eeprom->state = write_nr_3;
  450. else {
  451. invalid_write(me, eeprom->state, address, data, "unexpected");
  452. eeprom->state = read_reset;
  453. }
  454. return;
  455. case write_nr_3:
  456. if (address == 0x5555 && data == 0xf0)
  457. eeprom->state = read_reset;
  458. else if (address == 0x5555 && data == 0x90)
  459. eeprom->state = autoselect;
  460. else if (address == 0x5555 && data == 0xa0) {
  461. eeprom->state = byte_program;
  462. }
  463. else if (address == 0x5555 && data == 0x80)
  464. eeprom->state = write_nr_4;
  465. else {
  466. invalid_write(me, eeprom->state, address, data, "unexpected");
  467. eeprom->state = read_reset;
  468. }
  469. return;
  470. case write_nr_4:
  471. if (address == 0x5555 && data == 0xaa)
  472. eeprom->state = write_nr_5;
  473. else {
  474. invalid_write(me, eeprom->state, address, data, "unexpected");
  475. eeprom->state = read_reset;
  476. }
  477. return;
  478. case write_nr_5:
  479. if (address == 0x2aaa && data == 0x55)
  480. eeprom->state = write_nr_6;
  481. else {
  482. invalid_write(me, eeprom->state, address, data, "unexpected");
  483. eeprom->state = read_reset;
  484. }
  485. return;
  486. case write_nr_6:
  487. if (address == 0x5555 && data == 0x10) {
  488. start_erasing_chip(me, eeprom);
  489. eeprom->state = chip_erase;
  490. }
  491. else {
  492. start_erasing_sector(me, eeprom, address);
  493. eeprom->sector_state = read_reset;
  494. eeprom->state = sector_erase;
  495. }
  496. return;
  497. case autoselect:
  498. if (data == 0xf0)
  499. eeprom->state = read_reset;
  500. else if (address == 0x5555 && data == 0xaa)
  501. eeprom->state = write_nr_2;
  502. else {
  503. invalid_write(me, eeprom->state, address, data, "unsupported address");
  504. eeprom->state = read_reset;
  505. }
  506. return;
  507. case byte_program:
  508. start_programming_byte(me, eeprom, address, data);
  509. eeprom->state = byte_programming;
  510. return;
  511. case byte_programming:
  512. if (device_event_queue_time(me) > eeprom->program_finish_time) {
  513. finish_programming_byte(me, eeprom);
  514. eeprom->state = read_reset;
  515. continue;
  516. }
  517. /* ignore it */
  518. return;
  519. case chip_erase:
  520. if (device_event_queue_time(me) > eeprom->program_finish_time) {
  521. finish_erasing_chip(me, eeprom);
  522. eeprom->state = read_reset;
  523. continue;
  524. }
  525. /* ignore it */
  526. return;
  527. case sector_erase:
  528. if (device_event_queue_time(me) > eeprom->program_finish_time) {
  529. finish_erasing_sector(me, eeprom);
  530. eeprom->state = eeprom->sector_state;
  531. continue;
  532. }
  533. else if (device_event_queue_time(me) > eeprom->sector_start_time
  534. && data == 0xb0) {
  535. eeprom->sector_state = read_reset;
  536. eeprom->state = sector_erase_suspend;
  537. }
  538. else {
  539. if (eeprom->sector_state == read_reset
  540. && address == 0x5555 && data == 0xaa)
  541. eeprom->sector_state = write_nr_2;
  542. else if (eeprom->sector_state == write_nr_2
  543. && address == 0x2aaa && data == 0x55)
  544. eeprom->sector_state = write_nr_3;
  545. else if (eeprom->sector_state == write_nr_3
  546. && address == 0x5555 && data == 0x80)
  547. eeprom->sector_state = write_nr_4;
  548. else if (eeprom->sector_state == write_nr_4
  549. && address == 0x5555 && data == 0xaa)
  550. eeprom->sector_state = write_nr_5;
  551. else if (eeprom->sector_state == write_nr_5
  552. && address == 0x2aaa && data == 0x55)
  553. eeprom->sector_state = write_nr_6;
  554. else if (eeprom->sector_state == write_nr_6
  555. && address != 0x5555 && data == 0x30) {
  556. if (device_event_queue_time(me) > eeprom->sector_start_time) {
  557. DTRACE(eeprom, ("sector erase command after window closed\n"));
  558. eeprom->sector_state = read_reset;
  559. }
  560. else {
  561. start_erasing_sector(me, eeprom, address);
  562. eeprom->sector_state = read_reset;
  563. }
  564. }
  565. else {
  566. invalid_write(me, eeprom->state, address, data, state2a(eeprom->sector_state));
  567. eeprom->state = read_reset;
  568. }
  569. }
  570. return;
  571. case sector_erase_suspend:
  572. if (data == 0x30)
  573. eeprom->state = sector_erase;
  574. else {
  575. invalid_write(me, eeprom->state, address, data, "not resume command");
  576. eeprom->state = read_reset;
  577. }
  578. return;
  579. }
  580. }
  581. }
  582. static unsigned
  583. hw_eeprom_io_write_buffer(device *me,
  584. const void *source,
  585. int space,
  586. unsigned_word addr,
  587. unsigned nr_bytes,
  588. cpu *processor,
  589. unsigned_word cia)
  590. {
  591. hw_eeprom_device *eeprom = (hw_eeprom_device*)device_data(me);
  592. int i;
  593. for (i = 0; i < nr_bytes; i++) {
  594. unsigned_word address = (addr + i) % eeprom->sizeof_memory;
  595. unsigned8 byte = ((unsigned8*)source)[i];
  596. write_byte(me, eeprom, address, byte);
  597. }
  598. return nr_bytes;
  599. }
  600. /* An instance of the eeprom */
  601. typedef struct _hw_eeprom_instance {
  602. unsigned_word pos;
  603. hw_eeprom_device *eeprom;
  604. device *me;
  605. } hw_eeprom_instance;
  606. static void
  607. hw_eeprom_instance_delete(device_instance *instance)
  608. {
  609. hw_eeprom_instance *data = device_instance_data(instance);
  610. free(data);
  611. }
  612. static int
  613. hw_eeprom_instance_read(device_instance *instance,
  614. void *buf,
  615. unsigned_word len)
  616. {
  617. hw_eeprom_instance *data = device_instance_data(instance);
  618. int i;
  619. if (data->eeprom->state != read_reset)
  620. DITRACE(eeprom, ("eeprom not idle during instance read\n"));
  621. for (i = 0; i < len; i++) {
  622. ((unsigned8*)buf)[i] = data->eeprom->memory[data->pos];
  623. data->pos = (data->pos + 1) % data->eeprom->sizeof_memory;
  624. }
  625. return len;
  626. }
  627. static int
  628. hw_eeprom_instance_write(device_instance *instance,
  629. const void *buf,
  630. unsigned_word len)
  631. {
  632. hw_eeprom_instance *data = device_instance_data(instance);
  633. int i;
  634. if (data->eeprom->state != read_reset)
  635. DITRACE(eeprom, ("eeprom not idle during instance write\n"));
  636. for (i = 0; i < len; i++) {
  637. data->eeprom->memory[data->pos] = ((unsigned8*)buf)[i];
  638. data->pos = (data->pos + 1) % data->eeprom->sizeof_memory;
  639. }
  640. dump_eeprom(data->me, data->eeprom);
  641. return len;
  642. }
  643. static int
  644. hw_eeprom_instance_seek(device_instance *instance,
  645. unsigned_word pos_hi,
  646. unsigned_word pos_lo)
  647. {
  648. hw_eeprom_instance *data = device_instance_data(instance);
  649. if (pos_lo >= data->eeprom->sizeof_memory)
  650. device_error(data->me, "seek value 0x%lx out of range\n",
  651. (unsigned long)pos_lo);
  652. data->pos = pos_lo;
  653. return 0;
  654. }
  655. static const device_instance_callbacks hw_eeprom_instance_callbacks = {
  656. hw_eeprom_instance_delete,
  657. hw_eeprom_instance_read,
  658. hw_eeprom_instance_write,
  659. hw_eeprom_instance_seek,
  660. };
  661. static device_instance *
  662. hw_eeprom_create_instance(device *me,
  663. const char *path,
  664. const char *args)
  665. {
  666. hw_eeprom_device *eeprom = device_data(me);
  667. hw_eeprom_instance *data = ZALLOC(hw_eeprom_instance);
  668. data->eeprom = eeprom;
  669. data->me = me;
  670. return device_create_instance_from(me, NULL,
  671. data,
  672. path, args,
  673. &hw_eeprom_instance_callbacks);
  674. }
  675. static device_callbacks const hw_eeprom_callbacks = {
  676. { generic_device_init_address,
  677. hw_eeprom_init_data },
  678. { NULL, }, /* address */
  679. { hw_eeprom_io_read_buffer,
  680. hw_eeprom_io_write_buffer }, /* IO */
  681. { NULL, }, /* DMA */
  682. { NULL, }, /* interrupt */
  683. { NULL, }, /* unit */
  684. hw_eeprom_create_instance,
  685. };
  686. static void *
  687. hw_eeprom_create(const char *name,
  688. const device_unit *unit_address,
  689. const char *args)
  690. {
  691. hw_eeprom_device *eeprom = ZALLOC(hw_eeprom_device);
  692. return eeprom;
  693. }
  694. const device_descriptor hw_eeprom_device_descriptor[] = {
  695. { "eeprom", hw_eeprom_create, &hw_eeprom_callbacks },
  696. { NULL },
  697. };
  698. #endif /* _HW_EEPROM_C_ */