Context Navigation

eepromer.c

Revision 6048, 13.4 KB (checked in by khali, 3 weeks ago)
i2c-dev: Move SMBus helper functions to include/i2c/smbus.h
Property svn:eol-style set to `native` Property svn:keywords set to `Author Date Id Revision`

Line
1	#include <sys/ioctl.h>
2	#include <errno.h>
3	#include <string.h>
4	#include <stdio.h>
5	#include <stdlib.h>
6	#include <unistd.h>
7	#include <fcntl.h>
8	#include <time.h>
9	#include <linux/i2c.h>
10	#include <linux/i2c-dev.h>
11
12
13	#define MAX_BLK_SIZE 64
14	#define EEPROM_SIZE 32768
15	#define READ 1
16	#define WRITE 0
17	#define ERASE 2
18	#define PHEADER 3
19	#define VER "eepromer v 0.4 (c) Daniel Smolik 2001\n"
20	#define HEAD_SIZE sizeof(struct mini_inode)
21	#define START_ADDR 0
22	#define FORCE 1
23	/*
24	To disable startup warning #undef WARNINC
25
26
27	*/
28
29	#define WARNINC
30
31
32	int block_write(int file,int dev_addr,int eeprom_addr,unsigned char buf,int lenght);int block_write(int file,int dev_addr,int eeprom_addr,unsigned char buf,int lenght);
33	int block_read(int file,int dev_addr,int eeprom_addr,unsigned char *buf);
34
35	/* block_read read block 64 bytes length and returns actual length of data*/
36	void help(void);
37	int init(char *device,int addr);
38	int content_write(int file, int addr);
39	int content_read(int file, int addr);
40	int inode_write(int file, int dev_addr, int lenght);
41	int inode_read(int file, int dev_addr, void *p_inode);
42	void pheader(int file, int addr);
43	void erase(int file,int addr,int eeprom_size);
44	void made_address(int addr,unsigned char *buf);
45	void warn(void);
46	void bar(void);
47
48
49	static int stav=0;
50
51
52
53	static struct mini_inode {
54
55	time_t timestamp;
56	int data_len;
57	char data[56];
58
59	} m_ind,*p_ind;
60
61
62
63	void help(void)
64	{
65	FILE *fptr;
66	char s[100];
67
68	fprintf(stderr,"Syntax: eepromer [-r\|-w\|-e\|-p] -f /dev/i2c-X ADDRESS \n\n");
69	fprintf(stderr," ADDRESS is address of i2c device eg. 0x51\n");
70
71	if((fptr = fopen("/proc/bus/i2c", "r"))) {
72	fprintf(stderr," Installed I2C busses:\n");
73	while(fgets(s, 100, fptr))
74	fprintf(stderr, " %s", s);
75	fclose(fptr);
76	}
77	}
78
79
80
81
82
83	int main(int argc, char *argv[]){
84
85	int i, file, addr;
86	int action; //in this variable will be (-r,-w,-e)
87	char device[45];
88	int force;
89
90	p_ind=&m_ind;
91	force=0;
92
93
94
95
96	for(i=1; i < argc;i++){
97
98
99	if(!strcmp("-r",argv[i])) {
100	action=READ;
101	break;
102	}
103	if(!strcmp("-e",argv[i])) {
104	action=ERASE;
105	break;
106	}
107	if(!strcmp("-w",argv[i])) {
108	action=WRITE;
109	break;
110	}
111	if(!strcmp("-p",argv[i])) {
112	action=PHEADER;
113	break;
114	}
115	if(!strcmp("-force",argv[i])) {
116	force=FORCE;
117	break;
118	}
119	if(!strcmp("-v",argv[i])) {
120	fprintf(stderr,VER);
121	exit(0);
122	break;
123	}
124	else {
125
126	fprintf(stderr,"Error: No action specified !\n");
127	help();
128	exit(1);
129	}
130
131	}
132
133
134	#ifdef WARNINC
135
136	if(force!=FORCE) warn();
137
138	#endif
139
140
141	if(argc < 5) {
142	fprintf(stderr,"Error: No i2c address specified !\n");
143	help();
144	exit(1);
145
146	}
147
148
149	for(i=1; i < argc;i++){
150
151
152	if(!strcmp("-f",argv[i])) {
153	strcpy(device,argv[i+1]);
154	break;
155	}
156
157	}
158
159	if(!strlen(device)) {
160
161	fprintf(stderr,"Error: No device specified !\n");
162	help();
163	exit(1);
164	}
165
166
167	if(! (addr=strtol(argv[4],NULL,16))) {
168
169	fprintf(stderr,"Error: Bad device address !\n");
170	help();
171	exit(1);
172	}
173
174	if(! (file=init(device,addr))){
175
176	fprintf(stderr,"Error: Init failed !\n");
177	exit(1);
178	}
179
180
181	switch(action){
182
183	case READ:
184	content_read(file,addr);
185	break;
186
187	case WRITE:
188	content_write(file,addr);
189	break;
190
191	case ERASE: erase(file,addr,EEPROM_SIZE);
192	break;
193	case PHEADER: pheader(file,addr);
194	break;
195
196	default:
197	fprintf(stderr,"Internal error!\n");
198	exit(1); break;
199
200	}
201
202
203	close(file);
204	exit(0);
205
206	}
207
208
209
210	/****************************************************************************/
211	/* Low level function */
212	/* */
213	/****************************************************************************/
214
215
216
217
218
219	int block_write(int file,int dev_addr,int eeprom_addr,unsigned char *buf,int lenght){
220
221	unsigned char buff[2];
222	struct i2c_msg msg[2];
223
224	struct i2c_ioctl_rdwr_data {
225
226	struct i2c_msg msgs; / ptr to array of simple messages */
227	int nmsgs; /* number of messages to exchange */
228	} msgst;
229
230
231
232	if ( lenght > (MAX_BLK_SIZE) ) {
233
234	fprintf(stderr,
235	"Error: Block too large:\n");
236
237	}
238
239
240	//bar();
241
242	made_address(eeprom_addr,buff);
243
244
245	msg[0].addr = dev_addr;
246	msg[0].flags = 0;
247	msg[0].len = 2;
248	msg[0].buf = buff;
249
250
251	msg[1].addr = dev_addr;
252	msg[1].flags = I2C_M_NOSTART;
253	msg[1].len = lenght;
254	msg[1].buf = buf;
255
256
257	msgst.msgs = msg;
258	msgst.nmsgs = 2;
259
260
261	if (ioctl(file,I2C_RDWR,&msgst) < 0){
262
263	fprintf(stderr,
264	"Error: Transaction failed: %s\n",
265	strerror(errno));
266
267	return 1;
268
269	}
270
271	return 0;
272
273	}
274
275
276
277
278	int block_read(int file,int dev_addr,int eeprom_addr,unsigned char *buf){
279
280	int ln;
281	char buff[2]; //={0x0,0x0};
282
283	struct i2c_msg msg[2];
284
285	struct i2c_ioctl_rdwr_data {
286
287	struct i2c_msg msgs; / ptr to array of simple messages */
288	int nmsgs; /* number of messages to exchange */
289	} msgst;
290
291
292
293	made_address(eeprom_addr,buff);
294	ln=0;
295	//bar();
296
297	msg[0].addr = dev_addr;
298	msg[0].flags = 0;
299	msg[0].len = 2;
300	msg[0].buf = buff;
301
302
303	msg[1].addr = dev_addr;
304	msg[1].flags = I2C_M_RD;
305	msg[1].len = MAX_BLK_SIZE;
306	msg[1].buf = buf;
307
308
309
310
311	msgst.msgs = msg;
312	msgst.nmsgs = 2;
313
314
315
316
317	if ((ln = ioctl(file, I2C_RDWR, &msgst)) < 0) {
318
319	fprintf(stderr,
320	"Error: Read error:%d\n",ln);
321	return ln;
322	}
323
324	return ln;
325
326	}
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343	void made_address(int addr,unsigned char *buf){
344
345	int k;
346
347	//addr = addr & 0xFFFF; /odstranim nepoterbne bity/
348
349	k=addr;
350	buf[1]=(unsigned char) (k & 0xFF); //vyrobim druhy byte adresy
351	k=addr & 0xFF00 ;
352	buf[0]= ((unsigned char) (k >> 8)) & 0x7F;
353
354
355	return;
356	}
357
358
359	int init(char *device,int addr) {
360
361	int file;
362	unsigned long funcs;
363
364	if ((file = open(device,O_RDWR)) < 0) {
365
366	fprintf(stderr,"Error: Could not open file %s\n",
367	device);
368
369	return 0;
370	}
371
372
373	/* check adapter functionality */
374	if (ioctl(file,I2C_FUNCS,&funcs) < 0) {
375	fprintf(stderr,
376	"Error: Could not get the adapter functionality matrix: %s\n",
377	strerror(errno));
378	close(file);
379	return 0;
380	}
381
382	/* The I2C address */
383	if (ioctl(file,I2C_SLAVE,addr) < 0) {
384	/* ERROR HANDLING; you can check errno to see what went wrong */
385	fprintf(stderr,
386	"Error: Cannot communicate with slave: %s\n",
387	strerror(errno));
388
389	close(file);
390	return 0;
391	}
392
393	return file;
394	}
395
396
397	int content_write(int file, int addr){
398
399	unsigned char buf[MAX_BLK_SIZE];
400	unsigned char pom;
401	int i, j, k, delka, addr_cnt;
402
403	delka=0;
404	addr_cnt=HEAD_SIZE;
405	k=0;
406
407	for(j=0;j<MAX_BLK_SIZE;j++)
408	buf[j]=0;
409
410
411
412	i=0;
413
414	for(;;) {
415
416	delka=fread(&pom,1,1,stdin);
417
418	if( delka > 0 ){
419	buf[i]=pom;
420	}
421
422	if(i==(MAX_BLK_SIZE-1) \|\| (delka < 1)) {
423
424
425
426	if(block_write(file,addr,addr_cnt,buf,delka<1?i:(i+1)) !=0) {
427
428	fprintf(stderr,"Block write failed\n");
429	return 1;
430
431	}
432	//printf("i:%d\n",i);
433	addr_cnt=addr_cnt + i + (delka==1?1:0); //+i
434
435	for(j=0;j<MAX_BLK_SIZE;j++)
436	buf[j]=0;
437
438	i=0;
439	if(delka<1) {
440
441	//pisu EOF
442
443
444	if(inode_write(file,addr,(addr_cnt-HEAD_SIZE)) !=0) {
445
446	fprintf(stderr,"Inode write failed\n");
447	return 1;
448
449	}
450	break;
451	}
452
453
454	} else i++;
455
456	}
457
458	return 0;
459
460	}
461
462
463	int content_read(int file, int addr){
464
465	unsigned char buf[MAX_BLK_SIZE];
466	int i, j, k, delka;
467
468	delka=0;
469	k=0;
470
471
472	inode_read(file,addr,p_ind );
473
474
475	for(i=HEAD_SIZE;i<= (HEAD_SIZE + p_ind->data_len);i=i+MAX_BLK_SIZE ) {
476
477
478	if(block_read(file,addr,i,buf) !=0) {
479
480	fprintf(stderr,"Block read failed\n");
481	return 1;
482
483	}
484
485	if( (HEAD_SIZE + p_ind->data_len - i) < MAX_BLK_SIZE ) {
486	k= HEAD_SIZE + p_ind->data_len - i;
487	}else {
488	k=MAX_BLK_SIZE;
489	}
490
491
492	for(j=0;j<k ;j++){
493
494	putc(buf[j],stdout);
495
496	}
497
498
499	}
500
501	return 0;
502
503	}
504
505
506
507	void erase(int file, int addr,int eeprom_size){
508
509	unsigned char buf[MAX_BLK_SIZE];
510	int i, j, k, delka;
511
512	delka=0;
513	k=0;
514
515	for(j=0;j<MAX_BLK_SIZE;j++)
516	buf[j]=0;
517
518
519
520
521
522	for(i=0;i<eeprom_size;i=i+MAX_BLK_SIZE) {
523
524
525	if(block_write(file,addr,i,buf,MAX_BLK_SIZE) !=0) {
526
527	fprintf(stderr,"Block write failed\n");
528	return;
529
530	}
531
532	}
533
534	return;
535
536	}
537
538
539
540	void bar(void){
541
542
543	if( stav > 70 ) stav=0;
544
545
546	switch(stav) {
547
548
549	case 10: fwrite("\\",1,1,stderr);
550	fflush(stderr);
551	rewind(stderr);
552	break;
553	case 20: fwrite("\|",1,1,stderr);
554	fflush(stderr);
555	rewind(stderr);
556	break;
557	case 30: fwrite("/",1,1,stderr);
558	fflush(stderr);
559	rewind(stderr);
560	break;
561	case 40: fwrite("-",1,1,stderr);
562	fflush(stderr);
563	rewind(stderr);
564	break;
565	case 50: fwrite("\\",1,1,stderr);
566	fflush(stderr);
567	rewind(stderr);
568	break;
569	case 60: fwrite("\|",1,1,stderr);
570	fflush(stderr);
571	rewind(stderr);
572	break;
573	case 70: fwrite("/",1,1,stderr);
574	fflush(stderr);
575	rewind(stderr);
576	break;
577	}
578	stav++;
579
580	}
581
582
583
584
585
586	int inode_write(int file,int dev_addr,int lenght){
587
588	unsigned char buff[2];
589	struct i2c_msg msg[2];
590
591	struct i2c_ioctl_rdwr_data {
592
593	struct i2c_msg msgs; / ptr to array of simple messages */
594	int nmsgs; /* number of messages to exchange */
595	} msgst;
596
597
598	m_ind.timestamp=time(NULL);
599	m_ind.data_len=lenght;
600
601
602
603
604
605	//bar();
606
607	made_address(START_ADDR,buff);
608
609
610	msg[0].addr = dev_addr;
611	msg[0].flags = 0;
612	msg[0].len = 2;
613	msg[0].buf = buff;
614
615
616	msg[1].addr = dev_addr;
617	msg[1].flags = I2C_M_NOSTART;
618	msg[1].len = sizeof(struct mini_inode);
619	msg[1].buf = (char *) &m_ind;
620
621
622
623	msgst.msgs = msg;
624	msgst.nmsgs = 2;
625
626
627	if (ioctl(file,I2C_RDWR,&msgst) < 0){
628
629	fprintf(stderr,
630	"Error: Transaction failed: %s\n",
631	strerror(errno));
632
633	return 1;
634
635	}
636
637	return 0;
638
639	}
640
641
642
643	int inode_read(int file,int dev_addr,void *p_inode ){
644
645
646	#define POK 32
647	int ln;
648	char buff[2]; //={0x0,0x0};
649
650	struct i2c_msg msg[2];
651
652	struct i2c_ioctl_rdwr_data {
653
654	struct i2c_msg msgs; / ptr to array of simple messages */
655	int nmsgs; /* number of messages to exchange */
656	} msgst;
657
658	made_address(START_ADDR,buff);
659
660	ln=0;
661	//bar();
662
663	msg[0].addr = dev_addr;
664	msg[0].flags = 0;
665	msg[0].len = 2;
666	msg[0].buf = buff;
667
668
669	msg[1].addr = dev_addr;
670	msg[1].flags = I2C_M_RD;
671	msg[1].len = sizeof(struct mini_inode);
672	msg[1].buf = p_inode;
673
674
675
676
677	msgst.msgs = msg;
678	msgst.nmsgs = 2;
679
680
681	if ((ln = ioctl(file, I2C_RDWR, &msgst)) < 0) {
682
683	fprintf(stderr,
684	"Error: Read error:%d\n",ln);
685	return ln;
686	}
687
688
689
690	return ln;
691
692	}
693
694
695	void pheader(int file,int dev_addr){
696
697	struct tm *p_tm;
698	char time_buf[15],*p_buf;
699
700	p_buf=time_buf;
701	inode_read(file,dev_addr,p_ind );
702	p_tm=localtime(&p_ind->timestamp);
703	strftime(p_buf,sizeof(time_buf),"%Y%m%d%H%M%S",p_tm);
704	printf("LEN=%d,TIME=%s\n",p_ind->data_len,p_buf);
705	return;
706	}
707
708
709
710
711	#ifdef WARNINC
712	void warn(void)
713	{
714
715	fprintf(stderr,"\n\n!!!!!!!!!!!!!!!!!!!!!WARNING!!!!!!!!!!!!!!!!!!!!!\n");
716	fprintf(stderr,"This program is intended for use on eeproms\nusing external busses such as i2c-pport.\n");
717	fprintf(stderr,"Do not use this on your SDRAM DIMM EEPROMS\nunless you REALLY REALLY know what you are\ndoing!!! Doing so will render your SDRAM\nUSELESS and leave your system UNBOOTABLE!!!\n");
718	fprintf(stderr,"To disable this warning use -force\n");
719	fprintf(stderr,"\n\nPress ENTER to continue or hit Control-C NOW !!!!\n\n\n");
720
721	getchar();
722	}
723	#endif

Note: See TracBrowser for help on using the browser.

Context Navigation

root/i2c-tools/trunk/eepromer/eepromer.c

Download in other formats: