188 lines
3.1 KiB
C
188 lines
3.1 KiB
C
/* SPDX-License-Identifier: GPL-2.0-only */
|
|
|
|
#include <stdio.h>
|
|
#include <stdint.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
#if !(defined __NetBSD__ || defined __OpenBSD__)
|
|
#include <sys/io.h>
|
|
#endif
|
|
#include "ec.h"
|
|
|
|
static int ec_data = 0x62;
|
|
static int ec_sc = 0x66;
|
|
|
|
#if defined __NetBSD__ || defined __OpenBSD__
|
|
#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) {
|
|
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) {
|
|
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) {
|
|
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)
|
|
{
|
|
send_ec_command(RD_EC);
|
|
send_ec_data(addr);
|
|
|
|
return recv_ec_data();
|
|
}
|
|
|
|
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);
|
|
|
|
return send_ec_data(data);
|
|
}
|
|
|
|
int ec_write(uint8_t addr, uint8_t data)
|
|
{
|
|
send_ec_command(WR_EC);
|
|
send_ec_data(addr);
|
|
|
|
return send_ec_data(data);
|
|
}
|
|
|
|
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);
|
|
|
|
return inb(lpc_idx + 3);
|
|
}
|
|
|
|
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)) {
|
|
fgets(line, sizeof(line), fp);
|
|
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;
|
|
}
|