Previous 15994 Revisions Next

r5022 Monday 15th June, 2009 at 04:34:53 UTC by Barry Rodewald
[FM7] Re-worked floppy disk code to add support for odd sector layouts.
[src/mess/formats]fm7_dsk.c

src/mess/formats/fm7_dsk.c
r5021r5022
4545   return floppy_tag(floppy, "d77tag");
4646}
4747
48static int d77_get_sector_id(floppy_image *floppy, int head, int track, int sector_index)
49{
50   struct d77_tag* tag = get_d77_tag(floppy);
51   UINT32 offset;
52   UINT8 sector_hdr[16];
53   int x;
54   
55   offset = tag->trackoffset[(track*2)+head];
56
57   if(offset == 0)
58      return 0;
59
60   floppy_image_read(floppy,sector_hdr,offset,16);
61
62   // get to sector indexed
63   x=0;
64   while(x<sector_index)
65   {
66      offset += ((sector_hdr[15] << 8) | sector_hdr[14]);
67      offset += 16;
68      floppy_image_read(floppy,sector_hdr,offset,16);
69      x++;
70   }
71   
72   return sector_hdr[2];
73}
74
4875static int d77_get_tracks_per_disk(floppy_image *floppy)
4976{
5077   return 82;  // 82 tracks per side
r5021r5022
5582   return 2;  // 2 heads
5683}
5784
85static int d77_get_sectors_per_track(floppy_image *floppy, int head, int track)
86{
87   struct d77_tag* tag = get_d77_tag(floppy);
88   UINT32 offset;
89   UINT8 sector_hdr[16];
90   
91   offset = tag->trackoffset[(track*2)+head];
92
93   floppy_image_read(floppy,sector_hdr,offset,16);
94   
95   return sector_hdr[4];
96}
97   
5898static floperr_t d77_get_sector_length(floppy_image *floppy, int head, int track, int sector, UINT32 *sector_length)
5999{
60   *sector_length = 256;  // 256 byte sectors
61   return FLOPPY_ERROR_SUCCESS;
100   struct d77_tag* tag = get_d77_tag(floppy);
101   UINT32 offset;
102   UINT8 sector_hdr[16];
103   UINT32 len;
104   int count,secs;
105   
106   offset = tag->trackoffset[(track*2)+head];
107   
108   floppy_image_read(floppy,sector_hdr,offset,16);
109   secs = sector_hdr[4];
110   
111   for(count=0;count<secs;count++)
112   {
113      floppy_image_read(floppy,sector_hdr,offset,16);
114      if(sector == sector_hdr[2])
115      {
116         if(sector_length)
117            *sector_length = (sector_hdr[15] << 8) | sector_hdr[14];
118         return FLOPPY_ERROR_SUCCESS;
119      }
120      len = (sector_hdr[15] << 8) | sector_hdr[14];
121      len += 16;
122      offset += len;
123   }
124
125   return FLOPPY_ERROR_SEEKERROR;
62126}
63127
64128static floperr_t d77_read_track(floppy_image *floppy, int head, int track, UINT64 offset, void *buffer, size_t buflen)
r5021r5022
72136{
73137   struct d77_tag* tag = get_d77_tag(floppy);
74138   UINT32 offset = 0;
139   UINT8 sector_hdr[16];
140   UINT32 len;
141   UINT32 secs;
142   int count;
75143   
76144   // get offset of the beginning of the track
77145   offset = tag->trackoffset[(track*2)+head];
78   offset += (272 * sector);
146
147   floppy_image_read(floppy,sector_hdr,offset,16);
148   secs = sector_hdr[4];
79149   
80   if(offset > tag->image_size)
81      return 0;
82
83   logerror("d77_get_sector_offset - track %i, side %i, returns %08x\n",track,head,offset+16);
84   return offset + 16;   
150   for(count=0;count<secs;count++)
151   {
152      floppy_image_read(floppy,sector_hdr,offset,16);
153      if(sector == sector_hdr[2])
154      {
155         logerror("d77_get_sector_offset - track %i, side %i, sector %02x, returns %08x\n",track,head,sector,offset+16);
156         return offset + 16;
157      }
158      len = (sector_hdr[15] << 8) | sector_hdr[14];
159      len += 16;
160      offset += len;
161   }
162   logerror("d77_get_sector_offset - track %i, side %i, sector %02x, not found\n",track,head,sector);
163   return 0;
85164}
86165
87166static floperr_t d77_get_indexed_sector_info(floppy_image *floppy, int head, int track, int sector_index, int *cylinder, int *side, int *sector, UINT32 *sector_length)
r5021r5022
89168   struct d77_tag* tag = get_d77_tag(floppy);
90169   UINT32 offset;
91170   UINT8 sector_hdr[16];
171   int x;
92172   
93   offset = tag->trackoffset[(track*2)+head];
94   offset += (272 * sector_index);
173   offset = tag->trackoffset[(track*2)+head];
174
175   if(offset == 0)
176      return FLOPPY_ERROR_SEEKERROR;
95177   
96   if(offset > tag->image_size)
97      return FLOPPY_ERROR_SEEKERROR;
98     
178
99179   floppy_image_read(floppy,sector_hdr,offset,16);
100180
101181   if(sector_index >= sector_hdr[4])
102182      return FLOPPY_ERROR_SEEKERROR;
103183
184   // get to sector indexed
185   x=0;
186   while(x<sector_index)
187   {
188      offset += ((sector_hdr[15] << 8) | sector_hdr[14]);
189      offset += 16;
190      floppy_image_read(floppy,sector_hdr,offset,16);
191      x++;
192   }
193   
194   if(offset > tag->image_size || offset == 0)
195      return FLOPPY_ERROR_SEEKERROR;
196
104197   if(sector_length)
105      *sector_length = 256;
198      *sector_length = (sector_hdr[15] << 8) | sector_hdr[14];
106199   if(cylinder)
107200      *cylinder = sector_hdr[0];
108201   if(side)
r5021r5022
116209static floperr_t d77_read_sector(floppy_image *floppy, int head, int track, int sector, void *buffer, size_t buflen)
117210{
118211   UINT64 offset;
119   UINT8 sector_data[256];
212   UINT32 sector_length;
120213   
121214   offset = d77_get_sector_offset(floppy,head,track,sector);
215   
216   if(d77_get_sector_length(floppy,head,track,sector,&sector_length) != FLOPPY_ERROR_SUCCESS)
217      return FLOPPY_ERROR_SEEKERROR;
218     
122219   if(offset == 0)
123220      return FLOPPY_ERROR_SEEKERROR;
124221     
125   if(buflen > 256)
222   if(buflen > sector_length)
126223      return FLOPPY_ERROR_INTERNAL;
127     
128   floppy_image_read(floppy,sector_data,offset,256);
129224   
130   memcpy(buffer,sector_data,buflen);
225   floppy_image_read(floppy,buffer,offset,sector_length);
131226   
132227   return FLOPPY_ERROR_SUCCESS;
133228}
134229
135230static floperr_t d77_read_indexed_sector(floppy_image *floppy, int head, int track, int sector, void *buffer, size_t buffer_len)
136231{
137   return d77_read_sector(floppy,head,track,sector,buffer,buffer_len);
232   int sec;
233   
234   sec = d77_get_sector_id(floppy,head,track,sector);
235   return d77_read_sector(floppy,head,track,sec,buffer,buffer_len);
138236}
139237
140238static void d77_get_header(floppy_image* floppy,UINT32* size, UINT8* prot, UINT8* type, UINT32* offsets)
r5021r5022
227325   callbacks->read_sector = d77_read_sector;
228326   callbacks->read_indexed_sector = d77_read_indexed_sector;
229327   callbacks->get_indexed_sector_info = d77_get_indexed_sector_info;
328   callbacks->get_sectors_per_track = d77_get_sectors_per_track;
230329   
231330     
232331   return FLOPPY_ERROR_SUCCESS;

Previous 15994 Revisions Next


© 1998-2018 The MESS Team