#include <sys/param.h>
#include <hp300/dev/fhpibreg.h>
#include <hp300/stand/common/hpibvar.h>
#include <hp300/stand/common/samachdep.h>
static int fhpibwait(struct fhpibdevice *, uint8_t);
int
fhpibinit(int unit)
{
struct hpib_softc *hs = &hpib_softc[unit];
struct fhpibdevice *hd = (void *)hs->sc_addr;
if (hd->hpib_cid != HPIBC)
return 0;
hs->sc_type = HPIBC;
hs->sc_ba = HPIBC_BA;
fhpibreset(unit);
return 1;
}
void
fhpibreset(int unit)
{
struct hpib_softc *hs = &hpib_softc[unit];
struct fhpibdevice *hd;
hd = (void *)hs->sc_addr;
hd->hpib_cid = 0xFF;
DELAY(100);
hd->hpib_cmd = CT_8BIT;
hd->hpib_ar = AR_ARONC;
hd->hpib_cmd |= CT_IFC;
hd->hpib_cmd |= CT_INITFIFO;
DELAY(100);
hd->hpib_cmd &= ~CT_IFC;
hd->hpib_cmd |= CT_REN;
hd->hpib_stat = ST_ATN;
hd->hpib_data = C_DCL;
DELAY(100000);
}
int
fhpibsend(int unit, int slave, int sec, uint8_t *buf, int cnt)
{
struct hpib_softc *hs = &hpib_softc[unit];
struct fhpibdevice *hd;
int origcnt = cnt;
hd = (void *)hs->sc_addr;
hd->hpib_stat = 0;
hd->hpib_imask = IM_IDLE | IM_ROOM;
fhpibwait(hd, IM_IDLE);
hd->hpib_stat = ST_ATN;
hd->hpib_data = C_UNL;
hd->hpib_data = C_TAG + hs->sc_ba;
hd->hpib_data = C_LAG + slave;
if (sec != -1)
hd->hpib_data = C_SCG + sec;
fhpibwait(hd, IM_IDLE);
hd->hpib_stat = ST_WRITE;
if (cnt) {
while (--cnt) {
hd->hpib_data = *buf++;
if (fhpibwait(hd, IM_ROOM) < 0)
break;
}
hd->hpib_stat = ST_EOI;
hd->hpib_data = *buf;
if (fhpibwait(hd, IM_ROOM) < 0)
cnt++;
hd->hpib_stat = ST_ATN;
if (sec == 0x12)
DELAY(150);
hd->hpib_data = C_UNL;
fhpibwait(hd, IM_IDLE);
}
hd->hpib_imask = 0;
return origcnt - cnt;
}
int
fhpibrecv(int unit, int slave, int sec, uint8_t *buf, int cnt)
{
struct hpib_softc *hs = &hpib_softc[unit];
struct fhpibdevice *hd;
int origcnt = cnt;
hd = (void *)hs->sc_addr;
hd->hpib_stat = 0;
hd->hpib_imask = IM_IDLE | IM_ROOM | IM_BYTE;
fhpibwait(hd, IM_IDLE);
hd->hpib_stat = ST_ATN;
hd->hpib_data = C_UNL;
hd->hpib_data = C_LAG + hs->sc_ba;
hd->hpib_data = C_TAG + slave;
if (sec != -1)
hd->hpib_data = C_SCG + sec;
fhpibwait(hd, IM_IDLE);
hd->hpib_stat = ST_READ0;
hd->hpib_data = 0;
if (cnt) {
while (--cnt >= 0) {
if (fhpibwait(hd, IM_BYTE) < 0)
break;
*buf++ = hd->hpib_data;
}
cnt++;
fhpibwait(hd, IM_ROOM);
hd->hpib_stat = ST_ATN;
hd->hpib_data = (slave == 31) ? C_UNA : C_UNT;
fhpibwait(hd, IM_IDLE);
}
hd->hpib_imask = 0;
return origcnt - cnt;
}
int
fhpibppoll(int unit)
{
struct hpib_softc *hs = &hpib_softc[unit];
struct fhpibdevice *hd;
int ppoll;
hd = (void *)hs->sc_addr;
hd->hpib_stat = 0;
hd->hpib_psense = 0;
hd->hpib_pmask = 0xFF;
hd->hpib_imask = IM_PPRESP | IM_PABORT;
DELAY(25);
hd->hpib_intr = IM_PABORT;
ppoll = hd->hpib_data;
if (hd->hpib_intr & IM_PABORT)
ppoll = 0;
hd->hpib_imask = 0;
hd->hpib_pmask = 0;
hd->hpib_stat = ST_IENAB;
return ppoll;
}
static int
fhpibwait(struct fhpibdevice *hd, uint8_t x)
{
int timo = 100000;
while ((hd->hpib_intr & x) == 0 && --timo)
;
if (timo == 0)
return -1;
return 0;
}