util/intelmetool: Fix lint errors and warnings
Clean the code to fix all errors and warnings. No functional change. Changes: * Fix lines over 80chars * Fix typos * Restructure code to reduce indent level * Move RCBA handling into own files * Introduce helper functions for RCBA access * Move GPL string into header * Fix whitespace in macros Change-Id: Ib8e3617ebb34c47959d6619dfbc7189045e6b8f7 Signed-off-by: Patrick Rudolph <siro@das-labor.org> Reviewed-on: https://review.coreboot.org/22521 Tested-by: build bot (Jenkins) <no-reply@coreboot.org> Reviewed-by: Philipp Deppenwiese <zaolin.daisuki@gmail.com>
This commit is contained in:
		@@ -20,7 +20,7 @@ PREFIX  ?= /usr/local
 | 
				
			|||||||
CFLAGS  ?= -O0 -g -Wall -W -Wno-unused-parameter -Wno-sign-compare -Wno-unused-function
 | 
					CFLAGS  ?= -O0 -g -Wall -W -Wno-unused-parameter -Wno-sign-compare -Wno-unused-function
 | 
				
			||||||
LDFLAGS += -lpci -lz
 | 
					LDFLAGS += -lpci -lz
 | 
				
			||||||
 | 
					
 | 
				
			||||||
OBJS = intelmetool.o me.o me_status.o mmap.o
 | 
					OBJS = intelmetool.o me.o me_status.o mmap.o rcba.o
 | 
				
			||||||
 | 
					
 | 
				
			||||||
OS_ARCH	= $(shell uname)
 | 
					OS_ARCH	= $(shell uname)
 | 
				
			||||||
ifeq ($(OS_ARCH), Darwin)
 | 
					ifeq ($(OS_ARCH), Darwin)
 | 
				
			||||||
 
 | 
				
			|||||||
@@ -24,6 +24,7 @@
 | 
				
			|||||||
#include "me.h"
 | 
					#include "me.h"
 | 
				
			||||||
#include "mmap.h"
 | 
					#include "mmap.h"
 | 
				
			||||||
#include "intelmetool.h"
 | 
					#include "intelmetool.h"
 | 
				
			||||||
 | 
					#include "rcba.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#define FD2 0x3428
 | 
					#define FD2 0x3428
 | 
				
			||||||
#define ME_COMMAND_DELAY 10000
 | 
					#define ME_COMMAND_DELAY 10000
 | 
				
			||||||
@@ -32,8 +33,6 @@ extern int fd_mem;
 | 
				
			|||||||
int debug = 0;
 | 
					int debug = 0;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static uint32_t fd2 = 0;
 | 
					static uint32_t fd2 = 0;
 | 
				
			||||||
static const int size = 0x4000;
 | 
					 | 
				
			||||||
static volatile uint8_t *rcba;
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
static void dumpmem(uint8_t *phys, uint32_t size)
 | 
					static void dumpmem(uint8_t *phys, uint32_t size)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
