initial check-in of tool for USB-to-EHCI routing on AMD APU SoC
This commit is contained in:
commit
ea8bbe2e51
|
@ -0,0 +1,121 @@
|
|||
Creative Commons Legal Code
|
||||
|
||||
CC0 1.0 Universal
|
||||
|
||||
CREATIVE COMMONS CORPORATION IS NOT A LAW FIRM AND DOES NOT PROVIDE
|
||||
LEGAL SERVICES. DISTRIBUTION OF THIS DOCUMENT DOES NOT CREATE AN
|
||||
ATTORNEY-CLIENT RELATIONSHIP. CREATIVE COMMONS PROVIDES THIS
|
||||
INFORMATION ON AN "AS-IS" BASIS. CREATIVE COMMONS MAKES NO WARRANTIES
|
||||
REGARDING THE USE OF THIS DOCUMENT OR THE INFORMATION OR WORKS
|
||||
PROVIDED HEREUNDER, AND DISCLAIMS LIABILITY FOR DAMAGES RESULTING FROM
|
||||
THE USE OF THIS DOCUMENT OR THE INFORMATION OR WORKS PROVIDED
|
||||
HEREUNDER.
|
||||
|
||||
Statement of Purpose
|
||||
|
||||
The laws of most jurisdictions throughout the world automatically confer
|
||||
exclusive Copyright and Related Rights (defined below) upon the creator
|
||||
and subsequent owner(s) (each and all, an "owner") of an original work of
|
||||
authorship and/or a database (each, a "Work").
|
||||
|
||||
Certain owners wish to permanently relinquish those rights to a Work for
|
||||
the purpose of contributing to a commons of creative, cultural and
|
||||
scientific works ("Commons") that the public can reliably and without fear
|
||||
of later claims of infringement build upon, modify, incorporate in other
|
||||
works, reuse and redistribute as freely as possible in any form whatsoever
|
||||
and for any purposes, including without limitation commercial purposes.
|
||||
These owners may contribute to the Commons to promote the ideal of a free
|
||||
culture and the further production of creative, cultural and scientific
|
||||
works, or to gain reputation or greater distribution for their Work in
|
||||
part through the use and efforts of others.
|
||||
|
||||
For these and/or other purposes and motivations, and without any
|
||||
expectation of additional consideration or compensation, the person
|
||||
associating CC0 with a Work (the "Affirmer"), to the extent that he or she
|
||||
is an owner of Copyright and Related Rights in the Work, voluntarily
|
||||
elects to apply CC0 to the Work and publicly distribute the Work under its
|
||||
terms, with knowledge of his or her Copyright and Related Rights in the
|
||||
Work and the meaning and intended legal effect of CC0 on those rights.
|
||||
|
||||
1. Copyright and Related Rights. A Work made available under CC0 may be
|
||||
protected by copyright and related or neighboring rights ("Copyright and
|
||||
Related Rights"). Copyright and Related Rights include, but are not
|
||||
limited to, the following:
|
||||
|
||||
i. the right to reproduce, adapt, distribute, perform, display,
|
||||
communicate, and translate a Work;
|
||||
ii. moral rights retained by the original author(s) and/or performer(s);
|
||||
iii. publicity and privacy rights pertaining to a person's image or
|
||||
likeness depicted in a Work;
|
||||
iv. rights protecting against unfair competition in regards to a Work,
|
||||
subject to the limitations in paragraph 4(a), below;
|
||||
v. rights protecting the extraction, dissemination, use and reuse of data
|
||||
in a Work;
|
||||
vi. database rights (such as those arising under Directive 96/9/EC of the
|
||||
European Parliament and of the Council of 11 March 1996 on the legal
|
||||
protection of databases, and under any national implementation
|
||||
thereof, including any amended or successor version of such
|
||||
directive); and
|
||||
vii. other similar, equivalent or corresponding rights throughout the
|
||||
world based on applicable law or treaty, and any national
|
||||
implementations thereof.
|
||||
|
||||
2. Waiver. To the greatest extent permitted by, but not in contravention
|
||||
of, applicable law, Affirmer hereby overtly, fully, permanently,
|
||||
irrevocably and unconditionally waives, abandons, and surrenders all of
|
||||
Affirmer's Copyright and Related Rights and associated claims and causes
|
||||
of action, whether now known or unknown (including existing as well as
|
||||
future claims and causes of action), in the Work (i) in all territories
|
||||
worldwide, (ii) for the maximum duration provided by applicable law or
|
||||
treaty (including future time extensions), (iii) in any current or future
|
||||
medium and for any number of copies, and (iv) for any purpose whatsoever,
|
||||
including without limitation commercial, advertising or promotional
|
||||
purposes (the "Waiver"). Affirmer makes the Waiver for the benefit of each
|
||||
member of the public at large and to the detriment of Affirmer's heirs and
|
||||
successors, fully intending that such Waiver shall not be subject to
|
||||
revocation, rescission, cancellation, termination, or any other legal or
|
||||
equitable action to disrupt the quiet enjoyment of the Work by the public
|
||||
as contemplated by Affirmer's express Statement of Purpose.
|
||||
|
||||
3. Public License Fallback. Should any part of the Waiver for any reason
|
||||
be judged legally invalid or ineffective under applicable law, then the
|
||||
Waiver shall be preserved to the maximum extent permitted taking into
|
||||
account Affirmer's express Statement of Purpose. In addition, to the
|
||||
extent the Waiver is so judged Affirmer hereby grants to each affected
|
||||
person a royalty-free, non transferable, non sublicensable, non exclusive,
|
||||
irrevocable and unconditional license to exercise Affirmer's Copyright and
|
||||
Related Rights in the Work (i) in all territories worldwide, (ii) for the
|
||||
maximum duration provided by applicable law or treaty (including future
|
||||
time extensions), (iii) in any current or future medium and for any number
|
||||
of copies, and (iv) for any purpose whatsoever, including without
|
||||
limitation commercial, advertising or promotional purposes (the
|
||||
"License"). The License shall be deemed effective as of the date CC0 was
|
||||
applied by Affirmer to the Work. Should any part of the License for any
|
||||
reason be judged legally invalid or ineffective under applicable law, such
|
||||
partial invalidity or ineffectiveness shall not invalidate the remainder
|
||||
of the License, and in such case Affirmer hereby affirms that he or she
|
||||
will not (i) exercise any of his or her remaining Copyright and Related
|
||||
Rights in the Work or (ii) assert any associated claims and causes of
|
||||
action with respect to the Work, in either case contrary to Affirmer's
|
||||
express Statement of Purpose.
|
||||
|
||||
4. Limitations and Disclaimers.
|
||||
|
||||
a. No trademark or patent rights held by Affirmer are waived, abandoned,
|
||||
surrendered, licensed or otherwise affected by this document.
|
||||
b. Affirmer offers the Work as-is and makes no representations or
|
||||
warranties of any kind concerning the Work, express, implied,
|
||||
statutory or otherwise, including without limitation warranties of
|
||||
title, merchantability, fitness for a particular purpose, non
|
||||
infringement, or the absence of latent or other defects, accuracy, or
|
||||
the present or absence of errors, whether or not discoverable, all to
|
||||
the greatest extent permissible under applicable law.
|
||||
c. Affirmer disclaims responsibility for clearing rights of other persons
|
||||
that may apply to the Work or any use thereof, including without
|
||||
limitation any person's Copyright and Related Rights in the Work.
|
||||
Further, Affirmer disclaims responsibility for obtaining any necessary
|
||||
consents, permissions or other rights required for any use of the
|
||||
Work.
|
||||
d. Affirmer understands and acknowledges that Creative Commons is not a
|
||||
party to this document and has no duty or obligation with respect to
|
||||
this CC0 or use of the Work.
|
|
@ -0,0 +1,12 @@
|
|||
CFLAGS = -Wall -O2
|
||||
|
||||
all: apu-ehci
|
||||
|
||||
apu-ehco: apu-ehci.o
|
||||
$(CC) -o $@ $^
|
||||
|
||||
%.o: %.c
|
||||
$(CC) $(CFLAGS) -o $@ -c $<
|
||||
|
||||
clean:
|
||||
@rm -f *.o apu-ehci
|
|
@ -0,0 +1,186 @@
|
|||
/* Tool to route USB Ports 8+9 to EHCI instead of XHCI on an AMD APU */
|
||||
|
||||
/* (C) 2022 by Harald Welte <laforge@gnumonks.org> */
|
||||
|
||||
/* To the extent possible under law, the author(s) have dedicated all
|
||||
* copyright and related and neighboring rights to this software to the
|
||||
* public domain worldwide. This software is distributed without any
|
||||
* warranty.
|
||||
* You should have received a copy of the CC0 Public Domain Dedication
|
||||
* along with this software. If not, see
|
||||
* <http://creativecommons.org/publicdomain/zero/1.0/>. */
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <stdio.h>
|
||||
#include <stdint.h>
|
||||
#include <stdbool.h>
|
||||
#include <errno.h>
|
||||
#include <string.h>
|
||||
#include <fcntl.h>
|
||||
#include <unistd.h>
|
||||
|
||||
#include <sys/io.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/stat.h>
|
||||
|
||||
#define IOPORT_PMINDEX 0xCD6
|
||||
#define IOPORT_PMDATA 0xCD7
|
||||
|
||||
/* Page 938 of "BKDG for AMD Family 16h Models 30-3Fh Processors" */
|
||||
#define PM_REG_USB_ENABLE 0xEF
|
||||
|
||||
static inline void native_cpuid(unsigned int *eax, unsigned int *ebx,
|
||||
unsigned int *ecx, unsigned int *edx)
|
||||
{
|
||||
/* ecx is often an input as well as an output. */
|
||||
asm volatile("cpuid"
|
||||
: "=a" (*eax),
|
||||
"=b" (*ebx),
|
||||
"=c" (*ecx),
|
||||
"=d" (*edx)
|
||||
: "0" (*eax), "2" (*ecx));
|
||||
}
|
||||
|
||||
static bool compatible_cpu(void)
|
||||
{
|
||||
uint32_t eax, ebx, ecx, edx;
|
||||
uint16_t model, family;
|
||||
|
||||
eax = 1;
|
||||
native_cpuid(&eax, &ebx, &ecx, &edx);
|
||||
family = (eax >> 8) & 0xf;
|
||||
model = (eax >> 4) & 0xf;
|
||||
|
||||
if ((family == 6) | (family == 15))
|
||||
model |= ((eax >> 16) & 0x0f) << 4;
|
||||
|
||||
if (family == 15)
|
||||
family += ((eax >> 20) & 0xff);
|
||||
|
||||
printf("Detected CPU Family: 0x%x, Model: 0x%x\n", family, model);
|
||||
|
||||
if (family != 0x16)
|
||||
return false;
|
||||
|
||||
if (model < 0x30 || model > 0x3f)
|
||||
return false;
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
static uint8_t apu_read_pm_reg(uint8_t reg)
|
||||
{
|
||||
outb(reg, IOPORT_PMINDEX);
|
||||
return inb(IOPORT_PMDATA);
|
||||
}
|
||||
|
||||
static void apu_write_pm_reg(uint8_t reg, uint8_t val)
|
||||
{
|
||||
outb(reg, IOPORT_PMINDEX);
|
||||
outb(val, IOPORT_PMDATA);
|
||||
}
|
||||
|
||||
static int apu_write_pm_reg_verify(uint8_t reg, uint8_t val)
|
||||
{
|
||||
uint8_t val2;
|
||||
|
||||
apu_write_pm_reg(reg, val);
|
||||
|
||||
val2 = apu_read_pm_reg(reg);
|
||||
if (val != val2) {
|
||||
fprintf(stderr, "Wrote 0x%02x to register 0x%02x, but verify renders 0x%02x\n", val, reg, val2);
|
||||
return -EIO;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int usb_port89_to_ehci(bool to_ehci)
|
||||
{
|
||||
uint8_t reg;
|
||||
|
||||
printf("Routing USB Ports 8+8 to %s\n", to_ehci ? "EHCI2" : "XHCI");
|
||||
|
||||
reg = apu_read_pm_reg(PM_REG_USB_ENABLE);
|
||||
if (to_ehci)
|
||||
reg &= ~0x80; /* route USB8+USB9 to EHCI */
|
||||
else
|
||||
reg |= 0x80;
|
||||
return apu_write_pm_reg_verify(PM_REG_USB_ENABLE, reg);
|
||||
}
|
||||
|
||||
static int ehci2_enable(bool enable)
|
||||
{
|
||||
uint8_t reg;
|
||||
|
||||
printf("%sabling USB EHCI Controller 2\n", enable ? "En" : "Dis");
|
||||
|
||||
reg = apu_read_pm_reg(PM_REG_USB_ENABLE);
|
||||
if (enable)
|
||||
reg |= 0x20;
|
||||
else
|
||||
reg &= ~0x20;
|
||||
return apu_write_pm_reg_verify(PM_REG_USB_ENABLE, reg);
|
||||
}
|
||||
|
||||
static int rescan_pci(void)
|
||||
{
|
||||
int rc, fd;
|
||||
|
||||
fd = open("/sys/bus/pci/rescan", O_WRONLY);
|
||||
if (fd < 0) {
|
||||
fprintf(stderr, "Error opening /sys/bus/pci/rescan: %s\n", strerror(errno));
|
||||
return fd;
|
||||
}
|
||||
|
||||
printf("Instructing kernel to re-scan PCI bus\n");
|
||||
|
||||
rc = write(fd, "1\n", 2);
|
||||
if (rc != 2) {
|
||||
fprintf(stderr, "Error writing to /sys/bus/pci/rescan: %s\n", strerror(errno));
|
||||
close(fd);
|
||||
return rc;
|
||||
}
|
||||
|
||||
close(fd);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void print_usage(void)
|
||||
{
|
||||
printf("Usage: apu-ehci (enable|disable)\n");
|
||||
}
|
||||
|
||||
int main(int argc, char **argv)
|
||||
{
|
||||
int rc;
|
||||
|
||||
rc = ioperm(IOPORT_PMINDEX, 2, 1);
|
||||
if (rc < 0) {
|
||||
fprintf(stderr, "Unalbe to access I/O ports: %s\n", strerror(errno));
|
||||
return rc;
|
||||
}
|
||||
|
||||
if (argc < 2) {
|
||||
print_usage();
|
||||
exit(0);
|
||||
}
|
||||
|
||||
if (!compatible_cpu()) {
|
||||
fprintf(stderr, "Your CPU is not an AMD APU compatible with this program\n");
|
||||
exit(1);
|
||||
}
|
||||
|
||||
if (!strcmp(argv[1], "enable")) {
|
||||
usb_port89_to_ehci(true);
|
||||
ehci2_enable(true);
|
||||
rescan_pci();
|
||||
} else if (!strcmp(argv[1], "disable")) {
|
||||
usb_port89_to_ehci(false);
|
||||
ehci2_enable(false);
|
||||
rescan_pci();
|
||||
} else {
|
||||
print_usage();
|
||||
exit(2);
|
||||
}
|
||||
}
|
Loading…
Reference in New Issue