Subversion Repositories pentevo

Rev

Rev 883 | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed | ?url?

  1. #include "std.h"
  2.  
  3. #include "emul.h"
  4. #include "vars.h"
  5. #include "wd93crc.h"
  6.  
  7. #include "util.h"
  8.  
  9. static inline unsigned CalcSecSizeMask()
  10. {
  11.     // ╠рёър ъюфр ЁрчьхЁр ёхъЄюЁр (3 - фы  fd1793, 0xF - фы  uPD765)
  12.     return (conf.mem_model == MM_PLUS3) ? 0xFU : 3U;
  13. }
  14.  
  15. void TRKCACHE::seek(FDD *d, unsigned cyl, unsigned side, SEEK_MODE fs)
  16. {
  17.    if ((d == drive) && (sf == fs) && (cyl == TRKCACHE::cyl) && (side == TRKCACHE::side))
  18.        return;
  19.  
  20.    drive = d; sf = fs; s = 0;
  21.    TRKCACHE::cyl = cyl; TRKCACHE::side = side;
  22.    if (cyl >= d->cyls || side >= d->sides || !d->rawdata)
  23.    {
  24.        trkd = 0;
  25.        return;
  26.    }
  27.  
  28.    assert(cyl < MAX_CYLS);
  29.    trkd = d->trkd[cyl][side];
  30.    trki = d->trki[cyl][side];
  31.    trkwp = d->trkwp[cyl][side];
  32.    trklen = d->trklen[cyl][side];
  33.    if (!trklen)
  34.    {
  35.        trkd = nullptr;
  36.        return;
  37.    }
  38.  
  39.    ts_byte = Z80FQ / (trklen * FDD_RPS);
  40.    if (fs == JUST_SEEK)
  41.        return; // else find sectors
  42.  
  43.    auto SecSizeMask{ CalcSecSizeMask() };
  44.  
  45.    for (unsigned i = 0; i < trklen - 8; i++)
  46.    {
  47.       if (trkd[i] != 0xA1 || trkd[i+1] != 0xFE || !test_i(i)) // ╧юшёъ idam
  48.           continue;
  49.  
  50.       if (s == MAX_SEC)
  51.           errexit("too many sectors");
  52.  
  53.       SECHDR *h = &hdr[s++]; // ╟ряюыэхэшх чруюыютър
  54.       h->id = trkd + i + 2; // ╙ърчрЄхы№ эр чруюыютюъ ёхъЄюЁр
  55.       h->c = h->id[0];
  56.       h->s = h->id[1];
  57.       h->n = h->id[2];
  58.       h->l = h->id[3];
  59.       h->crc = *(unsigned short*)(trkd+i+6);
  60.       h->c1 = (wd93_crc(trkd+i+1, 5) == h->crc);
  61.       h->data = nullptr;
  62.       h->datlen = 0;
  63.       h->wp_start = 0;
  64.       h->Flags = 0;
  65. //      if (h->l > 5) continue; [vv]
  66.  
  67.       unsigned end = min(trklen - 8, i + 8 + 43); // 43-DD, 30-SD
  68.  
  69.       // ╘юЁьшЁютрэшх єърчрЄхы  эр чюэє фрээ√ї ёхъЄюЁр
  70.       for (unsigned j = i + 8; j < end; j++)
  71.       {
  72.          if (trkd[j] != 0xA1 || !test_i(j) || test_i(j+1))
  73.              continue;
  74.  
  75.          if (trkd[j+1] == 0xF8 || trkd[j+1] == 0xFB) // ═рщфхэ data am (0xFB), deleted data am (0xF8)
  76.          {
  77.             if(trkd[j + 1] == 0xF8) // ddam
  78.             {
  79.                 h->Flags |= SECHDR::FL_DDAM;
  80.             }
  81.             h->datlen = min(128U << (h->l & SecSizeMask), MAX_SEC_DATA_LEN); // [vv] FD1793 use only 2 lsb of sector size code
  82.             h->data = trkd + j + 2;
  83.             // ─ы  сюы№°шї ёхъЄюЁют 8192 срщЄр (эх тыхчр■∙шї эр фюЁюцъє)
  84.             // фю яЁютхЁъш crc фхыю эх фюїюфшЄ, ъюьрэфр яЁхЁ√трхЄё  яю тЄюЁюьє яЁюїюцфхэш■ шэфхъёр
  85.             if((h->l & SecSizeMask) < 6 && wd93_crc(h->data - 1, h->datlen + 1) != *(unsigned short*)(h->data + h->datlen))
  86.             {
  87.                 h->c2 = 0;
  88.             }
  89.             else
  90.             {
  91.                 h->c2 = 1;
  92.             }
  93.  
  94.             if(trkwp)
  95.             {
  96.                 for(unsigned b = 0; b < h->datlen; b++)
  97.                 {
  98.                     if(test_wp(j + 2 + b))
  99.                     {
  100.                         h->wp_start = j + 2; // ┼ёЄ№ їюЄ с√ юфшэ ёсющэ√щ срщЄ
  101.                         break;
  102.                     }
  103.                 }
  104.             }
  105.          }
  106.          break;
  107.       }
  108.    }
  109. }
  110.  
  111. void TRKCACHE::format()
  112. {
  113.    if(!trkd) // TЁ¤ъ схч фрээvї (ЇюЁьрЄшЁютрэшх эх эєцэю)
  114.    {
  115.        return;
  116.    }
  117.  
  118.    auto SecSizeMask{ CalcSecSizeMask() };
  119.  
  120.    memset(trkd, 0, trklen);
  121.    memset(trki, 0, unsigned(trklen + 7U) >> 3);
  122.    memset(trkwp, 0, unsigned(trklen + 7U) >> 3);
  123.  
  124.    unsigned char *dst = trkd;
  125.  
  126.    unsigned i;
  127.  
  128.    //6250-6144=106
  129.    //gap4a(80)+sync0(12)+iam(3)+1+s*(gap1(50)+sync1(12)+idam(3)+1+4+2+gap2(22)+sync2(12)+data_am(3)+1+2)
  130.    unsigned gap4a = 80;
  131.    unsigned sync0 = 12;
  132.    unsigned i_am = 3;
  133.    unsigned gap1 = 40;
  134.    unsigned sync1 = 12;
  135.    unsigned id_am = 3;
  136.    unsigned gap2 = 22;
  137.    unsigned sync2 = 12;
  138.    unsigned data_am = 3;
  139.  
  140.    unsigned data_sz = 0;
  141.    for (unsigned is = 0; is < s; is++)
  142.    {
  143.       SECHDR *sechdr = hdr + is;
  144.       data_sz += sechdr->datlen != 0 ? sechdr->datlen : min(128U << (sechdr->l & SecSizeMask), MAX_SEC_DATA_LEN); // n
  145.    }
  146.  
  147.    if((gap4a+sync0+i_am+1+data_sz+s*(gap1+sync1+id_am+1+4+2+gap2+sync2+data_am+1+2)) >= MAX_TRACK_LEN)
  148.    { // ╧Ёхт√°хэшх ёЄрэфрЁЄэющ фышэ√ фюЁюцъш, ёюъЁр∙рхь ярЁрьхЄЁ√ фю ьшэшьры№э√ї
  149.        gap4a = 1;
  150.        sync0 = 1;
  151.        i_am = 1;
  152.        gap1 = 1;
  153.        sync1 = 1;
  154.        id_am = 1;
  155.        gap2 = 1;
  156.        sync2 = 1;
  157.        data_am = 1;
  158.    }
  159.  
  160.    memset(dst, 0x4E, gap4a); dst += gap4a; // gap4a
  161.    memset(dst, 0, sync0); dst += sync0; //sync
  162.  
  163.    for (i = 0; i < i_am; i++) // iam
  164.        write(unsigned(dst++ - trkd), 0xC2, 1);
  165.    *dst++ = 0xFC;
  166.  
  167.    for (unsigned is = 0; is < s; is++)
  168.    {
  169.       memset(dst, 0x4E, gap1); dst += gap1; // gap1 // 50 [vv] // fixme: recalculate gap1 only for non standard formats
  170.       memset(dst, 0, sync1); dst += sync1; //sync
  171.       for (i = 0; i < id_am; i++) // idam
  172.           write(unsigned(dst++ - trkd), 0xA1, 1);
  173.       *dst++ = 0xFE;
  174.  
  175.       SECHDR *sechdr = hdr + is;
  176.       *dst++ = sechdr->c; // c
  177.       *dst++ = sechdr->s; // h
  178.       *dst++ = sechdr->n; // s
  179.       *dst++ = sechdr->l; // n
  180.  
  181.       unsigned crc = wd93_crc(dst-5, 5); // crc
  182.       if (sechdr->c1 == 1)
  183.           crc = sechdr->crc;
  184.       if (sechdr->c1 == 2)
  185.           crc ^= 0xFFFF;
  186.       *(unsigned*)dst = crc;
  187.       dst += 2;
  188.  
  189.       if (sechdr->data)
  190.       {
  191.          memset(dst, 0x4E, gap2); dst += gap2; // gap2
  192.          memset(dst, 0, sync2); dst += sync2; //sync
  193.          for (i = 0; i < data_am; i++) // data am
  194.              write(unsigned(dst++ - trkd), 0xA1, 1);
  195.          *dst++ = (sechdr->Flags & SECHDR::FL_DDAM) ? 0xF8 : 0xFB;
  196.  
  197. //         if (sechdr->l > 5) errexit("strange sector"); // [vv]
  198.          unsigned len = sechdr->datlen != 0 ? sechdr->datlen : min(128U << (sechdr->l & SecSizeMask), MAX_SEC_DATA_LEN); // data
  199.          if (sechdr->data != (unsigned char*)1)
  200.          {
  201.              memcpy(dst, sechdr->data, len);
  202.              if(sechdr->wp) // ╩юяшЁютрэшх сшЄютющ ърЁЄ√ ёсющэ√ї срщЄют
  203.              {
  204.                  unsigned wp_start = unsigned(dst - trkd);
  205.                  sechdr->wp_start = wp_start;
  206.                  for(unsigned b = 0; b < len; b++)
  207.                  {
  208.                      if(test_bit(sechdr->wp, b))
  209.                      {
  210.                          set_wp(wp_start + b);
  211.                      }
  212.                  }
  213.              }
  214.          }
  215.          else
  216.              memset(dst, 0, len);
  217.  
  218.          crc = wd93_crc(dst-1, len+1); // crc
  219.          if (sechdr->c2 == 1)
  220.              crc = sechdr->crcd;
  221.          if (sechdr->c2 == 2)
  222.              crc ^= 0xFFFF;
  223.          *(unsigned*)(dst+len) = crc;
  224.              dst += len+2;
  225.       }
  226.    }
  227.    if (dst > trklen + trkd)
  228.    {
  229.        printf("cyl=%u, h=%u, additional len=%u\n", cyl, side, unsigned(dst - (trklen + trkd)));
  230.        errexit("track too long");
  231.    }
  232.    while (dst < trkd + trklen)
  233.        *dst++ = 0x4E;
  234. }
  235.  
  236. #if 1
  237. void TRKCACHE::dump()
  238. {
  239.    printf("\n%u/%u:", cyl, side);
  240.    if (!trkd) { printf("<e>"); return; }
  241.    if (!sf) { printf("<n>"); return; }
  242.    for (unsigned i = 0; i < s; i++)
  243.       printf("%c%02X-%02X-%02X-%02X,%c%c%c", i?' ':'<', hdr[i].c,hdr[i].s,hdr[i].n,hdr[i].l, hdr[i].c1?'+':'-', hdr[i].c2?'+':'-', hdr[i].data?'d':'h');
  244.    printf(">");
  245. }
  246. #endif
  247.  
  248. unsigned TRKCACHE::write_sector(unsigned sec, unsigned l, unsigned char *data)
  249. {
  250.    const SECHDR *h = get_sector(sec, l);
  251.    if (!h || !h->data)
  252.        return 0;
  253.    unsigned sz = h->datlen;
  254.    if(h->data != data)
  255.       memcpy(h->data, data, sz);
  256.    *(unsigned short*)(h->data+sz) = (unsigned short)wd93_crc(h->data-1, sz+1);
  257.    return sz;
  258. }
  259.  
  260. const SECHDR *TRKCACHE::get_sector(unsigned sec, unsigned l) const
  261. {
  262.    unsigned i;
  263.    for (i = 0; i < s; i++)
  264.    {
  265.       if (hdr[i].n == sec)
  266.           break;
  267.    }
  268.    if (i == s)
  269.        return nullptr;
  270.  
  271. //   dump();
  272.  
  273.    auto SecSizeMask{ CalcSecSizeMask() };
  274.  
  275.    // hdr[i].c != cyl - эх ЁрсюЄр■Є batman the movie, op. thunderbold ш яюфюсэ√х
  276.    // тючьюцэю эрфю т√ёЄрты Є№ Їыру эх ёютярфхэш  ЎшышэфЁр, ышсю эюьхЁ ЎшышэфЁр тююс∙х эх тыш хЄ эр яюшёъ ёхъЄюЁр
  277.    // Є.х. тыш хЄ Єюы№ъю эюьхЁ ёхъЄюЁр ш ъюф хую ЁрчьхЁр
  278.    if ((hdr[i].l & SecSizeMask) != (l & SecSizeMask) /*|| hdr[i].c != cyl*/)
  279.        return nullptr;
  280.  
  281.    return &hdr[i];
  282. }
  283.  
  284.