| /* |
| * This file is part of the ectool project. |
| * |
| * Copyright (C) 2008-2009 coresystems GmbH |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License as |
| * published by the Free Software Foundation; version 2 of the License. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| */ |
| |
| #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; |
| } |