452 lines
15 KiB
C
452 lines
15 KiB
C
/*
|
||
* besm6_punch.c: BESM-6 punchcard/punchtape devices
|
||
*
|
||
* Copyright (c) 2009, Leonid Broukhis
|
||
*
|
||
* Permission is hereby granted, free of charge, to any person obtaining a
|
||
* copy of this software and associated documentation files (the "Software"),
|
||
* to deal in the Software without restriction, including without limitation
|
||
* the rights to use, copy, modify, merge, publish, distribute, sublicense,
|
||
* and/or sell copies of the Software, and to permit persons to whom the
|
||
* Software is furnished to do so, subject to the following conditions:
|
||
|
||
* The above copyright notice and this permission notice shall be included in
|
||
* all copies or substantial portions of the Software.
|
||
|
||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
||
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
||
* SERGE VAKULENKO OR LEONID BROUKHIS BE LIABLE FOR ANY CLAIM, DAMAGES
|
||
* OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
|
||
* ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE
|
||
* OR OTHER DEALINGS IN THE SOFTWARE.
|
||
|
||
* Except as contained in this notice, the name of Leonid Broukhis or
|
||
* Serge Vakulenko shall not be used in advertising or otherwise to promote
|
||
* the sale, use or other dealings in this Software without prior written
|
||
* authorization from Leonid Broukhis and Serge Vakulenko.
|
||
*/
|
||
#include "besm6_defs.h"
|
||
|
||
t_stat fs_event (UNIT *u);
|
||
t_stat uvvk_event (UNIT *u);
|
||
|
||
UNIT fs_unit [] = {
|
||
{ UDATA (fs_event, UNIT_SEQ+UNIT_ATTABLE, 0) },
|
||
{ UDATA (fs_event, UNIT_SEQ+UNIT_ATTABLE, 0) },
|
||
};
|
||
|
||
int curchar[2], feed[2], isfifo[2];
|
||
char line[2][128];
|
||
|
||
#define FS1_READY (1<<15)
|
||
#define FS2_READY (1<<14)
|
||
|
||
/* #define NEGATIVE_RDY */
|
||
|
||
#ifndef NEGATIVE_RDY
|
||
#define ENB_RDY SET_RDY
|
||
#define DIS_RDY CLR_RDY
|
||
#define IS_RDY ISSET_RDY
|
||
#else
|
||
#define ENB_RDY CLR_RDY
|
||
#define DIS_RDY SET_RDY
|
||
#define IS_RDY ISCLR_RDY
|
||
#endif
|
||
|
||
#define SET_RDY(x) do READY |= x; while (0)
|
||
#define CLR_RDY(x) do READY &= ~(x); while (0)
|
||
#define ISSET_RDY(x) ((READY & (x)) != 0)
|
||
#define ISCLR_RDY(x) ((READY & (x)) == 0)
|
||
|
||
#define FS_RATE 1000*MSEC/1500
|
||
|
||
unsigned char FS[2];
|
||
|
||
REG fs_reg[] = {
|
||
{ "Готов", &READY, 2, 2, 14, 1 },
|
||
{ "ФС1500-1", &FS[0], 8, 8, 0, 1 },
|
||
{ "ФС1500-2", &FS[2], 8, 8, 0, 1 },
|
||
{ 0 }
|
||
};
|
||
|
||
MTAB fs_mod[] = {
|
||
{ 0 }
|
||
};
|
||
|
||
t_stat fs_reset (DEVICE *dptr);
|
||
t_stat fs_attach (UNIT *uptr, char *cptr);
|
||
t_stat fs_detach (UNIT *uptr);
|
||
|
||
DEVICE fs_dev = {
|
||
"FS", fs_unit, fs_reg, fs_mod,
|
||
2, 8, 19, 1, 8, 50,
|
||
NULL, NULL, &fs_reset, NULL, &fs_attach, &fs_detach,
|
||
NULL, DEV_DISABLE | DEV_DEBUG
|
||
};
|
||
|
||
#define CARD_LEN 120
|
||
enum {
|
||
FS_IDLE,
|
||
FS_STARTING,
|
||
FS_RUNNING,
|
||
FS_IMAGE,
|
||
FS_IMAGE_LAST = FS_IMAGE + CARD_LEN - 1,
|
||
FS_TOOLONG,
|
||
FS_FILLUP,
|
||
FS_FILLUP_LAST = FS_FILLUP + CARD_LEN - 1,
|
||
FS_ENDA3,
|
||
FS_ENDA3_LAST = FS_ENDA3 + CARD_LEN - 1,
|
||
FS_TAIL,
|
||
} fs_state[2];
|
||
|
||
/*
|
||
* Reset routine
|
||
*/
|
||
t_stat fs_reset (DEVICE *dptr)
|
||
{
|
||
sim_cancel (&fs_unit[0]);
|
||
sim_cancel (&fs_unit[1]);
|
||
fs_state[0] = fs_state[1] = FS_IDLE;
|
||
DIS_RDY(FS1_READY | FS2_READY);
|
||
if (fs_unit[0].flags & UNIT_ATT)
|
||
ENB_RDY(FS1_READY);
|
||
if (fs_unit[1].flags & UNIT_ATT)
|
||
ENB_RDY(FS2_READY);
|
||
return SCPE_OK;
|
||
}
|
||
|
||
t_stat fs_attach (UNIT *u, char *cptr)
|
||
{
|
||
t_stat s;
|
||
int num = u - fs_unit;
|
||
s = attach_unit (u, cptr);
|
||
if (s != SCPE_OK)
|
||
return s;
|
||
isfifo[num] = (0 == sim_set_fifo_nonblock (u->fileref));
|
||
ENB_RDY(FS1_READY >> num);
|
||
return SCPE_OK;
|
||
}
|
||
|
||
t_stat fs_detach (UNIT *u)
|
||
{
|
||
int num = u - fs_unit;
|
||
DIS_RDY(FS1_READY >> num);
|
||
return detach_unit (u);
|
||
}
|
||
|
||
/*
|
||
* Управление двигателем, лампой, протяжкой
|
||
*/
|
||
void fs_control (int num, uint32 cmd)
|
||
{
|
||
UNIT *u = &fs_unit[num];
|
||
|
||
static int bytecnt = 0;
|
||
if (fs_dev.dctrl)
|
||
besm6_debug("<<< ФС1500-%d команда %o", num, cmd);
|
||
if (! IS_RDY(FS1_READY >> num)) {
|
||
if (fs_dev.dctrl)
|
||
besm6_debug("<<< ФС1500-%d не готово", num, cmd);
|
||
return;
|
||
}
|
||
switch (cmd) {
|
||
case 0: /* полное выключение */
|
||
sim_cancel (u);
|
||
fs_state[num] = FS_IDLE;
|
||
if (fs_dev.dctrl)
|
||
besm6_debug("<<<ФС1500-%d ВЫКЛ..", num);
|
||
bytecnt = 0;
|
||
break;
|
||
case 4: /* двигатель без протяжки */
|
||
fs_state[num] = FS_STARTING;
|
||
if (fs_dev.dctrl)
|
||
besm6_debug("<<<ФС1500-%d ВКЛ.", num);
|
||
sim_cancel (u);
|
||
break;
|
||
case 5: /* протяжка */
|
||
if (fs_state[num] == FS_IDLE)
|
||
besm6_debug("<<< ФС1500-%d протяжка без мотора", num);
|
||
else if (fs_state[num] != FS_TAIL) {
|
||
sim_activate (u, FS_RATE);
|
||
bytecnt++;
|
||
} else {
|
||
if (! isfifo[num]) {
|
||
fs_detach(u);
|
||
fs_state[num] = FS_IDLE;
|
||
}
|
||
}
|
||
break;
|
||
default:
|
||
besm6_debug ("<<< ФС1500-%d неизвестная команда %o", num, cmd);
|
||
}
|
||
if (cmd && fs_dev.dctrl) {
|
||
besm6_debug("<<<ФС1500-%d: %d симв.", num, bytecnt);
|
||
}
|
||
}
|
||
|
||
unsigned char unicode_to_gost (unsigned short val);
|
||
static int utf8_getc (FILE *fin);
|
||
|
||
/*
|
||
* Событие: читаем очередной символ с перфоленты в регистр.
|
||
* Устанавливаем флаг прерывания.
|
||
*/
|
||
t_stat fs_event (UNIT *u)
|
||
{
|
||
int num = u - fs_unit;
|
||
again:
|
||
if (fs_state[num] == FS_STARTING) {
|
||
/* По первому прерыванию после запуска двигателя ничего не читаем */
|
||
FS[num] = 0;
|
||
fs_state[num] = FS_RUNNING;
|
||
} else if (fs_state[num] == FS_RUNNING) {
|
||
int ch;
|
||
/* переводы строк игнорируются */
|
||
while ((ch = utf8_getc (u->fileref)) == '\n');
|
||
if (ch < 0) {
|
||
/* хвост ленты без пробивок */
|
||
FS[num] = 0;
|
||
fs_state[num] = FS_TAIL;
|
||
} else if (ch == '\f') {
|
||
fs_state[num] = FS_IMAGE;
|
||
goto again;
|
||
} else {
|
||
ch = FS[num] = unicode_to_gost (ch);
|
||
ch = (ch & 0x55) + ((ch >> 1) & 0x55);
|
||
ch = (ch & 0x33) + ((ch >> 2) & 0x33);
|
||
ch = (ch & 0x0F) + ((ch >> 4) & 0x0F);
|
||
if (ch & 1); else FS[num] |= 0x80;
|
||
}
|
||
} else if (FS_IMAGE <= fs_state[num] && fs_state[num] <= FS_IMAGE_LAST) {
|
||
int ch = utf8_getc (u->fileref);
|
||
if (ch < 0) {
|
||
/* обрыв ленты */
|
||
FS[num] = 0;
|
||
fs_state[num] = FS_TAIL;
|
||
} else if (ch == '\n') {
|
||
/* идем дополнять образ карты нулевыми байтами */
|
||
fs_state[num] = FS_FILLUP + (fs_state[num] - FS_IMAGE);
|
||
goto again;
|
||
} else if (ch == '\f') {
|
||
if (fs_state[num] != FS_IMAGE)
|
||
besm6_debug("<<< ENDA3 requested mid-card?");
|
||
fs_state[num] = FS_ENDA3;
|
||
goto again;
|
||
} else {
|
||
ch = FS[num] = unicode_to_gost (ch);
|
||
ch = (ch & 0x55) + ((ch >> 1) & 0x55);
|
||
ch = (ch & 0x33) + ((ch >> 2) & 0x33);
|
||
ch = (ch & 0x0F) + ((ch >> 4) & 0x0F);
|
||
if (ch & 1); else FS[num] |= 0x80;
|
||
++fs_state[num];
|
||
}
|
||
} else if (fs_state[num] == FS_TOOLONG) {
|
||
/* дочитываем до конца строки */
|
||
int ch;
|
||
besm6_debug("<<< too long???");
|
||
while ((ch = utf8_getc (u->fileref)) != '\n' && ch >= 0);
|
||
if (ch < 0) {
|
||
/* хвост ленты без пробивок */
|
||
FS[num] = 0;
|
||
fs_state[num] = FS_TAIL;
|
||
} else
|
||
goto again;
|
||
} else if (FS_FILLUP <= fs_state[num] && fs_state[num] <= FS_FILLUP_LAST) {
|
||
FS[num] = 0;
|
||
if (++fs_state[num] == FS_ENDA3) {
|
||
fs_state[num] = FS_IMAGE;
|
||
}
|
||
} else if (FS_ENDA3 <= fs_state[num] && fs_state[num] <= FS_ENDA3_LAST) {
|
||
if ((fs_state[num] - FS_ENDA3) % 5 == 0)
|
||
FS[num] = 0200;
|
||
else
|
||
FS[num] = 0;
|
||
if (++fs_state[num] == FS_TAIL) {
|
||
fs_state[num] = FS_RUNNING;
|
||
}
|
||
} else if (fs_state[num] == FS_IDLE || fs_state[num] == FS_TAIL) {
|
||
FS[num] = 0;
|
||
}
|
||
GRP |= GRP_FS1_SYNC >> num;
|
||
return SCPE_OK;
|
||
}
|
||
|
||
int fs_read(int num) {
|
||
if (fs_dev.dctrl)
|
||
besm6_debug("<<< ФС1500-%d: байт %03o", num, FS[num]);
|
||
|
||
return FS[num];
|
||
}
|
||
|
||
int fs_is_idle (void)
|
||
{
|
||
return fs_state[0] == FS_IDLE && fs_state[1] == FS_IDLE;
|
||
}
|
||
|
||
unsigned char
|
||
unicode_to_gost (unsigned short val)
|
||
{
|
||
static const unsigned char tab0 [256] = {
|
||
/* 00 - 07 */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* 08 - 0f */ 017, 017, 0214, 017, 017, 0174, 017, 017,
|
||
/* 10 - 17 */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* 18 - 1f */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* !"#$%&' */ 0017, 0133, 0134, 0034, 0127, 0126, 0121, 0033,
|
||
/* ()*+,-./ */ 0022, 0023, 0031, 0012, 0015, 0013, 0016, 0014,
|
||
/* 01234567 */ 0000, 0001, 0002, 0003, 0004, 0005, 0006, 0007,
|
||
/* 89:;<=>? */ 0010, 0011, 0037, 0026, 0035, 0025, 0036, 0136,
|
||
/* @ABCDEFG */ 0021, 0040, 0042, 0061, 0077, 0045, 0100, 0101,
|
||
/* HIJKLMNO */ 0055, 0102, 0103, 0052, 0104, 0054, 0105, 0056,
|
||
/* PQRSTUVW */ 0060, 0106, 0107, 0110, 0062, 0111, 0112, 0113,
|
||
/* XYZ[\]^_ */ 0065, 0063, 0114, 0027, 017, 0030, 0115, 0132,
|
||
/* `abcdefg */ 0032, 0040, 0042, 0061, 0077, 0045, 0100, 0101,
|
||
/* hijklmno */ 0055, 0102, 0103, 0052, 0104, 0054, 0105, 0056,
|
||
/* pqrstuvw */ 0060, 0106, 0107, 0110, 0062, 0111, 0112, 0113,
|
||
/* xyz{|}~ */ 0065, 0063, 0114, 017, 0130, 017, 0123, 017,
|
||
/* 80 - 87 */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* 88 - 8f */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* 90 - 97 */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* 98 - 9f */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* a0 - a7 */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* a8 - af */ 017, 017, 017, 017, 0123, 017, 017, 017,
|
||
/* b0 - b7 */ 0136, 017, 017, 017, 017, 017, 017, 017,
|
||
/* b8 - bf */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* c0 - c7 */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* c8 - cf */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* d0 - d7 */ 017, 017, 017, 017, 017, 017, 017, 0024,
|
||
/* d8 - df */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* e0 - e7 */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* e8 - ef */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
/* f0 - f7 */ 017, 017, 017, 017, 017, 017, 017, 0124,
|
||
/* f8 - ff */ 017, 017, 017, 017, 017, 017, 017, 017,
|
||
};
|
||
switch (val >> 8) {
|
||
case 0x00:
|
||
return tab0 [val];
|
||
case 0x04:
|
||
switch ((unsigned char) val) {
|
||
case 0x10: return 0040;
|
||
case 0x11: return 0041;
|
||
case 0x12: return 0042;
|
||
case 0x13: return 0043;
|
||
case 0x14: return 0044;
|
||
case 0x15: return 0045;
|
||
case 0x16: return 0046;
|
||
case 0x17: return 0047;
|
||
case 0x18: return 0050;
|
||
case 0x19: return 0051;
|
||
case 0x1a: return 0052;
|
||
case 0x1b: return 0053;
|
||
case 0x1c: return 0054;
|
||
case 0x1d: return 0055;
|
||
case 0x1e: return 0056;
|
||
case 0x1f: return 0057;
|
||
case 0x20: return 0060;
|
||
case 0x21: return 0061;
|
||
case 0x22: return 0062;
|
||
case 0x23: return 0063;
|
||
case 0x24: return 0064;
|
||
case 0x25: return 0065;
|
||
case 0x26: return 0066;
|
||
case 0x27: return 0067;
|
||
case 0x28: return 0070;
|
||
case 0x29: return 0071;
|
||
case 0x2a: return 0135;
|
||
case 0x2b: return 0072;
|
||
case 0x2c: return 0073;
|
||
case 0x2d: return 0074;
|
||
case 0x2e: return 0075;
|
||
case 0x2f: return 0076;
|
||
case 0x30: return 0040;
|
||
case 0x31: return 0041;
|
||
case 0x32: return 0042;
|
||
case 0x33: return 0043;
|
||
case 0x34: return 0044;
|
||
case 0x35: return 0045;
|
||
case 0x36: return 0046;
|
||
case 0x37: return 0047;
|
||
case 0x38: return 0050;
|
||
case 0x39: return 0051;
|
||
case 0x3a: return 0052;
|
||
case 0x3b: return 0053;
|
||
case 0x3c: return 0054;
|
||
case 0x3d: return 0055;
|
||
case 0x3e: return 0056;
|
||
case 0x3f: return 0057;
|
||
case 0x40: return 0060;
|
||
case 0x41: return 0061;
|
||
case 0x42: return 0062;
|
||
case 0x43: return 0063;
|
||
case 0x44: return 0064;
|
||
case 0x45: return 0065;
|
||
case 0x46: return 0066;
|
||
case 0x47: return 0067;
|
||
case 0x48: return 0070;
|
||
case 0x49: return 0071;
|
||
case 0x4a: return 0135;
|
||
case 0x4b: return 0072;
|
||
case 0x4c: return 0073;
|
||
case 0x4d: return 0074;
|
||
case 0x4e: return 0075;
|
||
case 0x4f: return 0076;
|
||
}
|
||
break;
|
||
case 0x20:
|
||
switch ((unsigned char) val) {
|
||
case 0x15: return 0131;
|
||
case 0x18: return 0032;
|
||
case 0x19: return 0033;
|
||
case 0x32: return 0137;
|
||
case 0x3e: return 0115;
|
||
}
|
||
break;
|
||
case 0x21:
|
||
switch ((unsigned char) val) {
|
||
case 0x2f: return 0020;
|
||
case 0x91: return 0021;
|
||
}
|
||
break;
|
||
case 0x22:
|
||
switch ((unsigned char) val) {
|
||
case 0x27: return 0121;
|
||
case 0x28: return 0120;
|
||
case 0x60: return 0034;
|
||
case 0x61: return 0125;
|
||
case 0x64: return 0116;
|
||
case 0x65: return 0117;
|
||
case 0x83: return 0122;
|
||
}
|
||
break;
|
||
case 0x25:
|
||
switch ((unsigned char) val) {
|
||
case 0xc7: return 0127;
|
||
case 0xca: return 0127;
|
||
}
|
||
break;
|
||
}
|
||
return 017;
|
||
}
|
||
|
||
/*
|
||
* Read Unicode symbol from file.
|
||
* Convert from UTF-8 encoding.
|
||
*/
|
||
static int
|
||
utf8_getc (FILE *fin)
|
||
{
|
||
int c1, c2, c3;
|
||
again:
|
||
c1 = getc (fin);
|
||
if (c1 < 0 || ! (c1 & 0x80))
|
||
return c1;
|
||
c2 = getc (fin);
|
||
if (! (c1 & 0x20))
|
||
return (c1 & 0x1f) << 6 | (c2 & 0x3f);
|
||
c3 = getc (fin);
|
||
if (c1 == 0xEF && c2 == 0xBB && c3 == 0xBF) {
|
||
/* Skip zero width no-break space. */
|
||
goto again;
|
||
}
|
||
return (c1 & 0x0f) << 12 | (c2 & 0x3f) << 6 | (c3 & 0x3f);
|
||
}
|