Files

191 lines
3.2 KiB
C
Raw Permalink Normal View History

/* SPDX-License-Identifier: GPL-2.0-only */
#include <stdio.h>
2010-09-27 18:48:15 +00:00
#include <stdint.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
2017-01-29 14:52:56 -05:00
#if !(defined __NetBSD__ || defined __OpenBSD__)
#include <sys/io.h>
2016-01-05 14:27:59 +03:00
#endif
#include "ec.h"
static int ec_data = 0x62;
static int ec_sc = 0x66;
2017-01-29 14:52:56 -05:00
#if defined __NetBSD__ || defined __OpenBSD__
2016-01-05 14:27:59 +03:00
#include <machine/sysarch.h>
static uint8_t inb(unsigned port)
{
uint8_t data;
__asm volatile("inb %w1,%0" : "=a" (data) : "d" (port));
return data;
}
static __inline void outb(uint8_t data, unsigned port)
{
__asm volatile("outb %0,%w1" : : "a" (data), "d" (port));
}
#endif
extern int verbose;
#define debug(x...) if (verbose) printf(x)
int send_ec_command(uint8_t command)
{
int timeout;
timeout = 0x7ff;
while ((inb(ec_sc) & EC_IBF) && --timeout) {
usleep(10);
if ((timeout & 0xff) == 0)
debug(".");
}
if (!timeout) {
2010-06-29 21:13:20 +00:00
debug("Timeout while sending command 0x%02x to EC!\n",
command);
// return -1;
}
outb(command, ec_sc);
return 0;
}
int send_ec_data(uint8_t data)
{
int timeout;
timeout = 0x7ff;
while ((inb(ec_sc) & EC_IBF) && --timeout) { // wait for IBF = 0
usleep(10);
if ((timeout & 0xff) == 0)
debug(".");
}
if (!timeout) {
2010-06-29 21:13:20 +00:00
debug("Timeout while sending data 0x%02x to EC!\n", data);
// return -1;
}
outb(data, ec_data);
return 0;
}
int send_ec_data_nowait(uint8_t data)
{
outb(data, ec_data);
return 0;
}
uint8_t recv_ec_data(void)
{
int timeout;
uint8_t data;
timeout = 0x7fff;
while (--timeout) { // Wait for OBF = 1
if (inb(ec_sc) & EC_OBF)
break;
usleep(10);
if ((timeout & 0xff) == 0)
debug(".");
}
if (!timeout) {
2010-06-29 21:13:20 +00:00
debug("\nTimeout while receiving data from EC!\n");
// return -1;
}
data = inb(ec_data);
debug("recv_ec_data: 0x%02x\n", data);
return data;
}
uint8_t ec_read(uint8_t addr)
{
2010-06-29 21:13:20 +00:00
send_ec_command(RD_EC);
send_ec_data(addr);
return recv_ec_data();
}
2010-06-29 21:13:20 +00:00
uint8_t ec_ext_read(uint16_t addr)
{
send_ec_command(WR_EC);
send_ec_data(0x02);
send_ec_data(addr & 0xff);
send_ec_command(RX_EC);
send_ec_data(addr >> 8);
return recv_ec_data();
}
int ec_ext_write(uint16_t addr, uint8_t data)
{
send_ec_command(WR_EC);
send_ec_data(0x02);
send_ec_data(addr & 0xff);
send_ec_command(WX_EC);
send_ec_data(addr >> 8);
2011-10-31 12:56:45 -07:00
2010-06-29 21:13:20 +00:00
return send_ec_data(data);
}
int ec_write(uint8_t addr, uint8_t data)
{
2010-06-29 21:13:20 +00:00
send_ec_command(WR_EC);
send_ec_data(addr);
return send_ec_data(data);
}
2010-01-16 17:50:55 +00:00
uint8_t ec_idx_read(uint16_t addr)
{
uint16_t lpc_idx = 0x380;
outb(addr & 0xff, lpc_idx + 2);
outb(addr >> 8, lpc_idx + 1);
2010-01-16 17:50:55 +00:00
return inb(lpc_idx + 3);
}
2015-02-06 22:27:33 +01:00
uint8_t ec_query(void)
{
send_ec_command(QR_EC);
return recv_ec_data();
}
int get_ec_ports(void)
{
FILE *fp = fopen("/proc/ioports", "r");
int data = 0, cmd = 0;
char line[100];
if (fp == NULL)
return -1;
while (!feof(fp) && (data == 0 || cmd == 0)) {
2020-10-22 22:16:20 +00:00
if (fgets(line, sizeof(line), fp) == NULL) {
fprintf(stderr, "Can not read from /proc/ioports.\n");
break;
}
if (strstr(line, "EC data") != NULL)
data = strtol(line, NULL, 16);
if (strstr(line, "EC cmd") != NULL)
cmd = strtol(line, NULL, 16);
}
fclose(fp);
if (data != 0 && cmd != 0) {
debug("EC data = 0x%x, EC cmd = 0x%x\n", data, cmd);
ec_data = data;
ec_sc = cmd;
} else {
return -1;
}
return 0;
}