Top secrets sources NedoPC pentevo

#include "std.h"

#include "emul.h"
#include "vars.h"
#include "wd93crc.h"

#include "util.h"

struct UDI
{
   char label[3];
   unsigned char cyls;
   unsigned char sides;
};

int FDD::read_udi()
{
   free();
   unsigned c,s;
   unsigned mem = 0;
   unsigned char *ptr = snbuf + 0x10;

   for (c = 0; c <= snbuf[9]; c++)
   {
      for (s = 0; s <= snbuf[10]; s++)
      {
         if (*ptr)
             return 0;
         unsigned sz = *(unsigned short*)(ptr+1);
         sz += sz/8 + ((sz & 7)? 1 : 0);
         mem += sz;
         ptr += 3 + sz;
         if (ptr > snbuf + snapsize)
             return 0;
      }
   }

   cyls = snbuf[9]+1;
   sides = snbuf[10]+1;

   if(cyls > MAX_CYLS)
   {
       err_printf("cylinders (%u) > MAX_CYLS(%d)", cyls, MAX_CYLS);
       return 0;
   }

   if(sides > 2)
   {
       err_printf("sides (%u) > 2", sides);
       return 0;
   }

   const unsigned bitmap_len = (unsigned(MAX_TRACK_LEN + 7U)) >> 3;

   mem += (MAX_CYLS - cyls) * sides * (MAX_TRACK_LEN + bitmap_len); // Äîáàâêà äëÿ âîçìîæíîñòè ôîðìàòèðîâàíèÿ íà MAX_CYLS äîðîæåê

   rawsize = align_by(mem, 4096U);
   rawdata = (unsigned char*)VirtualAlloc(nullptr, rawsize, MEM_COMMIT, PAGE_READWRITE);
   ptr = snbuf+0x10;
   unsigned char *dst = rawdata;

   for (c = 0; c < cyls; c++)
   {
      for (s = 0; s < sides; s++)
      {
         unsigned sz = *(unsigned short*)(ptr+1);
         trklen[c][s] = sz;
         trkd[c][s] = dst;
         trki[c][s] = dst + sz;
         sz += sz/8 + ((sz & 7)? 1 : 0);
         memcpy(dst, ptr+3, sz);
         ptr += 3 + sz;
         dst += sz;
      }
   }

   for(; c < MAX_CYLS; c++)
   {
       for(s = 0; s < sides; s++)
       {
           trklen[c][s] = MAX_TRACK_LEN;
           trkd[c][s] = dst;
           dst += MAX_TRACK_LEN;

           trki[c][s] = dst;
           dst += bitmap_len;
       }
   }

   u32 crc1 = *((u32*)ptr);
   int crc2 = -1;
   udi_buggy_crc(crc2, snbuf, unsigned(ptr - snbuf));
   if(crc1 != u32(crc2))
   {
       err_printf("udi crc mismatch: image=0x%08X, calc=0x%08X", crc1, crc2);
   }
   if (snbuf[11] & 1)
       strcpy(dsc, (char*)ptr);
   return 1;
}

int FDD::write_udi(FILE *ff)
{
   memset(snbuf, 0, 0x10);
   *(unsigned*)snbuf = WORD4('U','D','I','!');
   snbuf[8] = snbuf[11] = 0;
   snbuf[9] = u8(cyls-1);
   snbuf[10] = u8(sides-1);
   *(unsigned*)(snbuf+12) = 0;

   unsigned char *dst = snbuf+0x10;
   for (unsigned c = 0; c < cyls; c++)
      for (unsigned s = 0; s < sides; s++)
      {
         *dst++ = 0;
         unsigned len = trklen[c][s];
         *(unsigned short*)dst = u16(len); dst += 2;
         memcpy(dst, trkd[c][s], len); dst += len;
         len = (len+7)/8;
         memcpy(dst, trki[c][s], len); dst += len;
      }
   if(*dsc)
   {
       strcpy((char*)dst, dsc);
       dst += strlen(dsc) + 1;
       snbuf[11] = 1;
   }
   *(unsigned*)(snbuf+4) = u32(dst-snbuf);
   int crc = -1; udi_buggy_crc(crc, snbuf, unsigned(dst-snbuf));
   *(unsigned*)dst = u32(crc); dst += 4;
   if (fwrite(snbuf, 1, size_t(dst-snbuf), ff) != size_t(dst-snbuf)) return 0;
   return 1;
}