@@ -63,16 +62,6 @@ static void dumpmemfile(uint8_t *phys, uint32_t size)
 | 
				
			|||||||
	fclose(fp);
 | 
						fclose(fp);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static void rehide_me(void)
 | 
					 | 
				
			||||||
{
 | 
					 | 
				
			||||||
	if (fd2 & 0x2) {
 | 
					 | 
				
			||||||
		printf("Re-hiding MEI device...");
 | 
					 | 
				
			||||||
		fd2 = *(uint32_t *)(rcba + FD2);
 | 
					 | 
				
			||||||
		*(uint32_t *)(rcba + FD2) = fd2 | 0x2;
 | 
					 | 
				
			||||||
		printf("done\n");
 | 
					 | 
				
			||||||
	}
 | 
					 | 
				
			||||||
}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
/* You need >4GB total ram, in kernel cmdline, use 'mem=1000m'
 | 
					/* You need >4GB total ram, in kernel cmdline, use 'mem=1000m'
 | 
				
			||||||
 * then this code will clone to absolute memory address 0xe0000000
 | 
					 * then this code will clone to absolute memory address 0xe0000000
 | 
				
			||||||
 * which can be read using a mmap tool at that offset.
 | 
					 * which can be read using a mmap tool at that offset.
 | 
				
			||||||
@@ -103,7 +92,9 @@ static void dump_me_memory(void)
 | 
				
			|||||||
		printf("done\n\nHere are the first bytes:\n");
 | 
							printf("done\n\nHere are the first bytes:\n");
 | 
				
			||||||
		dumpmemfile(dump, 0x2000000);
 | 
							dumpmemfile(dump, 0x2000000);
 | 
				
			||||||
		//printf("Try reading 0x%zx with other mmap tool...\n"
 | 
							//printf("Try reading 0x%zx with other mmap tool...\n"
 | 
				
			||||||
		//	"Press enter to quit, you only get one chance to run this tool before reboot required for some reason\n", me_clone);
 | 
							//       "Press enter to quit, you only get one chance to run"
 | 
				
			||||||
 | 
							//       "this tool before reboot required for some reason\n",
 | 
				
			||||||
 | 
							//       me_clone);
 | 
				
			||||||
		while (getc(stdin) != '\n') {};
 | 
							while (getc(stdin) != '\n') {};
 | 
				
			||||||
		unmap_physical(dump, 0x2000000);
 | 
							unmap_physical(dump, 0x2000000);
 | 
				
			||||||
	}
 | 
						}
 | 
				
			||||||
@@ -123,27 +114,36 @@ static int pci_platform_scan(void)
 | 
				
			|||||||
	pci_scan_bus(pacc);
 | 
						pci_scan_bus(pacc);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
	for (dev=pacc->devices; dev; dev=dev->next) {
 | 
						for (dev=pacc->devices; dev; dev=dev->next) {
 | 
				
			||||||
		pci_fill_info(dev, PCI_FILL_IDENT | PCI_FILL_BASES | PCI_FILL_SIZES | PCI_FILL_CLASS);
 | 
							pci_fill_info(dev, PCI_FILL_IDENT | PCI_FILL_BASES |
 | 
				
			||||||
 | 
									   PCI_FILL_SIZES | PCI_FILL_CLASS);
 | 
				
			||||||
		name = pci_lookup_name(pacc, namebuf, sizeof(namebuf),
 | 
							name = pci_lookup_name(pacc, namebuf, sizeof(namebuf),
 | 
				
			||||||
			PCI_LOOKUP_DEVICE, dev->vendor_id, dev->device_id);
 | 
								PCI_LOOKUP_DEVICE, dev->vendor_id, dev->device_id);
 | 
				
			||||||
		if (name == NULL)
 | 
							if (name == NULL)
 | 
				
			||||||
			name = "<unknown>";
 | 
								name = "<unknown>";
 | 
				
			||||||
		if (dev->vendor_id == PCI_VENDOR_ID_INTEL) {
 | 
							if (dev->vendor_id != PCI_VENDOR_ID_INTEL)
 | 
				
			||||||
 | 
								continue;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
		if (PCI_DEV_HAS_ME_DISABLE(dev->device_id)) {
 | 
							if (PCI_DEV_HAS_ME_DISABLE(dev->device_id)) {
 | 
				
			||||||
				printf(CGRN "Good news, you have a `%s` so ME is present but can be disabled, continuing...\n\n" RESET, name);
 | 
								printf(CGRN "Good news, you have a `%s` so ME is "
 | 
				
			||||||
 | 
								       "present but can be disabled, continuing...\n\n"
 | 
				
			||||||
 | 
								       RESET, name);
 | 
				
			||||||
			break;
 | 
								break;
 | 
				
			||||||
		} else if (PCI_DEV_HAS_ME_DIFFICULT(dev->device_id)) {
 | 
							} else if (PCI_DEV_HAS_ME_DIFFICULT(dev->device_id)) {
 | 
				
			||||||
				printf(CRED "Bad news, you have a `%s` so you have ME hardware on board and you can't control or disable it, continuing...\n\n" RESET, name);
 | 
								printf(CRED "Bad news, you have a `%s` so you have ME "
 | 
				
			||||||
 | 
								       "hardware on board and you can't control or "
 | 
				
			||||||
 | 
								       "disable it, continuing...\n\n" RESET, name);
 | 
				
			||||||
			break;
 | 
								break;
 | 
				
			||||||
		} else if (PCI_DEV_CAN_DISABLE_ME_IF_PRESENT(dev->device_id)) {
 | 
							} else if (PCI_DEV_CAN_DISABLE_ME_IF_PRESENT(dev->device_id)) {
 | 
				
			||||||
				printf(CYEL "Not sure if ME hardware is present because you have a `%s`, but it is possible to disable it if you do, continuing...\n\n" RESET, name);
 | 
								printf(CYEL "Not sure if ME hardware is present "
 | 
				
			||||||
 | 
								       "because you have a `%s`, but it is possible to "
 | 
				
			||||||
 | 
								       "disable it if you do, continuing...\n\n" RESET,
 | 
				
			||||||
 | 
								       name);
 | 
				
			||||||
			break;
 | 
								break;
 | 
				
			||||||
		} else if (PCI_DEV_ME_NOT_SURE(dev->device_id)) {
 | 
							} else if (PCI_DEV_ME_NOT_SURE(dev->device_id)) {
 | 
				
			||||||
				printf(CYEL "Found `%s`. Not sure whether you have ME hardware, exiting\n\n" RESET, name);
 | 
								printf(CYEL "Found `%s`. Not sure whether you have ME "
 | 
				
			||||||
 | 
								       "hardware, exiting\n\n" RESET, name);
 | 
				
			||||||
			pci_cleanup(pacc);
 | 
								pci_cleanup(pacc);
 | 
				
			||||||
			return 1;
 | 
								return 1;
 | 
				
			||||||
				break;
 | 
					 | 
				
			||||||
			}
 | 
					 | 
				
			||||||
		}
 | 
							}
 | 
				
			||||||
	}
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
@@ -152,7 +152,8 @@ static int pci_platform_scan(void)
 | 
				
			|||||||
	    !PCI_DEV_HAS_ME_DIFFICULT(dev->device_id) &&
 | 
						    !PCI_DEV_HAS_ME_DIFFICULT(dev->device_id) &&
 | 
				
			||||||
	    !PCI_DEV_CAN_DISABLE_ME_IF_PRESENT(dev->device_id) &&
 | 
						    !PCI_DEV_CAN_DISABLE_ME_IF_PRESENT(dev->device_id) &&
 | 
				
			||||||
	    !PCI_DEV_ME_NOT_SURE(dev->device_id)) {
 | 
						    !PCI_DEV_ME_NOT_SURE(dev->device_id)) {
 | 
				
			||||||
		printf(CCYN "ME is not present on your board or unkown\n\n" RESET);
 | 
							printf(CCYN "ME is not present on your board or unknown\n\n"
 | 
				
			||||||
 | 
							       RESET);
 | 
				
			||||||
		pci_cleanup(pacc);
 | 
							pci_cleanup(pacc);
 | 
				
			||||||
		return 1;
 | 
							return 1;
 | 
				
			||||||
	}
 | 
						}
 | 
				
			||||||
@@ -162,6 +163,43 @@ static int pci_platform_scan(void)
 | 
				
			|||||||
	return 0;
 | 
						return 0;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					static int activate_me(void)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						if (read_rcba32(FD2, &fd2)) {
 | 
				
			||||||
 | 
							printf("Error reading RCBA\n");
 | 
				
			||||||
 | 
							return 1;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
						if (write_rcba32(FD2, fd2 & ~0x2)) {
 | 
				
			||||||
 | 
							printf("Error writing RCBA\n");
 | 
				
			||||||
 | 
							return 1;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
						if (debug) {
 | 
				
			||||||
 | 
							if (fd2 & 0x2)
 | 
				
			||||||
 | 
								printf("MEI was hidden on PCI, now unlocked\n");
 | 
				
			||||||
 | 
							else
 | 
				
			||||||
 | 
								printf("MEI not hidden on PCI, checking if visible\n");
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
						return 0;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					static void rehide_me(void)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						if (fd2 & 0x2) {
 | 
				
			||||||
 | 
							if (debug)
 | 
				
			||||||
 | 
								printf("Re-hiding MEI device...");
 | 
				
			||||||
 | 
							if (read_rcba32(FD2, &fd2)) {
 | 
				
			||||||
 | 
								printf("Error reading RCBA\n");
 | 
				
			||||||
 | 
								return;
 | 
				
			||||||
 | 
							}
 | 
				
			||||||
 | 
							if (write_rcba32(FD2, fd2 | 0x2)) {
 | 
				
			||||||
 | 
								printf("Error writing RCBA\n");
 | 
				
			||||||
 | 
								return;
 | 
				
			||||||
 | 
							}
 | 
				
			||||||
 | 
							if (debug)
 | 
				
			||||||
 | 
								printf("done\n");
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static struct pci_dev *pci_me_interface_scan(const char **name, char *namebuf,
 | 
					static struct pci_dev *pci_me_interface_scan(const char **name, char *namebuf,
 | 
				
			||||||
                                             int namebuf_size)
 | 
					                                             int namebuf_size)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
@@ -176,16 +214,18 @@ static struct pci_dev *pci_me_interface_scan(const char **name, char *namebuf,
 | 
				
			|||||||
	pci_scan_bus(pacc);
 | 
						pci_scan_bus(pacc);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
	for (dev=pacc->devices; dev; dev=dev->next) {
 | 
						for (dev=pacc->devices; dev; dev=dev->next) {
 | 
				
			||||||
		pci_fill_info(dev, PCI_FILL_IDENT | PCI_FILL_BASES | PCI_FILL_SIZES | PCI_FILL_CLASS);
 | 
							pci_fill_info(dev, PCI_FILL_IDENT | PCI_FILL_BASES |
 | 
				
			||||||
 | 
									   PCI_FILL_SIZES | PCI_FILL_CLASS);
 | 
				
			||||||
		*name = pci_lookup_name(pacc, namebuf, namebuf_size,
 | 
							*name = pci_lookup_name(pacc, namebuf, namebuf_size,
 | 
				
			||||||
			PCI_LOOKUP_DEVICE, dev->vendor_id, dev->device_id);
 | 
								PCI_LOOKUP_DEVICE, dev->vendor_id, dev->device_id);
 | 
				
			||||||
		if (dev->vendor_id == PCI_VENDOR_ID_INTEL) {
 | 
							if (dev->vendor_id != PCI_VENDOR_ID_INTEL)
 | 
				
			||||||
 | 
								continue;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
		if (PCI_DEV_HAS_SUPPORTED_ME(dev->device_id)) {
 | 
							if (PCI_DEV_HAS_SUPPORTED_ME(dev->device_id)) {
 | 
				
			||||||
			me = 1;
 | 
								me = 1;
 | 
				
			||||||
			break;
 | 
								break;
 | 
				
			||||||
		}
 | 
							}
 | 
				
			||||||
	}
 | 
						}
 | 
				
			||||||
	}
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
	if (!me) {
 | 
						if (!me) {
 | 
				
			||||||
		rehide_me();
 | 
							rehide_me();
 | 
				
			||||||
@@ -198,74 +238,28 @@ static struct pci_dev *pci_me_interface_scan(const char **name, char *namebuf,
 | 
				
			|||||||
	return dev;
 | 
						return dev;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static int activate_me(void)
 | 
					 | 
				
			||||||
{
 | 
					 | 
				
			||||||
	struct pci_access *pacc;
 | 
					 | 
				
			||||||
	struct pci_dev *sb;
 | 
					 | 
				
			||||||
	uint32_t rcba_phys;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
	pacc = pci_alloc();
 | 
					 | 
				
			||||||
	pacc->method = PCI_ACCESS_I386_TYPE1;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
	pci_init(pacc);
 | 
					 | 
				
			||||||
	pci_scan_bus(pacc);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
	sb = pci_get_dev(pacc, 0, 0, 0x1f, 0);
 | 
					 | 
				
			||||||
	if (!sb) {
 | 
					 | 
				
			||||||
		printf("Uh oh, southbridge not on BDF(0:31:0), please report this error, exiting.\n");
 | 
					 | 
				
			||||||
		pci_cleanup(pacc);
 | 
					 | 
				
			||||||
		return 1;
 | 
					 | 
				
			||||||
	}
 | 
					 | 
				
			||||||
	pci_fill_info(sb, PCI_FILL_IDENT | PCI_FILL_BASES | PCI_FILL_SIZES | PCI_FILL_CLASS);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
	rcba_phys = pci_read_long(sb, 0xf0) & 0xfffffffe;
 | 
					 | 
				
			||||||
	rcba = map_physical((off_t)rcba_phys, size);
 | 
					 | 
				
			||||||
	if (rcba == NULL) {
 | 
					 | 
				
			||||||
		printf("Could not map MEI PCI device memory\n");
 | 
					 | 
				
			||||||
		pci_free_dev(sb);
 | 
					 | 
				
			||||||
		pci_cleanup(pacc);
 | 
					 | 
				
			||||||
		return 1;
 | 
					 | 
				
			||||||
	}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
	//printf("RCBA at 0x%08" PRIx32 "\n", (uint32_t)rcba_phys);
 | 
					 | 
				
			||||||
	fd2 = *(uint32_t *)(rcba + FD2);
 | 
					 | 
				
			||||||
	*(uint32_t *)(rcba + FD2) = fd2 & ~0x2;
 | 
					 | 
				
			||||||
	if (fd2 & 0x2) {
 | 
					 | 
				
			||||||
		printf("MEI was hidden on PCI, now unlocked\n");
 | 
					 | 
				
			||||||
	} else {
 | 
					 | 
				
			||||||
		printf("MEI not hidden on PCI, checking if visible\n");
 | 
					 | 
				
			||||||
	}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
	pci_free_dev(sb);
 | 
					 | 
				
			||||||
	pci_cleanup(pacc);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
	return 0;
 | 
					 | 
				
			||||||
}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
static void dump_me_info(void)
 | 
					static void dump_me_info(void)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	struct pci_dev *dev;
 | 
						struct pci_dev *dev;
 | 
				
			||||||
	uint32_t stat, stat2;
 | 
						uint32_t stat, stat2;
 | 
				
			||||||
	char namebuf[1024];
 | 
						char namebuf[1024];
 | 
				
			||||||
	const char *name;
 | 
						const char *name = NULL;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
	if (pci_platform_scan()) {
 | 
						if (pci_platform_scan())
 | 
				
			||||||
		exit(1);
 | 
							exit(1);
 | 
				
			||||||
	}
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
	if (activate_me()) {
 | 
						if (activate_me())
 | 
				
			||||||
		exit(1);
 | 
							exit(1);
 | 
				
			||||||
	}
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
	dev = pci_me_interface_scan(&name, namebuf, sizeof(namebuf));
 | 
						dev = pci_me_interface_scan(&name, namebuf, sizeof(namebuf));
 | 
				
			||||||
	if (!dev) {
 | 
						if (!dev)
 | 
				
			||||||
		exit(1);
 | 
							exit(1);
 | 
				
			||||||
	}
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
	if (name == NULL)
 | 
						if (name == NULL)
 | 
				
			||||||
		name = "<unknown>";
 | 
							name = "<unknown>";
 | 
				
			||||||
 | 
					
 | 
				
			||||||
	printf("MEI found: [%x:%x] %s\n\n", dev->vendor_id, dev->device_id, name);
 | 
						printf("MEI found: [%x:%x] %s\n\n",
 | 
				
			||||||
 | 
						       dev->vendor_id, dev->device_id, name);
 | 
				
			||||||
	stat = pci_read_long(dev, 0x40);
 | 
						stat = pci_read_long(dev, 0x40);
 | 
				
			||||||
	printf("ME Status   : 0x%x\n", stat);
 | 
						printf("ME Status   : 0x%x\n", stat);
 | 
				
			||||||
	stat2 = pci_read_long(dev, 0x48);
 | 
						stat2 = pci_read_long(dev, 0x48);
 | 
				
			||||||
@@ -276,9 +270,9 @@ static void dump_me_info(void)
 | 
				
			|||||||
	intel_me_extend_valid(dev);
 | 
						intel_me_extend_valid(dev);
 | 
				
			||||||
	printf("\n");
 | 
						printf("\n");
 | 
				
			||||||
 | 
					
 | 
				
			||||||
	if (stat & 0xf000) {
 | 
						if (stat & 0xf000)
 | 
				
			||||||
		printf("ME: has a broken implementation on your board with this BIOS\n");
 | 
							printf("ME: has a broken implementation on your board with"
 | 
				
			||||||
	}
 | 
							       "this firmware\n");
 | 
				
			||||||
 | 
					
 | 
				
			||||||
	intel_mei_setup(dev);
 | 
						intel_mei_setup(dev);
 | 
				
			||||||
	usleep(ME_COMMAND_DELAY);
 | 
						usleep(ME_COMMAND_DELAY);
 | 
				
			||||||
@@ -292,22 +286,13 @@ static void dump_me_info(void)
 | 
				
			|||||||
	usleep(ME_COMMAND_DELAY);
 | 
						usleep(ME_COMMAND_DELAY);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
	rehide_me();
 | 
						rehide_me();
 | 
				
			||||||
 | 
					 | 
				
			||||||
	munmap((void*)rcba, size);
 | 
					 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static void print_version(void)
 | 
					static void print_version(void)
 | 
				
			||||||
{
 | 
					{
 | 
				
			||||||
	printf("intelmetool v%s -- ", INTELMETOOL_VERSION);
 | 
						printf("intelmetool v%s -- ", INTELMETOOL_VERSION);
 | 
				
			||||||
	printf("Copyright (C) 2015 Damien Zammit\n\n");
 | 
						printf("Copyright (C) 2015 Damien Zammit\n\n");
 | 
				
			||||||
	printf(
 | 
						printf(GPLV2COPYRIGHT);
 | 
				
			||||||
		"This program is free software: you can redistribute it and/or modify\n"
 | 
					 | 
				
			||||||
		"it under the terms of the GNU General Public License as published by\n"
 | 
					 | 
				
			||||||
		"the Free Software Foundation, version 2 of the License.\n\n"
 | 
					 | 
				
			||||||
		"This program is distributed in the hope that it will be useful,\n"
 | 
					 | 
				
			||||||
		"but WITHOUT ANY WARRANTY; without even the implied warranty of\n"
 | 
					 | 
				
			||||||
		"MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the\n"
 | 
					 | 
				
			||||||
		"GNU General Public License for more details.\n\n");
 | 
					 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static void print_usage(const char *name)
 | 
					static void print_usage(const char *name)
 | 
				
			||||||
@@ -377,7 +362,8 @@ int main(int argc, char *argv[])
 | 
				
			|||||||
		}
 | 
							}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
	#ifndef __DARWIN__
 | 
						#ifndef __DARWIN__
 | 
				
			||||||
		if ((fd_mem = open("/dev/mem", O_RDWR)) < 0) {
 | 
							fd_mem = open("/dev/mem", O_RDWR);
 | 
				
			||||||
 | 
							if (fd_mem < 0) {
 | 
				
			||||||
			perror("Can not open /dev/mem");
 | 
								perror("Can not open /dev/mem");
 | 
				
			||||||
			exit(1);
 | 
								exit(1);
 | 
				
			||||||
		}
 | 
							}
 | 
				
			||||||
 
 | 
				
			|||||||
@@ -24,6 +24,15 @@
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
#define INTELMETOOL_VERSION "1.0"
 | 
					#define INTELMETOOL_VERSION "1.0"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#define GPLV2COPYRIGHT \
 | 
				
			||||||
 | 
					"This program is free software: you can redistribute it and/or modify\n" \
 | 
				
			||||||
 | 
					"it under the terms of the GNU General Public License as published by\n" \
 | 
				
			||||||
 | 
					"the Free Software Foundation, version 2 of the License.\n\n" \
 | 
				
			||||||
 | 
					"This program is distributed in the hope that it will be useful,\n" \
 | 
				
			||||||
 | 
					"but WITHOUT ANY WARRANTY; without even the implied warranty of\n" \
 | 
				
			||||||
 | 
					"MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the\n" \
 | 
				
			||||||
 | 
					"GNU General Public License for more details.\n\n"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#if defined(__GLIBC__)
 | 
					#if defined(__GLIBC__)
 | 
				
			||||||
#include <sys/io.h>
 | 
					#include <sys/io.h>
 | 
				
			||||||
#endif
 | 
					#endif
 | 
				
			||||||
 
 | 
				
			|||||||
							
								
								
									
										104
									
								
								util/intelmetool/rcba.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										104
									
								
								util/intelmetool/rcba.c
									
									
									
									
									
										Normal file
									
								
							@@ -0,0 +1,104 @@
 | 
				
			|||||||
 | 
					/*
 | 
				
			||||||
 | 
					 * Copyright (C) 2014  Damien Zammit <damien@zamaudio.com>
 | 
				
			||||||
 | 
					 * Copyright (C) 2017  Patrick Rudolph <siro@das-labor.org>
 | 
				
			||||||
 | 
					 *
 | 
				
			||||||
 | 
					 * 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 <inttypes.h>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include "intelmetool.h"
 | 
				
			||||||
 | 
					#include "mmap.h"
 | 
				
			||||||
 | 
					#include "rcba.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					static const int size = 0x4000;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/* Returns the physical RCBA base address or zero on error. */
 | 
				
			||||||
 | 
					static u32 get_rcba_phys(void)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						struct pci_access *pacc;
 | 
				
			||||||
 | 
						struct pci_dev *sb;
 | 
				
			||||||
 | 
						uint32_t rcba_phys;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						pacc = pci_alloc();
 | 
				
			||||||
 | 
						pacc->method = PCI_ACCESS_I386_TYPE1;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						pci_init(pacc);
 | 
				
			||||||
 | 
						pci_scan_bus(pacc);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						sb = pci_get_dev(pacc, 0, 0, 0x1f, 0);
 | 
				
			||||||
 | 
						if (!sb) {
 | 
				
			||||||
 | 
							printf("Uh oh, southbridge not on BDF(0:31:0), please report "
 | 
				
			||||||
 | 
							       "this error, exiting.\n");
 | 
				
			||||||
 | 
							pci_cleanup(pacc);
 | 
				
			||||||
 | 
							return 0;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
						pci_fill_info(sb, PCI_FILL_IDENT | PCI_FILL_BASES | PCI_FILL_SIZES |
 | 
				
			||||||
 | 
								  PCI_FILL_CLASS);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						rcba_phys = pci_read_long(sb, 0xf0) & 0xfffffffe;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						pci_free_dev(sb);
 | 
				
			||||||
 | 
						pci_cleanup(pacc);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						return rcba_phys;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/*
 | 
				
			||||||
 | 
					 * Writes 'val' to RCBA register at address 'addr'.
 | 
				
			||||||
 | 
					 * Returns 1 on error and 0 on success.
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					int write_rcba32(uint32_t addr, uint32_t val)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						volatile uint8_t *rcba;
 | 
				
			||||||
 | 
						const uint32_t rcba_phys = get_rcba_phys();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						if (!rcba_phys) {
 | 
				
			||||||
 | 
							printf("Could not get RCBA address\n");
 | 
				
			||||||
 | 
							return 1;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						rcba = map_physical((off_t)rcba_phys, size);
 | 
				
			||||||
 | 
						if (rcba == NULL) {
 | 
				
			||||||
 | 
							printf("Could not map RCBA\n");
 | 
				
			||||||
 | 
							return 1;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
						*(uint32_t *)(rcba + addr) = val;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						munmap((void *)rcba, size);
 | 
				
			||||||
 | 
						return 0;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					/*
 | 
				
			||||||
 | 
					 * Reads RCBA register at address 'addr' and stores it in 'val'.
 | 
				
			||||||
 | 
					 * Returns 1 on error and 0 on success.
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					int read_rcba32(uint32_t addr, uint32_t *val)
 | 
				
			||||||
 | 
					{
 | 
				
			||||||
 | 
						volatile uint8_t *rcba;
 | 
				
			||||||
 | 
						const uint32_t rcba_phys = get_rcba_phys();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						if (!rcba_phys) {
 | 
				
			||||||
 | 
							printf("Could not get RCBA address\n");
 | 
				
			||||||
 | 
							return 1;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						rcba = map_physical((off_t)rcba_phys, size);
 | 
				
			||||||
 | 
						if (rcba == NULL) {
 | 
				
			||||||
 | 
							printf("Could not map RCBA\n");
 | 
				
			||||||
 | 
							return 1;
 | 
				
			||||||
 | 
						}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						*val = *(uint32_t *)(rcba + addr);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
						munmap((void *)rcba, size);
 | 
				
			||||||
 | 
						return 0;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
							
								
								
									
										15
									
								
								util/intelmetool/rcba.h
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										15
									
								
								util/intelmetool/rcba.h
									
									
									
									
									
										Normal file
									
								
							@@ -0,0 +1,15 @@
 | 
				
			|||||||
 | 
					/*
 | 
				
			||||||
 | 
					 * Copyright (C) 2017  Patrick Rudolph <siro@das-labor.org>
 | 
				
			||||||
 | 
					 *
 | 
				
			||||||
 | 
					 * 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.
 | 
				
			||||||
 | 
					 */
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					int write_rcba32(uint32_t addr, uint32_t val);
 | 
				
			||||||
 | 
					int read_rcba32(uint32_t addr, uint32_t *val);
 | 
				
			||||||
		Reference in New Issue
	
	Block a user