ViewVC Help
View File | Revision Log | Show Annotations | Revision Graph | Root Listing
root/cebix/cwcbm/common.c
Revision: 1.3
Committed: 2004-09-25T14:30:00Z (20 years, 1 month ago) by cebix
Content type: text/plain
Branch: MAIN
CVS Tags: HEAD
Changes since 1.2: +3 -3 lines
Log Message:
fixed compilation problem

File Contents

# User Rev Content
1 cebix 1.1 /*
2     * common.c - Common parts of readcbm and writecbm
3     *
4     * Written in 2003-2004 by Christian Bauer <Christian.Bauer@uni-mainz.de>
5     */
6    
7     #include "catweasel.h"
8     #include "common.h"
9    
10    
11 cebix 1.2 /* Effective crystal frequencies */
12     #define CRYSTAL_FREQ_1541 4000000 // 4 MHz
13     #define CRYSTAL_FREQ_8050 6000000 // 6 MHz
14 cebix 1.1
15 cebix 1.2 /* CBM drive RPM */
16 cebix 1.1 #define NOMINAL_RPM 300
17    
18     /* Catweasel frequency (7 MHz) */
19     #define CW_FREQ 7080500.0
20    
21 cebix 1.2
22     /* 1541 disk format */
23     static const int bps_1541[4] = {
24     CRYSTAL_FREQ_1541 / 16, CRYSTAL_FREQ_1541 / 15,
25     CRYSTAL_FREQ_1541 / 14, CRYSTAL_FREQ_1541 / 13
26 cebix 1.1 };
27    
28 cebix 1.2 static const int std_speed_1541[36] = {
29 cebix 1.1 0,
30     3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3,
31     2, 2, 2, 2, 2, 2, 2,
32     1, 1, 1, 1, 1, 1,
33     0, 0, 0, 0, 0
34     };
35    
36 cebix 1.2 static const int num_sectors_1541[36] = {
37 cebix 1.1 0,
38     21,21,21,21,21,21,21,21,21,21,21,21,21,21,21,21,21,
39     19,19,19,19,19,19,19,
40     18,18,18,18,18,18,
41     17,17,17,17,17
42     };
43    
44 cebix 1.2 static const struct format_t format_1541 = {
45     1, // sides
46     35, // tracks_per_side
47     bps_1541, // bps
48     std_speed_1541, // std_speed
49     num_sectors_1541 // num_sectors
50     };
51    
52     /* 8050 disk format */
53     static const int bps_8050[4] = {
54     CRYSTAL_FREQ_8050 / 16, CRYSTAL_FREQ_8050 / 15,
55     CRYSTAL_FREQ_8050 / 14, CRYSTAL_FREQ_8050 / 13
56     };
57    
58     static const int std_speed_8050[78] = {
59     0,
60     3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3,
61     2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
62     1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
63     0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
64     };
65    
66     static const int num_sectors_8050[78] = {
67     0,
68     29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29,
69     27, 27, 27, 27, 27, 27, 27, 27, 27, 27, 27, 27, 27, 27,
70     25, 25, 25, 25, 25, 25, 25, 25, 25, 25, 25,
71     23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23
72     };
73    
74     static const struct format_t format_8050 = {
75     1, // sides
76     77, // tracks_per_side
77     bps_8050, // bps
78     std_speed_8050, // std_speed
79     num_sectors_8050 // num_sectors
80     };
81    
82     /* 8250 disk format */
83     static const int std_speed_8250[155] = {
84     0,
85     3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3,
86     2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
87     1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
88     0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
89     3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3, 3,
90     2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
91     1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
92     0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
93     };
94    
95     static const int num_sectors_8250[155] = {
96     0,
97     29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29,
98     27, 27, 27, 27, 27, 27, 27, 27, 27, 27, 27, 27, 27, 27,
99     25, 25, 25, 25, 25, 25, 25, 25, 25, 25, 25,
100     23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23,
101     29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29, 29,
102     27, 27, 27, 27, 27, 27, 27, 27, 27, 27, 27, 27, 27, 27,
103     25, 25, 25, 25, 25, 25, 25, 25, 25, 25, 25,
104     23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23, 23
105     };
106    
107     static const struct format_t format_8250 = {
108     2, // sides
109     77, // tracks_per_side
110     bps_8050, // bps
111     std_speed_8250, // std_speed
112     num_sectors_8250 // num_sectors
113     };
114    
115     /* Selected format */
116     const struct format_t *format = NULL;
117    
118 cebix 1.1
119     /* Command line arguments */
120     int drive_num = 0;
121     int drive_rpm = 360;
122     int drive_40tracks = 0;
123 cebix 1.2 int steps_per_track = 1;
124 cebix 1.1 const char *file_name;
125    
126    
127     /* Catweasel controller struct */
128     catweasel_contr c;
129    
130    
131     /* Clock table (nominal number of Catweasel clocks per inter-flux-change gap) */
132     int clock_table[4] = {0, 0, 0, 0};
133    
134     /* Threshold table */
135     int thresh_table[3] = {0, 0, 0};
136    
137    
138     /* Track buffer */
139     unsigned char track_buf[MAX_SECTORS * SECTOR_SIZE];
140    
141    
142     /* Print usage information */
143     static void usage(const char *prgname)
144     {
145     fprintf(stderr,
146     "Reads/writes CBM formatted disks with the Catweasel controller\n\n"
147     "Usage: %s <options> <file>\n\n"
148     "Options:\n"
149     " -h | --help this text\n"
150     " -p | --port n Catweasel I/O port address (hex, required)\n"
151     " -d | --drive n drive number (0 or 1)\n"
152 cebix 1.2 " -f | --format n disk format type (1541, 8050, or 8250)\n"
153 cebix 1.1 " -4 | --40tracks assume 300RPM 40-track drive\n",
154     prgname
155     );
156     exit(1);
157     }
158    
159    
160     /* Parse command line arguments */
161     void parse_args(int argc, char **argv)
162     {
163     static struct option long_opts[] = {
164     {"help", 0, 0, 'h'},
165     {"port", 1, 0, 'p'},
166     {"drive", 1, 0, 'd'},
167 cebix 1.2 {"format", 1, 0, 'f'},
168 cebix 1.1 {"40tracks", 0, 0, '4'},
169     {NULL, 0, 0, 0}
170     };
171    
172 cebix 1.2 int format_type = 0;
173    
174 cebix 1.1 // Init Catweasel struct
175     memset(&c, 0, sizeof(c));
176     c.msdelay = msdelay;
177    
178     // Parse arguments
179     for (;;) {
180     int ch;
181 cebix 1.2 if ((ch = getopt_long(argc, argv, "hp:d:f:4", long_opts, NULL)) == -1)
182 cebix 1.1 break;
183    
184     switch (ch) {
185     case 0: /* Long option */
186     break;
187     case 'p':
188     c.iobase = strtol(optarg, NULL, 16);
189     break;
190     case 'd':
191     drive_num = atoi(optarg);
192     if (drive_num < 0 || drive_num > 1)
193     usage(argv[0]);
194     break;
195 cebix 1.2 case 'f':
196     format_type = atoi(optarg);
197     if (format_type == 1541 || format_type == 8050 || format_type == 8250)
198     select_format(format_type);
199     else
200     usage(argv[0]);
201     break;
202 cebix 1.1 case '4':
203     drive_rpm = 300;
204     drive_40tracks = 1;
205     break;
206     case 'h':
207     default:
208     usage(argv[0]);
209     break;
210     }
211     }
212    
213     if (optind >= argc)
214     usage(argv[0]);
215     else
216     file_name = argv[optind];
217    
218     // Check for consistency
219     if (c.iobase == 0)
220     usage(argv[0]);
221 cebix 1.2 if (format_type == 0)
222     select_format(1541);
223     if (format->tracks_per_side >= 40 && drive_40tracks) {
224     fprintf(stderr, "Can't use 80 track disk format on 40 track drive\n");
225     exit(1);
226     }
227     if (format->tracks_per_side < 40 && !drive_40tracks)
228     steps_per_track = 2; // double step
229 cebix 1.1
230     // Set Catweasel type
231     if (c.iobase < 0x1000)
232     c.type = CATWEASEL_TYPE_MK1;
233     else
234     c.type = CATWEASEL_TYPE_MK3;
235     }
236    
237    
238     /* Obtain access to I/O ports */
239     void ioport_access(void)
240     {
241     if ((c.type == CATWEASEL_TYPE_MK1 && ioperm(c.iobase, 8, 1) == -1)
242     || (c.type == CATWEASEL_TYPE_MK3 && iopl(3) == -1)) {
243     fprintf(stderr, "No access to I/O ports\n");
244     exit(1);
245     }
246     setuid(getuid());
247 cebix 1.2 }
248    
249    
250     /* Delay specified number of milliseconds */
251     void msdelay(int ms)
252     {
253     usleep(ms * 1000);
254     }
255    
256    
257     /* Select disk format */
258     void select_format(int type)
259     {
260     switch (type) {
261     case 1541:
262     format = &format_1541;
263     break;
264     case 8050:
265     format = &format_8050;
266     break;
267     case 8250:
268     format = &format_8250;
269     break;
270     default:
271     fprintf(stderr, "Invalid disk format type\n");
272     exit(1);
273     }
274     }
275    
276    
277     /* Set speed zone and tables */
278     static void set_zone(int track)
279     {
280     int zone = format->std_speed[track];
281     int bps = format->bps[zone];
282     clock_table[0] = 0;
283     clock_table[1] = CW_FREQ * NOMINAL_RPM * 1 / (bps * drive_rpm);
284     clock_table[2] = CW_FREQ * NOMINAL_RPM * 2 / (bps * drive_rpm);
285     clock_table[3] = CW_FREQ * NOMINAL_RPM * 3 / (bps * drive_rpm);
286     thresh_table[0] = (clock_table[0] + clock_table[1]) / 2;
287     thresh_table[1] = (clock_table[1] + clock_table[2]) / 2;
288     thresh_table[2] = (clock_table[2] + clock_table[3]) / 2;
289     }
290    
291    
292     /* Seek to given CBM track (1..35) and select correct side and speed zone */
293     void seek_to(int drive, int track)
294     {
295 cebix 1.3 int cw_track;
296    
297 cebix 1.2 // Set speed zone and tables
298     set_zone(track);
299    
300     // Seek to track
301 cebix 1.3 cw_track = ((track - 1) % format->tracks_per_side) * steps_per_track;
302 cebix 1.2 catweasel_seek(c.drives + drive, cw_track);
303     msdelay(20);
304 cebix 1.1 }
305    
306    
307     /* Start drive */
308     void start_drive(int drive)
309     {
310     catweasel_select(&c, drive == 0, drive == 1);
311     catweasel_set_motor(c.drives + drive, 1);
312     msdelay(500);
313     catweasel_seek(c.drives + drive, 0);
314     msdelay(20);
315     }
316    
317    
318     /* Stop drive */
319     void stop_drive(int drive)
320     {
321     catweasel_set_motor(c.drives + drive, 0);
322     catweasel_select(&c, 0, 0);
323     }