- fixed arm926 cp15 command bug (thanks to Vincent Palatin for this patch)
[openocd.git] / src / pld / xilinx_bit.c
1 /***************************************************************************
2 * Copyright (C) 2006 by Dominic Rath *
3 * Dominic.Rath@gmx.de *
4 * *
5 * This program is free software; you can redistribute it and/or modify *
6 * it under the terms of the GNU General Public License as published by *
7 * the Free Software Foundation; either version 2 of the License, or *
8 * (at your option) any later version. *
9 * *
10 * This program is distributed in the hope that it will be useful, *
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
13 * GNU General Public License for more details. *
14 * *
15 * You should have received a copy of the GNU General Public License *
16 * along with this program; if not, write to the *
17 * Free Software Foundation, Inc., *
18 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
19 ***************************************************************************/
20 #ifdef HAVE_CONFIG_H
21 #include "config.h"
22 #endif
23
24 #include "xilinx_bit.h"
25
26 #include "pld.h"
27 #include "log.h"
28
29 #include <stdlib.h>
30 #include <unistd.h>
31 #include <sys/types.h>
32 #include <sys/stat.h>
33 #include <fcntl.h>
34 #include <string.h>
35 #include <errno.h>
36
37 #include <sys/time.h>
38 #include <time.h>
39
40 int read_section(FILE *input_file, int length_size, char section, u32 *buffer_length, u8 **buffer)
41 {
42 u8 length_buffer[4];
43 u32 length;
44 char section_char;
45 int read_count;
46
47 if ((length_size != 2) && (length_size != 4))
48 {
49 ERROR("BUG: length_size neither 2 nor 4");
50 return ERROR_PLD_FILE_LOAD_FAILED;
51 }
52
53 if ((read_count = fread(&section_char, 1, 1, input_file)) != 1)
54 {
55 return ERROR_PLD_FILE_LOAD_FAILED;
56 }
57
58 if (section_char != section)
59 {
60 return ERROR_PLD_FILE_LOAD_FAILED;
61 }
62
63 if ((read_count = fread(length_buffer, 1, length_size, input_file)) != length_size)
64 {
65 return ERROR_PLD_FILE_LOAD_FAILED;
66 }
67
68 if (length_size == 4)
69 length = be_to_h_u32(length_buffer);
70 else /* (length_size == 2) */
71 length = be_to_h_u16(length_buffer);
72
73 if (buffer_length)
74 *buffer_length = length;
75
76 *buffer = malloc(length);
77
78 if ((read_count = fread(*buffer, 1, length, input_file)) != length)
79 {
80 return ERROR_PLD_FILE_LOAD_FAILED;
81 }
82
83 return ERROR_OK;
84 }
85
86 int xilinx_read_bit_file(xilinx_bit_file_t *bit_file, char *filename)
87 {
88 FILE *input_file;
89 struct stat input_stat;
90 int read_count;
91
92 if (!filename || !bit_file)
93 return ERROR_INVALID_ARGUMENTS;
94
95 if (stat(filename, &input_stat) == -1)
96 {
97 ERROR("couldn't stat() %s: %s", filename, strerror(errno));
98 return ERROR_PLD_FILE_LOAD_FAILED;
99 }
100
101 if (S_ISDIR(input_stat.st_mode))
102 {
103 ERROR("%s is a directory", filename);
104 return ERROR_PLD_FILE_LOAD_FAILED;
105 }
106
107 if (input_stat.st_size == 0){
108 ERROR("Empty file %s", filename);
109 return ERROR_PLD_FILE_LOAD_FAILED;
110 }
111
112 if (!(input_file = fopen(filename, "rb")))
113 {
114 ERROR("couldn't open %s: %s", filename, strerror(errno));
115 return ERROR_PLD_FILE_LOAD_FAILED;
116 }
117
118 if ((read_count = fread(bit_file->unknown_header, 1, 13, input_file)) != 13)
119 {
120 ERROR("couldn't read unknown_header from file '%s'", filename);
121 return ERROR_PLD_FILE_LOAD_FAILED;
122 }
123
124 if (read_section(input_file, 2, 'a', NULL, &bit_file->source_file) != ERROR_OK)
125 return ERROR_PLD_FILE_LOAD_FAILED;
126
127 if (read_section(input_file, 2, 'b', NULL, &bit_file->part_name) != ERROR_OK)
128 return ERROR_PLD_FILE_LOAD_FAILED;
129
130 if (read_section(input_file, 2, 'c', NULL, &bit_file->date) != ERROR_OK)
131 return ERROR_PLD_FILE_LOAD_FAILED;
132
133 if (read_section(input_file, 2, 'd', NULL, &bit_file->time) != ERROR_OK)
134 return ERROR_PLD_FILE_LOAD_FAILED;
135
136 if (read_section(input_file, 4, 'e', &bit_file->length, &bit_file->data) != ERROR_OK)
137 return ERROR_PLD_FILE_LOAD_FAILED;
138
139 DEBUG("bit_file: %s %s %s,%s %i", bit_file->source_file, bit_file->part_name,
140 bit_file->date, bit_file->time, bit_file->length);
141
142 fclose(input_file);
143
144 return ERROR_OK;
145 }