void
lk201_set_keyclick(struct lk201_state *lks, int vol)
{
unsigned int newvol;
if (vol == 0)
send(lks, LK_CL_DISABLE);
else {
newvol = 8 - vol * 8 / 100;
if (newvol > 7)
newvol = 7;
send(lks, LK_CL_ENABLE);
send(lks, LK_PARAM_VOLUME(newvol));
}
lks->kcvol = vol;
}
void
lk201_bell(struct lk201_state *lks, struct wskbd_bell_data *bell)
{
unsigned int vol;
if (bell->which & WSKBD_BELL_DOVOLUME) {
vol = 8 - bell->volume * 8 / 100;
if (vol > 7)
vol = 7;
} else
vol = 3;
if (vol != lks->bellvol) {
send(lks, LK_BELL_ENABLE);
send(lks, LK_PARAM_VOLUME(vol));
lks->bellvol = vol;
}
send(lks, LK_RING_BELL);
}
static void lk201_kd_mksound(unsigned int hz, unsigned int ticks)
{
if (!ticks)
return;
/*
* Can't set frequency and we "approximate"
* duration by volume. ;-)
*/
ticks /= HZ / 32;
if (ticks > 7)
ticks = 7;
ticks = 7 - ticks;
if (lk201_hook.poll_tx_char(lk201_handle, LK_CMD_ENB_BELL))
return;
if (lk201_hook.poll_tx_char(lk201_handle, LK_PARAM_VOLUME(ticks)))
return;
if (lk201_hook.poll_tx_char(lk201_handle, LK_CMD_BELL))
return;
}
LK_CMD_MODE(LK_MODE_RPT_DOWN, 1),
LK_CMD_MODE(LK_MODE_RPT_DOWN, 2),
LK_CMD_MODE(LK_MODE_RPT_DOWN, 3),
LK_CMD_MODE(LK_MODE_RPT_DOWN, 4),
LK_CMD_MODE(LK_MODE_DOWN_UP, 5),
LK_CMD_MODE(LK_MODE_DOWN_UP, 6),
LK_CMD_MODE(LK_MODE_RPT_DOWN, 7),
LK_CMD_MODE(LK_MODE_RPT_DOWN, 8),
LK_CMD_MODE(LK_MODE_RPT_DOWN, 9),
LK_CMD_MODE(LK_MODE_RPT_DOWN, 10),
LK_CMD_MODE(LK_MODE_RPT_DOWN, 11),
LK_CMD_MODE(LK_MODE_RPT_DOWN, 12),
LK_CMD_MODE(LK_MODE_DOWN, 13),
LK_CMD_MODE(LK_MODE_RPT_DOWN, 14),
LK_CMD_DIS_KEYCLK,
LK_CMD_ENB_BELL, LK_PARAM_VOLUME(4),
};
static void *lk201_handle;
static int lk201_send(unsigned char ch)
{
if (lk201_hook.poll_tx_char(lk201_handle, ch)) {
printk(KERN_ERR "lk201: transmit timeout\n");
return -EIO;
}
return 0;
}
static inline int lk201_get_id(void)
{
int
lk201_init(struct lk201_state *lks)
{
int i;
lks->waitack = 0;
send(lks, LK_LED_ENABLE);
send(lks, LK_LED_ALL);
/*
* set all keys to updown mode; autorepeat is
* done by wskbd software
*/
for (i = 1; i <= 14; i++)
send(lks, LK_CMD_MODE(LK_UPDOWN, i));
send(lks, LK_CL_ENABLE);
send(lks, LK_PARAM_VOLUME(3));
lks->kcvol = (8 - 3) * 100 / 8;
lks->bellvol = -1; /* not yet set */
for (i = 0; i < LK_KLL; i++)
lks->down_keys_list[i] = -1;
send(lks, LK_KBD_ENABLE);
send(lks, LK_LED_DISABLE);
send(lks, LK_LED_ALL);
lks->leds_state = 0;
/*
* Swallow all the keyboard acknowledges from lk201_init().
* There should be 14 of them - one per LK_CMD_MODE command.
*/
for(;;) {
lks->waitack = 1;
for (i = 100; i != 0; i--) {
DELAY(1000);
if (lks->waitack == 0)
break;
}
if (i == 0)
break;
}
/*
* Try to set the keyboard in LK-401 mode.
* If we receive an error, this is an LK-201 keyboard.
*/
lks->waitack = 1;
send(lks, LK_ENABLE_401);
for (i = 100; i != 0; i--) {
DELAY(1000);
if (lks->waitack == 0)
break;
}
if (lks->waitack != 0)
lks->kbdtype = KBD_NONE;
else {
if (lks->ackdata == LK_INPUT_ERROR)
lks->kbdtype = KBD_LK201;
else
lks->kbdtype = KBD_LK401;
}
lks->waitack = 0;
printf("lkkbd0: %s\n", lkkbd_descr[lks->kbdtype]);
return 0;
}