tinyvisor/0000755006644000001440000000000012206363327013070 5ustar yuichi_xyuserstinyvisor/vmm/0000755006644000001440000000000012206363326013666 5ustar yuichi_xyuserstinyvisor/vmm/Doxyfile0000644006644000001440000014522211733227577015415 0ustar yuichi_xyusers# Doxyfile 1.5.1 # This file describes the settings to be used by the documentation system # doxygen (www.doxygen.org) for a project # # All text after a hash (#) is considered a comment and will be ignored # The format is: # TAG = value [value, ...] # For lists items can also be appended using: # TAG += value [value, ...] # Values that contain spaces should be placed between quotes (" ") #--------------------------------------------------------------------------- # Project related configuration options #--------------------------------------------------------------------------- # The PROJECT_NAME tag is a single word (or a sequence of words surrounded # by quotes) that should identify the project. PROJECT_NAME = SecureVM # The PROJECT_NUMBER tag can be used to enter a project or revision number. # This could be handy for archiving the generated documentation or # if some version control system is used. PROJECT_NUMBER = 1.0 # The OUTPUT_DIRECTORY tag is used to specify the (relative or absolute) # base path where the generated documentation will be put. # If a relative path is entered, it will be relative to the location # where doxygen was started. If left blank the current directory will be used. OUTPUT_DIRECTORY = ./documents/ # If the CREATE_SUBDIRS tag is set to YES, then doxygen will create # 4096 sub-directories (in 2 levels) under the output directory of each output # format and will distribute the generated files over these directories. # Enabling this option can be useful when feeding doxygen a huge amount of # source files, where putting all generated files in the same directory would # otherwise cause performance problems for the file system. CREATE_SUBDIRS = NO # The OUTPUT_LANGUAGE tag is used to specify the language in which all # documentation generated by doxygen is written. Doxygen will use this # information to generate all constant output in the proper language. # The default language is English, other supported languages are: # Afrikaans, Arabic, Brazilian, Catalan, Chinese, Chinese-Traditional, # Croatian, Czech, Danish, Dutch, Finnish, French, German, Greek, Hungarian, # Italian, Japanese, Japanese-en (Japanese with English messages), Korean, # Korean-en, Lithuanian, Norwegian, Polish, Portuguese, Romanian, Russian, # Serbian, Slovak, Slovene, Spanish, Swedish, and Ukrainian. OUTPUT_LANGUAGE = Japanese # This tag can be used to specify the encoding used in the generated output. # The encoding is not always determined by the language that is chosen, # but also whether or not the output is meant for Windows or non-Windows users. # In case there is a difference, setting the USE_WINDOWS_ENCODING tag to YES # forces the Windows encoding (this is the default for the Windows binary), # whereas setting the tag to NO uses a Unix-style encoding (the default for # all platforms other than Windows). USE_WINDOWS_ENCODING = NO # If the BRIEF_MEMBER_DESC tag is set to YES (the default) Doxygen will # include brief member descriptions after the members that are listed in # the file and class documentation (similar to JavaDoc). # Set to NO to disable this. BRIEF_MEMBER_DESC = YES # If the REPEAT_BRIEF tag is set to YES (the default) Doxygen will prepend # the brief description of a member or function before the detailed description. # Note: if both HIDE_UNDOC_MEMBERS and BRIEF_MEMBER_DESC are set to NO, the # brief descriptions will be completely suppressed. REPEAT_BRIEF = YES # This tag implements a quasi-intelligent brief description abbreviator # that is used to form the text in various listings. Each string # in this list, if found as the leading text of the brief description, will be # stripped from the text and the result after processing the whole list, is # used as the annotated text. Otherwise, the brief description is used as-is. # If left blank, the following values are used ("$name" is automatically # replaced with the name of the entity): "The $name class" "The $name widget" # "The $name file" "is" "provides" "specifies" "contains" # "represents" "a" "an" "the" ABBREVIATE_BRIEF = # If the ALWAYS_DETAILED_SEC and REPEAT_BRIEF tags are both set to YES then # Doxygen will generate a detailed section even if there is only a brief # description. ALWAYS_DETAILED_SEC = NO # If the INLINE_INHERITED_MEMB tag is set to YES, doxygen will show all # inherited members of a class in the documentation of that class as if those # members were ordinary class members. Constructors, destructors and assignment # operators of the base classes will not be shown. INLINE_INHERITED_MEMB = NO # If the FULL_PATH_NAMES tag is set to YES then Doxygen will prepend the full # path before files name in the file list and in the header files. If set # to NO the shortest path that makes the file name unique will be used. FULL_PATH_NAMES = YES # If the FULL_PATH_NAMES tag is set to YES then the STRIP_FROM_PATH tag # can be used to strip a user-defined part of the path. Stripping is # only done if one of the specified strings matches the left-hand part of # the path. The tag can be used to show relative paths in the file list. # If left blank the directory from which doxygen is run is used as the # path to strip. STRIP_FROM_PATH = # The STRIP_FROM_INC_PATH tag can be used to strip a user-defined part of # the path mentioned in the documentation of a class, which tells # the reader which header file to include in order to use a class. # If left blank only the name of the header file containing the class # definition is used. Otherwise one should specify the include paths that # are normally passed to the compiler using the -I flag. STRIP_FROM_INC_PATH = # If the SHORT_NAMES tag is set to YES, doxygen will generate much shorter # (but less readable) file names. This can be useful is your file systems # doesn't support long names like on DOS, Mac, or CD-ROM. SHORT_NAMES = NO # If the JAVADOC_AUTOBRIEF tag is set to YES then Doxygen # will interpret the first line (until the first dot) of a JavaDoc-style # comment as the brief description. If set to NO, the JavaDoc # comments will behave just like the Qt-style comments (thus requiring an # explicit @brief command for a brief description. JAVADOC_AUTOBRIEF = NO # The MULTILINE_CPP_IS_BRIEF tag can be set to YES to make Doxygen # treat a multi-line C++ special comment block (i.e. a block of //! or /// # comments) as a brief description. This used to be the default behaviour. # The new default is to treat a multi-line C++ comment block as a detailed # description. Set this tag to YES if you prefer the old behaviour instead. MULTILINE_CPP_IS_BRIEF = NO # If the DETAILS_AT_TOP tag is set to YES then Doxygen # will output the detailed description near the top, like JavaDoc. # If set to NO, the detailed description appears after the member # documentation. DETAILS_AT_TOP = NO # If the INHERIT_DOCS tag is set to YES (the default) then an undocumented # member inherits the documentation from any documented member that it # re-implements. INHERIT_DOCS = YES # If the SEPARATE_MEMBER_PAGES tag is set to YES, then doxygen will produce # a new page for each member. If set to NO, the documentation of a member will # be part of the file/class/namespace that contains it. SEPARATE_MEMBER_PAGES = NO # The TAB_SIZE tag can be used to set the number of spaces in a tab. # Doxygen uses this value to replace tabs by spaces in code fragments. TAB_SIZE = 8 # This tag can be used to specify a number of aliases that acts # as commands in the documentation. An alias has the form "name=value". # For example adding "sideeffect=\par Side Effects:\n" will allow you to # put the command \sideeffect (or @sideeffect) in the documentation, which # will result in a user-defined paragraph with heading "Side Effects:". # You can put \n's in the value part of an alias to insert newlines. ALIASES = # Set the OPTIMIZE_OUTPUT_FOR_C tag to YES if your project consists of C # sources only. Doxygen will then generate output that is more tailored for C. # For instance, some of the names that are used will be different. The list # of all members will be omitted, etc. OPTIMIZE_OUTPUT_FOR_C = YES # Set the OPTIMIZE_OUTPUT_JAVA tag to YES if your project consists of Java # sources only. Doxygen will then generate output that is more tailored for Java. # For instance, namespaces will be presented as packages, qualified scopes # will look different, etc. OPTIMIZE_OUTPUT_JAVA = NO # If you use STL classes (i.e. std::string, std::vector, etc.) but do not want to # include (a tag file for) the STL sources as input, then you should # set this tag to YES in order to let doxygen match functions declarations and # definitions whose arguments contain STL classes (e.g. func(std::string); v.s. # func(std::string) {}). This also make the inheritance and collaboration # diagrams that involve STL classes more complete and accurate. BUILTIN_STL_SUPPORT = NO # If member grouping is used in the documentation and the DISTRIBUTE_GROUP_DOC # tag is set to YES, then doxygen will reuse the documentation of the first # member in the group (if any) for the other members of the group. By default # all members of a group must be documented explicitly. DISTRIBUTE_GROUP_DOC = NO # Set the SUBGROUPING tag to YES (the default) to allow class member groups of # the same type (for instance a group of public functions) to be put as a # subgroup of that type (e.g. under the Public Functions section). Set it to # NO to prevent subgrouping. Alternatively, this can be done per class using # the \nosubgrouping command. SUBGROUPING = YES #--------------------------------------------------------------------------- # Build related configuration options #--------------------------------------------------------------------------- # If the EXTRACT_ALL tag is set to YES doxygen will assume all entities in # documentation are documented, even if no documentation was available. # Private class members and static file members will be hidden unless # the EXTRACT_PRIVATE and EXTRACT_STATIC tags are set to YES EXTRACT_ALL = NO # If the EXTRACT_PRIVATE tag is set to YES all private members of a class # will be included in the documentation. EXTRACT_PRIVATE = NO # If the EXTRACT_STATIC tag is set to YES all static members of a file # will be included in the documentation. EXTRACT_STATIC = NO # If the EXTRACT_LOCAL_CLASSES tag is set to YES classes (and structs) # defined locally in source files will be included in the documentation. # If set to NO only classes defined in header files are included. EXTRACT_LOCAL_CLASSES = YES # This flag is only useful for Objective-C code. When set to YES local # methods, which are defined in the implementation section but not in # the interface are included in the documentation. # If set to NO (the default) only methods in the interface are included. EXTRACT_LOCAL_METHODS = NO # If the HIDE_UNDOC_MEMBERS tag is set to YES, Doxygen will hide all # undocumented members of documented classes, files or namespaces. # If set to NO (the default) these members will be included in the # various overviews, but no documentation section is generated. # This option has no effect if EXTRACT_ALL is enabled. HIDE_UNDOC_MEMBERS = NO # If the HIDE_UNDOC_CLASSES tag is set to YES, Doxygen will hide all # undocumented classes that are normally visible in the class hierarchy. # If set to NO (the default) these classes will be included in the various # overviews. This option has no effect if EXTRACT_ALL is enabled. HIDE_UNDOC_CLASSES = NO # If the HIDE_FRIEND_COMPOUNDS tag is set to YES, Doxygen will hide all # friend (class|struct|union) declarations. # If set to NO (the default) these declarations will be included in the # documentation. HIDE_FRIEND_COMPOUNDS = NO # If the HIDE_IN_BODY_DOCS tag is set to YES, Doxygen will hide any # documentation blocks found inside the body of a function. # If set to NO (the default) these blocks will be appended to the # function's detailed documentation block. HIDE_IN_BODY_DOCS = NO # The INTERNAL_DOCS tag determines if documentation # that is typed after a \internal command is included. If the tag is set # to NO (the default) then the documentation will be excluded. # Set it to YES to include the internal documentation. INTERNAL_DOCS = NO # If the CASE_SENSE_NAMES tag is set to NO then Doxygen will only generate # file names in lower-case letters. If set to YES upper-case letters are also # allowed. This is useful if you have classes or files whose names only differ # in case and if your file system supports case sensitive file names. Windows # and Mac users are advised to set this option to NO. CASE_SENSE_NAMES = YES # If the HIDE_SCOPE_NAMES tag is set to NO (the default) then Doxygen # will show members with their full class and namespace scopes in the # documentation. If set to YES the scope will be hidden. HIDE_SCOPE_NAMES = NO # If the SHOW_INCLUDE_FILES tag is set to YES (the default) then Doxygen # will put a list of the files that are included by a file in the documentation # of that file. SHOW_INCLUDE_FILES = YES # If the INLINE_INFO tag is set to YES (the default) then a tag [inline] # is inserted in the documentation for inline members. INLINE_INFO = YES # If the SORT_MEMBER_DOCS tag is set to YES (the default) then doxygen # will sort the (detailed) documentation of file and class members # alphabetically by member name. If set to NO the members will appear in # declaration order. SORT_MEMBER_DOCS = YES # If the SORT_BRIEF_DOCS tag is set to YES then doxygen will sort the # brief documentation of file, namespace and class members alphabetically # by member name. If set to NO (the default) the members will appear in # declaration order. SORT_BRIEF_DOCS = NO # If the SORT_BY_SCOPE_NAME tag is set to YES, the class list will be # sorted by fully-qualified names, including namespaces. If set to # NO (the default), the class list will be sorted only by class name, # not including the namespace part. # Note: This option is not very useful if HIDE_SCOPE_NAMES is set to YES. # Note: This option applies only to the class list, not to the # alphabetical list. SORT_BY_SCOPE_NAME = NO # The GENERATE_TODOLIST tag can be used to enable (YES) or # disable (NO) the todo list. This list is created by putting \todo # commands in the documentation. GENERATE_TODOLIST = YES # The GENERATE_TESTLIST tag can be used to enable (YES) or # disable (NO) the test list. This list is created by putting \test # commands in the documentation. GENERATE_TESTLIST = YES # The GENERATE_BUGLIST tag can be used to enable (YES) or # disable (NO) the bug list. This list is created by putting \bug # commands in the documentation. GENERATE_BUGLIST = YES # The GENERATE_DEPRECATEDLIST tag can be used to enable (YES) or # disable (NO) the deprecated list. This list is created by putting # \deprecated commands in the documentation. GENERATE_DEPRECATEDLIST= YES # The ENABLED_SECTIONS tag can be used to enable conditional # documentation sections, marked by \if sectionname ... \endif. ENABLED_SECTIONS = # The MAX_INITIALIZER_LINES tag determines the maximum number of lines # the initial value of a variable or define consists of for it to appear in # the documentation. If the initializer consists of more lines than specified # here it will be hidden. Use a value of 0 to hide initializers completely. # The appearance of the initializer of individual variables and defines in the # documentation can be controlled using \showinitializer or \hideinitializer # command in the documentation regardless of this setting. MAX_INITIALIZER_LINES = 30 # Set the SHOW_USED_FILES tag to NO to disable the list of files generated # at the bottom of the documentation of classes and structs. If set to YES the # list will mention the files that were used to generate the documentation. SHOW_USED_FILES = YES # If the sources in your project are distributed over multiple directories # then setting the SHOW_DIRECTORIES tag to YES will show the directory hierarchy # in the documentation. The default is NO. SHOW_DIRECTORIES = NO # The FILE_VERSION_FILTER tag can be used to specify a program or script that # doxygen should invoke to get the current version for each file (typically from the # version control system). Doxygen will invoke the program by executing (via # popen()) the command , where is the value of # the FILE_VERSION_FILTER tag, and is the name of an input file # provided by doxygen. Whatever the program writes to standard output # is used as the file version. See the manual for examples. FILE_VERSION_FILTER = #--------------------------------------------------------------------------- # configuration options related to warning and progress messages #--------------------------------------------------------------------------- # The QUIET tag can be used to turn on/off the messages that are generated # by doxygen. Possible values are YES and NO. If left blank NO is used. QUIET = NO # The WARNINGS tag can be used to turn on/off the warning messages that are # generated by doxygen. Possible values are YES and NO. If left blank # NO is used. WARNINGS = YES # If WARN_IF_UNDOCUMENTED is set to YES, then doxygen will generate warnings # for undocumented members. If EXTRACT_ALL is set to YES then this flag will # automatically be disabled. WARN_IF_UNDOCUMENTED = YES # If WARN_IF_DOC_ERROR is set to YES, doxygen will generate warnings for # potential errors in the documentation, such as not documenting some # parameters in a documented function, or documenting parameters that # don't exist or using markup commands wrongly. WARN_IF_DOC_ERROR = YES # This WARN_NO_PARAMDOC option can be abled to get warnings for # functions that are documented, but have no documentation for their parameters # or return value. If set to NO (the default) doxygen will only warn about # wrong or incomplete parameter documentation, but not about the absence of # documentation. WARN_NO_PARAMDOC = NO # The WARN_FORMAT tag determines the format of the warning messages that # doxygen can produce. The string should contain the $file, $line, and $text # tags, which will be replaced by the file and line number from which the # warning originated and the warning text. Optionally the format may contain # $version, which will be replaced by the version of the file (if it could # be obtained via FILE_VERSION_FILTER) WARN_FORMAT = "$file:$line: $text" # The WARN_LOGFILE tag can be used to specify a file to which warning # and error messages should be written. If left blank the output is written # to stderr. WARN_LOGFILE = #--------------------------------------------------------------------------- # configuration options related to the input files #--------------------------------------------------------------------------- # The INPUT tag can be used to specify the files and/or directories that contain # documented source files. You may enter file names like "myfile.cpp" or # directories like "/usr/src/myproject". Separate the files or directories # with spaces. INPUT = drivers # If the value of the INPUT tag contains directories, you can use the # FILE_PATTERNS tag to specify one or more wildcard pattern (like *.cpp # and *.h) to filter out the source-files in the directories. If left # blank the following patterns are tested: # *.c *.cc *.cxx *.cpp *.c++ *.java *.ii *.ixx *.ipp *.i++ *.inl *.h *.hh *.hxx # *.hpp *.h++ *.idl *.odl *.cs *.php *.php3 *.inc *.m *.mm *.py FILE_PATTERNS = # The RECURSIVE tag can be used to turn specify whether or not subdirectories # should be searched for input files as well. Possible values are YES and NO. # If left blank NO is used. RECURSIVE = NO # The EXCLUDE tag can be used to specify files and/or directories that should # excluded from the INPUT source files. This way you can easily exclude a # subdirectory from a directory tree whose root is specified with the INPUT tag. EXCLUDE = # The EXCLUDE_SYMLINKS tag can be used select whether or not files or # directories that are symbolic links (a Unix filesystem feature) are excluded # from the input. EXCLUDE_SYMLINKS = NO # If the value of the INPUT tag contains directories, you can use the # EXCLUDE_PATTERNS tag to specify one or more wildcard patterns to exclude # certain files from those directories. Note that the wildcards are matched # against the file with absolute path, so to exclude all test directories # for example use the pattern */test/* EXCLUDE_PATTERNS = # The EXAMPLE_PATH tag can be used to specify one or more files or # directories that contain example code fragments that are included (see # the \include command). EXAMPLE_PATH = # If the value of the EXAMPLE_PATH tag contains directories, you can use the # EXAMPLE_PATTERNS tag to specify one or more wildcard pattern (like *.cpp # and *.h) to filter out the source-files in the directories. If left # blank all files are included. EXAMPLE_PATTERNS = # If the EXAMPLE_RECURSIVE tag is set to YES then subdirectories will be # searched for input files to be used with the \include or \dontinclude # commands irrespective of the value of the RECURSIVE tag. # Possible values are YES and NO. If left blank NO is used. EXAMPLE_RECURSIVE = NO # The IMAGE_PATH tag can be used to specify one or more files or # directories that contain image that are included in the documentation (see # the \image command). IMAGE_PATH = # The INPUT_FILTER tag can be used to specify a program that doxygen should # invoke to filter for each input file. Doxygen will invoke the filter program # by executing (via popen()) the command , where # is the value of the INPUT_FILTER tag, and is the name of an # input file. Doxygen will then use the output that the filter program writes # to standard output. If FILTER_PATTERNS is specified, this tag will be # ignored. INPUT_FILTER = # The FILTER_PATTERNS tag can be used to specify filters on a per file pattern # basis. Doxygen will compare the file name with each pattern and apply the # filter if there is a match. The filters are a list of the form: # pattern=filter (like *.cpp=my_cpp_filter). See INPUT_FILTER for further # info on how filters are used. If FILTER_PATTERNS is empty, INPUT_FILTER # is applied to all files. FILTER_PATTERNS = # If the FILTER_SOURCE_FILES tag is set to YES, the input filter (if set using # INPUT_FILTER) will be used to filter the input files when producing source # files to browse (i.e. when SOURCE_BROWSER is set to YES). FILTER_SOURCE_FILES = NO #--------------------------------------------------------------------------- # configuration options related to source browsing #--------------------------------------------------------------------------- # If the SOURCE_BROWSER tag is set to YES then a list of source files will # be generated. Documented entities will be cross-referenced with these sources. # Note: To get rid of all source code in the generated output, make sure also # VERBATIM_HEADERS is set to NO. SOURCE_BROWSER = NO # Setting the INLINE_SOURCES tag to YES will include the body # of functions and classes directly in the documentation. INLINE_SOURCES = NO # Setting the STRIP_CODE_COMMENTS tag to YES (the default) will instruct # doxygen to hide any special comment blocks from generated source code # fragments. Normal C and C++ comments will always remain visible. STRIP_CODE_COMMENTS = YES # If the REFERENCED_BY_RELATION tag is set to YES (the default) # then for each documented function all documented # functions referencing it will be listed. REFERENCED_BY_RELATION = YES # If the REFERENCES_RELATION tag is set to YES (the default) # then for each documented function all documented entities # called/used by that function will be listed. REFERENCES_RELATION = YES # If the REFERENCES_LINK_SOURCE tag is set to YES (the default) # and SOURCE_BROWSER tag is set to YES, then the hyperlinks from # functions in REFERENCES_RELATION and REFERENCED_BY_RELATION lists will # link to the source code. Otherwise they will link to the documentstion. REFERENCES_LINK_SOURCE = YES # If the USE_HTAGS tag is set to YES then the references to source code # will point to the HTML generated by the htags(1) tool instead of doxygen # built-in source browser. The htags tool is part of GNU's global source # tagging system (see http://www.gnu.org/software/global/global.html). You # will need version 4.8.6 or higher. USE_HTAGS = NO # If the VERBATIM_HEADERS tag is set to YES (the default) then Doxygen # will generate a verbatim copy of the header file for each class for # which an include is specified. Set to NO to disable this. VERBATIM_HEADERS = YES #--------------------------------------------------------------------------- # configuration options related to the alphabetical class index #--------------------------------------------------------------------------- # If the ALPHABETICAL_INDEX tag is set to YES, an alphabetical index # of all compounds will be generated. Enable this if the project # contains a lot of classes, structs, unions or interfaces. ALPHABETICAL_INDEX = NO # If the alphabetical index is enabled (see ALPHABETICAL_INDEX) then # the COLS_IN_ALPHA_INDEX tag can be used to specify the number of columns # in which this list will be split (can be a number in the range [1..20]) COLS_IN_ALPHA_INDEX = 5 # In case all classes in a project start with a common prefix, all # classes will be put under the same header in the alphabetical index. # The IGNORE_PREFIX tag can be used to specify one or more prefixes that # should be ignored while generating the index headers. IGNORE_PREFIX = #--------------------------------------------------------------------------- # configuration options related to the HTML output #--------------------------------------------------------------------------- # If the GENERATE_HTML tag is set to YES (the default) Doxygen will # generate HTML output. GENERATE_HTML = YES # The HTML_OUTPUT tag is used to specify where the HTML docs will be put. # If a relative path is entered the value of OUTPUT_DIRECTORY will be # put in front of it. If left blank `html' will be used as the default path. HTML_OUTPUT = html # The HTML_FILE_EXTENSION tag can be used to specify the file extension for # each generated HTML page (for example: .htm,.php,.asp). If it is left blank # doxygen will generate files with .html extension. HTML_FILE_EXTENSION = .html # The HTML_HEADER tag can be used to specify a personal HTML header for # each generated HTML page. If it is left blank doxygen will generate a # standard header. HTML_HEADER = # The HTML_FOOTER tag can be used to specify a personal HTML footer for # each generated HTML page. If it is left blank doxygen will generate a # standard footer. HTML_FOOTER = # The HTML_STYLESHEET tag can be used to specify a user-defined cascading # style sheet that is used by each HTML page. It can be used to # fine-tune the look of the HTML output. If the tag is left blank doxygen # will generate a default style sheet. Note that doxygen will try to copy # the style sheet file to the HTML output directory, so don't put your own # stylesheet in the HTML output directory as well, or it will be erased! HTML_STYLESHEET = # If the HTML_ALIGN_MEMBERS tag is set to YES, the members of classes, # files or namespaces will be aligned in HTML using tables. If set to # NO a bullet list will be used. HTML_ALIGN_MEMBERS = YES # If the GENERATE_HTMLHELP tag is set to YES, additional index files # will be generated that can be used as input for tools like the # Microsoft HTML help workshop to generate a compressed HTML help file (.chm) # of the generated HTML documentation. GENERATE_HTMLHELP = NO # If the GENERATE_HTMLHELP tag is set to YES, the CHM_FILE tag can # be used to specify the file name of the resulting .chm file. You # can add a path in front of the file if the result should not be # written to the html output directory. CHM_FILE = # If the GENERATE_HTMLHELP tag is set to YES, the HHC_LOCATION tag can # be used to specify the location (absolute path including file name) of # the HTML help compiler (hhc.exe). If non-empty doxygen will try to run # the HTML help compiler on the generated index.hhp. HHC_LOCATION = # If the GENERATE_HTMLHELP tag is set to YES, the GENERATE_CHI flag # controls if a separate .chi index file is generated (YES) or that # it should be included in the master .chm file (NO). GENERATE_CHI = NO # If the GENERATE_HTMLHELP tag is set to YES, the BINARY_TOC flag # controls whether a binary table of contents is generated (YES) or a # normal table of contents (NO) in the .chm file. BINARY_TOC = NO # The TOC_EXPAND flag can be set to YES to add extra items for group members # to the contents of the HTML help documentation and to the tree view. TOC_EXPAND = NO # The DISABLE_INDEX tag can be used to turn on/off the condensed index at # top of each HTML page. The value NO (the default) enables the index and # the value YES disables it. DISABLE_INDEX = NO # This tag can be used to set the number of enum values (range [1..20]) # that doxygen will group on one line in the generated HTML documentation. ENUM_VALUES_PER_LINE = 1 # If the GENERATE_TREEVIEW tag is set to YES, a side panel will be # generated containing a tree-like index structure (just like the one that # is generated for HTML Help). For this to work a browser that supports # JavaScript, DHTML, CSS and frames is required (for instance Mozilla 1.0+, # Netscape 6.0+, Internet explorer 5.0+, or Konqueror). Windows users are # probably better off using the HTML help feature. GENERATE_TREEVIEW = NO # If the treeview is enabled (see GENERATE_TREEVIEW) then this tag can be # used to set the initial width (in pixels) of the frame in which the tree # is shown. TREEVIEW_WIDTH = 250 #--------------------------------------------------------------------------- # configuration options related to the LaTeX output #--------------------------------------------------------------------------- # If the GENERATE_LATEX tag is set to YES (the default) Doxygen will # generate Latex output. GENERATE_LATEX = YES # The LATEX_OUTPUT tag is used to specify where the LaTeX docs will be put. # If a relative path is entered the value of OUTPUT_DIRECTORY will be # put in front of it. If left blank `latex' will be used as the default path. LATEX_OUTPUT = latex # The LATEX_CMD_NAME tag can be used to specify the LaTeX command name to be # invoked. If left blank `latex' will be used as the default command name. LATEX_CMD_NAME = latex # The MAKEINDEX_CMD_NAME tag can be used to specify the command name to # generate index for LaTeX. If left blank `makeindex' will be used as the # default command name. MAKEINDEX_CMD_NAME = makeindex # If the COMPACT_LATEX tag is set to YES Doxygen generates more compact # LaTeX documents. This may be useful for small projects and may help to # save some trees in general. COMPACT_LATEX = NO # The PAPER_TYPE tag can be used to set the paper type that is used # by the printer. Possible values are: a4, a4wide, letter, legal and # executive. If left blank a4wide will be used. PAPER_TYPE = a4wide # The EXTRA_PACKAGES tag can be to specify one or more names of LaTeX # packages that should be included in the LaTeX output. EXTRA_PACKAGES = # The LATEX_HEADER tag can be used to specify a personal LaTeX header for # the generated latex document. The header should contain everything until # the first chapter. If it is left blank doxygen will generate a # standard header. Notice: only use this tag if you know what you are doing! LATEX_HEADER = # If the PDF_HYPERLINKS tag is set to YES, the LaTeX that is generated # is prepared for conversion to pdf (using ps2pdf). The pdf file will # contain links (just like the HTML output) instead of page references # This makes the output suitable for online browsing using a pdf viewer. PDF_HYPERLINKS = NO # If the USE_PDFLATEX tag is set to YES, pdflatex will be used instead of # plain latex in the generated Makefile. Set this option to YES to get a # higher quality PDF documentation. USE_PDFLATEX = NO # If the LATEX_BATCHMODE tag is set to YES, doxygen will add the \\batchmode. # command to the generated LaTeX files. This will instruct LaTeX to keep # running if errors occur, instead of asking the user for help. # This option is also used when generating formulas in HTML. LATEX_BATCHMODE = NO # If LATEX_HIDE_INDICES is set to YES then doxygen will not # include the index chapters (such as File Index, Compound Index, etc.) # in the output. LATEX_HIDE_INDICES = NO #--------------------------------------------------------------------------- # configuration options related to the RTF output #--------------------------------------------------------------------------- # If the GENERATE_RTF tag is set to YES Doxygen will generate RTF output # The RTF output is optimized for Word 97 and may not look very pretty with # other RTF readers or editors. GENERATE_RTF = NO # The RTF_OUTPUT tag is used to specify where the RTF docs will be put. # If a relative path is entered the value of OUTPUT_DIRECTORY will be # put in front of it. If left blank `rtf' will be used as the default path. RTF_OUTPUT = rtf # If the COMPACT_RTF tag is set to YES Doxygen generates more compact # RTF documents. This may be useful for small projects and may help to # save some trees in general. COMPACT_RTF = NO # If the RTF_HYPERLINKS tag is set to YES, the RTF that is generated # will contain hyperlink fields. The RTF file will # contain links (just like the HTML output) instead of page references. # This makes the output suitable for online browsing using WORD or other # programs which support those fields. # Note: wordpad (write) and others do not support links. RTF_HYPERLINKS = NO # Load stylesheet definitions from file. Syntax is similar to doxygen's # config file, i.e. a series of assignments. You only have to provide # replacements, missing definitions are set to their default value. RTF_STYLESHEET_FILE = # Set optional variables used in the generation of an rtf document. # Syntax is similar to doxygen's config file. RTF_EXTENSIONS_FILE = #--------------------------------------------------------------------------- # configuration options related to the man page output #--------------------------------------------------------------------------- # If the GENERATE_MAN tag is set to YES (the default) Doxygen will # generate man pages GENERATE_MAN = NO # The MAN_OUTPUT tag is used to specify where the man pages will be put. # If a relative path is entered the value of OUTPUT_DIRECTORY will be # put in front of it. If left blank `man' will be used as the default path. MAN_OUTPUT = man # The MAN_EXTENSION tag determines the extension that is added to # the generated man pages (default is the subroutine's section .3) MAN_EXTENSION = .3 # If the MAN_LINKS tag is set to YES and Doxygen generates man output, # then it will generate one additional man file for each entity # documented in the real man page(s). These additional files # only source the real man page, but without them the man command # would be unable to find the correct page. The default is NO. MAN_LINKS = NO #--------------------------------------------------------------------------- # configuration options related to the XML output #--------------------------------------------------------------------------- # If the GENERATE_XML tag is set to YES Doxygen will # generate an XML file that captures the structure of # the code including all documentation. GENERATE_XML = NO # The XML_OUTPUT tag is used to specify where the XML pages will be put. # If a relative path is entered the value of OUTPUT_DIRECTORY will be # put in front of it. If left blank `xml' will be used as the default path. XML_OUTPUT = xml # The XML_SCHEMA tag can be used to specify an XML schema, # which can be used by a validating XML parser to check the # syntax of the XML files. XML_SCHEMA = # The XML_DTD tag can be used to specify an XML DTD, # which can be used by a validating XML parser to check the # syntax of the XML files. XML_DTD = # If the XML_PROGRAMLISTING tag is set to YES Doxygen will # dump the program listings (including syntax highlighting # and cross-referencing information) to the XML output. Note that # enabling this will significantly increase the size of the XML output. XML_PROGRAMLISTING = YES #--------------------------------------------------------------------------- # configuration options for the AutoGen Definitions output #--------------------------------------------------------------------------- # If the GENERATE_AUTOGEN_DEF tag is set to YES Doxygen will # generate an AutoGen Definitions (see autogen.sf.net) file # that captures the structure of the code including all # documentation. Note that this feature is still experimental # and incomplete at the moment. GENERATE_AUTOGEN_DEF = NO #--------------------------------------------------------------------------- # configuration options related to the Perl module output #--------------------------------------------------------------------------- # If the GENERATE_PERLMOD tag is set to YES Doxygen will # generate a Perl module file that captures the structure of # the code including all documentation. Note that this # feature is still experimental and incomplete at the # moment. GENERATE_PERLMOD = NO # If the PERLMOD_LATEX tag is set to YES Doxygen will generate # the necessary Makefile rules, Perl scripts and LaTeX code to be able # to generate PDF and DVI output from the Perl module output. PERLMOD_LATEX = NO # If the PERLMOD_PRETTY tag is set to YES the Perl module output will be # nicely formatted so it can be parsed by a human reader. This is useful # if you want to understand what is going on. On the other hand, if this # tag is set to NO the size of the Perl module output will be much smaller # and Perl will parse it just the same. PERLMOD_PRETTY = YES # The names of the make variables in the generated doxyrules.make file # are prefixed with the string contained in PERLMOD_MAKEVAR_PREFIX. # This is useful so different doxyrules.make files included by the same # Makefile don't overwrite each other's variables. PERLMOD_MAKEVAR_PREFIX = #--------------------------------------------------------------------------- # Configuration options related to the preprocessor #--------------------------------------------------------------------------- # If the ENABLE_PREPROCESSING tag is set to YES (the default) Doxygen will # evaluate all C-preprocessor directives found in the sources and include # files. ENABLE_PREPROCESSING = YES # If the MACRO_EXPANSION tag is set to YES Doxygen will expand all macro # names in the source code. If set to NO (the default) only conditional # compilation will be performed. Macro expansion can be done in a controlled # way by setting EXPAND_ONLY_PREDEF to YES. MACRO_EXPANSION = NO # If the EXPAND_ONLY_PREDEF and MACRO_EXPANSION tags are both set to YES # then the macro expansion is limited to the macros specified with the # PREDEFINED and EXPAND_AS_DEFINED tags. EXPAND_ONLY_PREDEF = NO # If the SEARCH_INCLUDES tag is set to YES (the default) the includes files # in the INCLUDE_PATH (see below) will be search if a #include is found. SEARCH_INCLUDES = YES # The INCLUDE_PATH tag can be used to specify one or more directories that # contain include files that are not input files but should be processed by # the preprocessor. INCLUDE_PATH = # You can use the INCLUDE_FILE_PATTERNS tag to specify one or more wildcard # patterns (like *.h and *.hpp) to filter out the header-files in the # directories. If left blank, the patterns specified with FILE_PATTERNS will # be used. INCLUDE_FILE_PATTERNS = # The PREDEFINED tag can be used to specify one or more macro names that # are defined before the preprocessor is started (similar to the -D option of # gcc). The argument of the tag is a list of macros of the form: name # or name=definition (no spaces). If the definition and the = are # omitted =1 is assumed. To prevent a macro definition from being # undefined via #undef or recursively expanded use the := operator # instead of the = operator. PREDEFINED = # If the MACRO_EXPANSION and EXPAND_ONLY_PREDEF tags are set to YES then # this tag can be used to specify a list of macro names that should be expanded. # The macro definition that is found in the sources will be used. # Use the PREDEFINED tag if you want to use a different macro definition. EXPAND_AS_DEFINED = # If the SKIP_FUNCTION_MACROS tag is set to YES (the default) then # doxygen's preprocessor will remove all function-like macros that are alone # on a line, have an all uppercase name, and do not end with a semicolon. Such # function macros are typically used for boiler-plate code, and will confuse # the parser if not removed. SKIP_FUNCTION_MACROS = YES #--------------------------------------------------------------------------- # Configuration::additions related to external references #--------------------------------------------------------------------------- # The TAGFILES option can be used to specify one or more tagfiles. # Optionally an initial location of the external documentation # can be added for each tagfile. The format of a tag file without # this location is as follows: # TAGFILES = file1 file2 ... # Adding location for the tag files is done as follows: # TAGFILES = file1=loc1 "file2 = loc2" ... # where "loc1" and "loc2" can be relative or absolute paths or # URLs. If a location is present for each tag, the installdox tool # does not have to be run to correct the links. # Note that each tag file must have a unique name # (where the name does NOT include the path) # If a tag file is not located in the directory in which doxygen # is run, you must also specify the path to the tagfile here. TAGFILES = # When a file name is specified after GENERATE_TAGFILE, doxygen will create # a tag file that is based on the input files it reads. GENERATE_TAGFILE = # If the ALLEXTERNALS tag is set to YES all external classes will be listed # in the class index. If set to NO only the inherited external classes # will be listed. ALLEXTERNALS = NO # If the EXTERNAL_GROUPS tag is set to YES all external groups will be listed # in the modules index. If set to NO, only the current project's groups will # be listed. EXTERNAL_GROUPS = YES # The PERL_PATH should be the absolute path and name of the perl script # interpreter (i.e. the result of `which perl'). PERL_PATH = /usr/bin/perl #--------------------------------------------------------------------------- # Configuration options related to the dot tool #--------------------------------------------------------------------------- # If the CLASS_DIAGRAMS tag is set to YES (the default) Doxygen will # generate a inheritance diagram (in HTML, RTF and LaTeX) for classes with base # or super classes. Setting the tag to NO turns the diagrams off. Note that # this option is superseded by the HAVE_DOT option below. This is only a # fallback. It is recommended to install and use dot, since it yields more # powerful graphs. CLASS_DIAGRAMS = YES # If set to YES, the inheritance and collaboration graphs will hide # inheritance and usage relations if the target is undocumented # or is not a class. HIDE_UNDOC_RELATIONS = YES # If you set the HAVE_DOT tag to YES then doxygen will assume the dot tool is # available from the path. This tool is part of Graphviz, a graph visualization # toolkit from AT&T and Lucent Bell Labs. The other options in this section # have no effect if this option is set to NO (the default) HAVE_DOT = NO # If the CLASS_GRAPH and HAVE_DOT tags are set to YES then doxygen # will generate a graph for each documented class showing the direct and # indirect inheritance relations. Setting this tag to YES will force the # the CLASS_DIAGRAMS tag to NO. CLASS_GRAPH = YES # If the COLLABORATION_GRAPH and HAVE_DOT tags are set to YES then doxygen # will generate a graph for each documented class showing the direct and # indirect implementation dependencies (inheritance, containment, and # class references variables) of the class with other documented classes. COLLABORATION_GRAPH = YES # If the GROUP_GRAPHS and HAVE_DOT tags are set to YES then doxygen # will generate a graph for groups, showing the direct groups dependencies GROUP_GRAPHS = YES # If the UML_LOOK tag is set to YES doxygen will generate inheritance and # collaboration diagrams in a style similar to the OMG's Unified Modeling # Language. UML_LOOK = NO # If set to YES, the inheritance and collaboration graphs will show the # relations between templates and their instances. TEMPLATE_RELATIONS = NO # If the ENABLE_PREPROCESSING, SEARCH_INCLUDES, INCLUDE_GRAPH, and HAVE_DOT # tags are set to YES then doxygen will generate a graph for each documented # file showing the direct and indirect include dependencies of the file with # other documented files. INCLUDE_GRAPH = YES # If the ENABLE_PREPROCESSING, SEARCH_INCLUDES, INCLUDED_BY_GRAPH, and # HAVE_DOT tags are set to YES then doxygen will generate a graph for each # documented header file showing the documented files that directly or # indirectly include this file. INCLUDED_BY_GRAPH = YES # If the CALL_GRAPH and HAVE_DOT tags are set to YES then doxygen will # generate a call dependency graph for every global function or class method. # Note that enabling this option will significantly increase the time of a run. # So in most cases it will be better to enable call graphs for selected # functions only using the \callgraph command. CALL_GRAPH = NO # If the CALLER_GRAPH and HAVE_DOT tags are set to YES then doxygen will # generate a caller dependency graph for every global function or class method. # Note that enabling this option will significantly increase the time of a run. # So in most cases it will be better to enable caller graphs for selected # functions only using the \callergraph command. CALLER_GRAPH = NO # If the GRAPHICAL_HIERARCHY and HAVE_DOT tags are set to YES then doxygen # will graphical hierarchy of all classes instead of a textual one. GRAPHICAL_HIERARCHY = YES # If the DIRECTORY_GRAPH, SHOW_DIRECTORIES and HAVE_DOT tags are set to YES # then doxygen will show the dependencies a directory has on other directories # in a graphical way. The dependency relations are determined by the #include # relations between the files in the directories. DIRECTORY_GRAPH = YES # The DOT_IMAGE_FORMAT tag can be used to set the image format of the images # generated by dot. Possible values are png, jpg, or gif # If left blank png will be used. DOT_IMAGE_FORMAT = png # The tag DOT_PATH can be used to specify the path where the dot tool can be # found. If left blank, it is assumed the dot tool can be found in the path. DOT_PATH = # The DOTFILE_DIRS tag can be used to specify one or more directories that # contain dot files that are included in the documentation (see the # \dotfile command). DOTFILE_DIRS = # The MAX_DOT_GRAPH_WIDTH tag can be used to set the maximum allowed width # (in pixels) of the graphs generated by dot. If a graph becomes larger than # this value, doxygen will try to truncate the graph, so that it fits within # the specified constraint. Beware that most browsers cannot cope with very # large images. MAX_DOT_GRAPH_WIDTH = 1024 # The MAX_DOT_GRAPH_HEIGHT tag can be used to set the maximum allows height # (in pixels) of the graphs generated by dot. If a graph becomes larger than # this value, doxygen will try to truncate the graph, so that it fits within # the specified constraint. Beware that most browsers cannot cope with very # large images. MAX_DOT_GRAPH_HEIGHT = 1024 # The MAX_DOT_GRAPH_DEPTH tag can be used to set the maximum depth of the # graphs generated by dot. A depth value of 3 means that only nodes reachable # from the root by following a path via at most 3 edges will be shown. Nodes # that lay further from the root node will be omitted. Note that setting this # option to 1 or 2 may greatly reduce the computation time needed for large # code bases. Also note that a graph may be further truncated if the graph's # image dimensions are not sufficient to fit the graph (see MAX_DOT_GRAPH_WIDTH # and MAX_DOT_GRAPH_HEIGHT). If 0 is used for the depth value (the default), # the graph is not depth-constrained. MAX_DOT_GRAPH_DEPTH = 0 # Set the DOT_TRANSPARENT tag to YES to generate images with a transparent # background. This is disabled by default, which results in a white background. # Warning: Depending on the platform used, enabling this option may lead to # badly anti-aliased labels on the edges of a graph (i.e. they become hard to # read). DOT_TRANSPARENT = NO # Set the DOT_MULTI_TARGETS tag to YES allow dot to generate multiple output # files in one run (i.e. multiple -o and -T options on the command line). This # makes dot run faster, but since only newer versions of dot (>1.8.10) # support this, this feature is disabled by default. DOT_MULTI_TARGETS = NO # If the GENERATE_LEGEND tag is set to YES (the default) Doxygen will # generate a legend page explaining the meaning of the various boxes and # arrows in the dot generated graphs. GENERATE_LEGEND = YES # If the DOT_CLEANUP tag is set to YES (the default) Doxygen will # remove the intermediate dot files that are used to generate # the various graphs. DOT_CLEANUP = YES #--------------------------------------------------------------------------- # Configuration::additions related to the search engine #--------------------------------------------------------------------------- # The SEARCHENGINE tag specifies whether or not a search engine should be # used. If set to NO the values of all tags below this one will be ignored. SEARCHENGINE = NO tinyvisor/vmm/io/0000755006644000001440000000000012206363325014274 5ustar yuichi_xyuserstinyvisor/vmm/io/pci_core.c0000644006644000001440000003512212167264643016237 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /** * @file drivers/pci.c * @brief PCI driver (core) * @author T. Shinagawa */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #include #include #include #include #include #include #include #include "pci_internal.h" static spinlock_t pci_config_lock = SPINLOCK_INITIALIZER; drvdata_hdl_t pci_handle; struct resource mmio_resource; struct resource io_resource; LIST2_DEFINE_HEAD(struct pci_device, pci_device_on_root_bus); LIST_DEFINE_HEAD(pci_device_list); LIST_DEFINE_HEAD(pci_driver_list); LIST_DEFINE_HEAD(pci_mmconfig_list); static pci_config_address_t pci_make_config_address(u8 bus, u8 devfn, int reg) { pci_config_address_t addr; addr.allow = 1; addr.reserved = 0; addr.bus_no = bus; addr.devfn = devfn; addr.reg_no = reg; addr.type = 0; return addr; } /******************************************************************************** * PCI internal interfaces ********************************************************************************/ void pci_init_root_resources(void) { rm_init_resource(&mmio_resource, 0, 0xffffffffffffffffLL, RESOURCE_TYPE_MMIO, 0, "mmio_resource"); rm_init_resource(&io_resource, 0, 0x0000ffff, RESOURCE_TYPE_IO, 0, "io_resource"); } void pci_dump_resources(void) { rm_dump_resources(&mmio_resource); rm_dump_resources(&io_resource); } static void pci_insert_recouces(struct pci_device *dev) { struct pci_device *parent; struct resource *resource, *presource; vmmerr_t err; int i, j; parent = dev->parent; for (i = 0; i < PCI_RESOURCE_NUM; i++) { resource = dev->resource + i; if (resource->type == RESOURCE_TYPE_INVALID) { continue; } if (parent == NULL) { switch (resource->type) { case RESOURCE_TYPE_MMIO: rm_insert_resource(&mmio_resource, resource); break; case RESOURCE_TYPE_IO: rm_insert_resource(&io_resource, resource); break; } } else { for (j = 0; j < PCI_RESOURCE_NUM; j++) { presource = parent->resource + j; if ((presource->data & PCI_RESOURCE_WINDOW) == 0) { continue; } if (resource->type != presource->type) { continue; } if ((presource->data & PCI_RESOURCE_PREFETCHABLE) && (resource->data & PCI_RESOURCE_PREFETCHABLE) == 0) { continue; } err = rm_insert_resource(presource, resource); if (err == VMMERR_SUCCESS) { break; } } } if (resource->parent == NULL) { printf("Fail to insert resource. %s" " %016llx-%016llx type %x data %x\n", dev->name, resource->start, resource->end, resource->type, resource->data); } } } vmmerr_t pci_alloc_resource(struct pci_device *dev, struct resource *resource, size_t size, phys_t align, u32 type, u32 data) { struct pci_device *parent; struct resource *presource; vmmerr_t err; int j; parent = dev->parent; if (parent == NULL) { return VMMERR_NODEV; } for (j = 0; j < PCI_RESOURCE_NUM; j++) { presource = parent->resource + j; if ((presource->data & PCI_RESOURCE_WINDOW) == 0) { continue; } if (presource->type != type) { continue; } if ((presource->data & PCI_RESOURCE_PREFETCHABLE) && (data & PCI_RESOURCE_PREFETCHABLE) == 0) { continue; } err = rm_alloc_resource(presource, resource, size, align, type, data, dev->name); if (err == VMMERR_SUCCESS) { break; } } if (resource->parent == NULL) { return VMMERR_BUSY; } return VMMERR_SUCCESS; } void pci_register_device(struct pci_device *parent, struct pci_device *dev) { #ifdef PRINT_PCI_DEVICE printf("%s %04x:%04x %06x %02x\n", dev->name, dev->vendor_id, dev->device_id, dev->class_code, dev->header_type); #endif LIST_APPEND(pci_device_list, dev); if (parent) { dev->parent = parent; LIST2_ADD(parent->children, sibling, dev); } else { dev->parent = NULL; LIST2_ADD(pci_device_on_root_bus, sibling, dev); } pci_insert_recouces(dev); } struct pci_device * pci_next_device_on_root_bus(struct pci_device *cur) { return LIST2_NEXT(pci_device_on_root_bus, sibling, cur); } int pci_config_addr_handler(iotype_t type, ioport_t port, void *data) { struct pci_vm_data *pci_data; pci_data = (struct pci_vm_data *)vm_get_driver_data(pci_handle); switch(type) { case IOTYPE_OUTL: pci_data->config_addr.value = *(u32 *)data; break; case IOTYPE_INL: *(u32 *)data = pci_data->config_addr.value; break; default: break; } return 1; /* no pass */ } int pci_config_data_handler(iotype_t type, ioport_t port, void *data) { struct pci_vm_data *pci_data; bool wr; ioport_t size; int ret; pci_data = (struct pci_vm_data *)vm_get_driver_data(pci_handle); if (!pci_data->config_addr.allow) { return 1; /* no pass */ } ret = pci_check_assignment(pci_data->config_addr.bus_no, pci_data->config_addr.devfn); switch (ret) { case PCI_NOT_ASSIGNED: /* nothing to do */ break; case PCI_ASSIGNED: spinlock_lock(&pci_config_lock); out32(PCI_CONFIG_ADDR_PORT, pci_data->config_addr.value); do_io_pass(type, port, data); spinlock_unlock(&pci_config_lock); break; case PCI_DUMMY_FUNC0: iotype_to_size_wr(type, &size, &wr); return pci_dummy_func0((pci_data->config_addr.reg_no << 2) + (port & 0x3), size, wr, data); } return 1; /* no pass */ } /******************************************************************************** * PCI service functions exported to PCI device drivers ********************************************************************************/ /* ------------------------------------------------------------------------------ PCI driver registration ------------------------------------------------------------------------------ */ /** * @brief PCI driver registration function * @param driver pointer to struct pci_driver */ void pci_register_driver(struct pci_driver *driver) { struct pci_device *dev; LIST_APPEND(pci_driver_list, driver); LIST_FOREACH (pci_device_list, dev) { u32 id = dev->id; u32 class = dev->class_code; if (idmask_match(id, driver->id) && idmask_match(class, driver->class)) { dev->driver = driver; driver->new(dev); } } return; } /* ------------------------------------------------------------------------------ PCI configuration registers access ------------------------------------------------------------------------------ */ #define DEFINE_pci_read_config_data_without_lock(size) \ static inline u##size pci_read_config_data##size##_without_lock(pci_config_address_t addr, int offset) \ { \ u##size data; \ out32(PCI_CONFIG_ADDR_PORT, addr.value); \ in##size(PCI_CONFIG_DATA_PORT + offset, &data); \ return data; \ } #define DEFINE_pci_write_config_data_without_lock(size) \ static inline void pci_write_config_data##size##_without_lock(pci_config_address_t addr, int offset, u##size data) \ { \ out32(PCI_CONFIG_ADDR_PORT, addr.value); \ out##size(PCI_CONFIG_DATA_PORT + offset, data); \ } DEFINE_pci_read_config_data_without_lock(8) DEFINE_pci_read_config_data_without_lock(16) DEFINE_pci_read_config_data_without_lock(32) DEFINE_pci_write_config_data_without_lock(8) DEFINE_pci_write_config_data_without_lock(16) DEFINE_pci_write_config_data_without_lock(32) #define MMCONFIG_OFFSET(start_bus_no, bus_no, devfn, offset) \ ((bus_no - start_bus_no) * 32 * 8 * 4096 + devfn * 4096 + offset) \ #define DEFINE_pci_read_mmconfig(size) \ u##size pci_read_mmconfig_##size(u16 seg, u8 bus, u8 devfn, \ pci_off_t offset) \ { \ struct pci_mmconfig *mmconfig; \ LIST_FOREACH(pci_mmconfig_list, mmconfig) { \ if (mmconfig->seg != seg || \ mmconfig->start_bus_no > bus || \ mmconfig->end_bus_no < bus) { \ continue; \ } \ return *(vu##size*)((ulong)mmconfig->virt_base + \ MMCONFIG_OFFSET(mmconfig->start_bus_no, \ bus, devfn, offset)); \ } \ printf("Out of range of MMCONFIG: %04x:%02x:%02x.%01x %x\n", \ seg, bus, PCI_DEV_NO(devfn), PCI_FUNC_NO(devfn), \ offset); \ return (u##size)((i##size)-1); \ } #define DEFINE_pci_write_mmconfig(size) \ void pci_write_mmconfig_##size(u16 seg, u8 bus, u8 devfn, \ pci_off_t offset, u##size data) \ { \ struct pci_mmconfig *mmconfig; \ LIST_FOREACH(pci_mmconfig_list, mmconfig) { \ if (mmconfig->seg != seg || \ mmconfig->start_bus_no > bus || \ mmconfig->end_bus_no < bus) { \ continue; \ } \ *(vu##size*)((ulong)mmconfig->virt_base + \ MMCONFIG_OFFSET(mmconfig->start_bus_no, \ bus, devfn, offset)) = data; \ return; \ } \ printf("Out of range of MMCONFIG: %04x:%02x:%02x.%01x %x\n", \ seg, bus, PCI_DEV_NO(devfn), PCI_FUNC_NO(devfn), \ offset); \ } DEFINE_pci_read_mmconfig(8) DEFINE_pci_read_mmconfig(16) DEFINE_pci_read_mmconfig(32) DEFINE_pci_read_mmconfig(64) DEFINE_pci_write_mmconfig(8) DEFINE_pci_write_mmconfig(16) DEFINE_pci_write_mmconfig(32) DEFINE_pci_write_mmconfig(64) #define DEFINE_pci_read_legacy_config(size) \ u##size pci_read_legacy_config_##size(u8 bus, u8 devfn, \ pci_off_t offset) \ { \ u##size data; \ pci_config_address_t addr; \ if (offset > 0xff) \ return (u##size)((i##size)-1); \ addr = pci_make_config_address(bus, devfn, offset >> 2); \ offset &= 0x03; \ ASSERT(offset + size / 8 <= 4); \ spinlock_lock(&pci_config_lock); \ data = pci_read_config_data##size##_without_lock(addr, \ offset); \ spinlock_unlock(&pci_config_lock); \ return data; \ } #define DEFINE_pci_write_legacy_config(size) \ void pci_write_legacy_config_##size(u8 bus, u8 devfn, \ pci_off_t offset, \ u##size data) \ { \ pci_config_address_t addr; \ if (offset > 0xff) \ return; \ addr = pci_make_config_address(bus, devfn, offset >> 2); \ offset &= 0x03; \ ASSERT(offset + size / 8 <= 4); \ spinlock_lock(&pci_config_lock); \ pci_write_config_data##size##_without_lock(addr, offset,\ data); \ spinlock_unlock(&pci_config_lock); \ } DEFINE_pci_read_legacy_config(8) DEFINE_pci_read_legacy_config(16) DEFINE_pci_read_legacy_config(32) DEFINE_pci_write_legacy_config(8) DEFINE_pci_write_legacy_config(16) DEFINE_pci_write_legacy_config(32) #define DEFINE_pci_read_config(size) \ u##size pci_read_config_##size(/* u16 seg, */ u8 bus, u8 devfn, \ pci_off_t offset) \ { \ u16 seg = 0; \ if (LIST_HEAD(pci_mmconfig_list)) { \ return pci_read_mmconfig_##size(seg, bus, devfn,\ offset); \ } else { \ ASSERT(seg == 0); \ return pci_read_legacy_config_##size(bus, \ devfn, \ offset); \ } \ } #define DEFINE_pci_write_config(size) \ void pci_write_config_##size(/* u16 seg, */ u8 bus, u8 devfn, \ pci_off_t offset, u##size data) \ { \ u16 seg = 0; \ if (LIST_HEAD(pci_mmconfig_list)) { \ pci_write_mmconfig_##size(seg, bus, devfn, \ offset, data); \ } else { \ ASSERT(seg == 0); \ pci_write_legacy_config_##size(bus, devfn, \ offset, data); \ } \ } DEFINE_pci_read_config(8) DEFINE_pci_read_config(16) DEFINE_pci_read_config(32) DEFINE_pci_write_config(8) DEFINE_pci_write_config(16) DEFINE_pci_write_config(32) u64 pci_read_config_64(/* u16 seg, */ u8 bus, u8 devfn, pci_off_t offset) { u16 seg = 0; if (LIST_HEAD(pci_mmconfig_list)) { return pci_read_mmconfig_64(seg, bus, devfn, offset); } ASSERT(seg == 0); return (((u64)pci_read_config_32(bus, devfn, offset + 4) << 32) | pci_read_config_32(bus, devfn, offset)); } void pci_write_config_64(/* u16 seg, */ u8 bus, u8 devfn, pci_off_t offset, u64 data) { u16 seg = 0; if (LIST_HEAD(pci_mmconfig_list)) { pci_write_mmconfig_64(seg, bus, devfn, offset, data); } ASSERT(seg == 0); pci_write_config_32(bus, devfn, offset + 4, data >> 32); pci_write_config_32(bus, devfn, offset, data); } u8 pci_read_config8(struct pci_device *dev, pci_off_t offset) { return pci_read_config_8(dev->bus_no, dev->devfn, offset); } u16 pci_read_config16(struct pci_device *dev, pci_off_t offset) { return pci_read_config_16(dev->bus_no, dev->devfn, offset); } u32 pci_read_config32(struct pci_device *dev, pci_off_t offset) { return pci_read_config_32(dev->bus_no, dev->devfn, offset); } u64 pci_read_config64(struct pci_device *dev, pci_off_t offset) { return pci_read_config_64(dev->bus_no, dev->devfn, offset); } void pci_write_config8(struct pci_device *dev, pci_off_t offset, u8 data) { pci_write_config_8(dev->bus_no, dev->devfn, offset, data); } void pci_write_config16(struct pci_device *dev, pci_off_t offset, u16 data) { pci_write_config_16(dev->bus_no, dev->devfn, offset, data); } void pci_write_config32(struct pci_device *dev, pci_off_t offset, u32 data) { pci_write_config_32(dev->bus_no, dev->devfn, offset, data); } void pci_write_config64(struct pci_device *dev, pci_off_t offset, u64 data) { pci_write_config_64(dev->bus_no, dev->devfn, offset, data); } size_t pci_config_size(void) { return LIST_HEAD(pci_mmconfig_list) ? PCI_MMCONFIG_SIZE : PCI_LEGACY_CONFIG_SIZE; } tinyvisor/vmm/io/pic_emu.c0000644006644000001440000002532011773614246016074 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * 8259A programable interrupt controller emulator. * Supports two EOI modes. * Non-specific EOI * Specific EOI * Auto EOI */ #include #include #include #include #include #include #include #include #include #include #include #include #include "pit_emu.h" #define PIC_MASTER 0 #define PIC_SLAVE 1 #define PIC_CHIP_NUM 2 #define PIC_IRQ_NUM 8 #define PIC_CASCADE_IRQ 2 #define PICEMU_BOOT_INT_TIMER_INTERVAL 10000 /* 10ms */ /* #define PICEMU_DEBUG */ #ifdef PICEMU_DEBUG #define PICEMU_DBG(...) \ do { \ printf(__VA_ARGS__); \ } while (0) #else #define PICEMU_DBG(...) #endif #define PIC_CHIP_NO(irq) ((irq) / PIC_IRQ_NUM) #define PIC_IR_BIT(irq) (1 << ((irq) % PIC_IRQ_NUM)) typedef enum pic_state { PIC_NOT_INITIALIZED = 0, PIC_ICW1_ACCEPTED, PIC_ICW2_ACCEPTED, PIC_ICW3_ACCEPTED, PIC_OPERATING } pic_state_t; struct pic_chip { pic_state_t state; vector_t vector_base; u8 icw4; u8 ocw3; u8 imr; u8 irr; u8 isr; u8 no; }; struct pic_emu { spinlock_t lock; void *timer_handle; bool disable_int_emu; struct pic_chip pic_chip[PIC_CHIP_NUM]; }; static drvdata_hdl_t pic_handle; /* * BIT scan forward. * Find the least significant set bit. */ static inline u8 asm_bsf_u8 (u8 val) { u32 val32 = val; u32 bit; asm volatile ("bsfl %1,%0\n" : "=r" (bit) : "r" (val32)); return bit; } static vmmerr_t picemu_irq2vector(struct pic_emu *pic, irq_t irq, vector_t *vector) { int chip_no; chip_no = PIC_CHIP_NO(irq); if (chip_no >= PIC_CHIP_NUM) { return VMMERR_RANGE; } *vector = pic->pic_chip[chip_no].vector_base + (irq - chip_no * PIC_IRQ_NUM); return VMMERR_SUCCESS; } vmmerr_t picemu_get_vector(irq_t irq, vector_t *vector) { struct pic_emu *pic; vmmerr_t ret; pic = vm_get_driver_data(pic_handle); spinlock_lock(&pic->lock); ret = picemu_irq2vector(pic, irq, vector); spinlock_unlock(&pic->lock); return ret; } static void picemu_next_int(struct pic_emu *pic) { vector_t vector; struct pic_chip *chip; u8 ir_bit; u8 masked_irr; irq_t irq; irq_t slave_irq = INVALID_IRQ; irq_t is_irq; chip = pic->pic_chip + PIC_SLAVE; masked_irr = chip->irr & (~chip->imr); if (masked_irr == 0) { goto master; } irq = asm_bsf_u8(masked_irr); if (chip->isr) { is_irq = asm_bsf_u8(chip->isr); if (irq >= is_irq) { goto master; } } ir_bit = 1 << irq; chip->irr &= ~ir_bit; if ((chip->icw4 & PIC_ICW4_AUTO_EOI) == 0) { chip->isr |= ir_bit; } slave_irq = irq + PIC_IRQ_NUM; master: chip = pic->pic_chip + PIC_MASTER; masked_irr = chip->irr & (~chip->imr); if (masked_irr == 0) { return; } irq = asm_bsf_u8(masked_irr); if (chip->isr) { is_irq = asm_bsf_u8(chip->isr); if (irq >= is_irq) { return; } } ir_bit = 1 << irq; chip->irr &= ~ir_bit; if ((chip->icw4 & PIC_ICW4_AUTO_EOI) == 0) { chip->isr |= ir_bit; } if (irq == PIC_CASCADE_IRQ) { irq = slave_irq; } if (picemu_irq2vector(pic, irq, &vector) == VMMERR_SUCCESS) { extint_pend_8259a_int(vector); } } static void picemu_do_trigger_int(struct pic_emu *pic, irq_t irq) { struct pic_chip *chip; int chip_no; chip_no = PIC_CHIP_NO(irq); if (chip_no >= PIC_CHIP_NUM) { printf("picemu_do_trigger_int: " "Out of range of irq. irq %d\n", irq); return; } chip = pic->pic_chip + chip_no; if (chip->state == PIC_NOT_INITIALIZED) { return; } chip->irr |= PIC_IR_BIT(irq); picemu_next_int(pic); } void picemu_trigger_int(irq_t irq) { struct pic_emu *pic; PICEMU_DBG("PIC: Trigger %d\n", irq); pic = vm_get_driver_data(pic_handle); spinlock_lock(&pic->lock); picemu_do_trigger_int(pic, irq); spinlock_unlock(&pic->lock); } void picemu_trigger_boot_int(irq_t irq) { struct pic_emu *pic; pic = vm_get_driver_data(pic_handle); spinlock_lock(&pic->lock); if (pic->disable_int_emu) { spinlock_unlock(&pic->lock); return; } picemu_do_trigger_int(pic, irq); spinlock_unlock(&pic->lock); } static u8 picemu_cmd_read(struct pic_chip *pic_chip) { /* * Return ISR value or IRR value. * Currently ,return 0 regardless of selecting ISR or IRR by OCW3. */ PICEMU_DBG("PIC%d Read ISR/IRR\n", pic_chip->no); if ((pic_chip->ocw3 & PIC_OCW3_READ_REG_MASK) == PIC_OCW3_READ_IRR) { return pic_chip->irr; } else if ((pic_chip->ocw3 & PIC_OCW3_READ_REG_MASK) == PIC_OCW3_READ_ISR) { return pic_chip->isr; } return 0; } static void picemu_cmd_write(struct pic_emu *pic, struct pic_chip *pic_chip, u8 data) { irq_t irq; if ((data & PIC_ICW1_SELECT_MASK) == PIC_ICW1_SELECT_MATCH) { /* ICW1 */ pic->disable_int_emu = true; pic_chip->imr = 0; pic_chip->icw4 = 0; pic_chip->ocw3 = 0; pic_chip->irr = 0; pic_chip->isr = 0; pic_chip->state = PIC_ICW1_ACCEPTED; extint_reset_8259a(); PICEMU_DBG("PIC%d ICW1\n", pic_chip->no); } else if ((data & PIC_NON_SPECIFIC_EOI_MASK) == PIC_NON_SPECIFIC_EOI_MATCH) { if (pic_chip->isr) { irq = asm_bsf_u8(pic_chip->isr); pic_chip->isr &= ~(1 << irq); } PICEMU_DBG("PIC%d Non-Specific EOI\n", pic_chip->no); picemu_next_int(pic); } else if ((data & PIC_SPECIFIC_EOI_MASK) == PIC_SPECIFIC_EOI_MATCH) { irq = data & PIC_EOI_IRQ_MASK; pic_chip->isr &= ~(1 << irq); PICEMU_DBG("PIC%d Specific-EOI\n", pic_chip->no); picemu_next_int(pic); } else if ((data & PIC_OCW3_SELECT_MASK) == PIC_OCW3_SELECT_MATCH) { pic_chip->ocw3 = data; PICEMU_DBG("PIC%d OCW3\n", pic_chip->no); #ifdef PICEMU_DEBUG } else { PICEMU_DBG("PIC%d Unknown command 0x%x\n", pic_chip->no, data); #endif } } static int picemu_cmd(iotype_t type, ioport_t port, void *data) { struct pic_emu *pic; struct pic_chip *pic_chip; pic = vm_get_driver_data(pic_handle); spinlock_lock(&pic->lock); if (port == PIC_MASTER_CMD_PORT) { pic_chip = &pic->pic_chip[PIC_MASTER]; } else { pic_chip = &pic->pic_chip[PIC_SLAVE]; } switch (type) { case IOTYPE_OUTB: picemu_cmd_write(pic, pic_chip, *(u8 *)data); break; case IOTYPE_INB: *(u8 *)data = picemu_cmd_read(pic_chip); break; default: break; } spinlock_unlock(&pic->lock); return 1; /* emulated */ } static void picemu_boot_int_timer(void *handle, void *data) { struct pic_emu *pic = (struct pic_emu *)data; spinlock_lock(&pic->lock); if (pic->disable_int_emu) { spinlock_unlock(&pic->lock); return; } spinlock_unlock(&pic->lock); /* * Emulate system timer interrupts. */ pit_update_counter0(); spinlock_lock(&pic->lock); timer_set(handle, PICEMU_BOOT_INT_TIMER_INTERVAL); spinlock_unlock(&pic->lock); } static void picemu_imr_write(struct pic_emu *pic, struct pic_chip *pic_chip, u8 data, void *timer_handle) { switch (pic_chip->state) { case PIC_ICW1_ACCEPTED: /* ICW2 */ pic_chip->state = PIC_ICW2_ACCEPTED; pic_chip->vector_base = (data & PIC_ICW2_VECTOR_MASK); PICEMU_DBG("PIC%d ICW2 vector_base 0x%x\n", pic_chip->no, pic_chip->vector_base); break; case PIC_ICW2_ACCEPTED: /* ICW3 */ pic_chip->state = PIC_ICW3_ACCEPTED; PICEMU_DBG("PIC%d ICW3\n", pic_chip->no); break; case PIC_ICW3_ACCEPTED: /* ICW4 */ pic_chip->state = PIC_OPERATING; pic_chip->icw4 = data; PICEMU_DBG("PIC%d ICW4 %s\n", pic_chip->no, (data & PIC_ICW4_AUTO_EOI ? "Auto EOI": "Non-Auto EOI")); break; default: /* OCW1 */ pic_chip->imr = data; PICEMU_DBG("PIC%d OCW1 IMR 0x%x\n", pic_chip->no, pic_chip->imr); picemu_next_int(pic); if ((pic_chip->no == PIC_CHIP_NO(0) && (pic_chip->imr & PIC_IR_BIT(0)) == 0)) { /* * Assigned devices's interrupt or timer * interrupt is enabled. */ timer_set(timer_handle, PICEMU_BOOT_INT_TIMER_INTERVAL); pic->disable_int_emu = false; } else { pic->disable_int_emu = true; } break; } } static u8 picemu_imr_read(struct pic_chip *pic_chip) { PICEMU_DBG("PIC%d Read IMR 0x%x\n", pic_chip->no, pic_chip->imr); return pic_chip->imr; } static int picemu_imr(iotype_t type, ioport_t port, void *data) { struct pic_emu *pic; struct pic_chip *pic_chip; pic = vm_get_driver_data(pic_handle); spinlock_lock(&pic->lock); if (port == PIC_MASTER_IMR_PORT) { pic_chip = &pic->pic_chip[PIC_MASTER]; } else { pic_chip = &pic->pic_chip[PIC_SLAVE]; } switch (type) { case IOTYPE_OUTB: picemu_imr_write(pic, pic_chip, *(u8 *)data, pic->timer_handle); break; case IOTYPE_INB: *(u8 *)data = picemu_imr_read(pic_chip); break; default: break; } spinlock_unlock(&pic->lock); return 1; /* emulated */ } static void picemu_setup (void) { struct pic_emu *pic; int i; pic = vm_get_driver_data(pic_handle); spinlock_init(&pic->lock); for (i = 0; i < PIC_CHIP_NUM; i++) { pic->pic_chip[i].no = i; } pic->timer_handle = timer_new(picemu_boot_int_timer, pic); pic->disable_int_emu = true; if (cpu_is_bsp()) { /* * vm0 is allowed to access pic directory. * See core/pic.c. */ return; } set_iofunc(PIC_MASTER_CMD_PORT, picemu_cmd); set_iofunc(PIC_SLAVE_CMD_PORT, picemu_cmd); set_iofunc(PIC_MASTER_IMR_PORT, picemu_imr); set_iofunc(PIC_SLAVE_IMR_PORT, picemu_imr); } static void picemu_init(void) { pic_handle = vm_alloc_driver_data(sizeof(struct pic_emu)); } DRIVER_PASSVM(picemu_setup); DRIVER_INIT(picemu_init); tinyvisor/vmm/io/pci_assign.c0000644006644000001440000003143612167264643016577 0ustar yuichi_xyusers/* * Copyright (c) 2010-2013 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "pci_internal.h" #define PCI_DUMMY_FUNC0_VENDOR_ID 0x0001 #define PCI_DUMMY_FUNC0_DEVICE_ID 0x0001 /* #define NO_CLEAR_IOBITMAP */ static void pci_save_config(struct pci_device *dev) { int i; for (i = 0; i < pci_config_size(); i += sizeof(u32)) { dev->saved_config[i / sizeof(u32)] = pci_read_config32(dev, i); } } static void pci_save_configs(struct pci_device *dev) { struct pci_device *child; pci_save_config(dev); LIST2_FOREACH(dev->children, sibling, child) { pci_save_configs(child); } } static void pci_setup_assigned_device(struct pci_device *dev) { struct pci_device *child; struct resource *resource; u32 reg_val, mask; size_t size; vmmerr_t err; /* * Disable IRQ for assigned devices. */ pci_write_config8(dev, PCI_CONFIG_INTERRUPT_LINE, PCI_ASSIGNED_DEVICE_IRQ); /* * Disable INTx interrupt. */ reg_val = pci_read_config16(dev, PCI_CONFIG_COMMAND); reg_val |= PCI_CONFIG_COMMAND_INTERRUPT_DISABLE; pci_write_config16(dev, PCI_CONFIG_COMMAND, reg_val); /* * Assign a memory region to ROM. */ resource = dev->resource + PCI_RESOURCE_EXPANTION_ROM_INDEX; mask = pci_get_base_address_mask(dev, PCI_CONFIG_EXPANSION_ROM); if (mask != 0x00000000 && mask != 0xFFFFFFFF) { size = ~(mask & PCI_CONFIG_ROM_MEMMASK) + 1; err = pci_alloc_resource(dev, resource, size, size, RESOURCE_TYPE_MMIO, PCI_RESOURCE_PREFETCHABLE); if (err == VMMERR_SUCCESS) { reg_val = resource->start & PCI_CONFIG_ROM_MEMMASK; pci_write_config32(dev, PCI_CONFIG_EXPANSION_ROM, reg_val); } else { printf("Failed to allocate a memory region for ROM. " "pci %s size 0x%llx err 0x%x\n", dev->name, size, err); } } LIST2_FOREACH(dev->children, sibling, child) { pci_setup_assigned_device(child); } } static void pci_insert_vmresources(struct pci_device *dev) { struct pci_device *parent; struct resource *resource, *presource; vmmerr_t err; int i, j; parent = dev->parent; for (i = 0; i < PCI_RESOURCE_NUM; i++) { resource = dev->vmresource + i; if (resource->type == RESOURCE_TYPE_INVALID) { continue; } if (parent == NULL) { switch (resource->type) { case RESOURCE_TYPE_MMIO: rm_insert_resource(vmrm_mmio_resource(), resource); break; case RESOURCE_TYPE_IO: rm_insert_resource(vmrm_io_resource(), resource); break; } } else { for (j = 0; j < PCI_RESOURCE_NUM; j++) { presource = parent->vmresource + j; if ((presource->data & PCI_RESOURCE_WINDOW) == 0) { continue; } if (resource->type != presource->type) { continue; } if ((presource->data & PCI_RESOURCE_PREFETCHABLE) && (resource->data & PCI_RESOURCE_PREFETCHABLE) == 0) { continue; } err = rm_insert_resource(presource, resource); if (err == VMMERR_SUCCESS) { break; } } } if (resource->parent == NULL) { printf("Fail to insert resource. %s" " %016llx-%016llx type %x data %x\n", dev->name, resource->start, resource->end, resource->type, resource->data); } } } static void pci_setup_vmresource(struct pci_device *dev) { struct pci_device *child; struct resource *resource; int i; for (i = 0; i < PCI_RESOURCE_NUM; i++) { resource = dev->resource + i; if (resource->type == RESOURCE_TYPE_INVALID) { continue; } rm_init_resource(dev->vmresource + i, resource->start, resource->end, resource->type, resource->data, resource->name); } pci_insert_vmresources(dev); LIST2_FOREACH(dev->children, sibling, child) { pci_setup_vmresource(child); } } static void pci_assign_device(struct pci_device *dev) { struct pci_vm_data *pci_data; #ifndef NO_CLEAR_IOBITMAP struct resource *resource; int i, j; #endif pci_data = vm_get_driver_data(pci_handle); LIST2_ADD(pci_data->vm_pci_device_list, vm_pci_device_list, dev); if (!cpu_is_bsp()) { pci_setup_assigned_device(dev); } pci_setup_vmresource(dev); pci_save_configs(dev); #ifndef NO_CLEAR_IOBITMAP /* * Set do_io_pass to clear io bitmap so that vm-exits on io * port access will be reduced. */ for (i = 0; i < PCI_RESOURCE_NUM; i++) { resource = dev->resource + i; if (resource->type != RESOURCE_TYPE_IO) { continue; } for (j = resource->start; j <= (int)resource->end - 3; j++) { set_iofunc(j, do_io_pass); } } #endif dev->assigned = true; } static void pci_dump_device(struct pci_device *dev, int level) { struct pci_device *child; char buf[17] = {0}; memset(buf, ' ', level <= 8 ? level * 2 : 16); printf(" %s%s %04x:%04x %02x %02x\n", buf, dev->name, dev->vendor_id, dev->device_id, dev->class_code, dev->header_type); LIST2_FOREACH(dev->children, sibling, child) { pci_dump_device(child, level + 1); } } void pci_dump_assignment(void) { struct pci_vm_data *pci_data; struct pci_device *dev = NULL; static spinlock_t lock = SPINLOCK_INITIALIZER; pci_data = vm_get_driver_data(pci_handle); spinlock_lock(&lock); LIST2_FOREACH(pci_data->vm_pci_device_list, vm_pci_device_list, dev) { pci_dump_device(dev, 0); } spinlock_unlock(&lock); } static void pci_reserve_unused_legacy_ioport(void) { struct resource *resource; vmmerr_t err; for (;;) { resource = alloc(sizeof(struct resource)); if (resource == NULL) { panic("Failed to reserve unused legacy ioport"); } err = rm_alloc_avail_resource(vmrm_io_resource(), resource, 0x0, 0xfff, 1, RESOURCE_TYPE_IO, 0, "legacy"); if (err != VMMERR_SUCCESS) { free(resource); break; } } } void pci_assign_devices(void) { struct pci_device *dev = NULL; u8 bus_no, dev_no, func_no; char param_name[VM_NAME_BUF_SIZE + 4]; int index; vmmerr_t err; snprintf(param_name, VM_NAME_BUF_SIZE + 4, "%s.pci", vm_get_name()); while ((dev = pci_next_device_on_root_bus(dev)) != NULL) { index = 0; while ((err = param_get_bdf(param_name, index++, &bus_no, &dev_no, &func_no)) != VMMERR_NOTEXIST) { if (err != VMMERR_SUCCESS) { printf("Failed to get %s(%d) paramater. err 0x%x\n", param_name, index - 1, err); continue; } if (dev->bus_no == bus_no && PCI_DEV_NO(dev->devfn) == dev_no && PCI_FUNC_NO(dev->devfn) == func_no) { pci_assign_device(dev); } } } pci_reserve_unused_legacy_ioport(); } void pci_assign_devices_to_vm0(void) { struct pci_device *dev = NULL; /* * This function is called for vm0 after all assignments except * vm0 are completed. */ while ((dev = pci_next_device_on_root_bus(dev)) != NULL) { if (dev->assigned) { continue; } pci_assign_device(dev); } pci_reserve_unused_legacy_ioport(); } int pci_check_assignment(u8 bus_no, u8 devfn) { struct pci_vm_data *pci_data; struct pci_device *dev; pci_data = (struct pci_vm_data *)vm_get_driver_data(pci_handle); LIST2_FOREACH(pci_data->vm_pci_device_list, vm_pci_device_list, dev) { if (bus_no == dev->bus_no && devfn == dev->devfn) { return PCI_ASSIGNED; } if (dev->type == PCI_CONFIG_HEADER_TYPE_1 && bus_no >= dev->sec_bus && bus_no <= dev->sub_bus) { return PCI_ASSIGNED; } if (bus_no == dev->bus_no && PCI_DEV_NO(devfn) == PCI_DEV_NO(dev->devfn) && PCI_FUNC_NO(devfn) == 0) { return PCI_DUMMY_FUNC0; } } return PCI_NOT_ASSIGNED; } struct pci_device * pci_next_assgined_pci_device(struct pci_device *cur) { struct pci_vm_data *pci_data; struct pci_device *dev; pci_data = (struct pci_vm_data *)vm_get_driver_data(pci_handle); dev = LIST2_NEXT(pci_data->vm_pci_device_list, vm_pci_device_list, cur); return dev; } int pci_dummy_func0(pci_off_t offset, pci_off_t size, bool wr, void *data) { static char header[0x10 + 3] = {PCI_DUMMY_FUNC0_VENDOR_ID, PCI_DUMMY_FUNC0_VENDOR_ID >> 8, PCI_DUMMY_FUNC0_DEVICE_ID, PCI_DUMMY_FUNC0_DEVICE_ID >> 8, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, PCI_CONFIG_HEADER_TYPE_MULTI_FUNCTION | PCI_CONFIG_HEADER_TYPE_0, 0x0, 0x0, 0x0, 0x0}; if (wr) { return 1; /* no pass */ } if (offset < sizeof(header) - 3) { memcpy(data, header + offset, size); } else { memset(data, 0, size); } return 1; /* no pass */ } int pci_assigned_mmio_addr(phys_t addr, size_t *len) { struct pci_vm_data *pci_data; struct pci_device *dev; struct resource *resource; int i; pci_data = (struct pci_vm_data *)vm_get_driver_data(pci_handle); LIST2_FOREACH(pci_data->vm_pci_device_list, vm_pci_device_list, dev) { for (i = 0; i < PCI_RESOURCE_NUM; i++) { resource = dev->resource + i; if (resource->type != RESOURCE_TYPE_MMIO) { continue; } if (resource->start <= addr && resource->end >= addr) { if (len) { *len = resource->end - addr + 1; } return 1; } } } return 0; } int pci_assigned_ioport(ioport_t port, ioport_t *len) { struct pci_vm_data *pci_data; struct pci_device *dev; struct resource *resource; int i; pci_data = (struct pci_vm_data *)vm_get_driver_data(pci_handle); LIST2_FOREACH(pci_data->vm_pci_device_list, vm_pci_device_list, dev) { for (i = 0; i < PCI_RESOURCE_NUM; i++) { resource = dev->resource + i; if (resource->type != RESOURCE_TYPE_IO) { continue; } if (resource->start <= port && resource->end >= port) { if (len) { *len = resource->end - port + 1; } return 1; } } } return 0; } static void pci_reprogram_device(struct pci_device *dev) { int i; printf("Reprogram %s\n", dev->name); for (i = 0; i < pci_config_size(); i += sizeof(u32)) { pci_write_config32(dev, i, dev->saved_config[i / sizeof(u32)]); } } static void pci_reprogram_devices(struct pci_device *dev) { struct pci_device *child; u16 vendor_id; u16 device_id; vendor_id = pci_read_config16(dev, PCI_CONFIG_VENDOR_ID); device_id = pci_read_config16(dev, PCI_CONFIG_DEVICE_ID); if (dev->vendor_id != vendor_id || dev->device_id != device_id) { /* A device might be replaced */ return; } pci_reprogram_device(dev); LIST2_FOREACH(dev->children, sibling, child) { pci_reprogram_devices(child); } } static void pci_reset_assigned_device(void) { struct pci_vm_data *pci_data; struct pci_device *dev; struct pci_device *child; u16 reg; pci_data = (struct pci_vm_data *)vm_get_driver_data(pci_handle); /* Secondary bus reset */ LIST2_FOREACH(pci_data->vm_pci_device_list, vm_pci_device_list, dev) { if (dev->type != PCI_CONFIG_HEADER_TYPE_1) { continue; } printf("Execute secondary bus reset on %s\n", dev->name); reg = pci_read_config16(dev, PCI_CONFIG_BRIDGE_CONTROL); reg |= PCI_CONFIG_SECONDARY_BUS_RESET; pci_write_config16(dev, PCI_CONFIG_BRIDGE_CONTROL, reg); /* wait 100 ms */ usleep(100 * 1000); reg &= ~PCI_CONFIG_SECONDARY_BUS_RESET; pci_write_config16(dev, PCI_CONFIG_BRIDGE_CONTROL, reg); } /* wait 2 sec */ usleep(2 * 1000 * 1000); /* Reprogram children */ LIST2_FOREACH(pci_data->vm_pci_device_list, vm_pci_device_list, dev) { LIST2_FOREACH(dev->children, sibling, child) { pci_reprogram_devices(child); } } } BUS_RESETVM(pci_reset_assigned_device); tinyvisor/vmm/io/Makefile0000644006644000001440000000170212143453571015737 0ustar yuichi_xyusersTOPDIR = .. include $(TOPDIR)/Makefile.master CONSTANTS-$(CONFIG_ENABLE_ASSERT) += -DENABLE_ASSERT CONSTANTS-$(CONFIG_SPINLOCK_DEBUG) += -DSPINLOCK_DEBUG CONSTANTS-$(CONFIG_IO_HOOK) += -DCONFIG_IO_HOOK TARGET = io.o OBJS-1 = \ pic_hook.o OBJS-$(CONFIG_IO_HOOK) += \ acpi_emu.o \ hpet.o \ ioapic_emu.o \ pci_acpi.o \ pci_assign.o \ pci_core.o \ pci_init.o \ rtc.o \ pic_emu.o \ pit_emu.o \ vmrm.o OBJS-$(CONFIG_TTY_SERIAL) += serial_emu.o OBJS-$(CONFIG_VTD_IOMMU) += vtd_dmar.o vtd.o HEADERS += $(wildcard *.h) CFLAGS += $(CONSTANTS-1) LINTFLAGS += $(CONSTANTS-1) LDFLAGS += -r .PHONY : all clean sloc count lint all: $(TARGET) clean: find . -name '*.o' -type f -exec rm -f {} \; lint: splint $(LINTFLAGS) *.c $(TARGET): $(OBJS-1) $(CONFIG) Makefile $(LD) $(LDFLAGS) -o $(TARGET) $(OBJS-1) $(OBJS-1): $(HEADERS) $(CONFIG) check-syntax: gcc -fsyntax-only $(CPPFLAGS) $(CFLAGS) $(CHK_SOURCES) # splint $(LINTFLAGS) $(CHK_SOURCES) tinyvisor/vmm/io/pci_acpi.c0000644006644000001440000000624011733245403016211 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include #include #include "pci_internal.h" #define MCFG_SIGNATURE "MCFG" struct mcfg { struct acpi_desc_header header; u8 reserved[8]; } __attribute__ ((packed)); struct mcfg_entry { u64 address; u16 pci_segment; u8 start_bus_number; u8 end_bus_number; u32 reserved; } __attribute__ ((packed)); LIST_DEFINE_HEAD(acpi_mmconfig_list); static acpi_parser_t parse_mcfg; static void parse_mcfg(void *table, u32 length) { int count; int i; struct mcfg *mcfg = (struct mcfg *)table; struct mcfg_entry *mcfg_entry; struct acpi_mmconfig *mmconfig; printf ("ACPI MCFG found.\n"); count = (mcfg->header.length - sizeof(struct mcfg)) / sizeof(struct mcfg_entry); for (i = 0; i < count; i++) { mcfg_entry = (struct mcfg_entry *)((ulong)mcfg + sizeof(struct mcfg) + sizeof(struct mcfg_entry) * i); mmconfig = (struct acpi_mmconfig*)alloc(sizeof(*mmconfig)); if (!mmconfig) { printf("parse_mcfg: Can't alloc memory"); return; } mmconfig->base = mcfg_entry->address; mmconfig->seg = mcfg_entry->pci_segment; mmconfig->start_bus_no = mcfg_entry->start_bus_number; mmconfig->end_bus_no = mcfg_entry->end_bus_number; LIST_APPEND(acpi_mmconfig_list, mmconfig); } memset(mcfg, 0, 4); printf ("ACPI MCFG cleared.\n"); } struct acpi_mmconfig* acpi_get_next_mmconfig(struct acpi_mmconfig* cur) { return LIST_NEXT(acpi_mmconfig_list, cur); } static void pci_acpi_init(void) { acpi_register_parser(MCFG_SIGNATURE, parse_mcfg); } INITFUNC("global3", pci_acpi_init); tinyvisor/vmm/io/vtd_dmar.h0000644006644000001440000000453111733245403016250 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _ACPI_DMAR_H_ #define _ACPI_DMAR_H_ #include #include struct iommu; struct pci_dev { u8 bus; union { u8 devfn ; struct { unsigned int func_no: 3 ; unsigned int dev_no: 5 ; } df ; } ; }; struct dmar_drhd_u { LIST_DEFINE(drhd_list) ; u64 address; /* register base address of the unit */ struct pci_dev *devices; /* target devices */ int devices_cnt; u8 include_pci_all; struct iommu *iommu; }; int dmar_drhd_exists(); struct dmar_drhd_u* dmar_get_next_drhd(struct dmar_drhd_u* cur); struct iommu *dmar_matched_iommu(u8 bus, u8 devfn); #endif /* _ACPI_DMAR_H_ */ tinyvisor/vmm/io/vmrm.c0000644006644000001440000000501412143442661015422 0ustar yuichi_xyusers/* * Copyright (c) 2013 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include #include struct vmrm { struct resource mmio_resource; struct resource io_resource; }; static drvdata_hdl_t vmrm_handle; static void vmrm_setup(void) { struct vmrm *vmrm; vmrm = vm_get_driver_data(vmrm_handle); rm_init_resource(&vmrm->mmio_resource, 0, 0xffffffffffffffffLL, RESOURCE_TYPE_MMIO, 0, "mmio_resource"); rm_init_resource(&vmrm->io_resource, 0, 0x0000ffff, RESOURCE_TYPE_IO, 0, "io_resource"); } struct resource * vmrm_mmio_resource(void) { struct vmrm *vmrm; vmrm = vm_get_driver_data(vmrm_handle); return &vmrm->mmio_resource; } struct resource * vmrm_io_resource(void) { struct vmrm *vmrm; vmrm = vm_get_driver_data(vmrm_handle); return &vmrm->io_resource; } static void vmrm_init(void) { vmrm_handle = vm_alloc_driver_data(sizeof(struct vmrm)); } RM_PASSVM(vmrm_setup); RM_INIT(vmrm_init); tinyvisor/vmm/io/vtd.c0000644006644000001440000005631312201041250015226 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include "vtd_dmar.h" /* #define DUMP_IOPT */ #define MAX_IO_DOM 256 #define PERM_DMA_NO 0 // 00b #define PERM_DMA_RO 1 // 01b #define PERM_DMA_WO 2 // 10b #define PERM_DMA_RW 3 // 11b /* * Intel VT-d register offset */ #define CAP_REG 0x8 /* Capabilities, 64 bit */ #define ECAP_REG 0x10 /* Extended-capabilities, 64 bit */ #define GCMD_REG 0x18 /* Global command register, 32 bit */ #define GSTS_REG 0x1c /* Global status register, 32 bit */ #define RTADDR_REG 0x20 /* Root-entry table address, 64 bit */ #define CCMD_REG 0x28 /* Context command register, 64 bit*/ #define FSTS_REG 0x34 /* Fault status register, 32 bit */ #define FSTS_REG_FRI_SHIFT 8 #define FSTS_REG_FRI_MASK 0xFF #define FECTL_REG 0x38 /* Fault event control register, 32 bit */ /* * Decoding Extended Capability Register */ #define ecap_iro(e) ((((e) >> 8) & 0x3ff) * 16) #define ecap_c(e) ((e >> 0) & 0x1) /* IOTLB Invalidate Register Field Offset */ #define IOTLB_FLUSH_GLOBAL (((u64)1) << 60) #define IOTLB_DRAIN_READ (((u64)1) << 49) #define IOTLB_DRAIN_WRITE (((u64)1) << 48) #define IOTLB_IVT (((u64)1) << 63) /* * Global Command Register Field Offset */ #define GCMD_TE (((u64)1) << 31) #define GCMD_SRTP (((u64)1) << 30) #define GCMD_WBF (((u64)1) << 27) /* * Global Status Register Field Offset */ #define GSTS_TES (((u64)1) << 31) #define GSTS_RTPS (((u64)1) << 30) #define GSTS_WBFS (((u64)1) << 27) /* * Context Command Register Field Offset */ #define CCMD_ICC (((u64)1) << 63) #define CCMD_GLOBAL_INVL (((u64)1) << 61) /* * Decoding Fault Status Register */ #define FSTS_MASK ((u64)0x7f) /* * Fault Recoding Registers */ #define FR_F 0x8000000000000000LL /* IO pagetable walk */ #define IOPT_LEVEL_STRIDE (9) #define IOPT_LEVEL_MASK ((1 << IOPT_LEVEL_STRIDE) - 1) #define IOPT_L1PTN(gpfn) (gpfn >> IOPT_LEVEL_STRIDE) #define VTD_PCI_VTBAR 0x180 #define VTD_PCI_VTBAR_ADDRESS_MASK 0xFFFFE000 #define VTD_PCI_VTBAR_ENABLE 0x00000001 #define VTD_PCI_VTGENCTRL 0x184 #define VTD_PCI_VTISOCHCTRL 0x188 #define VTD_PCI_VTGENCTRL2 0x18C #define VTD_PCI_VTSTS 0x199 #define VTD_MMREG_BASE 0xFD000000 struct iommu { LIST_DEFINE(iommu_list) ; void *reg; /* register base address of the unit = drhd->address */ u32 gcmd; /* maintaining TE field */ u64 cap; /* capability register */ u64 ecap; /* extended capability register */ spinlock_t unit_lock; /* iommu lock */ spinlock_t reg_lock; /* register operation lock */ struct root_entry *root_entry; /* virtual address */ phys_t root_entry_phys ;/* physical address */ }; // Translation Sturcture Format /* * Root Entry Structure and Ops. */ struct root_entry { struct { unsigned p: 1 ; unsigned rsvd: 11 ; u64 ctp: 52 ; } v ; u64 rsvd; }; /* * Context Entry Structure and Ops. */ struct context_entry { struct { unsigned p:1 ; unsigned fpd:1 ; unsigned t:2 ; unsigned eh:1 ; unsigned alh:1 ; unsigned rsvd: 6 ; u64 asr: 52 ; } l; struct { unsigned aw: 3 ; unsigned avail: 4 ; unsigned rsfc: 1 ; unsigned did:16 ; u64 rsvd: 40 ; } h; }; /* * Page-Table Entry Structure and Ops. */ struct iopt_entry { unsigned r: 1 ; unsigned w: 1 ; unsigned avail1: 5 ; unsigned sp: 1; unsigned avail2: 3; unsigned snp: 1; u64 addr: 40 ; unsigned avail3: 10 ; unsigned tm: 1; unsigned avail4: 1 ; }; struct io_domain { unsigned short int domain_id; phys_t pgd; /* io page directory root */ spinlock_t iopt_lock; /* io page table lock */ int agaw; /* adjusted guest address width, 0 is level 2 30-bit */ }; unsigned int clflush_size; LIST_DEFINE_HEAD(iommu_list); static inline void asm_clflush (void *a) { __asm__ volatile ("clflush (%0)" : : "r"(a)); } /* * Decoding Capability Register */ /* Fault-recording register offset */ #define cap_fro(c) ((((c) >> 24) & 0x3ff) * 16) /* Number of fault-recording register */ #define cap_nfr(c) ((((c) >> 40) & 0xff) + 1) /* Maximum guest address width */ #define cap_mgaw(c) ((((c) >> 16) & 0x3f) + 1) /* Supported adjusted guest address widths */ #define cap_sagaw(c) (((c) >> 8) & 0x1f) /* write-buffer flushing requirement */ #define cap_rwbf(c) (((c) >> 4) & 1) #define root_entry_present(r) ((r).v.p) #define set_root_present(r) do {(r).v.p = 1;} while(0) #define root_entry_ctp(r) ((r).v.ctp << PAGE_SHIFT) #define set_ctp(r, value) \ do {(r).v.ctp = (value) >> PAGE_SHIFT;} while(0) #define context_entry_present(c) \ ((c).l.p) #define set_context_present(c) \ do {(c).l.p = 1;} while(0) #define set_context_domid(c, d) \ do {(c).h.did = (d) ;} while (0) #define enable_fault_handling(c) \ do {(c).l.fpd = 0;} while(0) #define set_context_trans_type(c, val) \ do {(c).l.t = val;} while(0) #define set_asr(c, val) \ do {(c).l.asr = (val) >> PAGE_SHIFT ;} while(0) #define set_agaw(c, val) \ do {(c).h.aw = (val) & 7;} while(0) #define iopt_level_offset(addr, level) \ ((addr >> (PAGE_SHIFT + (level - 1) * IOPT_LEVEL_STRIDE)) & IOPT_LEVEL_MASK) #define set_pte_perm(p, prot) \ do { (p).r = prot & 1; (p).w = (prot & 2) >> 1; } while (0) #define get_pte_addr(p) \ ((p).addr << PAGE_SHIFT) #define set_pte_addr(p, address) \ do {(p).addr = (address) >> PAGE_SHIFT ;} while(0) #define get_pte_vailed(p) \ ((p).r || (p).w) static inline unsigned int cpuid_ebx(unsigned int op) { unsigned int eax, ebx, ecx, edx; __asm__ volatile ("cpuid" : "=a" (eax), "=b" (ebx), "=c" (ecx), "=d" (edx) : "a" (op)); return ebx; } static void flush_cacheline(struct iommu *iommu, void *addr, int size) { int i=0 ; if (ecap_c(iommu->ecap)) return; // 'Coherency' field of ECAP register while (i < size) { asm_clflush(addr + i); i += clflush_size ; } ; } #define flush_cacheline_dw(iommu, addr) flush_cacheline(iommu, addr, 8) #define flush_cacheline_pg(iommu, addr) flush_cacheline(iommu, addr, PAGE_SIZE) /* * Flush write buffer in root-complex. */ static void flush_write_buffer(struct iommu *iommu) { u32 val; if (!cap_rwbf(iommu->cap)) { // no need for write-buffer flushing to ensure changes to // memory-resident structures are visible to hardware return; } val = iommu->gcmd | GCMD_WBF; spinlock_lock(&iommu->reg_lock); write32(iommu->reg + GCMD_REG, val); // wait until completion for (;;) { val = read32(iommu->reg + GSTS_REG); if (!(val & GSTS_WBFS)) break; cpu_relax(); } spinlock_unlock(&iommu->reg_lock); } // Context-Cache global invalidation static int flush_context_cache(struct iommu *iommu) { u64 val = CCMD_GLOBAL_INVL | CCMD_ICC; spinlock_lock(&iommu->reg_lock); write64(iommu->reg + CCMD_REG, val); // wait until complettion for (;;) { val = read64(iommu->reg + CCMD_REG); if (!(val & CCMD_ICC)) break; cpu_relax(); } spinlock_unlock(&iommu->reg_lock); return 0; } // IOTLB global invalidation static int flush_iotlb_global(struct iommu *iommu) { int iotlb_reg_offset = ecap_iro(iommu->ecap); u64 val = 0 ; // IOTLB global invalidation // Also DMA draining will be applied, if supported val = IOTLB_FLUSH_GLOBAL|IOTLB_IVT|IOTLB_DRAIN_READ|IOTLB_DRAIN_WRITE; spinlock_lock(&iommu->reg_lock); write64(iommu->reg + iotlb_reg_offset + 8, val); // wait until completion for (;;) { val = read64(iommu->reg + iotlb_reg_offset + 8); if (!(val & IOTLB_IVT)) break; cpu_relax(); } spinlock_unlock(&iommu->reg_lock); return 0; } static void flush_all(void) { struct iommu *iommu; LIST_FOREACH(iommu_list, iommu) { flush_write_buffer(iommu); flush_context_cache(iommu); flush_iotlb_global(iommu); } } static void * iopt_walk(struct io_domain *dom, phys_t addr, int req_level, int *result_level) { struct iommu *iommu; int addr_width; struct iopt_entry *tbl, *pte = NULL; int level; int offset; void *vaddr = NULL; phys_t phys; vmmerr_t ret; level = dom->agaw + 2; addr_width = level * IOPT_LEVEL_STRIDE + PAGE_SHIFT; if (addr >= ((phys_t)1 << addr_width)) { return NULL; } iommu = LIST_HEAD(iommu_list); spinlock_lock(&dom->iopt_lock); tbl = (void *)phys_to_virt(dom->pgd); for (; level >= req_level + 1; level--) { offset = iopt_level_offset(addr, level); pte = &tbl[offset]; if (get_pte_addr(*pte) == 0) { /* if iommu page table is NOT present ... */ ret = alloc_page(&vaddr, &phys); if (ret!=0) { spinlock_unlock(&dom->iopt_lock); return NULL; } memset(vaddr, 0, PAGE_SIZE); flush_cacheline_pg(iommu, vaddr); set_pte_addr(*pte, (phys & PAGE_MASK)); set_pte_perm(*pte, PERM_DMA_RW); flush_cacheline_dw(iommu, pte); } else { if (pte->sp) { break; } phys = get_pte_addr(*pte); vaddr = (void *)phys_to_virt(phys); } tbl = (struct iopt_entry *)vaddr; } spinlock_unlock(&dom->iopt_lock); *result_level = level; return tbl + iopt_level_offset(addr, level); } // Set Root-entry table address static vmmerr_t set_root_entry_table(struct iommu *iommu) { u32 cmd, stat; void *virt; vmmerr_t ret; if (iommu == NULL) { printf("set_root_entry_table: iommu == NULL\n"); return VMMERR_INVAL; } if (!iommu->root_entry) { ret = alloc_page(&virt, &(iommu->root_entry_phys)); if (ret != 0) { printf("Failed to allocate root entry table."); return VMMERR_NOMEM; } memset((u8*)virt, 0, PAGE_SIZE); flush_cacheline_pg(iommu, virt); iommu->root_entry = (struct root_entry *)virt; } spinlock_lock(&iommu->reg_lock); write64(iommu->reg + RTADDR_REG, iommu->root_entry_phys); cmd = iommu->gcmd | GCMD_SRTP; write32(iommu->reg + GCMD_REG, cmd); // wait until completion for (;;) { stat = read32(iommu->reg + GSTS_REG); if (stat & GSTS_RTPS) break; cpu_relax(); } spinlock_unlock(&iommu->reg_lock); return 0; } // Enable DMA Remapping static void enable_dma_remapping(struct iommu *iommu) { u32 stat; spinlock_lock(&iommu->reg_lock); // Enable translation iommu->gcmd |= GCMD_TE; write32(iommu->reg + GCMD_REG, iommu->gcmd); // Wait until completion for (;;) { stat = read32(iommu->reg + GSTS_REG); if (stat & GSTS_TES) break; cpu_relax(); } spinlock_unlock(&iommu->reg_lock); } static int gaw_to_agaw(int gaw) { // Just mentioned in chapter 3.4.2 in VT-d spec. int agaw, r; r = (gaw-PAGE_SHIFT) % 9; if (r==0) { agaw = gaw; } else { agaw = gaw+9-r; } if (agaw > 64) { agaw = 64; } return agaw; } static void map_guest_pages(struct io_domain *dom, phys_t gphys, phys_t len) { struct iommu *iommu; phys_t gpfn, gpfn_start, gpfn_end; phys_t hphys; struct iopt_entry *pte = NULL; int level; iommu = LIST_HEAD(iommu_list); gpfn_start = gphys >> PAGE_SHIFT; gpfn_end = (gphys + len + PAGE_SIZE - 1) >> PAGE_SHIFT; for (gpfn = gpfn_start; gpfn < gpfn_end; gpfn++) { hphys = gmm_gp2hp(gpfn << PAGE_SHIFT); if (hphys == GMM_NO_MAPPING) { continue; } pte = iopt_walk(dom, (phys_t)gpfn << PAGE_SHIFT, 1, &level); if (pte == NULL) { panic("Failed to get io-pte."); } set_pte_addr(*pte, hphys); set_pte_perm(*pte, PERM_DMA_RW); flush_cacheline_dw(iommu, pte); } return; } static void map_all_guest_pages(struct io_domain *dom) { int index = 0; phys_t gphys; phys_t len; u32 type; /* * 0MB - 1MB area need to be mapped because * BIOS may use the area as a DMA target. */ map_guest_pages(dom, 0, 0x100000); while (gmm_get_mem_map(index++, &gphys, &len, &type)) { map_guest_pages(dom, gphys, len); } } #ifdef DUMP_IOPT static void dump_iopt(struct io_domain *dom) { phys_t top_of_gphys; phys_t gphys, hphys, next_gphys = 0, next_hphys = 0; struct iopt_entry pte; static spinlock_t dump_lock = SPINLOCK_INITIALIZER; int level; spinlock_lock(&dump_lock); top_of_gphys = gmm_top_of_high_avail_mem(); if (top_of_gphys == 0) { top_of_gphys = gmm_top_of_low_avail_mem(); } printf("Dumping iopt 0x0 to 0x%llx\n", top_of_gphys); for (gphys = 0; gphys < top_of_gphys; gphys += PAGE_SIZE) { pte = *(struct iopt_entry *)iopt_walk(dom, gphys, 1, &level); if (!get_pte_vailed(pte)) { if (next_hphys != 0) { printf(" 0x%llx -> 0x%llx\n", next_gphys - 1, next_hphys - 1); } next_hphys = 0; continue; } hphys = get_pte_addr(pte); if (hphys != next_hphys) { if (next_hphys != 0) { printf(" 0x%llx -> 0x%llx\n", next_gphys - 1, next_hphys - 1); } printf(" 0x%llx -> 0x%llx", gphys, hphys); } next_gphys = gphys + PAGE_SIZE; next_hphys = hphys + PAGE_SIZE; } if (next_hphys != 0) { printf(" 0x%llx -> 0x%llx\n", next_gphys - 1, next_hphys - 1); } spinlock_unlock(&dump_lock); } #endif /* Setup device context information */ static struct context_entry * get_context_entry(struct iommu *iommu, u8 bus, u8 devfn) { struct root_entry *root; struct context_entry *context; void *virt; phys_t phys; vmmerr_t ret; spinlock_lock(&iommu->unit_lock); root = &iommu->root_entry[bus]; if (!root_entry_present(*root)) { ret = alloc_page(&virt, &phys); if (ret != 0) { spinlock_unlock(&iommu->unit_lock); printf("get_context_entry: Can't alloc a page.\n"); return NULL; } memset((void *)(virt) , 0, PAGE_SIZE); flush_cacheline_pg(iommu, (void *)(virt)); set_ctp(*root, phys); set_root_present(*root); flush_cacheline_dw(iommu, root); } context = (struct context_entry *)phys_to_virt( (phys_t)root_entry_ctp(*root)); spinlock_unlock(&iommu->unit_lock); return &context[devfn]; } static vmmerr_t map_device_to_domain(struct io_domain *dom, u8 bus_no, u8 devfn) { struct context_entry *context; void *virt; phys_t phys; vmmerr_t ret = 0; struct iommu *iommu; if (dmar_drhd_exists()) { iommu = dmar_matched_iommu(bus_no, devfn); } else { iommu = LIST_HEAD(iommu_list); } if (!iommu) { printf("map_device_to_domain: " "Can't find a iommu for the pci device. " PCI_LOCATION_FORMAT "\n", bus_no, PCI_DEV_NO(devfn), PCI_FUNC_NO(devfn)); return VMMERR_NOMEM; } spinlock_lock(&dom->iopt_lock); if (!dom->pgd) { ret = alloc_page(&virt, &phys); if (ret!=0) { spinlock_unlock(&dom->iopt_lock); printf("map_device_to_domain: " "Can't alloc a page"); return VMMERR_NOMEM; } memset(virt, 0, PAGE_SIZE); flush_cacheline_dw(iommu, virt); dom->pgd = phys; } spinlock_unlock(&dom->iopt_lock); context = get_context_entry(iommu, bus_no, devfn); if (!context) { printf("map_device_to_domain: " "Can't get context entry.\n"); return VMMERR_NOMEM; } if (context_entry_present(*context)) { return 0; } spinlock_lock(&iommu->unit_lock); set_agaw(*context, dom->agaw); set_asr(*context, (unsigned long)dom->pgd); set_context_trans_type(*context, 0x0); /* means "ASR field points to a multi-level page-table" */ enable_fault_handling(*context); set_context_domid(*context, dom->domain_id); set_context_present(*context); flush_cacheline_dw(iommu, context); spinlock_unlock(&iommu->unit_lock); return ret; } static void map_assigned_devices_to_domain(struct io_domain *dom) { struct pci_device *dev; int bus_no; int devfn; for (dev = pci_next_assgined_pci_device(NULL); dev; dev = pci_next_assgined_pci_device(dev)) { map_device_to_domain(dom, dev->bus_no, dev->devfn); /* * If assigned device is PCI-PCI bridge, Assign all * devices behind it to a specified io domain. */ if (dev->type == PCI_CONFIG_HEADER_TYPE_1) { for (bus_no = dev->sec_bus; bus_no <= dev->sub_bus; bus_no++) { for (devfn = 0; devfn < 256; devfn++) { map_device_to_domain(dom, bus_no, devfn); } } } } } static void clear_fault_record(struct iommu *iommu) { u64 fro; // Fault Register Offset int nfo; // Number of fault register offset int i; fro = cap_fro(iommu->cap); nfo = cap_nfr(iommu->cap); for (i = 0; i < nfo; i++) { /* writing back to clear fault status */ write64(iommu->reg + fro + i * 16 + 8, 0x80000000); } /* Clearing lower 7bits of Fault Status Register */ write32(iommu->reg + FSTS_REG, FSTS_MASK); } static void dump_fault_record(struct iommu *iommu) { u64 val; u64 fro; // Fault Register Offset int i; u32 status; int fri; int nfo; // Number of fault register offset spinlock_lock(&iommu->unit_lock); status = read32(iommu->reg + FSTS_REG); printf("VT-d fault status 0x%08X\n", status); fri = (status >> FSTS_REG_FRI_SHIFT) & FSTS_REG_FRI_MASK; fro = cap_fro(iommu->cap); nfo = cap_nfr(iommu->cap); for (i = 0; i < nfo; i++) { if (fri >= nfo) { fri = 0; } val = read64(iommu->reg + fro + fri * 16 + 8); if ((val & FR_F) == 0) { break; } printf("VT-d fault record[%d] 0x%016llX", fri, val); val = read64(iommu->reg + fro + fri * 16); printf("_%016llX\n", val); write64(iommu->reg + fro + fri * 16 + 8, FR_F); fri++; } write32(iommu->reg + FSTS_REG, FSTS_MASK); spinlock_unlock(&iommu->unit_lock); } static struct iommu * new_iommu(phys_t reg_base) { struct iommu *iommu; vmmerr_t ret; iommu = alloc(sizeof(struct iommu)); if (!iommu) { return NULL; } memset(iommu, 0, sizeof(struct iommu)); iommu->reg = mapmem_hphys(reg_base, PAGE_SIZE, MAPMEM_WRITE | MAPMEM_UC); if (iommu->reg == NULL) { free(iommu); return NULL; } iommu->cap = read64(iommu->reg + CAP_REG); iommu->ecap = read64(iommu->reg + ECAP_REG); printf("VT-d: base 0x%llx, cap 0x%llx, ecap 0x%llx\n", reg_base, iommu->cap, iommu->ecap); #ifdef ENABLE_COHERENCY_SUPPORT /* * Hardware accesses to remapping structures are coherent. */ iommu->ecap |= 0x1; write64(iommu->reg + ECAP_REG, iommu->ecap); iommu->ecap = read64(iommu->reg + ECAP_REG); #endif spinlock_init(&iommu->unit_lock); spinlock_init(&iommu->reg_lock); LIST_APPEND(iommu_list, iommu); ret = set_root_entry_table(iommu); if (ret) { panic("VT-d: set root entry failed\n"); } clear_fault_record(iommu); write32(iommu->reg + FECTL_REG, 0); /* clearing IM field */ return iommu; } static vmmerr_t iodom_init(struct io_domain *dom) { struct iommu *iommu = NULL; int guest_width ; int adjust_width ; int agaw ; u64 sagaw; void *vaddr; vmmerr_t ret; iommu = LIST_HEAD(iommu_list); ASSERT(iommu); /* determine AGAW */ guest_width = cap_mgaw(iommu->cap); adjust_width = gaw_to_agaw(guest_width); agaw = ((adjust_width-PAGE_SHIFT)/IOPT_LEVEL_STRIDE)-2; sagaw = cap_sagaw(iommu->cap); if ((1UL << (agaw % 32) & sagaw)==0) { printf("Unsupported AGAW value.\n"); return VMMERR_NODEV; } dom->agaw = agaw; ret = alloc_page(&vaddr, &dom->pgd); if (ret != 0) { return VMMERR_NOMEM; } memset(vaddr, 0, PAGE_SIZE); flush_cacheline_pg(iommu, vaddr); spinlock_init(&dom->iopt_lock); return 0; } static struct io_domain *create_domain() { struct io_domain *dom; static int number_of_domain = 0; if (number_of_domain >= MAX_IO_DOM) { return NULL; } if ((dom = alloc(sizeof(struct io_domain))) == NULL) return NULL; memset(dom, 0, sizeof(*dom)); dom->domain_id = number_of_domain; if (iodom_init(dom) != 0) { free(dom); return NULL; // Init. failed. } number_of_domain++; return dom; } static void vtd_pci_new(struct pci_device *dev) { phys_t reg_base = 0; static int vtd_pci_count = 0; static u32 reg_val, writing_val; printf("VT-d PCI device %s found.\n", dev->name); vtd_pci_count++; if (vtd_pci_count > 1) { printf("Multi VT-d PCI device is not supported.\n"); return; } reg_val = pci_read_config32(dev, VTD_PCI_VTBAR); if (reg_val == 0xffffffff) { printf("Failed to access VTBAR register.\n"); return; } reg_base = reg_val & VTD_PCI_VTBAR_ADDRESS_MASK; if (reg_base == 0) { reg_base = VTD_MMREG_BASE; printf("Configure VT-d memory mapped registers to 0x%llx\n", reg_base); writing_val = (reg_val & ~VTD_PCI_VTBAR_ADDRESS_MASK) | (reg_base & VTD_PCI_VTBAR_ADDRESS_MASK) | VTD_PCI_VTBAR_ENABLE; } else { printf("VT-d memory mapped registers is locate at 0x%llx\n", reg_base); writing_val = reg_val | VTD_PCI_VTBAR_ENABLE; } pci_write_config32(dev, VTD_PCI_VTBAR, writing_val); reg_val = pci_read_config32(dev, VTD_PCI_VTBAR); if (writing_val != reg_val) { printf("Can't write VTD_PCI_VTBAR. writing 0x%X reading 0x%X\n", writing_val, reg_val); return; } new_iommu(reg_base); } struct pci_driver vtd_pci_driver = { .id = {PCI_ID(0x8086, 0xD155), PCI_ID(0xFFFF, 0xFFFF)}, .new = vtd_pci_new, .name = "vtd_pci", .longname = "VT-d PCI driver" }; static int vtddump_msghandler(int m, int c) { struct iommu *iommu; LIST_FOREACH(iommu_list, iommu) { dump_fault_record(iommu); } return 0; } static void iommu_init(void) { struct dmar_drhd_u *drhd; struct iommu *iommu; clflush_size = ((cpuid_ebx(1) >> 8) & 0xff) * 8; if (dmar_drhd_exists()) { for (drhd = dmar_get_next_drhd(NULL); drhd; drhd = dmar_get_next_drhd(drhd)) { iommu = new_iommu(drhd->address); if (!iommu) { continue; } drhd->iommu = iommu; } } else { pci_register_driver(&vtd_pci_driver); } msgregister ("vtddump", vtddump_msghandler); } static void iommu_setup_vm(void) { struct io_domain *dom; if (!LIST_HEAD(iommu_list)) { return; } dom = create_domain(); if (!dom) { panic("Failed to create domain."); } map_all_guest_pages(dom); map_assigned_devices_to_domain(dom); #ifdef DUMP_IOPT dump_iopt(dom); #endif vm_iommu_enabled(); } static void iommu_enable(void) { struct iommu *iommu; if (!LIST_HEAD(iommu_list)) { return; } flush_all(); LIST_FOREACH(iommu_list, iommu) { enable_dma_remapping(iommu); } printf("VT-d IOMMU enabled.\n"); } DRIVER_INIT(iommu_init); DRIVER_PASSVM(iommu_setup_vm); DRIVER_START(iommu_enable); tinyvisor/vmm/io/hpet.h0000644006644000001440000000321411741307010015375 0ustar yuichi_xyusers/* * Copyright (c) 2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _IO_HPET_H #define _IO_HPET_H void hpet_ioapic_updated(gsi_t gsi); #endif /* _IO_HPET_H */ tinyvisor/vmm/io/pit_emu.c0000644006644000001440000002317111740312120016073 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * PIT emulator with 3 counters. * Only support the following modes. * mode 0 (out signal on end of count) to boot linux * mode 2 (rate genarater) for system timer of bios * mode 3 (square wave mode) for beep */ #include #include #include #include #include #include #include #include #include #include #include #include #include #define PIT_COUNTER_RAIT 1193182 /* HZ */ #define PIT_COUNTER_NUM 3 #define PIT_COUNTER0_ACCESS_IOPORT 0x40 #define PIT_COUNTER1_ACCESS_IOPORT 0x41 #define PIT_COUNTER2_ACCESS_IOPORT 0x42 #define PIT_TCW_REG_IOPORT 0x43 #define PIT_TCW_REG_MODE_SELECT_MASK 0x0e #define PIT_TCW_REG_MODE0 0x00 #define PIT_TCW_REG_MODE2 0x04 #define PIT_TCW_REG_MODE2A 0x0c #define PIT_TCW_REG_MODE3 0x06 #define PIT_TCW_REG_RDWR_SELECT_MASK 0x30 #define PIT_TCW_REG_COUNTER_LATCH_COMMAND 0x00 #define PIT_TCW_REG_LSB 0x10 #define PIT_TCW_REG_MSB 0x20 #define PIT_TCW_REG_LSB_MSB 0x30 #define PIT_TCW_REG_COUNTER_SELECT_MASK 0xc0 #define PIT_TCW_REG_COUNTER_SELECT_SHIFT 6 #define PIT_TCW_REG_COUNTER0 0x00 #define PIT_TCW_REG_COUNTER1 0x40 #define PIT_TCW_REG_COUNTER2 0x80 #define PIT_TCW_REG_READ_BACK_COMMAND 0xc0 #define PIT_NMI_SC_REG_IOPORT 0x61 #define PIT_NMI_SC_REG_CONTROL_MASK 0x0f #define PIT_NMI_SC_REG_CONTROL_COUNTER2_EN 0x01 #define PIT_NMI_SC_REG_TIMER_COUNTER2 0x20 #define SYSTEM_TIMER_IRQ 0 /* #define PITEMU_DEBUG */ #ifdef PITEMU_DEBUG #define PITEMU_DBG(...) \ do { \ printf(__VA_ARGS__); \ } while (0) #else #define PITEMU_DBG(...) #endif struct pit_counter { u8 no; u16 value; u16 init_val; u8 tcw; int access_cnt; u64 last_time; }; struct pit_emu { spinlock_t lock; struct pit_counter counter[PIT_COUNTER_NUM]; u8 nmi_sc; }; static drvdata_hdl_t pit_handle; static void pit_write_counter(struct pit_counter *counter, u8 data) { switch (counter->tcw & PIT_TCW_REG_RDWR_SELECT_MASK) { case PIT_TCW_REG_LSB: counter->init_val = (counter->init_val & 0xff00) | data; break; case PIT_TCW_REG_MSB: counter->init_val = (counter->init_val & 0x00ff) | (u16)data << 8; break; case PIT_TCW_REG_LSB_MSB: counter->access_cnt++; if (counter->access_cnt % 2) { counter->init_val = (counter->init_val & 0xff00) | data; } else { counter->init_val = (counter->init_val & 0x00ff) | (u16)data << 8; } break; } counter->value = counter->init_val; counter->last_time = get_cpu_time(); } static u16 pit_usec_to_counter(u64 usec) { #ifndef __x86_64__ u32 usec32; #endif /* * If we specify a value over than 78 sec, overflow will be * occured. */ if (usec > 0xffffLL * PIT_COUNTER_RAIT / 1000000) { return 0xffff; } #ifdef __x86_64__ usec *= 1000000; usec /= PIT_COUNTER_RAIT; #else usec32 = usec; usec32 *= 10000; usec32 /= (PIT_COUNTER_RAIT / 100); #endif return usec; } static void pit_update_counter(struct pit_counter *counter) { u64 now; u16 new_value; now = get_cpu_time(); new_value = counter->value - pit_usec_to_counter(now - counter->last_time); switch (counter->tcw & PIT_TCW_REG_MODE_SELECT_MASK) { case PIT_TCW_REG_MODE0: if (new_value > counter->value) { /* Overflowed */ new_value = 0; } break; case PIT_TCW_REG_MODE2: case PIT_TCW_REG_MODE2A: case PIT_TCW_REG_MODE3: if (new_value > counter->value) { /* Overflowed */ if (counter->no == 0) { picemu_trigger_boot_int(SYSTEM_TIMER_IRQ); } if (counter->init_val != 0) { while (new_value > counter->init_val) { new_value += counter->init_val; } } } break; } counter->value = new_value; counter->last_time = now; } static void pit_read_counter(struct pit_counter *counter, u8 *data) { pit_update_counter(counter); switch (counter->tcw & PIT_TCW_REG_RDWR_SELECT_MASK) { case PIT_TCW_REG_LSB: *data = counter->value & 0x00ff; break; case PIT_TCW_REG_MSB: *data = (counter->value & 0xff00) >> 8; break; case PIT_TCW_REG_LSB_MSB: counter->access_cnt++; if (counter->access_cnt % 2) { *data = counter->value & 0x00ff; } else { *data = (counter->value & 0xff00) >> 8; } break; default: *data = 0; } } static int pit_counter_access_handler(iotype_t type, ioport_t port, void *data) { struct pit_emu *pit_emu; pit_emu = vm_get_driver_data(pit_handle); spinlock_lock(&pit_emu->lock); switch(type) { case IOTYPE_OUTB: PITEMU_DBG("counter %d reg outb 0x%x\n", port - PIT_COUNTER0_ACCESS_IOPORT, (*(u8 *)data)); pit_write_counter(pit_emu->counter + (port - PIT_COUNTER0_ACCESS_IOPORT), *(u8 *)data); break; case IOTYPE_INB: pit_read_counter(pit_emu->counter + (port - PIT_COUNTER0_ACCESS_IOPORT), (u8 *)data); PITEMU_DBG("counter %d reg inb 0x%x\n", port - PIT_COUNTER0_ACCESS_IOPORT, (*(u8 *)data)); break; default: /* noting to do */ PITEMU_DBG("counter %d reg access type %x\n", port - PIT_COUNTER0_ACCESS_IOPORT, type); break; } spinlock_unlock(&pit_emu->lock); return 1; /* emulated */ } static void pit_write_counter_tcw(struct pit_counter *counter, u8 data_u8) { counter->access_cnt = 0; counter->tcw = data_u8; counter->init_val = 0; switch (counter->tcw & PIT_TCW_REG_MODE_SELECT_MASK) { case PIT_TCW_REG_MODE0: case PIT_TCW_REG_MODE2: case PIT_TCW_REG_MODE2A: case PIT_TCW_REG_MODE3: break; default: printf("Unsupported pit mode. tcw 0x%x\n", counter->tcw); break; } } static int pit_tcw_reg_handler(iotype_t type, ioport_t port, void *data) { struct pit_emu *pit_emu; u8 data_u8; pit_emu = vm_get_driver_data(pit_handle); spinlock_lock(&pit_emu->lock); switch(type) { case IOTYPE_OUTB: PITEMU_DBG("TCW reg outb 0x%x\n", (*(u8 *)data)); data_u8 = *(u8 *)data; if ((data_u8 & PIT_TCW_REG_RDWR_SELECT_MASK) == PIT_TCW_REG_COUNTER_LATCH_COMMAND) { break; } if ((data_u8 & PIT_TCW_REG_COUNTER_SELECT_MASK) == PIT_TCW_REG_READ_BACK_COMMAND) { break; } pit_write_counter_tcw(pit_emu->counter + ((data_u8 & PIT_TCW_REG_COUNTER_SELECT_MASK) >> PIT_TCW_REG_COUNTER_SELECT_SHIFT), data_u8); break; default: /* noting to do */ PITEMU_DBG("TCW regaccess type %x\n", type); break; } spinlock_unlock(&pit_emu->lock); return 1; /* emulated */ } static int pit_nmi_sc_reg_handler(iotype_t type, ioport_t port, void *data) { struct pit_emu *pit_emu; int counter2_out = 0; pit_emu = vm_get_driver_data(pit_handle); spinlock_lock(&pit_emu->lock); switch(type) { case IOTYPE_OUTB: pit_emu->nmi_sc = (*(u8 *)data) & PIT_NMI_SC_REG_CONTROL_MASK; PITEMU_DBG("NMI SC reg outb 0x%x\n", (*(u8 *)data)); break; case IOTYPE_INB: if (pit_emu->nmi_sc & PIT_NMI_SC_REG_CONTROL_COUNTER2_EN) { pit_update_counter(pit_emu->counter + 2); counter2_out = (pit_emu->counter[2].value == 0); } *(u8 *)data = pit_emu->nmi_sc | (counter2_out ? PIT_NMI_SC_REG_TIMER_COUNTER2: 0); PITEMU_DBG("NMI SC reg inb 0x%x\n", (*(u8 *)data)); break; default: /* noting to do */ PITEMU_DBG("NMI SC reg access type %x\n", type); break; } spinlock_unlock(&pit_emu->lock); return 1; /* emulated */ } void pit_update_counter0(void) { struct pit_emu *pit_emu; pit_emu = vm_get_driver_data(pit_handle); spinlock_lock(&pit_emu->lock); pit_update_counter(pit_emu->counter); spinlock_unlock(&pit_emu->lock); } static void pit_setup_vm(void) { struct pit_emu *pit_emu; int i; if (cpu_is_bsp()) { return; } pit_emu = vm_get_driver_data(pit_handle); spinlock_init(&pit_emu->lock); for (i = 0; i < PIT_COUNTER_NUM; i++) { pit_emu->counter[i].no = i; } set_iofunc(PIT_COUNTER0_ACCESS_IOPORT, pit_counter_access_handler); set_iofunc(PIT_COUNTER1_ACCESS_IOPORT, pit_counter_access_handler); set_iofunc(PIT_COUNTER2_ACCESS_IOPORT, pit_counter_access_handler); set_iofunc(PIT_TCW_REG_IOPORT, pit_tcw_reg_handler); set_iofunc(PIT_NMI_SC_REG_IOPORT, pit_nmi_sc_reg_handler); } static void pit_init(void) { pit_handle = vm_alloc_driver_data(sizeof(struct pit_emu)); } DRIVER_PASSVM(pit_setup_vm); DRIVER_INIT(pit_init); tinyvisor/vmm/io/pci_internal.h0000644006644000001440000000720412166267145017127 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _PCI_INTERNAL_H #define _PCI_INTERNAL_H #include #include #include #include #include #define PCI_CONFIG_ADDR_PORT 0x0CF8 #define PCI_CONFIG_DATA_PORT 0x0CFC #define PCI_NOT_ASSIGNED 0 #define PCI_ASSIGNED 1 #define PCI_DUMMY_FUNC0 2 typedef struct { union { u32 value; struct { unsigned int type: 2; unsigned int reg_no: 6; union { struct { unsigned int func_no: 3; unsigned int device_no: 5; } __attribute__ ((packed)) ; u8 devfn; }; unsigned int bus_no: 8; unsigned int reserved: 7; unsigned int allow: 1; } __attribute__ ((packed)) ; }; } pci_config_address_t; struct pci_mmconfig { LIST_DEFINE(pci_mmconfig_list); phys_t phys_base; void *virt_base; size_t size; u16 seg; u8 start_bus_no; u8 end_bus_no; }; struct pci_vm_data { pci_config_address_t config_addr; LIST2_DEFINE_HEAD(struct pci_device, vm_pci_device_list); }; struct acpi_mmconfig { LIST_DEFINE(acpi_mmconfig_list); phys_t base; u16 seg; u8 start_bus_no; u8 end_bus_no; }; extern drvdata_hdl_t pci_handle; LIST_EXTERN_HEAD(pci_mmconfig_list); void pci_init_root_resources(void); struct pci_device *pci_next_device_on_root_bus(struct pci_device *cur); int pci_config_data_handler(iotype_t type, ioport_t port, void *data); int pci_config_addr_handler(iotype_t type, ioport_t port, void *data); void pci_register_device(struct pci_device *parent, struct pci_device *dev); void pci_assign_devices(void); void pci_assign_devices_to_vm0(void); int pci_check_assignment(u8 bus_no, u8 devfn); struct pci_device *pci_next_assgined_pci_device(struct pci_device *cur); int pci_dummy_func0(pci_off_t offset, pci_off_t size, bool wr, void *data); struct acpi_mmconfig* acpi_get_next_mmconfig(struct acpi_mmconfig* cur); vmmerr_t pci_alloc_resource(struct pci_device *dev, struct resource *resource, size_t size, phys_t align, u32 type, u32 data); u32 pci_get_base_address_mask(struct pci_device *dev, int offset); #endif /* _PCI_INTERNAL_H */ tinyvisor/vmm/io/acpi_emu.c0000644006644000001440000000515412143453571016232 0ustar yuichi_xyusers/* * Copyright (c) 2013 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include #include #include /* #define ACPI_DEBUG */ #ifdef ACPI_DEBUG #define ACPI_DBG(...) \ do { \ printf("ACPI: " __VA_ARGS__); \ } while (0) #else #define ACPI_DBG(...) #endif struct acpi_emu { struct resource resource; }; static drvdata_hdl_t acpi_handle; static void acpi_emu_setup(void) { struct acpi_emu *acpi; vmmerr_t err; if (cpu_is_bsp()) { return; } acpi = vm_get_driver_data(acpi_handle); err = rm_alloc_resource(vmrm_io_resource(), &acpi->resource, 0x100, 0x100, RESOURCE_TYPE_IO, 0, "acpi_emu"); if (err != VMMERR_SUCCESS) { panic("Can't find free ioport for ACPI device."); } } ioport_t acpi_get_dev_base(void) { struct acpi_emu *acpi; acpi = vm_get_driver_data(acpi_handle); return acpi->resource.start; } static void acpi_emu_init(void) { acpi_handle = vm_alloc_driver_data(sizeof(struct acpi_emu)); } DRIVER_PASSVM(acpi_emu_setup); DRIVER_INIT(acpi_emu_init); tinyvisor/vmm/io/pic_hook.c0000644006644000001440000000443511733245403016241 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * 8259A programable interrupt controller hook. */ #include #include #include #include #include #include static void pic_master_cmd(u8 data) { if ((data & PIC_ICW1_SELECT_MASK) == PIC_ICW1_SELECT_MATCH) { extint_reset_8259a(); } } static int pic_io_hook(iotype_t type, ioport_t port, void *data) { switch (type) { case IOTYPE_OUTB: pic_master_cmd(*(u8 *)data); break; default: break; } return 0; /* pass */ } static void pic_init (void) { if (!cpu_is_bsp()) { /* * For VMs except vm0, we provide pic emulator. * See io/pic_emu.c. */ return; } set_iofunc(PIC_MASTER_CMD_PORT, pic_io_hook); } INITFUNC ("passvm1", pic_init); tinyvisor/vmm/io/pci_init.c0000644006644000001440000003017612166267145016255 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /** * @file drivers/pci_init.c * @brief PCI driver (init) * @author T. Shinagawa */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #include #include #include #include #include #include #include #include #include #include #include #include "pci_internal.h" #define PCI_MAX_BUSES 256 #define PCI_MAX_DEVICES 32 #define PCI_MAX_FUNCS 8 static const char driver_name[] = "pci_driver"; static pci_config_address_t initial_config_addr; static u8 pci_scan_bus(struct pci_device *parent, u16 seg, u8 bn); static void pci_init_legacy_config(void) { in32(PCI_CONFIG_ADDR_PORT, &initial_config_addr.value); } static void pci_init_mmconfig() { struct acpi_mmconfig* acpi_mmconfig; struct pci_mmconfig* pci_mmconfig; for (acpi_mmconfig = acpi_get_next_mmconfig(NULL); acpi_mmconfig; acpi_mmconfig = acpi_get_next_mmconfig(acpi_mmconfig)) { pci_mmconfig = (struct pci_mmconfig *)alloc( sizeof(* pci_mmconfig)); if (!pci_mmconfig) { printf("pci_init_mmconfig: Can't alloc memory.\n"); return; } pci_mmconfig->phys_base = acpi_mmconfig->base; pci_mmconfig->seg = acpi_mmconfig->seg; pci_mmconfig->start_bus_no = acpi_mmconfig->start_bus_no; pci_mmconfig->end_bus_no = acpi_mmconfig->end_bus_no; pci_mmconfig->size = (pci_mmconfig->end_bus_no - pci_mmconfig->start_bus_no + 1) * 4096 * 32 * 8; pci_mmconfig->virt_base = mapmem(MAPMEM_HPHYS | MAPMEM_WRITE | MAPMEM_UC, pci_mmconfig->phys_base, pci_mmconfig->size); if (!pci_mmconfig->virt_base) { printf("pci_init_mmconfig: Can't map mmconfig area.\n"); free(pci_mmconfig); } printf("MMCONFIG enabled: phys 0x%llx virt 0x%lx size 0x%llx " "seg 0x%04x start bus 0x%02x end bus 0x%02x\n", pci_mmconfig->phys_base, (unsigned long)pci_mmconfig->virt_base, pci_mmconfig->size, pci_mmconfig->seg, pci_mmconfig->start_bus_no, pci_mmconfig->end_bus_no); LIST_APPEND(pci_mmconfig_list, pci_mmconfig); } } u32 pci_get_base_address_mask(struct pci_device *dev, int offset) { u32 mask; u32 tmp; tmp = pci_read_config32(dev, offset); pci_write_config32(dev, offset, 0xFFFFFFFF); mask = pci_read_config32(dev, offset); pci_write_config32(dev, offset, tmp); return mask; } static void pci_read_config_space(struct pci_device *dev) { dev->vendor_id = pci_read_config16(dev, PCI_CONFIG_VENDOR_ID); dev->device_id = pci_read_config16(dev, PCI_CONFIG_DEVICE_ID); dev->class_code = pci_read_config32(dev, PCI_CONFIG_CLASS_CODE - 1) >> 8; dev->header_type = pci_read_config8(dev, PCI_CONFIG_HEADER_TYPE); if (dev->type != PCI_CONFIG_HEADER_TYPE_1) { return; } dev->sec_bus = pci_read_config8(dev, PCI_CONFIG_SUBORDINATE_BUS_NUMBER); dev->sub_bus = pci_read_config8(dev, PCI_CONFIG_SUBORDINATE_BUS_NUMBER); } static void pci_init_resource_window(struct pci_device *dev) { struct resource *resource; u64 reg_val, base, limit; if (dev->type != PCI_CONFIG_HEADER_TYPE_1) { return; } /* * Iitialize I/O window. */ resource = dev->resource + PCI_RESOURCE_IO_WINDOW_INDEX; reg_val = pci_read_config8(dev, PCI_CONFIG_IO_BASE); base = (reg_val & PCI_CONFIG_IO_BASE_ADDRESS_MASK) << 8; if ((reg_val & PCI_CONFIG_IO_BASE_CAP_MASK) == PCI_CONFIG_IO_BASE_32_BIT) { reg_val = pci_read_config16(dev, PCI_CONFIG_IO_BASE_UPPER); base |= reg_val << 16; } reg_val = pci_read_config8(dev, PCI_CONFIG_IO_LIMIT); limit = (((reg_val & PCI_CONFIG_IO_LIMIT_ADDRESS_MASK) + PCI_CONFIG_IO_LIMIT_CAP_MASK) << 8) + 0xff; if ((reg_val & PCI_CONFIG_IO_LIMIT_CAP_MASK) == PCI_CONFIG_IO_LIMIT_32_BIT) { reg_val = pci_read_config16(dev, PCI_CONFIG_IO_LIMIT_UPPER); limit |= reg_val << 16; } if (base <= limit) { rm_init_resource(resource, base, limit, RESOURCE_TYPE_IO, PCI_RESOURCE_WINDOW, dev->name); } /* * Iitialize memory window. */ resource = dev->resource + PCI_RESOURCE_MEMORY_WINDOW_INDEX; reg_val = pci_read_config16(dev, PCI_CONFIG_MEMORY_BASE); base = (reg_val & PCI_CONFIG_MEMORY_BASE_ADDRESS_MASK) << 16; reg_val = pci_read_config16(dev, PCI_CONFIG_MEMORY_LIMIT); limit = (((reg_val & PCI_CONFIG_MEMORY_LIMIT_ADDRESS_MASK) + PCI_CONFIG_MEMORY_LIMIT_RESERVED_MASK) << 16) + 0xffff; if (base <= limit) { rm_init_resource(resource, base, limit, RESOURCE_TYPE_MMIO, PCI_RESOURCE_WINDOW, dev->name); } /* * Iitialize prefetchable memory window. */ resource = dev->resource + PCI_RESOURCE_PREFETCHABLE_WINDOW_INDEX; reg_val = pci_read_config16(dev, PCI_CONFIG_PREFETCHABLE_BASE); base = ((reg_val & PCI_CONFIG_PREFETCHABLE_BASE_ADDRESS_MASK) << 16); if ((reg_val & PCI_CONFIG_PREFETCHABLE_BASE_CAP_MASK) == PCI_CONFIG_PREFETCHABLE_BASE_64_BIT) { reg_val = pci_read_config32(dev, PCI_CONFIG_PREFETCHABLE_BASE_UPPER); base |= reg_val << 32; } reg_val = pci_read_config16(dev, PCI_CONFIG_PREFETCHABLE_LIMIT); limit = (((reg_val & PCI_CONFIG_PREFETCHABLE_LIMIT_ADDRESS_MASK) + PCI_CONFIG_PREFETCHABLE_LIMIT_CAP_MASK) << 16) + 0xffff; if ((reg_val & PCI_CONFIG_PREFETCHABLE_LIMIT_CAP_MASK) == PCI_CONFIG_PREFETCHABLE_LIMIT_64_BIT) { reg_val = pci_read_config32(dev, PCI_CONFIG_PREFETCHABLE_LIMIT_UPPER); limit |= (reg_val << 32); } if (base <= limit) { rm_init_resource(resource, base, limit, RESOURCE_TYPE_MMIO, PCI_RESOURCE_WINDOW | PCI_RESOURCE_PREFETCHABLE, dev->name); } reg_val = pci_read_config16(dev, PCI_CONFIG_BRIDGE_CONTROL); if ((reg_val & PCI_CONFIG_VGA_ENABLE) == 0) { return; } resource = dev->resource + PCI_RESOURCE_VGA_MEM; rm_init_resource(resource, 0xa0000, 0xbffff, RESOURCE_TYPE_MMIO, PCI_RESOURCE_WINDOW | PCI_RESOURCE_PREFETCHABLE, dev->name); resource = dev->resource + PCI_RESOURCE_VGA_IO1; rm_init_resource(resource, 0x3b0, 0x3bb, RESOURCE_TYPE_IO, PCI_RESOURCE_WINDOW, dev->name); resource = dev->resource + PCI_RESOURCE_VGA_IO2; rm_init_resource(resource, 0x3c0, 0x3df, RESOURCE_TYPE_IO, PCI_RESOURCE_WINDOW, dev->name); } static void pci_init_resources(struct pci_device *dev) { int i, bar_num; u32 reg_val; int offset; u32 mask; u32 data; phys_t start; struct resource *resource; switch (dev->type) { case PCI_CONFIG_HEADER_TYPE_0: bar_num = PCI_CONFIG_BAR_NUM; break; case PCI_CONFIG_HEADER_TYPE_1: bar_num = PCI_CONFIG_HEADER1_BAR_NUM; break; default: return; } for (i = 0; i < bar_num; i++) { offset = PCI_CONFIG_BASE_ADDRESS0 + i * 4; resource = dev->resource + i; reg_val = pci_read_config32(dev, offset); if (reg_val == 0x00000000 || reg_val == 0xFFFFFFFF) { /* Unimplemented register */ continue; } mask = pci_get_base_address_mask(dev, offset); if ((reg_val & PCI_CONFIG_BAR_SPACEMASK) == PCI_CONFIG_BAR_IOSPACE) { start = reg_val & PCI_CONFIG_BAR_IOMASK; if (start == 0x0) { continue; } mask &= PCI_CONFIG_BAR_IOMASK; mask |= 0xFFFF0000; rm_init_resource(resource, start, start + (~mask), RESOURCE_TYPE_IO, 0, dev->name); } else { if (reg_val & PCI_CONFIG_BAR_PREFETCHABLE) { data = PCI_RESOURCE_PREFETCHABLE; } else { data = 0; } start = reg_val & PCI_CONFIG_BAR_MEMMASK; if ((reg_val & PCI_CONFIG_BAR_MEMTYPE_MASK) == PCI_CONFIG_BAR_MEMTYPE_64) { i++; offset += 4; reg_val = pci_read_config32(dev, offset); start |= (u64)reg_val << 32; } if (start == 0x0) { continue; } mask &= PCI_CONFIG_BAR_MEMMASK; rm_init_resource(resource, start, start + (~mask), RESOURCE_TYPE_MMIO, data, dev->name); } resource->name = dev->name; } pci_init_resource_window(dev); resource = dev->resource + PCI_RESOURCE_EXPANTION_ROM_INDEX; reg_val = pci_read_config32(dev, PCI_CONFIG_EXPANSION_ROM); if (reg_val != 0x00000000 && reg_val != 0xFFFFFFFF) { start = reg_val & PCI_CONFIG_ROM_MEMMASK; mask = pci_get_base_address_mask(dev, PCI_CONFIG_EXPANSION_ROM) & PCI_CONFIG_ROM_MEMMASK; rm_init_resource(resource, start, start + (~mask), RESOURCE_TYPE_MMIO, 0, dev->name); } } static struct pci_device *pci_new_device(u8 bus, u8 devfn) { struct pci_device *dev; dev = (struct pci_device *)alloc(sizeof(struct pci_device)); if (dev != NULL) { memset(dev, 0, sizeof(*dev)); dev->bus_no = bus; dev->devfn = devfn; dev->driver = NULL; snprintf(dev->name, PCI_LOCATION_STR_SIZE, PCI_LOCATION_FORMAT, PCI_LOCATION_VALUE(dev)); pci_read_config_space(dev); pci_init_resources(dev); } return dev; } static u8 pci_scan_buses_behind_bridge(struct pci_device *bridge) { int bn; for (bn = bridge->sec_bus; bn <= bridge->sub_bus; bn++) { bn = pci_scan_bus(bridge, bridge->seg, bn); } return bn; } static u8 pci_scan_bus(struct pci_device *parent, u16 seg, u8 bn) { int dn, fn; u16 data; struct pci_device *dev; u8 ret = bn; if (seg != 0) { /* * Currently we does not support multi segments. */ return bn; } for (dn = 0; dn < PCI_MAX_DEVICES; dn++) { for (fn = 0; fn < PCI_MAX_FUNCS; fn++) { data = pci_read_config_16(bn, PCI_DEVFN(dn, fn), 0); if (data == 0xFFFF) /* not exist */ continue; dev = pci_new_device(bn, PCI_DEVFN(dn, fn)); if (dev == NULL) { panic("pci_scan_bus: Can't alloc memory"); } pci_register_device(parent, dev); if (dev->type == PCI_CONFIG_HEADER_TYPE_1) { ret = pci_scan_buses_behind_bridge(dev); } if (fn == 0 && dev->multi_function == 0) break; } } return ret; } static void pci_find_devices(void) { int bn; struct pci_mmconfig *mmconfig; if (LIST_HEAD(pci_mmconfig_list)) { LIST_FOREACH(pci_mmconfig_list, mmconfig) { for (bn = mmconfig->start_bus_no; bn <= mmconfig->end_bus_no; bn++) { bn = pci_scan_bus(NULL, mmconfig->seg, bn); } } } else { for (bn = 0; bn < PCI_MAX_BUSES; bn++) { bn = pci_scan_bus(NULL, 0, bn); } } return; } static void pci_init(void) { pci_init_root_resources(); pci_init_legacy_config(); pci_init_mmconfig(); pci_find_devices(); pci_handle = vm_alloc_driver_data(sizeof(struct pci_vm_data)); } static void pci_setup_vm(void) { int i; struct pci_vm_data *pci_data; pci_data = vm_get_driver_data(pci_handle); pci_data->config_addr.value = initial_config_addr.value; LIST2_HEAD_INIT(pci_data->vm_pci_device_list); if (cpu_is_bsp()) { pci_assign_devices_to_vm0(); } else { pci_assign_devices(); } set_iofunc(PCI_CONFIG_ADDR_PORT, pci_config_addr_handler); for (i = 0; i < 4; i++) { set_iofunc(PCI_CONFIG_DATA_PORT + i, pci_config_data_handler); } } BUS_INIT(pci_init); BUS_PASSVM(pci_setup_vm); tinyvisor/vmm/io/serial_emu.c0000644006644000001440000001354012011466501016562 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Serial controller (UART 16550) emulator. * I implement only writing for serial console of guest Linux and * guest BIOS. */ #include #include #include #include #include #include #include #include #include #define SERIAL_GSI 4 /* #define SERIAL_DEBUG */ #ifdef SERIAL_DEBUG #define SERIAL_DBG(...) \ do { \ printf("SERIAL: " __VA_ARGS__); \ } while (0) #else #define SERIAL_DBG(...) #endif struct serial_emu { spinlock_t lock; u8 ratelsb; u8 ratemsb; u8 intrctl; u8 fifoctl; u8 linectl; u8 modectl; u8 modestat; u8 user; bool tbr_empty; }; static drvdata_hdl_t serial_handle; static void serial_inb(ioport_t port_off, u8 *data) { struct serial_emu *serial; serial = vm_get_driver_data(serial_handle); spinlock_lock(&serial->lock); if (serial->linectl & LINECTL_DLAB_BIT) { switch (port_off) { case PORT_RATELSB: /* 0 */ *data = serial->ratelsb; spinlock_unlock(&serial->lock); return; case PORT_RATEMSB: /* 1 */ *data = serial->ratemsb; spinlock_unlock(&serial->lock); return; } } switch (port_off) { case PORT_DATA: /* 0 */ *data = 0; break; case PORT_INTRCTL: /* 1 */ *data = serial->intrctl; break; case PORT_INTRSTAT: /* 2 */ if (serial->intrctl & INTRCTL_ETBREI_BIT && serial->tbr_empty) { *data = INTRSTAT_TBR_EMPTY_INTR; serial->tbr_empty = false; /* Reading ISR clears TBR empty interrupt. */ } else { *data = INTRSTAT_INT_NO_PENDING; /* 0 if interrupt pending */ } break; case PORT_LINECTL: /* 3 */ *data = serial->linectl; break; case PORT_MODECTL: /* 4 */ *data = serial->modectl; break; case PORT_LINESTAT: /* 5 */ *data = LINESTAT_TXSTART_BIT | LINESTAT_TX_BIT; break; case PORT_MODESTAT: /* 6 */ *data = serial->modestat | MODESTAT_CTS_BIT; break; case PORT_USER: /* 7 */ *data = serial->user; break; default: panic("serial_inb: Invalid port_off. port_off 0x%x", port_off); } spinlock_unlock(&serial->lock); } static void serial_outb(ioport_t port_off, u8 data) { struct serial_emu *serial; u8 oldval; serial = vm_get_driver_data(serial_handle); spinlock_lock(&serial->lock); if (serial->linectl & LINECTL_DLAB_BIT) { switch (port_off) { case PORT_RATELSB: /* 0 */ serial->ratelsb = data; spinlock_unlock(&serial->lock); return; case PORT_RATEMSB: /* 1 */ serial->ratemsb = data; spinlock_unlock(&serial->lock); return; } } switch (port_off) { case PORT_DATA: /* 0 */ if (data != '\r') { /* * Emit '\r' because serial_putchar add '\r' * before '\n'. */ serial_putchar(data); } if (serial->intrctl & INTRCTL_ETBREI_BIT) { serial->tbr_empty = true; ioapic_trigger_int(SERIAL_GSI); } break; case PORT_INTRCTL: /* 1 */ oldval = serial->intrctl; serial->intrctl = data; SERIAL_DBG("Write INTRCTL 0x%x\n", data); if ((oldval & INTRCTL_ETBREI_BIT) == 0 || serial->intrctl & INTRCTL_ETBREI_BIT) { serial->tbr_empty = true; ioapic_trigger_int(SERIAL_GSI); } break; case PORT_FIFOCTL: /* 2 */ serial->fifoctl = data; SERIAL_DBG("Write FIFOCTL 0x%x\n", data); break; case PORT_LINECTL: /* 3 */ serial->linectl = data; break; case PORT_MODECTL: /* 4 */ serial->modectl = data; break; case PORT_LINESTAT: /* 5 */ break; case PORT_MODESTAT: /* 6 */ serial->modestat = data; break; case PORT_USER: /* 7 */ serial->user = data; break; default: panic("serial_outb: Invalid port_off. port_off 0x%x", port_off); } spinlock_unlock(&serial->lock); } static int serial_io_hook(iotype_t type, ioport_t port, void *data) { ioport_t port_off; port_off = port - SERIAL_PORT1; switch (type) { case IOTYPE_INB: serial_inb(port_off, data); break; case IOTYPE_OUTB: serial_outb(port_off, *(u8 *)data); break; default: break; } return 1; /* emulated */ } static void serial_setup(void) { struct serial_emu *serial; u32 i; serial = vm_get_driver_data(serial_handle); spinlock_init(&serial->lock); for (i = SERIAL_PORT1; i < SERIAL_PORT1 + SERIAL_NUM_OF_IOPORT; i++) set_iofunc (i, serial_io_hook); } static void serial_init(void) { serial_handle = vm_alloc_driver_data(sizeof(struct serial_emu)); } DRIVER_PASSVM(serial_setup); DRIVER_INIT(serial_init); tinyvisor/vmm/io/ioapic_emu.c0000644006644000001440000002005611763377733016574 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * IOAPIC emulator. * Supports injecting a edge-triggered interrupt. * Not-supports injecting a level-triggered interrupt. */ #include #include #include #include #include #include #include #include #include #include #include "hpet.h" #define IOAPIC_MEM_START 0xfec00000 #define IOAPIC_MEM_SIZE 0x00100000 #define IOAPIC_INDEX_REG 0xfec00000 #define IOAPIC_DATA_REG 0xfec00010 #define IOAPIC_ID_REG_INDEX 0x00 #define IOAPIC_VER_REG_INDEX 0x01 #define IOAPIC_REDIR_TBL_SIZE 2 #define IOAPIC_REDIR_TBL_NUM 24 #define IOAPIC_REDIR_TBL0_LOW_INDEX 0x10 #define IOAPIC_REDIR_TBLmax_HIGH_INDEX \ (IOAPIC_REDIR_TBL0_LOW_INDEX \ + IOAPIC_REDIR_TBL_SIZE * IOAPIC_REDIR_TBL_NUM \ - 1) #define IOAPIC_REDIR_HIGH(ioapic, pin) \ (ioapic->redir[pin * 2 + 1]) #define IOAPIC_REDIR_LOW(ioapic, pin) \ (ioapic->redir[pin * 2]) #define IOAPIC_GSI(index) \ ((index - IOAPIC_REDIR_TBL0_LOW_INDEX) / 2) #define IOAPIC_VER_REG_VAL 0x00170011 #define IOAPIC_REDIR_LOW_MASK_BIT 0x00010000 #define IOAPIC_REDIR_LOW_VECTOR_MASK 0x000000ff #define IOAPIC_REDIR_LOW_VECTOR_SHIFT 0 #define IOAPIC_REDIR_LOW_DELIVERY_MODE_MASK 0x00000700 #define IOAPIC_REDIR_LOW_DELIVERY_MODE_FIXED 0x00000000 #define IOAPIC_REDIR_LOW_LOGICAL_DEST_BIT 0x00000800 #define IOAPIC_REDIR_LOW_LEVEL_TRIGGER_BIT 0x00008000 #define IOAPIC_REDIR_HIGH_DEST_MASK 0xff000000 #define IOAPIC_REDIR_HIGH_DEST_SHIFT 24 /* #define IOAPIC_DEBUG */ #ifdef IOAPIC_DEBUG #define IOAPIC_DBG(...) \ do { \ printf(__VA_ARGS__); \ } while (0) #else #define IOAPIC_DBG(...) #endif struct ioapic_emu { spinlock_t lock; u8 index; u32 id; u32 redir[IOAPIC_REDIR_TBL_NUM * 2]; }; static drvdata_hdl_t ioapic_handle; vmmerr_t ioapic_get_vector(gsi_t gsi, vector_t *vector, bool *mask) { struct ioapic_emu *ioapic; u32 redir_low; if (gsi >= IOAPIC_REDIR_TBL_NUM) { return VMMERR_RANGE; } ioapic = vm_get_driver_data(ioapic_handle); spinlock_lock(&ioapic->lock); redir_low = IOAPIC_REDIR_LOW(ioapic, gsi); *mask = (redir_low & IOAPIC_REDIR_LOW_MASK_BIT) ? true : false; *vector = redir_low & IOAPIC_REDIR_LOW_VECTOR_MASK; spinlock_unlock(&ioapic->lock); return VMMERR_SUCCESS; } void ioapic_trigger_int(gsi_t gsi) { struct ioapic_emu *ioapic; vector_t vector; u32 redir_low; apic_id_t dest; if (gsi >= IOAPIC_REDIR_TBL_NUM) { return; } ioapic = vm_get_driver_data(ioapic_handle); spinlock_lock(&ioapic->lock); redir_low = IOAPIC_REDIR_LOW(ioapic, gsi); if (redir_low & (IOAPIC_REDIR_LOW_MASK_BIT | IOAPIC_REDIR_LOW_LEVEL_TRIGGER_BIT)) { spinlock_unlock(&ioapic->lock); return; } if ((redir_low & IOAPIC_REDIR_LOW_DELIVERY_MODE_MASK) != IOAPIC_REDIR_LOW_DELIVERY_MODE_FIXED) { spinlock_unlock(&ioapic->lock); return; } vector = (redir_low & IOAPIC_REDIR_LOW_VECTOR_MASK) >> IOAPIC_REDIR_LOW_VECTOR_SHIFT; dest = (IOAPIC_REDIR_HIGH(ioapic, gsi) & IOAPIC_REDIR_HIGH_DEST_MASK) >> IOAPIC_REDIR_HIGH_DEST_SHIFT; IOAPIC_DBG("IOAPIC: trigger vector 0x%x dest 0x%x\n", vector, dest); extint_send_apic_int(vector, dest); spinlock_unlock(&ioapic->lock); } static gsi_t ioapic_write_data_reg(struct ioapic_emu *ioapic, u32 val) { int updated_gsi = INVALID_GSI; switch(ioapic->index) { case IOAPIC_ID_REG_INDEX: ioapic->id = val; IOAPIC_DBG("IOAPIC: Write ID, val 0x%x\n", val); break; default: if (ioapic->index >= IOAPIC_REDIR_TBL0_LOW_INDEX && ioapic->index <= IOAPIC_REDIR_TBLmax_HIGH_INDEX) { ioapic->redir[ioapic->index - IOAPIC_REDIR_TBL0_LOW_INDEX] = val; IOAPIC_DBG("IOAPIC: Write REDIR %d %s. val 0x%x\n", (ioapic->index - IOAPIC_REDIR_TBL0_LOW_INDEX) / 2, ioapic->index % 2 ? "high" : "low", val); updated_gsi = IOAPIC_GSI(ioapic->index); } else { IOAPIC_DBG("IOAPIC: Write unknown reg. index %d. val 0x%x\n", ioapic->index, val); } break; } return updated_gsi; } static u32 ioapic_read_data_reg(struct ioapic_emu* ioapic) { u32 val = 0xffffffff; switch(ioapic->index) { case IOAPIC_ID_REG_INDEX: val = ioapic->id; IOAPIC_DBG("IOAPIC: Read ID, val 0x%x\n", val); break; case IOAPIC_VER_REG_INDEX: val = IOAPIC_VER_REG_VAL; IOAPIC_DBG("IOAPIC: Read VER, val 0x%x\n", val); break; default: if (ioapic->index >= IOAPIC_REDIR_TBL0_LOW_INDEX && ioapic->index <= IOAPIC_REDIR_TBLmax_HIGH_INDEX) { val = ioapic->redir[ioapic->index - IOAPIC_REDIR_TBL0_LOW_INDEX]; IOAPIC_DBG("IOAPIC: Read REDIR %d %s. val 0x%x\n", (ioapic->index - IOAPIC_REDIR_TBL0_LOW_INDEX) / 2, ioapic->index % 2 ? "high" : "low", val); } else { IOAPIC_DBG("IOAPIC: Read unknown reg. index %d\n", ioapic->index); } break; } return val; } static int ioapic_mem_reg_handler(void *data, phys_t gphys, bool wr, void *buf, uint len, u32 flags) { struct ioapic_emu *ioapic = (struct ioapic_emu *)data; gsi_t updated_gsi = INVALID_GSI;; int ret = 1; int done = 0; spinlock_lock(&ioapic->lock); if (len == 4) { if (wr) { switch (gphys) { case IOAPIC_INDEX_REG: ioapic->index = *(u32 *)buf; done = 1; break; case IOAPIC_DATA_REG: updated_gsi = ioapic_write_data_reg( ioapic, *(u32 *)buf); done = 1; break; default: IOAPIC_DBG("IOAPIC: Write unknown reg. gphys 0x%llx, val 0x%x\n", gphys, *(u32 *)buf); } } else { switch (gphys) { case IOAPIC_INDEX_REG: *(u32 *)buf = ioapic->index; done = 1; break; case IOAPIC_DATA_REG: *(u32 *)buf = ioapic_read_data_reg(ioapic); done = 1; break; default: IOAPIC_DBG("IOAPIC: Read unknown reg. gphys 0x%llx\n", gphys); } } } if (! done) { ret = mmio_do_nothing(data, gphys, wr, buf, len, flags); } spinlock_unlock(&ioapic->lock); if (updated_gsi != INVALID_GSI) { hpet_ioapic_updated(updated_gsi); } return ret; } static void ioapic_setup (void) { struct ioapic_emu *ioapic; int i; ioapic = vm_get_driver_data(ioapic_handle); spinlock_init(&ioapic->lock); for (i = 0; i < IOAPIC_REDIR_TBL_NUM; i++) { IOAPIC_REDIR_LOW(ioapic, i) = IOAPIC_REDIR_LOW_MASK_BIT; } if (cpu_is_bsp()) { /* * vm0 is allowed to access ioapic directory. */ return; } mmio_register(IOAPIC_MEM_START, IOAPIC_MEM_SIZE, ioapic_mem_reg_handler, ioapic); } static void ioapic_init(void) { ioapic_handle = vm_alloc_driver_data(sizeof(struct ioapic_emu)); } DRIVER_PASSVM(ioapic_setup); DRIVER_INIT(ioapic_init); tinyvisor/vmm/io/hpet.c0000644006644000001440000003601112166260613015402 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include /* #define HPET_DEBUG 1 */ #ifdef HPET_DEBUG #define HPET_DBG(level, ...) \ do { \ if (level <= HPET_DEBUG) { \ printf(__VA_ARGS__); \ } \ } while (0) #else #define HPET_DBG(...) #endif #define ACPI_HPET_SIGNATURE "HPET" #define ACPI_NUM_OF_TIMER_MASK 0x00001f00 #define ACPI_NUM_OF_TIMER_SHIFT 8 #define HPET_EMU_BASE 0xfed00000 #define HPET_MEM_SIZE 0x400 #define HPET_GCAP_ID 0x0 #define HPET_GCAP_ID_SIZE 8 #define HPET_NUM_OF_TIMER_MASK 0x00001f00 #define HPET_NUM_OF_TIMER_SHIFT 8 #define HPET_GEN_CONF 0x10 #define HPET_GEN_CONF_SIZE 8 #define HPET_LEG_RT_CNF 0x2 #define HPET_ENABLE_CNF 0x1 #define HPET_ENABLED(gen_conf) \ (((gen_conf) & HPET_ENABLE_CNF) != 0) #define HPET_LEG_RT_ENABLED(gen_conf) \ (((gen_conf) & (HPET_LEG_RT_CNF | HPET_ENABLE_CNF)) \ == (HPET_LEG_RT_CNF | HPET_ENABLE_CNF)) #define HPET_NON_LEG_RT_ENABLED(gen_conf) \ (((gen_conf) & (HPET_LEG_RT_CNF | HPET_ENABLE_CNF)) \ == HPET_ENABLE_CNF) #define HPET_GINTR_STA 0x20 #define HPET_GINTR_STA_SIZE 8 #define HPET_MAIN_CNT 0xf0 #define HPET_MAIN_CNT_SIZE 8 #define HPET_TIM_CONF(timer) ((timer) * 0x20 + 0x100) #define HPET_TIM_CONF_SIZE 8 #define HPET_TIM_CONF_TIMER(reg) (((reg) - 0x100) / 0x20) #define HPET_TN_FSB_INT_DEL_CAP 0x8000 #define HPET_TN_FSB_EN_CNF 0x4000 #define HPET_TN_INT_ROUTE_CNF_MASK 0x3e00 #define HPET_TN_VAL_SET_CNF 0x0040 #define HPET_TN_INT_ENB_CNF 0x0004 #define HPET_TN_INT_TYPE_CNF 0x0002 #define HPET_PIN_BASED_ENABLED(conf) \ (((conf) & (HPET_TN_INT_ENB_CNF | HPET_TN_FSB_EN_CNF)) == \ HPET_TN_INT_ENB_CNF) #define HPET_TIM_COMP(timer) ((timer) * 0x20 + 0x108) #define HPET_TIM_COMP_SIZE 8 #define HPET_TIM_COMP_TIMER(reg) (((reg) - 0x108) / 0x20) #define HPET_FSB_INT_ROUTE(timer) ((timer) * 0x20 + 0x110) #define HPET_FSB_INT_ROUTE_SIZE 8 #define HPET_FSB_INT_ROUTE_TIMER(reg) (((reg) - 0x110) / 0x20) #define TIMER0_GSI 2 #define TIMER1_GSI 8 /* * Physial destination mode. * No redirection. * Edge trigger. * FIxed interrupt. */ #define HPET_FSB_INT_ROUTE_VAL 0xfee0000000000000LL #define HPET_FSB_DEST_ID_SHIFT 44 #define HPET_FSB_VECTOR_SHIFT 0 #define hpet_reg(emu, gphys) \ ((gphys) - (emu)->gphys_base) #define hpet_g2v(dev, emu, gphys) \ (void *)((char *)(dev)->virt_base + hpet_reg((emu), (gphys))) /* #define HPET_PASS_TIMER_NUM 4 */ #define HPET_TIMER_MAX_NUM 32 #define hpet_read32(dev, reg) \ read64((char *)((dev)->virt_base) + (reg)) #define hpet_read64(dev, reg) \ read32((char *)((dev)->virt_base) + (reg)) #define hpet_write32(dev, reg, val) \ write32((char *)((dev)->virt_base) + (reg), (val)) #define hpet_write64(dev, reg, val) \ write64((char *)((dev)->virt_base) + (reg), (val)) struct acpi_hpet { struct acpi_desc_header header; u32 hardware_id; struct acpi_generic_address base_address; u8 number; u16 min_clock_tick; u8 attribute; } __attribute__ ((packed)); struct hpet_emu_timer { u64 conf; vector_t vector; gsi_t gsi; }; struct hpet_emu { spinlock_t lock; phys_t gphys_base; u64 gen_conf; struct hpet_emu_timer timer[HPET_TIMER_MAX_NUM]; }; struct hpet_dev { spinlock_t lock; phys_t phys_base; void *virt_base; uint num_of_timer; bool initialized; }; static struct hpet_dev hpet_dev = {.lock = SPINLOCK_INITIALIZER, .initialized = false}; static drvdata_hdl_t hpet_handle; static void hpet_modify_reg_val64(u64 *reg, phys_t off, char *buf, uint len) { memcpy((char *)reg + (off & 0x7), buf, len); } static void hpet_modify_buf_val64(char *buf, uint len, u64 *reg, phys_t off) { memcpy(buf, (char *)reg + (off & 0x7), len); } static void hpet_setup_non_legacy_int(struct hpet_emu *hpet_emu, uint timer_no) { struct hpet_emu_timer *timer = hpet_emu->timer + timer_no; u64 conf = timer->conf; #ifdef HPET_DEBUG u64 old_conf; #endif if (HPET_PIN_BASED_ENABLED(conf)) { printf("HPET: Pin-based interrupt is not supported. timer %d\n", timer_no); conf &= ~HPET_TN_INT_ENB_CNF; } conf |= HPET_TN_FSB_EN_CNF; spinlock_lock(&hpet_dev.lock); if (timer_no >= hpet_dev.num_of_timer) { spinlock_unlock(&hpet_dev.lock); return; } #ifdef HPET_DEBUG old_conf = hpet_read64(&hpet_dev, HPET_TIM_CONF(timer_no)); if (!(old_conf & HPET_TN_INT_ENB_CNF) && (conf & HPET_TN_INT_ENB_CNF)) { HPET_DBG(1, "Enable non-legacy int of timer %d. " "HPET_TIM_CONF(%d) 0x%llx\n", timer_no, timer_no, conf); } else { HPET_DBG(2, "Write host HPET_TIM_CONF(%d) 0x%llx\n", timer_no, conf); } #endif hpet_write64(&hpet_dev, HPET_TIM_CONF(timer_no), conf); spinlock_unlock(&hpet_dev.lock); } #ifdef HPET_HOOK_INTR static int hpet_int(vector_t vector, void *data) { HPET_DBG(2, "hpet_int 0x%x\n", vector); return INT_UNHANDLED; } #endif static void hpet_setup_legacy_int(struct hpet_emu *hpet_emu, uint timer_no) { struct hpet_emu_timer *timer = hpet_emu->timer + timer_no; u64 conf = timer->conf; u64 fsb; vector_t vector = 0; apic_id_t dest_id; bool mask; #ifdef HPET_DEBUG u64 old_conf; #endif #ifdef HPET_HOOK_INTR if (timer->vector) { clear_int_hook(timer->vector); } #endif if (conf & HPET_TN_INT_ENB_CNF) { ioapic_get_vector(timer->gsi, &vector, &mask); if (mask) { vector = 0; } } spinlock_lock(&hpet_dev.lock); if (timer_no >= hpet_dev.num_of_timer) { spinlock_unlock(&hpet_dev.lock); return; } if (vector) { #ifdef HPET_HOOK_INTR /* * Setup a interrupt. */ set_int_hook(vector, hpet_int, (void *)(long)timer->gsi); #endif dest_id = vm_vbsp_apic_id(); fsb = HPET_FSB_INT_ROUTE_VAL | ((u64)dest_id << HPET_FSB_DEST_ID_SHIFT) | (vector << HPET_FSB_VECTOR_SHIFT); HPET_DBG(2, "Write host HPET_FSB(%d) 0x%llx\n", timer_no, fsb); hpet_write64(&hpet_dev, HPET_FSB_INT_ROUTE(timer_no), fsb); conf &= ~HPET_TN_INT_TYPE_CNF; /* Use edge-triggered */ conf |= HPET_TN_FSB_EN_CNF; /* Enable MSI */ } else { conf &= ~HPET_TN_INT_ENB_CNF; } #ifdef HPET_DEBUG old_conf = hpet_read64(&hpet_dev, HPET_TIM_CONF(timer_no)); if (!(old_conf & HPET_TN_INT_ENB_CNF) && (conf & HPET_TN_INT_ENB_CNF)) { HPET_DBG(1, "Enable legacy int of timer %d. " "HPET_TIM_CONF(%d) 0x%llx\n", timer_no, timer_no, conf); } else { HPET_DBG(2, "Write host HPET_TIM_CONF(%d) 0x%llx\n", timer_no, conf); } #endif hpet_write64(&hpet_dev, HPET_TIM_CONF(timer_no), conf); spinlock_unlock(&hpet_dev.lock); timer->vector = vector; } static void hpet_setup_all_int(struct hpet_emu *hpet_emu) { struct hpet_emu_timer *timer; int i; for (i = 0; i < HPET_TIMER_MAX_NUM; i++) { timer = hpet_emu->timer + i; if (HPET_LEG_RT_ENABLED(hpet_emu->gen_conf) && timer->gsi != INVALID_GSI) { hpet_setup_legacy_int(hpet_emu, i); } else { hpet_setup_non_legacy_int(hpet_emu, i); } } } static int hpet_gen_conf_handler(void *data, phys_t gphys, bool wr, void *buf, uint len, u32 flags) { struct hpet_emu *hpet_emu = (struct hpet_emu *)data; u64 reg, old_conf; spinlock_lock(&hpet_emu->lock); reg = hpet_emu->gen_conf; if (wr) { old_conf = reg; hpet_modify_reg_val64(®, gphys, buf, len); hpet_emu->gen_conf = reg; HPET_DBG(2, "Write guest HPET_GEN_CONF 0x%llx\n", reg); if (!HPET_ENABLED(old_conf) && HPET_ENABLED(hpet_emu->gen_conf)) { hpet_setup_all_int(hpet_emu); } /* * Disable legacy interrupt. We use MSI (FSB). */ reg &= ~HPET_LEG_RT_CNF; spinlock_lock(&hpet_dev.lock); HPET_DBG(2, "Write host HPET_GEN_CONF 0x%llx\n", reg); hpet_write64(&hpet_dev, HPET_GEN_CONF, reg); spinlock_unlock(&hpet_dev.lock); } else { hpet_modify_buf_val64(buf, len, ®, gphys); } spinlock_unlock(&hpet_emu->lock); return 1; /* emulated */ } void hpet_ioapic_updated(gsi_t gsi) { struct hpet_emu *hpet_emu = vm_get_driver_data(hpet_handle); spinlock_lock(&hpet_emu->lock); if (!HPET_LEG_RT_ENABLED(hpet_emu->gen_conf)) { spinlock_unlock(&hpet_emu->lock); return; } switch (gsi) { case TIMER0_GSI: hpet_setup_legacy_int(hpet_emu, 0); break; case TIMER1_GSI: hpet_setup_legacy_int(hpet_emu, 1); break; } spinlock_unlock(&hpet_emu->lock); } static mmio_handler_t hpet_tim_conf_handler; static int hpet_tim_conf_handler(void *data, phys_t gphys, bool wr, void *buf, uint len, u32 flags) { struct hpet_emu *hpet_emu = (struct hpet_emu *)data; struct hpet_emu_timer *timer; u64 conf; uint timer_no; spinlock_lock(&hpet_emu->lock); timer_no = HPET_TIM_CONF_TIMER(hpet_reg(hpet_emu, gphys)); timer = hpet_emu->timer + timer_no; conf = timer->conf; if (!wr) { hpet_modify_buf_val64(buf, len, &conf, gphys); spinlock_unlock(&hpet_emu->lock); return 1; /* emulated */ } hpet_modify_reg_val64(&conf, gphys, buf, len); timer->conf = conf; HPET_DBG(2, "Write guest HPET_TIM_CONF(%d) 0x%llx\n", timer_no, conf); if (HPET_LEG_RT_ENABLED(hpet_emu->gen_conf) && timer->gsi != INVALID_GSI) { hpet_setup_legacy_int(hpet_emu, timer_no); } else if (HPET_NON_LEG_RT_ENABLED(hpet_emu->gen_conf) || (HPET_LEG_RT_ENABLED(hpet_emu->gen_conf) && timer->gsi == INVALID_GSI)) { hpet_setup_non_legacy_int(hpet_emu, timer_no); } else { spinlock_lock(&hpet_dev.lock); if (timer_no < hpet_dev.num_of_timer) { HPET_DBG(2, "Write host HPET_TIM_CONF(%d) 0x%llx\n", timer_no, conf); } hpet_write64(&hpet_dev, HPET_TIM_CONF(timer_no), conf); spinlock_unlock(&hpet_dev.lock); } /* * HPET_TN_VAL_SET_CNF should be cleared automatically for * guest software. */ timer->conf &= ~HPET_TN_VAL_SET_CNF; spinlock_unlock(&hpet_emu->lock); return 1; /* emulated */ } static int hpet_pass(void *data, phys_t gphys, bool wr, void *buf, uint len, u32 flags) { struct hpet_emu *hpet_emu = (struct hpet_emu *)data; #ifdef HPET_DEBUG u64 tmp = 0; #endif spinlock_lock(&hpet_emu->lock); spinlock_lock(&hpet_dev.lock); if (wr) { mmio_memcpy(hpet_g2v(&hpet_dev, hpet_emu, gphys), buf, len); } else { mmio_memcpy(buf, hpet_g2v(&hpet_dev, hpet_emu, gphys), len); } #ifdef HPET_DEBUG memcpy(&tmp, buf, len <= sizeof(tmp) ? len : sizeof(tmp)); HPET_DBG(2, "%s HPET off 0x%llx val 0x%llx\n", wr ? "Write" : "Read", hpet_reg(hpet_emu, gphys), tmp); #endif spinlock_unlock(&hpet_dev.lock); spinlock_unlock(&hpet_emu->lock); return 1; /* emulated */ } static void hpet_setup_vm(void) { struct hpet_emu *hpet_emu; int i; spinlock_lock(&hpet_dev.lock); if (hpet_dev.initialized == false) { spinlock_unlock(&hpet_dev.lock); return; } if (vm_get_id() != 1) { /* * Hide HPET from vm0 and vmn (n > 1). */ mmio_register(hpet_dev.phys_base, HPET_MEM_SIZE, mmio_do_nothing, NULL); spinlock_unlock(&hpet_dev.lock); return; } hpet_emu = vm_get_driver_data(hpet_handle); spinlock_init(&hpet_emu->lock); hpet_emu->gphys_base = HPET_EMU_BASE; mmio_register(hpet_emu->gphys_base + HPET_GCAP_ID, HPET_GCAP_ID_SIZE, hpet_pass, hpet_emu); mmio_register(hpet_emu->gphys_base + HPET_GEN_CONF, HPET_GEN_CONF_SIZE, hpet_gen_conf_handler, hpet_emu); mmio_register(hpet_emu->gphys_base + HPET_GINTR_STA, HPET_GINTR_STA_SIZE, hpet_pass, hpet_emu); mmio_register(hpet_emu->gphys_base + HPET_MAIN_CNT, HPET_MAIN_CNT_SIZE, hpet_pass, hpet_emu); for (i = 0; i < hpet_dev.num_of_timer; i++) { mmio_register(hpet_emu->gphys_base + HPET_TIM_CONF(i), HPET_TIM_CONF_SIZE, hpet_tim_conf_handler, hpet_emu); mmio_register(hpet_emu->gphys_base + HPET_TIM_COMP(i), HPET_TIM_COMP_SIZE + HPET_FSB_INT_ROUTE_SIZE, hpet_pass, hpet_emu); hpet_emu->timer[i].conf = hpet_read64(&hpet_dev, HPET_TIM_CONF(i)); } hpet_emu->gen_conf = hpet_read64(&hpet_dev, HPET_GEN_CONF); hpet_emu->timer[0].gsi = TIMER0_GSI; hpet_emu->timer[1].gsi = TIMER1_GSI; for (i = 2; i < HPET_TIMER_MAX_NUM; i++) { hpet_emu->timer[i].gsi = INVALID_GSI; } spinlock_unlock(&hpet_dev.lock); } static void hpet_init_dev(phys_t base) { u32 cap_reg; spinlock_lock(&hpet_dev.lock); hpet_dev.virt_base = mapmem(MAPMEM_HPHYS | MAPMEM_WRITE | MAPMEM_UC, base, HPET_MEM_SIZE); if (hpet_dev.virt_base == NULL) { printf("Failed to map HPET registers.\n"); return; } hpet_dev.phys_base = base; cap_reg = hpet_read32(&hpet_dev, HPET_GCAP_ID); hpet_dev.num_of_timer = ((cap_reg & HPET_NUM_OF_TIMER_MASK) >> HPET_NUM_OF_TIMER_SHIFT) + 1; printf("HPET has %d timers.\n", hpet_dev.num_of_timer); hpet_dev.initialized = true; spinlock_unlock(&hpet_dev.lock); } static acpi_parser_t hpet_parse_acpi_table; static void hpet_parse_acpi_table(void *table, u32 length) { struct acpi_hpet *acpi_hpet = (struct acpi_hpet *)table; if (acpi_hpet->base_address.space_id != ACPI_SYSTEM_MEMORY) { printf("A space id of base address of HPET is invalid. %d\n", acpi_hpet->base_address.space_id); return; } printf("HPET found. base 0x%llx\n", acpi_hpet->base_address.address); if (acpi_hpet->number > 0) { /* * We only handle the first HPET. * not-first HPETs are exposed to a vm0. */ return; } printf("Hide HPET from vm0\n"); acpi_hpet->header.signature[0] = '\0'; hpet_init_dev(acpi_hpet->base_address.address); } static void hpet_init(void) { hpet_handle = vm_alloc_driver_data(sizeof(struct hpet_emu)); acpi_register_parser(ACPI_HPET_SIGNATURE, hpet_parse_acpi_table); } DRIVER_PASSVM(hpet_setup_vm); DRIVER_INIT(hpet_init); tinyvisor/vmm/io/rtc.c0000644006644000001440000001646712143453571015251 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #define RTC_SECONDS 0x00 #define RTC_SECONDS_ALARM 0x01 #define RTC_MINUTES 0x02 #define RTC_MINUTES_ALARM 0x03 #define RTC_HOURS 0x04 #define RTC_HOURS_ALARM 0x05 #define RTC_DAY_OF_WEEK 0x06 #define RTC_DAY_OF_MONTH 0x07 #define RTC_MONTH 0x08 #define RTC_YEAR 0x09 #define RTC_REGISTER_A 0x0a #define RTC_REGISTER_B 0x0b #define RTC_REGISTER_C 0x0c #define RTC_REGISTER_D 0x0d #define RTC_EXTMEM_LOW 0x30 #define RTC_EXTMEM_HIGH 0x31 #define RTC_CENTURY 0x32 #define RTC_EXTMEM2_LOW 0x34 #define RTC_EXTMEM2_HIGH 0x35 #define RTC_BIOS_BOOTFLAG1 0x38 #define RTC_BIOS_DISKTRANSFLAG 0x39 #define RTC_BIOS_BOOTFLAG2 0x3d #define RTC_HIGHMEM_LOW 0x5b #define RTC_HIGHMEM_MID 0x5c #define RTC_HIGHMEM_HIGH 0x5d #define RTC_BIOS_SMP_COUNT 0x5f #define RTC_ACPI_PM_BASE 0x60 #define RTC_INDEX_REG_IOPORT 0x70 #define RTC_TARGET_REG_IOPORT 0x71 /* * We call "NMI disable bit" because 1 means NMI is disabled, while * Intel spec call "NMI enable bit". */ #define RTC_INDEX_REG_NMI_DISABLE_BIT 0x80 #define RTC_INDEX_REG_INDEX_MASK 0x7f /* #define RTC_DEBUG */ #ifdef RTC_DEBUG #define RTC_DBG(...) \ do { \ printf(__VA_ARGS__); \ } while (0) #else #define RTC_DBG(...) #endif struct rtc_emu { spinlock_t lock; u8 index; bool allow_host_access; }; static bool nmi_disable; static drvdata_hdl_t rtc_handle; static spinlock_t host_rtc_lock = SPINLOCK_INITIALIZER; static void read_rtc(u8 index, u8 *data) { spinlock_lock(&host_rtc_lock); out8(RTC_INDEX_REG_IOPORT, (nmi_disable ? RTC_INDEX_REG_NMI_DISABLE_BIT : 0) | (index & RTC_INDEX_REG_INDEX_MASK)); in8(RTC_TARGET_REG_IOPORT, data); spinlock_unlock(&host_rtc_lock); } static void write_rtc(u8 index, u8 data) { spinlock_lock(&host_rtc_lock); out8(RTC_INDEX_REG_IOPORT, (nmi_disable ? RTC_INDEX_REG_NMI_DISABLE_BIT : 0) | (index & RTC_INDEX_REG_INDEX_MASK)); out8(RTC_TARGET_REG_IOPORT, data); spinlock_unlock(&host_rtc_lock); } static phys_t low_mem_size(void) { phys_t addr; addr = gmm_top_of_low_avail_mem(); if (addr < 16*1024*1024) { return 0; } return addr + 1 - 16*1024*1024; } static phys_t high_mem_size(void) { phys_t addr; addr = gmm_top_of_high_avail_mem(); if (addr < 0x100000000) { return 0; } return addr + 1 - 0x100000000; } static void read_vrtc(u8 index, u8 *data) { switch (index & RTC_INDEX_REG_INDEX_MASK) { case RTC_SECONDS: case RTC_MINUTES: case RTC_HOURS: case RTC_DAY_OF_WEEK: case RTC_DAY_OF_MONTH: case RTC_MONTH: case RTC_YEAR: read_rtc(index, data); break; case RTC_EXTMEM2_LOW: *data = low_mem_size() >> 16; break; case RTC_EXTMEM2_HIGH: *data = low_mem_size() >> 24; break; case RTC_HIGHMEM_LOW: *data = high_mem_size() >> 16; break; case RTC_HIGHMEM_MID: *data = high_mem_size() >> 24; break; case RTC_HIGHMEM_HIGH: *data = high_mem_size() >> 32; break; case RTC_BIOS_SMP_COUNT: *data = vm_get_vcpu_count() - 1; break; case RTC_BIOS_BOOTFLAG1: *data = 0x00; /* Don't check floopy sig */ break; case RTC_BIOS_BOOTFLAG2: *data = 0x23; /* Boot from CD-ROM first, then HDD */ break; case RTC_ACPI_PM_BASE: *data = acpi_get_dev_base() >> 8; break; default: *data = 0; break; } } static void rtc_init(void) { u8 reg; in8(RTC_INDEX_REG_IOPORT, ®); nmi_disable = (reg & RTC_INDEX_REG_NMI_DISABLE_BIT) ? true : false; RTC_DBG("nmi %s.\n", nmi_disable ? "disabled": "enabled"); rtc_handle = vm_alloc_driver_data(sizeof(struct rtc_emu)); } static int rtc_index_handler(iotype_t type, ioport_t port, void *data) { struct rtc_emu *rtc_emu; bool guest_nmi_disable; rtc_emu = vm_get_driver_data(rtc_handle); spinlock_lock(&rtc_emu->lock); switch (type) { case IOTYPE_INB: *(u8 *)data = rtc_emu->index; RTC_DBG("RTC index reg inb 0x%x\n", *(u8 *)data); break; case IOTYPE_OUTB: RTC_DBG("RTC index reg outb 0x%x\n", *(u8 *)data); rtc_emu->index = *(u8 *)data; if (!rtc_emu->allow_host_access) { break; } guest_nmi_disable = (rtc_emu->index & RTC_INDEX_REG_NMI_DISABLE_BIT) ? true : false; if (guest_nmi_disable == nmi_disable) { break; } spinlock_lock(&host_rtc_lock); nmi_disable = guest_nmi_disable; out8(RTC_INDEX_REG_IOPORT, nmi_disable ? RTC_INDEX_REG_NMI_DISABLE_BIT : 0); RTC_DBG("nmi %s.\n", nmi_disable ? "disabled": "enabled"); spinlock_unlock(&host_rtc_lock); break; default: break; } spinlock_unlock(&rtc_emu->lock); return 1; /* emulated */ } static int rtc_target_handler(iotype_t type, ioport_t port, void *data) { struct rtc_emu *rtc_emu; rtc_emu = vm_get_driver_data(rtc_handle); spinlock_lock(&rtc_emu->lock); switch (type) { case IOTYPE_INB: if (rtc_emu->allow_host_access) { read_rtc(rtc_emu->index, data); } else { read_vrtc(rtc_emu->index, data); } RTC_DBG("RTC target reg inb 0x%x\n", *(u8 *)data); case IOTYPE_OUTB: RTC_DBG("RTC target reg outb 0x%x\n", *(u8 *)data); if (rtc_emu->allow_host_access) { write_rtc(rtc_emu->index, *(u8 *)data); } default: break; } spinlock_unlock(&rtc_emu->lock); return 1; /* emulated */ } static void rtc_setup_vm(void) { struct rtc_emu *rtc_emu; rtc_emu = vm_get_driver_data(rtc_handle); spinlock_init(&rtc_emu->lock); if (cpu_is_bsp()) { rtc_emu->allow_host_access = 1; rtc_emu->index = (nmi_disable ? RTC_INDEX_REG_NMI_DISABLE_BIT : 0); } else { rtc_emu->allow_host_access = 0; rtc_emu->index = 0; } set_iofunc(RTC_INDEX_REG_IOPORT, rtc_index_handler); set_iofunc(RTC_TARGET_REG_IOPORT, rtc_target_handler); } DRIVER_INIT(rtc_init); DRIVER_PASSVM(rtc_setup_vm); tinyvisor/vmm/io/vtd_dmar.c0000644006644000001440000001715712165655743016267 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #include #include #include #include #include #include #include #include "vtd_dmar.h" #define DMAR_SIGNATURE "DMAR" #define DRHD_STRUCT 0 #define RMRR_STRUCT 1 #define ATSR_STRUCT 2 #define RHSA_STRUCT 3 #define MIN_DEV_SCOPE_LEN \ (sizeof(struct pci_path) + sizeof(struct dev_scope)) struct acpi_ent_dmar { struct acpi_desc_header header; u8 haw; /* Host address Width */ u8 flags; u8 reserved[10]; } __attribute__ ((packed)); struct acpi_ent_drhd { u16 type; u16 length; u8 flags; u8 reserved; u16 segment; u64 address; /* register base address for this drhd */ } __attribute__ ((packed)); enum dev_scope_type { DEV_SCOPE_ENDPOINT = 0x01, /* PCI Endpoing device */ DEV_SCOPE_PCIBRIDGE, /* PCI-PCI Bridge */ DEV_SCOPE_IOAPIC, /* IOAPIC device*/ DEV_SCOPE_MSIHPET, /* MSI capable HPET*/ }; struct dev_scope { u8 dev_type; u8 length; u8 reserved[2]; u8 enum_id; u8 start_bus; } __attribute__((packed)); struct pci_path { u8 dev; u8 fn; } __attribute__((packed)); LIST_DEFINE_HEAD(drhd_list); int dmar_drhd_exists() { return LIST_HEAD(drhd_list) != NULL; } struct dmar_drhd_u* dmar_get_next_drhd(struct dmar_drhd_u* cur) { return LIST_NEXT(drhd_list, cur); } static int pci_device_match(struct pci_dev *devices, int cnt, u8 bus, u8 devfn) { int i; for (i = 0; i < cnt; i++, devices++) { if (devfn != devices->devfn) continue ; if (bus != devices->bus) continue ; goto found ; } return 0; found: return 1; } struct iommu* dmar_matched_iommu(u8 bus, u8 devfn) { struct dmar_drhd_u *drhd; struct dmar_drhd_u *include_pci_all_drhd; include_pci_all_drhd = NULL; LIST_FOREACH(drhd_list, drhd) { if (drhd->include_pci_all) { include_pci_all_drhd = drhd; continue; } if (pci_device_match(drhd->devices, drhd->devices_cnt, bus, devfn)) { return drhd->iommu; } } if (include_pci_all_drhd) { return include_pci_all_drhd->iommu; } return NULL; } static vmmerr_t num_dev_scope_entry(void *start, void *end) { struct dev_scope *scope; int count=0; while (start < end) { scope = start; if (scope->length < MIN_DEV_SCOPE_LEN) { printf("(DMAR) Device scope length mismatch.\n"); return VMMERR_INVAL; } if (scope->dev_type > 0x4) { printf("(DMAR) Unknown device type.\n"); return VMMERR_INVAL; } count+=(scope->length-6)/2; // number of entries in the 'Path' field start += scope->length; // go next entry } return count; } static vmmerr_t parse_dev_scope(void *start, void *end, struct dmar_drhd_u *drhd_u) { struct dev_scope *scope; struct pci_path *path; struct pci_dev *pdev; struct pci_dev **devices = NULL; u8 bus; int *cnt = NULL; cnt = &(drhd_u->devices_cnt); devices = &(drhd_u->devices); *cnt = num_dev_scope_entry(start, end); if (*cnt == 0) { #ifdef VTD_DEBUG printf("(DMAR) parse_dev_scope: no device\n"); #endif // of VTD_DEBUG return 0; } *devices = alloc(sizeof(struct pci_dev)*(*cnt)); if (!*devices) { return VMMERR_NOMEM; } memset(*devices, 0, sizeof(struct pci_dev) * (*cnt)); pdev = *devices; scope = start; while ((void *)scope < end) { path = (struct pci_path *)(scope + 1); bus = scope->start_bus; if (scope->dev_type == DEV_SCOPE_ENDPOINT || scope->dev_type == DEV_SCOPE_PCIBRIDGE) { #ifdef VTD_DEBUG printf("(DMAR) including : bdf = %x:%x:%x\n", bus, path->dev, path->fn); #endif // of VTD_DEBUG pdev->bus = bus; pdev->df.dev_no = path->dev ; pdev->df.func_no = path->fn ; pdev++; } scope = (struct dev_scope *)(((void *)scope)+scope->length); } return 0; } static vmmerr_t parse_drhd_u(struct acpi_ent_drhd *ent) { struct acpi_ent_drhd *drhd = ent; struct dmar_drhd_u *drhd_u; static int include_pci_all; void *sp, *ep; int ret = 0; drhd_u = alloc(sizeof(struct dmar_drhd_u)); if (!drhd_u) { printf("Failed to allocate dmar_drhd_u.\n"); return VMMERR_NOMEM; } memset(drhd_u, 0, sizeof(struct dmar_drhd_u)); drhd_u->address = drhd->address; #ifdef VTD_DEBUG printf("(DMAR) Register base address = %llx\n", drhd_u->address); #endif // of VTD_DEBUG if (drhd->flags & 1) { drhd_u->include_pci_all = 1 ; #ifdef VTD_DEBUG printf("(DMAR) Including ALL the other PCI devices.\n"); #endif // of VTD_DEBUG if (include_pci_all) { printf("(DMAR) There should be only one INCLUDE_PCI_ALL DRHD!!\n"); ret = VMMERR_INVAL; } include_pci_all = 1; } else { drhd_u->include_pci_all = 0 ; sp = (void *)(drhd + 1); ep = ((void *)drhd) + ent->length; ret = parse_dev_scope(sp, ep, drhd_u); } if (ret) free(drhd_u); else LIST_APPEND(drhd_list, drhd_u); return ret; } static acpi_parser_t parse_dmar; static void parse_dmar(void *table, u32 length) { struct acpi_ent_drhd *ent; struct acpi_ent_dmar *dmar = (struct acpi_ent_dmar *)table; unsigned long size; printf ("ACPI DMAR found.\n"); size = dmar->header.length; if (!dmar->haw) { printf("(DMAR) Invalid DMAR haw\n"); return; } #ifdef VTD_DEBUG printf("(DMAR) Host address width %d\n", dmar->haw); #endif // of VTD_DEBUG ent = (struct acpi_ent_drhd *)(dmar + 1) ; while (((unsigned long)ent) < (((unsigned long)dmar) + size)) { switch (ent->type) { case DRHD_STRUCT: #ifdef VTD_DEBUG printf("(DMAR) found DRHD_STRUCT\n"); #endif // of VTD_DEBUG (void)parse_drhd_u(ent); break; #ifdef VTD_DEBUG case RMRR_STRUCT: printf("(DMAR) found RMRR_STRUCT\n"); break; case ATSR_STRUCT: printf("(DMAR) found ATSR_STRUCT\n"); break; case RHSA_STRUCT: printf("(DMAR) found RHSA_STRUCT\n"); break; #endif // of VTD_DEBUG default: #ifdef VTD_DEBUG printf("(DMAR) Unknown DMAR structure type\n"); #endif // of VTD_DEBUG break; } ent = ((void *)ent + ent->length); } printf("ACPI DMAR cleared.\n"); // Zap APCI 'DMAR' signature to avoid guest OS's detection memset(dmar, 0, 4); return; } static void dmar_init(void) { acpi_register_parser(DMAR_SIGNATURE, parse_dmar); } INITFUNC("global3", dmar_init); tinyvisor/vmm/io/pit_emu.h0000644006644000001440000000322511733245403016111 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _IO_PIT_EMU_H #define _IO_PIT_EMU_H void pit_update_counter0(void); #endif /* _IO_PIT_EMU_H */ tinyvisor/vmm/Makefile0000644006644000001440000000416012143714154015326 0ustar yuichi_xyusersTOPDIR = . include Makefile.master # default configurations CONFIG_64 ?= 1 CONFIG_SPINLOCK_DEBUG ?= 1 CONFIG_TTY_SERIAL ?= 1 CONFIG_CPU_MMU_SPT_USE_PAE ?= 1 CONFIG_PS2KBD_F11PANIC ?= 0 CONFIG_PS2KBD_F12MSG ?= 0 CONFIG_DBGSH ?= 0 CONFIG_LOG_TO_GUEST ?= 0 CONFIG_ACPI_DSDT ?= 1 CONFIG_DISABLE_SLEEP ?= 1 CONFIG_ENABLE_ASSERT ?= 1 CONFIG_VTD_IOMMU ?= 1 CONFIG_VT_EPT ?= 1 CONFIG_IO_HOOK ?= 1 CONFIG_SPT3 ?= 1 # config list CONFIGLIST := CONFIGLIST += CONFIG_64=$(CONFIG_64)[64bit VMM] CONFIGLIST += CONFIG_SPINLOCK_DEBUG=$(CONFIG_SPINLOCK_DEBUG)[spinlock debug] CONFIGLIST += CONFIG_TTY_SERIAL=$(CONFIG_TTY_SERIAL)[VMM uses a serial port (COM1) for output] CONFIGLIST += CONFIG_PS2KBD_F11PANIC=$(CONFIG_PS2KBD_F11PANIC)[Panic when F11 is pressed (PS/2 only)] CONFIGLIST += CONFIG_PS2KBD_F12MSG=$(CONFIG_PS2KBD_F12MSG)[Print when F12 is pressed (PS/2 only)] CONFIGLIST += CONFIG_DBGSH=$(CONFIG_DBGSH)[Debug shell access from guest] CONFIGLIST += CONFIG_LOG_TO_GUEST=$(CONFIG_LOG_TO_GUEST)[Log to guest memory] CONFIGLIST += CONFIG_ACPI_DSDT=$(CONFIG_ACPI_DSDT)[Parse ACPI DSDT] CONFIGLIST += CONFIG_DISABLE_SLEEP=$(CONFIG_DISABLE_SLEEP)[Disable ACPI S2 and S3] CONFIGLIST += CONFIG_ENABLE_ASSERT=$(CONFIG_ENABLE_ASSERT)[Enable checking assertion failure] CONFIGLIST += CONFIG_VTD_IOMMU=$(CONFIG_VTD_IOMMU)[Enable VT-d IOMMU] CONFIGLIST += CONFIG_VT_EPT=$(CONFIG_VT_EPT)[Enable VT EPT] CONFIGLIST += CONFIG_IO_HOOK=$(CONFIG_IO_HOOK)[Enable I/O hook (should be enabled)] CONFIGLIST += CONFIG_SPT3=$(CONFIG_SPT3)[SPT3] NAME = vmm FORMAT = elf32-i386 TARGET = $(NAME).elf MAP = $(NAME).map LDS = vmm.lds OBJS-1 = core/core.o io/io.o OBJS = $(OBJS-1) .PHONY : all clean config $(OBJS) sloc lint all : $(TARGET) clean : rm -f $(TARGET) $(MAP) $(MAKE) -C core clean $(MAKE) -C io clean config : ./config.sh lint: $(MAKE) -C core lint $(MAKE) -C io lint $(CONFIG) : Makefile echo -n '$(CONFIGLIST)' | tr '[' '#' | tr ']' '\n' | \ sed 's/^ //' > $(CONFIG) $(TARGET) $(MAP) : $(LDS) $(OBJS) $(CONFIG) $(LD) $(LDFLAGS) $(LDFLAGS2) -o $(TARGET) $(OBJS) objcopy --output-format $(FORMAT) $(TARGET) core/core.o : $(MAKE) -C core io/io.o : $(MAKE) -C io tinyvisor/vmm/core/0000755006644000001440000000000012206363326014616 5ustar yuichi_xyuserstinyvisor/vmm/core/serial.h0000644006644000001440000000327212011466501016243 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_SERIAL_H #define _CORE_SERIAL_H void serial_init_global(void); void serial_putchar (unsigned char c); #endif tinyvisor/vmm/core/thread_switch.h0000644006644000001440000000356011733245403017622 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_THREAD_SWITCH_H #define _CORE_THREAD_SWITCH_H #include #include "thread.h" #include struct thread_context; asmlinkage ulong thread_switch (struct thread_context **old, struct thread_context *new, ulong arg); asmlinkage void thread_start0 (void); #endif tinyvisor/vmm/core/svm_init.h0000644006644000001440000000336011733227577016634 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_SVM_INIT_H #define _CORE_SVM_INIT_H bool svm_available (void); void svm_reset (void); void svm_vminit (void); void svm_vmexit (void); void svm_init (void); #endif tinyvisor/vmm/core/builtin/0000755006644000001440000000000012206363326016264 5ustar yuichi_xyuserstinyvisor/vmm/core/builtin/lib_stdlib.h0000644006644000001440000000343011733227577020557 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #define ULONG_MAX (~0UL) #define ULONG_MIN 0UL #define LONG_MAX ((long int)(ULONG_MAX >> 1)) #define LONG_MIN ((long int)((ULONG_MAX >> 1) + 1)) #define NULL ((void *)0) long int strtol (char *s, char **e, int base); tinyvisor/vmm/core/builtin/bin_init.c0000644006644000001440000000365311733227577020245 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include int _start (int a1, int a2) { int kbd, dsp, shell; kbd = msgopen ("ttyin"); dsp = msgopen ("ttyout"); shell = newprocess ("shell"); if (kbd < 0 || dsp < 0 || shell < 0) return 0; msgsenddesc (shell, kbd); msgsenddesc (shell, dsp); if (a2) msgsendint (shell, 0); return 0; } tinyvisor/vmm/core/builtin/bin_help.c0000644006644000001440000000434511733245403020215 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include char *help[][2] = { { "debug", "start debugger", }, { "init", 0, }, { "log", "print VMM log", }, { "panic", "make VMM panic", }, { "recvexample", "msgregister() example", }, { "sendexample", "msgsendbuf() example", }, { "sendint", "call msgsendint()", }, { "serialtest", "serial I/O test", }, { "shell", "start shell", }, { "reboot", "reboot system", }, { "exit", "exit shell", }, { 0, 0 } }; int _start (int a1, int a2) { char *(*p)[2]; for (p = help; p[0][0]; p++) { if (p[0][1]) printf ("%-15s %s\n", p[0][0], p[0][1]); } exitprocess (0); return 0; } tinyvisor/vmm/core/builtin/bin_sendint.c0000644006644000001440000000427511733227577020747 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include void sendint (char *name, int val) { int d; d = msgopen (name); if (d >= 0) { msgsendint (d, val); msgclose (d); } else printf ("%s not found.\n", name); } int _start (int a1, int a2) { int d; char buf[100]; char *s; for (;;) { printf ("sendint> "); lineinput (buf, 100); if (!strcmp (buf, "")) exitprocess (0); s = strchr (buf, ' '); if (!s) { d = 0; } else { *s = '\0'; d = (int)strtol (s + 1, NULL, 0); } printf ("send %d to %s\n", d, buf); sendint (buf, d); } } tinyvisor/vmm/core/builtin/Makefile0000644006644000001440000000365111733245403017730 0ustar yuichi_xyusersCONFIG = ../../.config include $(CONFIG) BITS-0 = 32 BITS-1 = 64 LIB_OBJS = $(patsubst %.c,%.o,$(wildcard lib_*.c)) \ $(patsubst %.s,%.o,$(wildcard lib_*.s)) BIN_OUT = $(patsubst %.c,%,$(wildcard bin_*.c)) \ $(patsubst %.s,%,$(wildcard bin_*.s)) BIN_NAME = $(patsubst bin_%,%,$(patsubst %.c,%,$(wildcard bin_*.c))) \ $(patsubst bin_%,%,$(patsubst %.s,%,$(wildcard bin_*.s))) HEADERS = $(wildcard *.h) CFLAGS = -m$(BITS-$(CONFIG_64)) -mno-red-zone -g -O2 -nostdinc \ -fno-builtin -Wall -I. -nostdlib -fno-stack-protector -mno-sse ASFLAGS = --$(BITS-$(CONFIG_64)) LDFLAGS-0 = -Wl,-melf_i386 LDFLAGS-1 = -Wl,-melf_x86_64 LDFLAGS = $(LDFLAGS-$(CONFIG_64)) AS_1-0 = .long AS_2-0 = , 0 AS_1-1 = .quad AS_2-1 = AS_1 = $(AS_1-$(CONFIG_64)) AS_2 = $(AS_2-$(CONFIG_64)) OUT_OBJ = process_builtin.o OUT_LIB = lib.a OUT_ASM = process_builtin.s .PHONY : all clean all : $(OUT_OBJ) clean : rm -f $(OUT_OBJ) $(OUT_LIB) $(OUT_ASM) $(BIN_OUT) *.o *~ $(OUT_OBJ) : $(OUT_ASM) as $(ASFLAGS) -o $(OUT_OBJ) $(OUT_ASM) $(OUT_ASM) : $(BIN_OUT) echo ' .data' > $(OUT_ASM) echo ' .globl process_builtin' >> $(OUT_ASM) echo ' .align 8' >> $(OUT_ASM) echo 'process_builtin:' >> $(OUT_ASM) for i in $(BIN_NAME); do \ echo ' $(AS_1) prc_'$$i'_name$(AS_2)'; \ echo ' $(AS_1) prc_'$$i'_bin$(AS_2)'; \ echo ' .quad prc_'$$i'_bin_end - prc_'$$i'_bin'; \ done >> $(OUT_ASM) echo ' .quad 0, 0, 0' >> $(OUT_ASM) for i in $(BIN_NAME); do \ echo 'prc_'$$i'_name: .string "'$$i'"'; \ echo 'prc_'$$i'_bin: .incbin "bin_'$$i'"'; \ echo 'prc_'$$i'_bin_end:'; \ done >> $(OUT_ASM) $(BIN_OUT) : $(OUT_LIB) $(OUT_LIB) : $(LIB_OBJS) rm -f $(OUT_LIB) ar cr $(OUT_LIB) $(LIB_OBJS) $(LIB_OBJS) : $(HEADERS) $(CONFIG) Makefile check-syntax: gcc -fsyntax-only $(CPPFLAGS) $(CFLAGS) $(CHK_SOURCES) # splint $(LINTFLAGS) $(CHK_SOURCES) tinyvisor/vmm/core/builtin/lib_string.h0000644006644000001440000000454711733227577020616 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ static inline void * memset (void *addr, int val, int len) { char *p; for (p = addr; len; len--) *p++ = val; return addr; } static inline void * memcpy (void *dest, void *src, int len) { char *p, *q; for (p = dest, q = src; len; len--) *p++ = *q++; return dest; } static inline int strcmp (char *s1, char *s2) { int r, c1, c2; do { c1 = *s1++; c2 = *s2++; r = c1 - c2; } while (!r && c1); return r; } static inline int memcmp (void *p1, void *p2, int len) { int r, i; char *q1, *q2; q1 = p1; q2 = p2; for (r = 0, i = 0; !r && i < len; i++) r = *q1++ - *q2++; return r; } static inline int strlen (char *p) { int len = 0; while (*p++) len++; return len; } static inline char * strchr (char *s, int c) { while (*s) { if (*s == c) return s; s++; } return 0; } tinyvisor/vmm/core/builtin/lib_stdlib.c0000644006644000001440000000553611733227577020563 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include static unsigned int digit_to_num (char c, int base) { unsigned int n; if (c >= '0' && c <= '9') n = c - '0'; else if (c >= 'A' && c <= 'Z') n = c - 'A' + 10; else if (c >= 'a' && c <= 'z') n = c - 'a' + 10; else n = base; if (n >= base) n = base; if (base < 2 || base > 36) n = base; return n; } long int strtol (char *s, char **e, int base) { int b; enum { SIGN_NONE, SIGN_PLUS, SIGN_MINUS } sign; unsigned long int val = 0, valmax, c; while (isspace (*s)) s++; if (*s == '+') { sign = SIGN_PLUS; s++; valmax = LONG_MAX; } else if (*s == '-') { sign = SIGN_MINUS; s++; valmax = (unsigned long int)LONG_MAX + 1; } else { sign = SIGN_NONE; valmax = ULONG_MAX; } if (s[0] == '0') { if (s[1] == 'X' || s[1] == 'x') b = 16; else b = 8; } else { b = 10; } if (base == 0) base = b; if (base == 16 && b == 16) s += 2; for (;;) { if (e) *e = s; c = digit_to_num (*s, base); if (c == base) break; if (val > valmax / base) goto overflow_or_underflow; val = val * base + c; if (val > valmax) goto overflow_or_underflow; s++; } if (sign == SIGN_MINUS) return -val; else return val; overflow_or_underflow: if (sign == SIGN_MINUS) return -valmax; else return valmax; } tinyvisor/vmm/core/builtin/bin_sendexample.c0000644006644000001440000000513311733227577021602 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include void command_error (void) { printf ("error.\n"); } void print_help (char *buf) { printf ("s data : send\n"); printf ("q : quit\n"); } void sendex (char *buf) { unsigned char d[32]; int a, i; a = msgopen ("recvex"); if (a < 0) { printf ("msgopen failed.\n"); return; } memset (d, 0, 32); printf ("sending buf %p len 0x%x recvbuf %p len 0x%lx\n", buf, strlen (buf), d, (unsigned long)sizeof d); if (msgsendbuf (a, 0, buf, strlen (buf), d, sizeof d)) { printf ("msgsendbuf failed.\n"); msgclose (a); return; } msgclose (a); printf ("received: "); for (i = 0; i < 32; i++) printf ("0x%02x ", d[i]); printf ("\n"); } int _start (int a1, int a2) { char buf[100]; for (;;) { printf ("sendexample> "); lineinput (buf, 100); switch (buf[0]) { case 'h': print_help (buf); break; case 's': sendex (buf); break; case 'q': exitprocess (0); break; default: command_error (); break; } } } tinyvisor/vmm/core/builtin/lib_putchar.c0000644006644000001440000000321711733227577020742 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include void putchar (unsigned char c) { msgsendint (1, c); } tinyvisor/vmm/core/builtin/lib_lineinput.c0000644006644000001440000001712311733227577021304 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #define NUM_OF_CH 8192 #define NUM_OF_ST 128 #define LINEMAX 1024 #define TYPE1 unsigned short #define TYPE2 unsigned char #define T1MAX 0xFFFF #define T2MAX 0xFF struct lineinput_char { TYPE1 prev, next; char c; }; struct lineinput_string { TYPE2 prev, next; TYPE1 ch; short n; }; static struct lineinput_char ch[NUM_OF_CH]; static struct lineinput_string st[NUM_OF_ST]; static TYPE1 ch_free; static TYPE2 st_free, st_history; static int lineinputinit = 0; static TYPE1 ch_get (TYPE1 *head) { TYPE1 r; r = *head; if (r != T1MAX) { ch[r].prev = T1MAX; *head = ch[r].next; } return r; } static void ch_put (TYPE1 *head, TYPE1 i) { if (*head == T1MAX) { ch[i].prev = T1MAX; ch[i].next = T1MAX; *head = i; } else { ch[i].prev = T1MAX; ch[i].next = *head; ch[*head].prev = i; *head = i; } } static TYPE2 st_get (TYPE2 *head) { TYPE2 r; r = *head; if (r != T2MAX) { st[r].prev = T2MAX; *head = st[r].next; } return r; } static void st_put (TYPE2 *head, TYPE2 i) { if (*head == T2MAX) { st[i].prev = T2MAX; st[i].next = T2MAX; *head = i; } else { st[i].prev = T2MAX; st[i].next = *head; st[*head].prev = i; *head = i; } } static void lineinput_init (void) { int i; ch_free = T1MAX; for (i = 0; i < NUM_OF_CH; i++) ch_put (&ch_free, i); st_free = T2MAX; for (i = 0; i < NUM_OF_ST; i++) { st[i].ch = T1MAX; st_put (&st_free, i); } st_history = T2MAX; lineinputinit = 1; } static void drop_old_history (void) { int i; for (i = st_history; i != T2MAX; i = st[i].next) { if (st[i].next == T2MAX) goto found; } return; found: if (st[i].prev == T2MAX) st_history = T2MAX; else st[st[i].prev].next = T2MAX; while (st[i].ch != T1MAX) ch_put (&ch_free, ch_get (&st[i].ch)); st_put (&st_free, i); } int lineinput_desc (int kbd, int dsp, char *buf, int len) { TYPE2 st_i, st_new; TYPE1 ch_cursor, ch_tmp; char c; int i; # define GET_CH_TMP() do { \ ch_tmp = ch_get (&ch_free); \ while (ch_tmp == T1MAX) { \ drop_old_history (); \ ch_tmp = ch_get (&ch_free); \ } \ } while (0) enum { DEL_OFF, DEL_U, DEL_K } delmode; if (!lineinputinit) lineinput_init (); if (len == 0) return 0; st_i = st_get (&st_free); if (st_i == T2MAX) { drop_old_history (); st_i = st_get (&st_free); if (st_i == T2MAX) return 0; } st_put (&st_history, st_i); GET_CH_TMP (); ch[ch_tmp].c = '\0'; ch[ch_tmp].prev = ch[ch_tmp].next = T1MAX; ch_cursor = st[st_i].ch = ch_tmp; st_new = st_i; st[st_i].n = 0; inputloop_deldone: delmode = DEL_OFF; inputloop: switch (delmode) { case DEL_U: c = '\b'; break; case DEL_K: c = 'd' & 31; break; default: c = msgsendint (kbd, 0); } if (c >= ' ' && c <= '~') { if (st[st_i].n < LINEMAX) { GET_CH_TMP (); ch[ch_tmp].c = c; ch[ch_tmp].prev = ch[ch_cursor].prev; ch[ch_tmp].next = ch_cursor; if (ch[ch_cursor].prev == T1MAX) st[st_i].ch = ch_tmp; else ch[ch[ch_cursor].prev].next = ch_tmp; ch[ch_cursor].prev = ch_tmp; msgsendint (dsp, c); st[st_i].n++; } prnt: for (ch_tmp = ch_cursor; ch_tmp != T1MAX; ch_tmp = ch[ch_tmp].next) { if (ch[ch_tmp].next == T1MAX) break; msgsendint (dsp, ch[ch_tmp].c); } if (ch_tmp != T1MAX) msgsendint (dsp, ' '); for (ch_tmp = ch_cursor; ch_tmp != T1MAX; ch_tmp = ch[ch_tmp].next) msgsendint (dsp, '\b'); goto inputloop; } switch (c) { case 'f' & 31: ch_tmp = ch[ch_cursor].next; if (ch_tmp == T1MAX) goto inputloop; msgsendint (dsp, ch[ch_cursor].c); ch_cursor = ch_tmp; goto inputloop; case 'k' & 31: delmode = DEL_K; goto inputloop; case 'u' & 31: delmode = DEL_U; goto inputloop; case '\b': case 127: case 'b' & 31: ch_tmp = ch[ch_cursor].prev; if (ch_tmp == T1MAX) goto inputloop_deldone; ch_cursor = ch_tmp; msgsendint (dsp, '\b'); if (c == ('b' & 31)) goto inputloop; case 'd' & 31: if (ch[ch_cursor].next == T1MAX) goto inputloop_deldone; ch[ch[ch_cursor].next].prev = ch[ch_cursor].prev; ch_tmp = ch[ch_cursor].next; if (ch[ch_cursor].prev == T1MAX) st[st_i].ch = ch_tmp; else ch[ch[ch_cursor].prev].next = ch_tmp; ch_put (&ch_free, ch_cursor); ch_cursor = ch_tmp; st[st_i].n--; goto prnt; case '\n': case '\r': goto inputend; case 'p' & 31: case 'n' & 31: case 'a' & 31: while (ch[ch_cursor].prev != T1MAX) { msgsendint (dsp, '\b'); ch_cursor = ch[ch_cursor].prev; } if (c == ('a' & 31)) goto inputloop; while (ch[ch_cursor].next != T1MAX) { msgsendint (dsp, ' '); ch_cursor = ch[ch_cursor].next; } while (ch[ch_cursor].prev != T1MAX) { msgsendint (dsp, '\b'); ch_cursor = ch[ch_cursor].prev; } if (c == ('p' & 31) && st[st_i].next != T2MAX) st_i = st[st_i].next; if (c == ('n' & 31) && st[st_i].prev != T2MAX) st_i = st[st_i].prev; ch_cursor = st[st_i].ch; case 'e' & 31: while (ch[ch_cursor].next != T1MAX) { msgsendint (dsp, ch[ch_cursor].c); ch_cursor = ch[ch_cursor].next; } goto inputloop; } goto inputloop; inputend: for (ch_tmp = ch_cursor; ch_tmp != T1MAX; ch_tmp = ch[ch_tmp].next) { if (ch[ch_tmp].next == T1MAX) break; msgsendint (dsp, ch[ch_tmp].c); } if (ch_tmp != T1MAX) msgsendint (dsp, ' '); msgsendint (dsp, '\b'); msgsendint (dsp, '\n'); i = 0; for (ch_tmp = st[st_i].ch; ch_tmp != T1MAX && len > 0; ch_tmp = ch[ch_tmp].next, len--) buf[i++] = ch[ch_tmp].c; if (i > 0) i--; if (len == 0 && buf[i] != '\0') buf[i] = '\0'; if (st[st_i].prev != T2MAX) { st[st[st_i].prev].next = st[st_i].next; if (st[st_i].next != T2MAX) st[st[st_i].next].prev = st[st_i].prev; st[st_i].prev = T2MAX; st[st_i].next = st_history; st[st_history].prev = st_i; st_history = st_i; } if (ch[st[st_new].ch].c == '\0') { if (st[st_new].prev == T2MAX) st_history = st[st_new].next; else st[st[st_new].prev].next = st[st_new].next; if (st[st_new].next != T2MAX) st[st[st_new].next].prev = st[st_new].prev; st_put (&st_free, st_new); } return i; } int lineinput (char *buf, int len) { return lineinput_desc (0, 1, buf, len); } tinyvisor/vmm/core/builtin/lib_syscalls.c0000644006644000001440000001113211733227577021124 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include "lib_syscalls.h" typedef unsigned long ulong; #define CALLADDR 0x3FFFF000 #define SYS_NOP 1 #define SYS_MSGSETFUNC 3 #define SYS_MSGREGISTER 4 #define SYS_MSGOPEN 5 #define SYS_MSGCLOSE 6 #define SYS_MSGSENDINT 7 #define SYS_MSGRET 8 #define SYS_MSGSENDDESC 9 #define SYS_NEWPROCESS 10 #define SYS_MSGSENDBUF 11 #define SYS_MSGUNREGISTER 12 #define SYS_EXITPROCESS 13 #ifdef __x86_64__ # define DOSYSCALL0(rb, ra) asm volatile \ ("syscall" : "=a" (ra) \ : "b" ((ulong)rb) \ : "memory", "cc", "%rcx", "%rdx" \ , "%r8", "%r9", "%r10", "%r11", "%r12", "%r13" \ , "%r14", "%r15") # define DOSYSCALL1(rb, rs, ra) asm volatile \ ("syscall" : "=a" (ra) \ : "b" ((ulong)rb) \ , "S" ((ulong)rs) \ : "memory", "cc", "%rcx", "%rdx" \ , "%r8", "%r9", "%r10", "%r11", "%r12", "%r13" \ , "%r14", "%r15") # define DOSYSCALL2(rb, rs, rd, ra) asm volatile \ ("syscall" : "=a" (ra) \ : "b" ((ulong)rb) \ , "S" ((ulong)rs), "D" ((ulong)rd) \ : "memory", "cc", "%rcx", "%rdx" \ , "%r8", "%r9", "%r10", "%r11", "%r12", "%r13" \ , "%r14", "%r15") #else # define DOSYSCALL0(rb, ra) asm volatile \ ("call *%1" : "=a" (ra) \ : "0" (CALLADDR), "b" (rb) \ : "memory", "cc", "%ecx", "%edx") # define DOSYSCALL1(rb, rs, ra) asm volatile \ ("call *%1" : "=a" (ra) \ : "0" (CALLADDR), "b" (rb), "S" (rs) \ : "memory", "cc", "%ecx", "%edx") # define DOSYSCALL2(rb, rs, rd, ra) asm volatile \ ("call *%1" : "=a" (ra) \ : "0" (CALLADDR), "b" (rb), "S" (rs), "D" (rd) \ : "memory", "cc", "%ecx", "%edx") #endif void nop (void) { ulong tmp; DOSYSCALL0 (SYS_NOP, tmp); } void * msgsetfunc (int desc, void *func) { ulong tmp; DOSYSCALL2 (SYS_MSGSETFUNC, desc, func, tmp); return (void *)tmp; } int msgregister (char *name, void *func) { ulong tmp; DOSYSCALL2 (SYS_MSGREGISTER, name, func, tmp); return (int)tmp; } int msgopen (char *name) { ulong tmp; DOSYSCALL1 (SYS_MSGOPEN, name, tmp); return (int)tmp; } int msgclose (int desc) { ulong tmp; DOSYSCALL1 (SYS_MSGCLOSE, desc, tmp); return (int)tmp; } int msgsendint (int desc, int data) { ulong tmp; DOSYSCALL2 (SYS_MSGSENDINT, desc, data, tmp); return (int)tmp; } int msgsenddesc (int desc, int data) { ulong tmp; DOSYSCALL2 (SYS_MSGSENDDESC, desc, data, tmp); return (int)tmp; } int newprocess (char *name) { ulong tmp; DOSYSCALL1 (SYS_NEWPROCESS, name, tmp); return (int)tmp; } int msgsendbuf (int desc, int data, void *sendbuf, int sendlen, void *recvbuf, int recvlen) { ulong tmp; struct msgsendbuf_args { int data; void *sendbuf; int sendlen; void *recvbuf; int recvlen; } a; a.data = data; a.sendbuf = sendbuf; a.sendlen = sendlen; a.recvbuf = recvbuf; a.recvlen = recvlen; DOSYSCALL2 (SYS_MSGSENDBUF, desc, &a, tmp); return (int)tmp; } int msgunregister (int desc) { ulong tmp; DOSYSCALL1 (SYS_MSGUNREGISTER, desc, tmp); return (int)tmp; } void exitprocess (int retval) { ulong tmp; DOSYSCALL1 (SYS_EXITPROCESS, retval, tmp); } tinyvisor/vmm/core/builtin/lib_ctype.c0000644006644000001440000000463011733227577020420 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include int isalnum (int c) { return isalpha(c) || isdigit(c); } int isalpha (int c) { return isupper(c) || islower(c); } int isascii (int c) { return c >= '\0' && c <= '\177'; } int isblank (int c) { return c == ' ' || c == '\t'; } int iscntrl (int c) { return isascii (c) && !isprint (c); } int isdigit (int c) { return c >= '0' && c <= '9'; } int isgraph (int c) { return isprint (c) && !isblank (c); } int islower (int c) { return c >= 'a' && c <= 'z'; } int isprint (int c) { return c >= ' ' && c <= '~'; } int ispunct (int c) { return isgraph (c) && !isalnum (c); } int isspace (int c) { return isblank (c) || c == '\f' || c == '\n' || c == '\r' || c == '\v'; } int isupper (int c) { return c >= 'A' && c <= 'Z'; } int isxdigit (int c) { return isdigit (c) || (c >= 'A' && c <= 'F') || (c >= 'a' && c <= 'f'); } tinyvisor/vmm/core/builtin/lib_ctype.h0000644006644000001440000000350211733227577020422 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ int isalnum(int c); int isalpha(int c); int isascii(int c); int isblank(int c); int iscntrl(int c); int isdigit(int c); int isgraph(int c); int islower(int c); int isprint(int c); int ispunct(int c); int isspace(int c); int isupper(int c); int isxdigit(int c); tinyvisor/vmm/core/builtin/bin_recvexample.c0000644006644000001440000000457011733227577021614 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include static int recvex_msghandler (int m, int c, void *recvbuf, int recvlen, void *sendbuf, int sendlen) { int i; printf ("***recvexample start***\n"); printf ("recvbuf %p recvlen 0x%x\n", recvbuf, recvlen); printf ("sendbuf %p sendlen 0x%x\n", sendbuf, sendlen); printf ("recvbuf: "); for (i = 0; i < 16 && i < recvlen; i++) printf ("0x%02x ", ((unsigned char *)recvbuf)[i]); printf ("\n"); printf ("sendbuf: "); for (i = 0; i < 16 && i < sendlen; i++) printf ("0x%02x ", ((unsigned char *)sendbuf)[i] = ((unsigned char *)recvbuf)[i] + 1); printf ("\n"); printf ("***recvexample end***\n"); return 0; } int _start (int a1, int a2) { printf ("recvex registered %d\n", msgregister ("recvex", recvex_msghandler)); return 0; } tinyvisor/vmm/core/builtin/lib_printf.c0000644006644000001440000003226711733227577020605 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #define NULL ((void *)0) #define va_start(PTR, LASTARG) __builtin_va_start (PTR, LASTARG) #define va_end(PTR) __builtin_va_end (PTR) #define va_arg(PTR, TYPE) __builtin_va_arg (PTR, TYPE) #define va_list __builtin_va_list typedef unsigned long int size_t; #define spinlock_t int #define spinlock_init(a) (*a) = 0 #define spinlock_lock(a) #define spinlock_unlock(a) int vprintf (const char *format, va_list ap); int vsnprintf (char *str, size_t size, const char *format, va_list ap); /* printf 20071010 %[flags][width][.[precision]][length modifier] flags: # alternate form 0 zero padded - left adjusted ' ' a blank before a positive number + a sign before a number width, precision: decimal number only. length modifier: h short hh char l long ll long long j intmax_t z size_t t ptrdiff_t conversion: d, i integer as decimal o unsigned integer as octal number u unsigned integer as decimal number X unsigned integer as capital hexadecimal number x unsigned integer as hexadecimal number c int as character s char* as string p void* as hexadecimal number % % */ struct snputchar_data { char *buf; size_t len; }; struct parse_data { int width; int precision; }; #define FLAG_ALTERNATE_FORM 0x1 #define FLAG_ZERO_PADDED 0x2 #define FLAG_LEFT_ADJUSTED 0x4 #define FLAG_POSITIVE_BLANK 0x8 #define FLAG_POSITIVE_SIGN 0x10 #define HAS_WIDTH 0x20 #define HAS_PRECISION 0x40 #define LENGTH_SHORT 0x80 #define LENGTH_CHAR 0x100 #define LENGTH_LONG 0x200 #define LENGTH_LONGLONG 0x400 #define LENGTH_INTMAX 0x800 #define LENGTH_SIZE 0x1000 #define LENGTH_PTRDIFF 0x2000 #define CONVERSION_INT 0x4000 #define CONVERSION_DECIMAL 0x8000 #define CONVERSION_UINT 0x10000 #define CONVERSION_OCTAL 0x20000 #define CONVERSION_CAPITAL 0x40000 #define CONVERSION_HEXADECIMAL 0x80000 #define CONVERSION_CHARACTER 0x100000 #define CONVERSION_CHARP 0x200000 #define CONVERSION_VOIDP 0x400000 #define CONVERSION_NONE 0x800000 #define END_STRING 0x1000000 #define FLAG_MINUS 0x2000000 #define FLAG_PLUS 0x4000000 #define PUTCHAR(c) do { if (func (c, data) < 0) goto error; n++; } while (0) static unsigned long long sub10[] = { 10000000000000000000ULL, 1000000000000000000ULL, 100000000000000000ULL, 10000000000000000ULL, 1000000000000000ULL, 100000000000000ULL, 10000000000000ULL, 1000000000000ULL, 100000000000ULL, 10000000000ULL, 1000000000ULL, 100000000ULL, 10000000ULL, 1000000ULL, 100000ULL, 10000ULL, 1000ULL, 100ULL, 10ULL, 1ULL, 0ULL, }; static unsigned long long sub8[] = { 01000000000000000000000ULL, 0100000000000000000000ULL, 010000000000000000000ULL, 01000000000000000000ULL, 0100000000000000000ULL, 010000000000000000ULL, 01000000000000000ULL, 0100000000000000ULL, 010000000000000ULL, 01000000000000ULL, 0100000000000ULL, 010000000000ULL, 01000000000ULL, 0100000000ULL, 010000000ULL, 01000000ULL, 0100000ULL, 010000ULL, 01000ULL, 0100ULL, 010ULL, 01ULL, 00ULL, }; static unsigned long long sub16[] = { 0x1000000000000000ULL, 0x100000000000000ULL, 0x10000000000000ULL, 0x1000000000000ULL, 0x100000000000ULL, 0x10000000000ULL, 0x1000000000ULL, 0x100000000ULL, 0x10000000ULL, 0x1000000ULL, 0x100000ULL, 0x10000ULL, 0x1000ULL, 0x100ULL, 0x10ULL, 0x1ULL, 0x0ULL, }; static spinlock_t printf_lock; static int parse_format (const char **format, int *width, int *precision) { char c; int r = 0; *width = 0; *precision = 0; while ((c = *(*format)++) != '\0') { switch (c) { case '#': r |= FLAG_ALTERNATE_FORM; break; case '0': r |= FLAG_ZERO_PADDED; break; case '-': r |= FLAG_LEFT_ADJUSTED; break; case ' ': r |= FLAG_POSITIVE_BLANK; break; case '+': r |= FLAG_POSITIVE_SIGN; break; default: goto parse_width; } } return END_STRING; while ((c = *(*format)++) != '\0') { parse_width: if (c >= '0' && c <= '9') { r |= HAS_WIDTH; *width *= 10; *width += (c - '0'); } else { goto parse_precision; } } return END_STRING; parse_precision: if (c != '.') goto parse_length_modifier; r |= HAS_PRECISION; while ((c = *(*format)++) != '\0') { if (c >= '0' && c <= '9') { *precision *= 10; *precision += (c - '0'); } else { goto parse_length_modifier; } } return END_STRING; while ((c = *(*format)++) != '\0') { parse_length_modifier: switch (c) { case 'h': if (r & LENGTH_SHORT) r |= LENGTH_CHAR; else r |= LENGTH_SHORT; break; case 'l': if (r & LENGTH_LONG) r |= LENGTH_LONGLONG; else r |= LENGTH_LONG; break; case 'j': r |= LENGTH_INTMAX; break; case 'z': r |= LENGTH_SIZE; break; case 't': r |= LENGTH_PTRDIFF; break; default: goto parse_conversion; } } return END_STRING; parse_conversion: switch (c) { case 'd': case 'i': r |= CONVERSION_INT | CONVERSION_DECIMAL; break; case 'o': r |= CONVERSION_UINT | CONVERSION_OCTAL; break; case 'u': r |= CONVERSION_UINT | CONVERSION_DECIMAL; break; case 'X': r |= CONVERSION_CAPITAL; /* Fall through */ case 'x': r |= CONVERSION_UINT | CONVERSION_HEXADECIMAL; break; case 'c': r |= CONVERSION_INT | CONVERSION_CHARACTER; break; case 's': r |= CONVERSION_CHARP; break; case 'p': r |= CONVERSION_VOIDP | CONVERSION_HEXADECIMAL | FLAG_ALTERNATE_FORM; break; case '%': r |= CONVERSION_NONE; break; } return r; } static int valconv (unsigned long long val, char *buf, unsigned long long *sub, char *str) { int n = 0; int digit; if (val == 0) { *buf++ = '0'; return 1; } while (val < *sub) sub++; while (*sub) { digit = 0; while (val >= *sub) { digit++; val -= *sub; } *buf++ = str[digit]; n++; sub++; } return n; } static int do_conversion_int (unsigned long long val, int f, int width, int precision, int (*func)(int c, void *data), void *data) { int len = 0; int n = 0; int leftsp = 0, leftlen = 0, leftzero = 0, rightsp = 0; char buf[32], *leftbuf = "", *bufp; if (f & CONVERSION_CHARACTER) { PUTCHAR ((int)val); return n; } if ((f & HAS_PRECISION) && precision == 0 && val == 0) return 0; if (f & CONVERSION_DECIMAL) len = valconv (val, buf, sub10, "0123456789"); else if (f & CONVERSION_OCTAL) len = valconv (val, buf, sub8, "01234567"); else if ((f & CONVERSION_HEXADECIMAL) && (f & CONVERSION_CAPITAL)) len = valconv (val, buf, sub16, "0123456789ABCDEF"); else if (f & CONVERSION_HEXADECIMAL) len = valconv (val, buf, sub16, "0123456789abcdef"); if ((f & HAS_PRECISION) && precision > len) leftzero = precision - len; if (!(f & CONVERSION_DECIMAL) && (f & FLAG_ALTERNATE_FORM) && val != 0) { if ((f & CONVERSION_OCTAL) && leftzero == 0) { leftbuf = "0"; leftlen = 1; } else if (f & CONVERSION_HEXADECIMAL) { if (f & CONVERSION_CAPITAL) leftbuf = "0X"; else leftbuf = "0x"; leftlen = 2; } } if (f & CONVERSION_DECIMAL) { if (f & FLAG_PLUS) { if (f & FLAG_POSITIVE_SIGN) { leftbuf = "+"; leftlen = 1; } else if (f & FLAG_POSITIVE_BLANK) { leftbuf = " "; leftlen = 1; } } else if (f & FLAG_MINUS) { leftbuf = "-"; leftlen = 1; } } if ((f & HAS_WIDTH) && width > leftlen + leftzero + len) { if (f & FLAG_LEFT_ADJUSTED) rightsp = width - (leftlen + leftzero + len); else leftsp = width - (leftlen + leftzero + len); } if ((f & FLAG_ZERO_PADDED) && !(f & HAS_PRECISION)) { leftzero += leftsp; leftsp = 0; } bufp = buf; while (leftsp--) PUTCHAR (' '); while (leftlen--) PUTCHAR (*leftbuf++); while (leftzero--) PUTCHAR ('0'); while (len--) PUTCHAR (*bufp++); while (rightsp--) PUTCHAR (' '); error: return n; } static int do_conversion_string (const char *str, int f, int width, int precision, int (*func)(int c, void *data), void *data) { int len; int n = 0; int leftsp = 0, rightsp = 0; len = 0; while (!((f & HAS_PRECISION) && len >= precision) && str[len] != '\0') len++; if ((f & HAS_WIDTH) && width > len) { if (f & FLAG_LEFT_ADJUSTED) rightsp = width - len; else leftsp = width - len; } while (leftsp--) PUTCHAR (' '); while (len--) PUTCHAR (*str++); while (rightsp--) PUTCHAR (' '); error: return n; } static int do_printf (const char *format, va_list ap, int (*func)(int c, void *data), void *data) { char c; int n, f; int width, precision; n = 0; while ((c = *format++) != '\0') { if (c == '%') { f = parse_format (&format, &width, &precision); if (f & LENGTH_INTMAX) f |= LENGTH_LONGLONG; else if (f & LENGTH_SIZE) f |= LENGTH_LONG; else if (f & LENGTH_PTRDIFF) f |= LENGTH_LONG; if (f == END_STRING) { break; } else if (f & CONVERSION_NONE) { PUTCHAR ('%'); } else if (f & CONVERSION_INT) { long long intval; unsigned long long uintval; if (f & LENGTH_CHAR) intval = (long long)va_arg (ap, int); else if (f & LENGTH_SHORT) intval = (long long)va_arg (ap, int); else if (f & LENGTH_LONGLONG) intval = va_arg (ap, long long); else if (f & LENGTH_LONG) intval = (long long)va_arg (ap, long); else intval = (long long)va_arg (ap, int); if (intval < 0) { uintval = (unsigned long long)-intval; f |= FLAG_MINUS; } else { uintval = (unsigned long long)intval; f |= FLAG_PLUS; } n += do_conversion_int (uintval, f, width, precision, func, data); continue; } else if (f & CONVERSION_UINT) { unsigned long long uintval; if (f & LENGTH_CHAR) uintval = (unsigned long long) va_arg (ap, unsigned int); else if (f & LENGTH_SHORT) uintval = (unsigned long long) va_arg (ap, unsigned int); else if (f & LENGTH_LONGLONG) uintval = va_arg (ap, unsigned long long); else if (f & LENGTH_LONG) uintval = (unsigned long long) va_arg (ap, unsigned long); else uintval = (unsigned long long) va_arg (ap, unsigned int); n += do_conversion_int (uintval, f, width, precision, func, data); } else if (f & CONVERSION_VOIDP) { void *voidpval; unsigned long long uintval; voidpval = va_arg (ap, void *); uintval = (unsigned long long) (unsigned long)voidpval; n += do_conversion_int (uintval, f, width, precision, func, data); } else if (f & CONVERSION_CHARP) { char *charpval; charpval = va_arg (ap, char *); if (charpval == NULL) charpval = "(null)"; n += do_conversion_string (charpval, f, width, precision, func, data); } else { n += do_conversion_string ("FORMAT ERROR", CONVERSION_CHARP, 0, 0, func, data); } } else { PUTCHAR (c); } } error: return n; } static int do_putchar (int c, void *data) { putchar (c); return 0; } static int do_snputchar (int c, void *data) { struct snputchar_data *p; p = data; if (!p->len) return -1; if (!--p->len) c = '\0'; *p->buf++ = (char)c; return 0; } int printf (const char *format, ...) { va_list ap; int r; va_start (ap, format); r = vprintf (format, ap); va_end (ap); return r; } int vprintf (const char *format, va_list ap) { int r; spinlock_lock (&printf_lock); r = do_printf (format, ap, do_putchar, NULL); spinlock_unlock (&printf_lock); return r; } int snprintf (char *str, size_t size, const char *format, ...) { va_list ap; int r; va_start (ap, format); r = vsnprintf (str, size, format, ap); va_end (ap); return r; } int vsnprintf (char *str, size_t size, const char *format, va_list ap) { struct snputchar_data data; int r; data.buf = str; data.len = size; r = do_printf (format, ap, do_snputchar, &data); do_snputchar ('\0', &data); return r; } void printf_init_global (void) { spinlock_init (&printf_lock); } tinyvisor/vmm/core/builtin/bin_serialtest.c0000644006644000001440000000402711733227577021455 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include int _start (int a1, int a2) { int in, out, i, c; in = msgopen ("serialin"); out = msgopen ("serialout"); if (in < 0 || out < 0) { printf ("serial open failed\n"); return -1; } printf ("serial out test\n"); for (i = 0; i < 20; i++) msgsendint (out, "@ABCDEFG1234567890\r\n"[i]); printf ("serial in test\n"); while ((c = msgsendint (in, 0)) != '.') printf ("%c", c); return 0; } tinyvisor/vmm/core/builtin/lib_spinlock.h0000644006644000001440000000474311733227577021130 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ typedef char spinlock_t; static inline void spinlock_lock (spinlock_t *l) { char dummy; asm volatile ("3: \n" " xchg %1, %0 \n" /* exchange %0 and *l */ " test %0, %0 \n" /* check whether %0 is 0 */ " je 1f \n" /* if 0, succeeded */ "2: \n" " pause \n" /* spin loop hint */ " cmp %1, %0 \n" /* compare %0 and *l */ " je 2b \n" /* if not 0, do spin loop */ " jmp 3b \n" /* if 0, try again */ "1: \n" #ifdef __x86_64__ : "=r" (dummy) #else : "=abcd" (dummy) #endif , "=m" (*l) : "0" ((char)1) : "cc"); } static inline void spinlock_unlock (spinlock_t *l) { char dummy; asm volatile ("xchg %1, %0 \n" #ifdef __x86_64__ : "=r" (dummy) #else : "=abcd" (dummy) #endif , "=m" (*l) : "0" ((char)0)); } static inline void spinlock_init (spinlock_t *l) { spinlock_unlock (l); } tinyvisor/vmm/core/builtin/bin_shell.c0000644006644000001440000000504111733245403020366 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include void builtin_reboot () { int d; d = msgopen ("reboot"); if (d >= 0) { msgsendint (d, 0); msgclose (d); printf ("Reboot failed.\n"); } else printf ("reboot not found.\n"); } void builtin_panic () { int d; d = msgopen ("panic"); if (d >= 0) { msgsendint (d, 0); msgclose (d); printf ("panic failed.\n"); } else printf ("panic not found.\n"); } int _start (int a1, int a2) { int d; char buf[100]; for (;;) { printf ("> "); lineinput (buf, 100); if (!strcmp (buf, "")) continue; if (!strcmp (buf, "reboot")) builtin_reboot (); if (!strcmp (buf, "panic")) builtin_panic (); if (!strcmp (buf, "exit")) exitprocess (0); d = newprocess (buf); if (d >= 0) { msgsenddesc (d, 0); msgsenddesc (d, 1); msgsendint (d, 0); msgclose (d); } else printf ("%s not found.\n", buf); } } tinyvisor/vmm/core/builtin/bin_log.c0000644006644000001440000000647711733227577020072 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include char buf[65536]; void print_log (char *buf, int len) { int col = 80, row = 23, x, y, i, c, kbd = 0, top = 0, n = 0; goto first; loop: n = 0; printf ("\n\e[2J\e[H\r \r"); first: x = 0; y = 0; for (i = 0; i < len; i++) { if (y == top + row) { if (n) goto pagenext; for (;;) { printf ("-- more --"); c = msgsendint (kbd, 0); printf ("\r \r"); switch (c) { case 'f': case 'v' & 31: case ' ': n = row; pagenext: n--; case 'j': case 'n' & 31: case '\n': case '\r': top++; goto cont; case 'k': case 'p' & 31: if (top == 0) break; top--; goto loop; case 'b': case 128+'v': if (top == 0) break; if (top < row) top = 0; else top -= row; goto loop; case 'q': return; } } } cont: if (y >= top) { if (buf[i] == '\n' || (buf[i] >= ' ' && buf[i] <= '~')) printf ("%c", buf[i]); else printf (" "); } if (buf[i] == '\n' || ++x == col) x = 0, ++y; } for (;;) { printf ("-- end --"); c = msgsendint (kbd, 0); printf ("\r \r"); switch (c) { case 'k': case 'p' & 31: if (top == 0) break; top--; goto loop; case 'b': case 128+'v': if (top == 0) break; if (top < row) top = 0; else top -= row; goto loop; case 'q': return; } } } int _start (int a1, int a2) { int d, len; d = msgopen ("ttylog"); if (d >= 0) { len = msgsendbuf (d, 0, "", 0, buf, sizeof buf); msgclose (d); if (len > sizeof buf) len = sizeof buf; print_log (buf, len); } else printf ("ttylog not found.\n"); exitprocess (0); return 0; } tinyvisor/vmm/core/builtin/lib_syscalls.h0000644006644000001440000000376711733227577021150 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ enum { MSG_INT, MSG_BUF, }; void nop (void); void *msgsetfunc (int desc, void *func); int msgregister (char *name, void *func); int msgopen (char *name); int msgclose (int desc); int msgsendint (int desc, int data); int msgsenddesc (int desc, int data); int newprocess (char *name); int msgsendbuf (int desc, int data, void *sendbuf, int sendlen, void *recvbuf, int recvlen); int msgunregister (int desc); void exitprocess (int retval); tinyvisor/vmm/core/builtin/bin_debug.c0000644006644000001440000002112311733245403020344 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include enum memdump_type { MEMDUMP_GPHYS, MEMDUMP_HVIRT, MEMDUMP_GVIRT, MEMDUMP_HPHYS, }; typedef unsigned long long u64; typedef unsigned long ulong; struct memdump_data { u64 physaddr; u64 cr0, cr3, cr4, efer; ulong virtaddr; }; unsigned char memdata[128]; enum memdump_type dtype; u64 daddr; int dinit; char logbuf[65536]; int loglen; int logoff; struct { u64 rip, rsp, gdtrbase, idtrbase; u64 cr0, cr3, cr4, efer; } guest; void command_error (void) { printf ("error.\n"); } void print_help (char *buf) { printf ("dp guest-physical-address(hex) : dump memory\n"); printf ("dv guest-virtual-address(hex) : dump memory\n"); printf ("Dp vmm-physical-address(hex) : dump memory\n"); printf ("Dv vmm-virtual-address(hex) : dump memory\n"); printf ("h value1(hex) value2(hex) : add/sub\n"); printf ("r [register-name register-value(hex)]: print/set guest registers\n"); printf ("n : get next guest state from log\n"); printf ("! command : call external command\n"); printf ("q : quit\n"); } char * skip_space (char *buf) { while (*buf && isspace (*buf)) buf++; return buf; } int parse_hex (char **buf, unsigned long long *v) { int c = 0; *v = 0; for (;;++*buf) { if (**buf == '\0') break; if (**buf <= ' ') break; if (**buf >= '0' && **buf <= '9') { c++; *v = (*v << 4) | (**buf - '0'); continue; } if (**buf >= 'A' && **buf <= 'F') { c++; *v = (*v << 4) | (**buf - 'A' + 0xA); continue; } if (**buf >= 'a' && **buf <= 'f') { c++; *v = (*v << 4) | (**buf - 'a' + 0xA); continue; } break; } return c; } void dump_mem (char *buf, int t) { int c = 0; unsigned long long i, v; int tmp[16], j, k; int a; struct memdump_data d; buf++; buf = skip_space (buf); if (*buf == '\0') c = 1; if (c) { if (dinit == 0) { command_error (); return; } } else { dinit = 0; switch (*buf) { case 'p': case 'P': dtype = t ? MEMDUMP_HPHYS : MEMDUMP_GPHYS; buf++; break; case 'v': case 'V': dtype = t ? MEMDUMP_HVIRT : MEMDUMP_GVIRT; buf++; break; default: command_error (); return; } buf = skip_space (buf); if (!parse_hex (&buf, &daddr)) { command_error (); return; } dinit = 1; } d.physaddr = daddr; d.cr3 = guest.cr3; d.cr0 = guest.cr0; d.cr4 = guest.cr4; d.efer = guest.efer; d.virtaddr = (ulong)daddr; a = msgopen ("memdump"); if (a < 0) { printf ("msgopen failed.\n"); return; } if (msgsendbuf (a, dtype, &d, sizeof d, memdata, sizeof memdata)) { printf ("msgsendbuf failed.\n"); } else { v = daddr; i = v & ~0xFULL; k = -(int)(v & 0xF); do { for (j = 0; j < 16; j++) { if (k >= 0 && k < sizeof memdata) tmp[j] = memdata[k]; else tmp[j] = -1; k++; } printf ("%08llX ", i); /* address */ for (j = 0; j < 8; j++) { /* hex dump */ if (tmp[j] < 0) printf (" "); else printf (" %02X", tmp[j]); } if (tmp[7] < 0 || tmp[8] < 0) printf (" "); else printf ("-"); for (j = 8; j < 16; j++) { if (tmp[j] < 0) printf (" "); else printf ("%02X ", tmp[j]); } printf (" "); for (j = 0; j < 16; j++) { /* string */ if (tmp[j] < 0) printf (" "); else if (isprint (tmp[j])) printf ("%c", tmp[j]); else printf ("."); } printf ("\n"); i += 16; } while (k < sizeof memdata); v = v + sizeof memdata; daddr = v; } msgclose (a); } void getlog (void) { int d; memset (logbuf, 0, sizeof logbuf); d = msgopen ("ttylog"); if (d >= 0) { loglen = msgsendbuf (d, 0, "", 0, logbuf, sizeof logbuf); msgclose (d); if (loglen > sizeof logbuf) loglen = sizeof logbuf; } else { printf ("ttylog not found.\n"); loglen = 0; } } int findlog (int off, int end, char *key, int len, int *ii) { int i; for (i = off; i < end; i++) { if (logbuf[i] == key[0]) { if (memcmp (&logbuf[i], key, len) == 0) { *ii = i + len; return 1; } } } return 0; } void getnextstate (void) { int i, j; char *p; static char key1[] = "\nGuest state of "; static struct { char *key; u64 *data; } *pp, l[] = { { "RSP ", &guest.rsp }, { "CR0 ", &guest.cr0 }, { "CR3 ", &guest.cr3 }, { "CR4 ", &guest.cr4 }, { "EFER ", &guest.efer }, { "RIP ", &guest.rip }, { "GDTR ", &guest.gdtrbase }, { "IDTR ", &guest.idtrbase }, { 0, 0 } }; if (findlog (logoff, loglen - strlen (key1), key1, strlen (key1), &i)) goto found; if (findlog (0, logoff, key1, strlen (key1), &i)) goto found; printf ("guest state not found\n"); return; found: logoff = i; for (; i < loglen && logbuf[i] != '-'; i++) printf ("%c", logbuf[i]); for (pp = l; pp->key; pp++) { if (!findlog (i, loglen - 3, pp->key, strlen (pp->key), &j)) { printf ("%s not found\n", pp->key); continue; } p = &logbuf[j]; p = skip_space (p); if (!parse_hex (&p, pp->data)) { printf ("%s parse failed\n", pp->key); continue; } } printf ("guest state loaded\n"); } void guestreg (char *buf) { static struct { char *fmt; char *name; u64 *data; } *pp, l[] = { { "%s %08llX ", "RIP", &guest.rip }, { "%s %08llX ", "RSP", &guest.rsp }, { "%s %08llX ", "GDTR", &guest.gdtrbase }, { "%s %08llX\n", "IDTR", &guest.idtrbase }, { "%s %08llX ", "CR0", &guest.cr0 }, { "%s %08llX ", "CR3", &guest.cr3 }, { "%s %08llX ", "CR4", &guest.cr4 }, { "%s %08llX\n", "EFER", &guest.efer }, { 0, 0, 0 } }; u64 tmp; if (buf[1] == '\0') { for (pp = l; pp->fmt; pp++) printf (pp->fmt, pp->name, *pp->data); } else { buf++; buf = skip_space (buf); for (pp = l; pp->fmt; pp++) { if (memcmp (buf, pp->name, strlen (pp->name)) == 0) goto next1; } printf ("bad register name\n"); return; next1: buf += strlen (pp->name); buf = skip_space (buf); if (!parse_hex (&buf, &tmp)) { printf ("bad register value\n"); return; } *pp->data = tmp; } } void hexaddsub (char *buf) { u64 val1, val2; buf++; buf = skip_space (buf); if (!parse_hex (&buf, &val1)) { command_error (); return; } buf = skip_space (buf); if (!parse_hex (&buf, &val2)) { command_error (); return; } printf ("%llX %llX\n", val1 + val2, val1 - val2); } void callprog (char *buf) { int d; buf++; buf = skip_space (buf); d = newprocess (buf); if (d >= 0) { msgsenddesc (d, 0); msgsenddesc (d, 1); msgsendint (d, 0); msgclose (d); } else printf ("%s not found.\n", buf); } int _start (int a1, int a2) { char buf[100]; getlog (); logoff = 0; getnextstate (); for (;;) { printf ("debug> "); lineinput (buf, 100); switch (buf[0]) { case 'h': if (buf[1] != '\0' && buf[1] != 'e') { hexaddsub (buf); break; } /* fall through */ case '?': print_help (buf); break; case 'd': dump_mem (buf, 0); break; case 'D': dump_mem (buf, 1); break; case 'q': exitprocess (0); break; case 'r': guestreg (buf); break; case 'n': getnextstate (); break; case '!': callprog (buf); break; default: command_error (); break; } } } tinyvisor/vmm/core/builtin/lib_printf.h0000644006644000001440000000320711733227577020602 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ int printf(const char *fmt, ...) __attribute__ ((format (printf, 1, 2))); tinyvisor/vmm/core/builtin/lib_putchar.h0000644006644000001440000000313511733227577020746 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ void putchar (unsigned char c); tinyvisor/vmm/core/builtin/lib_lineinput.h0000644006644000001440000000323411733227577021307 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ int lineinput_desc (int kbd, int dsp, char *buf, int len); int lineinput (char *buf, int len); tinyvisor/vmm/core/mtrr.c0000644006644000001440000000765111753734500015761 0ustar yuichi_xyusers/* * Copyright (c) 2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include "asm.h" #include "constants.h" #include "mtrr.h" u8 mtrr_get_fixed_mem_type(phys_t addr) { u64 msr_val; ulong msr_num; phys_t width; phys_t index; u8 type; if (addr >= 0xc0000) { width = 0x1000; msr_num = MSR_IA32_MTRR_FIX4K_C000 + (addr - 0xc0000) / (0x1000 * MSR_IA32_MTRR_FIX_TYPE_NUM); } else if (addr >= 0x80000) { width = 0x4000; msr_num = MSR_IA32_MTRR_FIX16K_800 + (addr - 0x80000) / (0x4000 * MSR_IA32_MTRR_FIX_TYPE_NUM); } else { width = 0x10000; msr_num = MSR_IA32_MTRR_FIX64K_000; } index = ((addr / width) % MSR_IA32_MTRR_FIX_TYPE_NUM); asm_rdmsr64(msr_num, &msr_val); type = (msr_val >> index * MSR_IA32_MTRR_FIX_TYPE_SHIFT) & MSR_IA32_MTRR_FIX_TYPE_MASK; return type; } u8 mtrr_get_mem_type(phys_t addr) { u64 msr_val; u64 mtrrcap; u8 type; u8 vcnt; phys_t base; phys_t mask; int i; asm_rdmsr64(MSR_IA32_MTRRCAP, &mtrrcap); asm_rdmsr64(MSR_IA32_MTRR_DEF_TYPE, &msr_val); if ((msr_val & MSR_IA32_MTRR_DEF_TYPE_E_BIT) == 0) { return MTRR_ENCODING_UC; } type = msr_val & MSR_IA32_MTRR_DEF_TYPE_TYPE_MASK; if ((mtrrcap & MSR_IA32_MTRRCAP_FIX_BIT) && (msr_val & MSR_IA32_MTRR_DEF_TYPE_FE_BIT) && addr < 0x100000) { return mtrr_get_fixed_mem_type(addr); } vcnt = mtrrcap & MSR_IA32_MTRRCAP_VCNT_MASK; for (i = vcnt - 1; i >= 0; i--) { asm_rdmsr64(MSR_IA32_MTRR_PHYSMASK0 + i * 2, &msr_val); if ((msr_val & MSR_IA32_MTRR_PHYSMASK_V_BIT) == 0) { continue; } mask = msr_val & MSR_IA32_MTRR_PHYSMASK_MASK_MASK; asm_rdmsr64(MSR_IA32_MTRR_PHYSBASE0 + i * 2, &msr_val); base = msr_val & MSR_IA32_MTRR_PHYSBASE_BASE_MASK; if ((addr & mask) == (base & mask)) { type = msr_val & MSR_IA32_MTRR_PHYSBASE_TYPE_MASK; break; } } return type; } #ifdef DUMP_MTRR static void mtrr_init(void) { phys_t start = 0; phys_t cur; u8 type, new_type; if (get_cpu_id() == 0) { type = mtrr_get_mem_type(0); for (cur = 0;; cur += PAGESIZE) { new_type = mtrr_get_mem_type(cur); if (new_type != type) { if (cur > 0xffffffff && new_type != MTRR_ENCODING_WB) { break; } printf("MTRR 0x%llx-0x%llx 0x%x\n", start, cur - 1, type); start = cur; type = new_type; } } printf("MTRR 0x%llx-0x%llx 0x%x\n", start, cur - 1, type); } } INITFUNC("pcpu5", mtrr_init); #endif tinyvisor/vmm/core/cpu_mmu_spt.c0000644006644000001440000002113311764604316017322 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ /* MMU emulation, Shadow Page Tables (SPT) */ #include #include #include #include #include #include "asm.h" #include "constants.h" #include "cpu_mmu.h" #include "cpu_mmu_spt.h" #include "current.h" #include "mm.h" #include "mmio.h" #include "msr_pass.h" #include "panic.h" #include "pcpu.h" #include "vmmcall_status.h" struct access_data { unsigned int write : 1; unsigned int user : 1; unsigned int wp : 1; }; struct guest_table_data { unsigned int rw : 1; unsigned int us : 1; unsigned int nx : 1; unsigned int ps : 1; u32 cache_flag; u64 gfn; }; static bool guest64 (void) { u64 efer; current->vmctl.read_msr (MSR_IA32_EFER, &efer); if (efer & MSR_IA32_EFER_LMA_BIT) return true; return false; } void cpu_mmu_spt_invalidate(ulong v) { pmap_t p; u64 tmp; pmap_open_vmm (&p, current->spt.cr3tbl_phys, current->spt.levels); pmap_setvirt (&p, v, 2); tmp = pmap_read (&p); if (tmp & PDE_P_BIT) { if (tmp & PDE_AVAILABLE1_BIT) { pmap_write (&p, tmp & ~PDE_AVAILABLE1_BIT, 0xFFF); pmap_setlevel (&p, 1); pmap_clear (&p); if (current->spt.levels >= 3) { pmap_setvirt (&p, v ^ PAGESIZE2M, 2); tmp = pmap_read (&p); if (tmp & PDE_P_BIT) { pmap_write (&p, tmp & ~PDE_AVAILABLE1_BIT, 0xFFF); pmap_setlevel (&p, 1); pmap_clear (&p); } } } else { pmap_setlevel (&p, 1); tmp = pmap_read (&p); pmap_write (&p, 0, 0xFFF); } } pmap_close (&p); current->spt.tlbflash = true; } static void invalidate_all_spt(void) { pmap_t p; struct spt_page *spt_page; pmap_open_vmm (&p, current->spt.cr3tbl_phys, current->spt.levels); pmap_clear (&p); pmap_close (&p); while((spt_page = LIST2_POP(current->spt.shadow_l1, list)) != NULL) { spt_page->pte_virt = NULL; LIST2_ADD(current->spt.shadow_free, list, spt_page); } while((spt_page = LIST2_POP(current->spt.shadow_lu, list)) != NULL) { spt_page->pte_virt = NULL; LIST2_ADD(current->spt.shadow_free, list, spt_page); } current->spt.tlbflash = true; } static void map_page (u64 v, struct access_data ad, struct guest_table_data *gtd, int glvl, phys_t hphys) { pmap_t p; u64 tmp; int l; ulong cr0; struct spt_page *spt_page; current->vmctl.read_control_reg (CONTROL_REG_CR0, &cr0); if (!(cr0 & CR0_WP_BIT)) { if (!ad.user && ad.write) { gtd->us = 0; gtd->rw = 1; } } pmap_open_vmm (&p, current->spt.cr3tbl_phys, current->spt.levels); pmap_setvirt (&p, v, 1); tmp = pmap_read (&p); for (; (l = pmap_getreadlevel (&p)) > 1; tmp = pmap_read (&p)) { pmap_setlevel (&p, l); spt_page = LIST2_POP(current->spt.shadow_free, list); if (spt_page == NULL) { spt_page = LIST2_POP(current->spt.shadow_l1, list); if (spt_page == NULL) { invalidate_all_spt(); continue; } if (spt_page->pte_virt) { *spt_page->pte_virt = 0; current->spt.tlbflash = true; } } spt_page->pte_virt = pmap_pointer(&p); if (l == 1) { LIST2_ADD(current->spt.shadow_l1, list, spt_page); } else { LIST2_ADD(current->spt.shadow_lu, list, spt_page); } pmap_write (&p, spt_page->phys | PDE_P_BIT, PDE_P_BIT); pmap_setlevel (&p, l - 1); pmap_clear (&p); pmap_setlevel (&p, 1); } if (gtd->ps) { pmap_setlevel (&p, 2); tmp = pmap_read (&p); if (!(tmp & PDE_AVAILABLE1_BIT)) pmap_write (&p, tmp | PDE_AVAILABLE1_BIT, 0xFFF); pmap_setlevel (&p, 1); } pmap_write (&p, (hphys & (~PAGESIZE_MASK)) | PTE_P_BIT | (gtd->rw ? PTE_RW_BIT : 0) | (gtd->us ? PTE_US_BIT : 0) | (gtd->nx ? PTE_NX_BIT : 0) | mm_cache_flag_to_pte_attr (gtd->cache_flag), PTE_P_BIT | PTE_RW_BIT | PTE_US_BIT | PTE_PWT_BIT | PTE_PCD_BIT | PTE_PAT_BIT); pmap_close (&p); } void cpu_mmu_spt_updatecr3(void) { current->spt.levels = guest64 () ? 4 : 3; invalidate_all_spt(); current->vmctl.spt_setcr3 (current->spt.cr3tbl_phys); } void cpu_mmu_spt_init(void) { int i; vmmerr_t err; err = alloc_page(¤t->spt.cr3tbl, ¤t->spt.cr3tbl_phys); if (err) { panic("Failed to allocate memory for a cr3-table."); } memset(current->spt.cr3tbl, 0, PAGESIZE); LIST2_HEAD_INIT(current->spt.shadow_free); LIST2_HEAD_INIT(current->spt.shadow_l1); LIST2_HEAD_INIT(current->spt.shadow_lu); for (i = 0; i < NUM_OF_SPTTBL; i++) { err = alloc_page(¤t->spt.spt_page[i].virt, ¤t->spt.spt_page[i].phys); if (err) { panic("Failed to allocate memory for a shadow page table."); } current->spt.spt_page[i].pte_virt = NULL; LIST2_ADD(current->spt.shadow_free, list, ¤t->spt.spt_page[i]); } } bool cpu_mmu_spt_tlbflush(void) { if (current->spt.tlbflash) { current->spt.tlbflash = false; return true; } else { return false; } } static void set_ad (bool write, bool user, bool wp, struct access_data *ad) { ad->write = write; ad->user = user; ad->wp = wp; } static void set_gtd (u64 entries[5], int levels, struct guest_table_data *gtd) { unsigned int rw = 1, us = 1, nx = 0; int i; u64 entry; for (i = levels; i >= 0; i--) { entry = entries[i]; if (!(entry & PDE_RW_BIT)) rw = 0; if (!(entry & PDE_US_BIT)) us = 0; if (entry & PDE_NX_BIT) nx = 1; } if (!(entries[0] & PTE_D_BIT)) rw = 0; gtd->cache_flag = msr_pte_to_cache_flag(entries[0]); gtd->rw = rw; gtd->us = us; gtd->nx = nx; gtd->gfn = (entries[0] & PTE_ADDR_MASK64) >> PAGESIZE_SHIFT; if (levels >= 2 && entries[1] & PDE_PS_BIT) { gtd->ps = 1; } else { gtd->ps = 0; } } /* handling a page fault of a guest */ void cpu_mmu_spt_pagefault (ulong err, ulong cr2) { int levels; vmmerr_t ret; bool wr, us, ex, wp; ulong cr0, cr3, cr4; struct access_data ad; struct guest_table_data gtd; u64 efer, entries[5]; phys_t hphys; current->vmctl.read_control_reg(CONTROL_REG_CR0, &cr0); current->vmctl.read_control_reg(CONTROL_REG_CR3, &cr3); current->vmctl.read_control_reg(CONTROL_REG_CR4, &cr4); current->vmctl.read_msr(MSR_IA32_EFER, &efer); wr = !!(err & PAGEFAULT_ERR_WR_BIT); us = !!(err & PAGEFAULT_ERR_US_BIT); ex = !!(err & PAGEFAULT_ERR_ID_BIT); wp = !!(cr0 & CR0_WP_BIT); ret = mmu_get_pte(cr2, cr0, cr3, cr4, efer, wr, us, ex, entries, &levels); if (ret != VMMERR_SUCCESS) { mmu_generate_pagefault(ret, err & PAGEFAULT_ERR_WR_BIT, err & PAGEFAULT_ERR_US_BIT, cr2); return; } set_ad(wr, us, wp, &ad); set_gtd(entries, levels, >d); mmio_lock(); ret = mmio_pagefault(gtd.gfn << PAGESIZE_SHIFT); mmio_unlock(); if (ret != VMMERR_NODEV) { if (ret != VMMERR_SUCCESS && (ret < VMMERR_PAGE_NOT_PRESENT || ret > VMMERR_PAGE_BAD_RESERVED_BIT)) { panic("Failed to emulate accessing to MMIO area. ret 0x%x", ret); } return; } hphys = current->vm->gmm.gp2hp((gtd.gfn << PAGESIZE_SHIFT) + (cr2 & PAGESIZE_MASK)); if (hphys == GMM_NO_MAPPING) { ret = cpu_interpreter(); if (ret != VMMERR_SUCCESS && (ret < VMMERR_PAGE_NOT_PRESENT || ret > VMMERR_PAGE_BAD_RESERVED_BIT)) { panic("Failed to emulate accessing to no mapping area. ret 0x%x", ret); } return; } map_page(cr2, ad, >d, levels, hphys); } tinyvisor/vmm/core/int.h0000644006644000001440000000404512072152324015557 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #ifndef _CORE_INT_H #define _CORE_INT_H #include #include struct int_stack; struct vm; struct int_hook{ spinlock_t lock; int_handler_t *handler; void *data; }; void set_exception_handler (int intnum, void *handler); void set_int_handler (int intnum, void *handler); void int_init_hook(void); void int_init_ap (void); char *exception_name (int num); void int_dump_stack(struct int_stack *s); #endif tinyvisor/vmm/core/int.c0000644006644000001440000003230212072152324015547 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #include #include #include #include #include #include "apic.h" #include "asm.h" #include "bitmap.h" #include "constants.h" #include "current.h" #include "extint.h" #include "int.h" #include "panic.h" #include "pcpu.h" #include "process.h" #include #ifdef __x86_64__ static struct gatedesc64 intrdesctbl[NUM_OF_INT]; #else static struct gatedesc32 intrdesctbl[NUM_OF_INT]; #endif struct int_stack { ulong r15, r14, r13, r12, r11, r10, r9, r8; ulong rdi, rsi, rbp, rsp, rbx, rdx, rcx, rax; ulong fs, ds, ss, cs, es, gs; ulong vector; ulong s[]; }; #define M(N) \ void int##N##handler (void); \ asm ("int" #N "handler: \n" \ " push $" #N "\n" \ " jmp int_handler \n") M(0x00); M(0x01); M(0x02); M(0x03); M(0x04); M(0x05); M(0x06); M(0x07); M(0x08); M(0x09); M(0x0A); M(0x0B); M(0x0C); M(0x0D); M(0x0E); M(0x0F); M(0x10); M(0x11); M(0x12); M(0x13); M(0x14); M(0x15); M(0x16); M(0x17); M(0x18); M(0x19); M(0x1A); M(0x1B); M(0x1C); M(0x1D); M(0x1E); M(0x1F); M(0x20); M(0x21); M(0x22); M(0x23); M(0x24); M(0x25); M(0x26); M(0x27); M(0x28); M(0x29); M(0x2A); M(0x2B); M(0x2C); M(0x2D); M(0x2E); M(0x2F); M(0x30); M(0x31); M(0x32); M(0x33); M(0x34); M(0x35); M(0x36); M(0x37); M(0x38); M(0x39); M(0x3A); M(0x3B); M(0x3C); M(0x3D); M(0x3E); M(0x3F); M(0x40); M(0x41); M(0x42); M(0x43); M(0x44); M(0x45); M(0x46); M(0x47); M(0x48); M(0x49); M(0x4A); M(0x4B); M(0x4C); M(0x4D); M(0x4E); M(0x4F); M(0x50); M(0x51); M(0x52); M(0x53); M(0x54); M(0x55); M(0x56); M(0x57); M(0x58); M(0x59); M(0x5A); M(0x5B); M(0x5C); M(0x5D); M(0x5E); M(0x5F); M(0x60); M(0x61); M(0x62); M(0x63); M(0x64); M(0x65); M(0x66); M(0x67); M(0x68); M(0x69); M(0x6A); M(0x6B); M(0x6C); M(0x6D); M(0x6E); M(0x6F); M(0x70); M(0x71); M(0x72); M(0x73); M(0x74); M(0x75); M(0x76); M(0x77); M(0x78); M(0x79); M(0x7A); M(0x7B); M(0x7C); M(0x7D); M(0x7E); M(0x7F); M(0x80); M(0x81); M(0x82); M(0x83); M(0x84); M(0x85); M(0x86); M(0x87); M(0x88); M(0x89); M(0x8A); M(0x8B); M(0x8C); M(0x8D); M(0x8E); M(0x8F); M(0x90); M(0x91); M(0x92); M(0x93); M(0x94); M(0x95); M(0x96); M(0x97); M(0x98); M(0x99); M(0x9A); M(0x9B); M(0x9C); M(0x9D); M(0x9E); M(0x9F); M(0xA0); M(0xA1); M(0xA2); M(0xA3); M(0xA4); M(0xA5); M(0xA6); M(0xA7); M(0xA8); M(0xA9); M(0xAA); M(0xAB); M(0xAC); M(0xAD); M(0xAE); M(0xAF); M(0xB0); M(0xB1); M(0xB2); M(0xB3); M(0xB4); M(0xB5); M(0xB6); M(0xB7); M(0xB8); M(0xB9); M(0xBA); M(0xBB); M(0xBC); M(0xBD); M(0xBE); M(0xBF); M(0xC0); M(0xC1); M(0xC2); M(0xC3); M(0xC4); M(0xC5); M(0xC6); M(0xC7); M(0xC8); M(0xC9); M(0xCA); M(0xCB); M(0xCC); M(0xCD); M(0xCE); M(0xCF); M(0xD0); M(0xD1); M(0xD2); M(0xD3); M(0xD4); M(0xD5); M(0xD6); M(0xD7); M(0xD8); M(0xD9); M(0xDA); M(0xDB); M(0xDC); M(0xDD); M(0xDE); M(0xDF); M(0xE0); M(0xE1); M(0xE2); M(0xE3); M(0xE4); M(0xE5); M(0xE6); M(0xE7); M(0xE8); M(0xE9); M(0xEA); M(0xEB); M(0xEC); M(0xED); M(0xEE); M(0xEF); M(0xF0); M(0xF1); M(0xF2); M(0xF3); M(0xF4); M(0xF5); M(0xF6); M(0xF7); M(0xF8); M(0xF9); M(0xFA); M(0xFB); M(0xFC); M(0xFD); M(0xFE); M(0xFF); #undef M #ifdef __x86_64__ static void init_intrgate (struct gatedesc64 *p, ulong offset, u16 sel) { p->offset_15_0 = offset; p->sel = sel; p->ist = 0; p->reserved1 = 0; p->type = GATEDESC_TYPE_64BIT_INTR; p->zero = 0; p->dpl = 0; p->p = 1; p->offset_31_16 = offset >> 16; p->offset_63_32 = offset >> 32; p->reserved2 = 0; } #else static void init_intrgate (struct gatedesc32 *p, ulong offset, u16 sel) { p->offset_15_0 = offset; p->sel = sel; p->param_count = 0; p->zero1 = 0; p->type = GATEDESC_TYPE_32BIT_INTR; p->zero2 = 0; p->dpl = 0; p->p = 1; p->offset_31_16 = offset >> 16; } #endif char * exception_name (int vector) { switch (vector) { case EXCEPTION_DE: return "Divide Error Exception (#DE)"; case EXCEPTION_DB: return "Debug Exception (#DB)"; case EXCEPTION_NMI: return "NMI"; case EXCEPTION_BP: return "Breakpoint Exception (#BP)"; case EXCEPTION_OF: return "Overflow Exception (#OF)"; case EXCEPTION_BR: return "BOUND Range Exceeded Exception (#BR)"; case EXCEPTION_UD: return "Invalid Opcode Exception (#UD)"; case EXCEPTION_NM: return "Device Not Available Exception (#NM)"; case EXCEPTION_DF: return "Double Fault Exception (#DF)"; case EXCEPTION_COPROCESSOR_SEGMENT_OVERRUN: return "Coprocessor Segment Overrun"; case EXCEPTION_TS: return "Invalid TSS Exception (#TS)"; case EXCEPTION_NP: return "Segment Not Present (#NP)"; case EXCEPTION_SS: return "Stack Fault Exception (#SS)"; case EXCEPTION_GP: return "General Protection Exception (#GP)"; case EXCEPTION_PF: return "Page-Fault Exception (#PF)"; case EXCEPTION_MF: return "x87 FPU Floating-Point Error (#MF)"; case EXCEPTION_AC: return "Alignment Check Exception (#AC)"; case EXCEPTION_MC: return "Machine-Check Exception (#MC)"; case EXCEPTION_XM: return "SIMD Floating-Point Exception (#XM)"; } return ""; } static bool dec_nest (void *data) { struct int_stack *s = (struct int_stack *)data; printf("Fatal interrupt in process: 0x%02lX %s\n", s->vector, exception_name ((int)s->vector)); int_dump_stack(s); printf("Kill process.\n"); currentcpu->int_fatal--; return true; } void int_dump_stack(struct int_stack *s) { ulong cr0, cr2, cr3, cr4; int n; asm_rdcr0 (&cr0); asm_rdcr2 (&cr2); asm_rdcr3 (&cr3); asm_rdcr4 (&cr4); printf ("CR0: 0x%08lX CR2: 0x%08lX CR3: 0x%08lX CR4: 0x%08lX\n", cr0, cr2, cr3, cr4); printf ("RSP on interrupt: 0x%08lX ", (ulong)&s->s[0]); printf ("Stack information:\n"); n = sizeof (s->s[0]); printf (" +%02d Error code / RIP : 0x%08lX", n * 0, s->s[0]); printf (" +%02d RSP / SS : 0x%08lX\n", n * 4, s->s[4]); printf (" +%02d RIP / CS : 0x%08lX", n * 1, s->s[1]); printf (" +%02d SS / : 0x%08lX\n", n * 5, s->s[5]); printf (" +%02d CS / RFLAGS : 0x%08lX", n * 2, s->s[2]); printf (" +%02d / : 0x%08lX\n", n * 6, s->s[6]); printf (" +%02d RFLAGS / RSP : 0x%08lX", n * 3, s->s[3]); printf (" +%02d / : 0x%08lX\n", n * 7, s->s[7]); printf ("RAX: 0x%08lX RCX: 0x%08lX RDX: 0x%08lX RBX: 0x%08lX\n", s->rax, s->rcx, s->rdx, s->rbx); printf ("RSP: 0x%08lX RBP: 0x%08lX RSI: 0x%08lX RDI: 0x%08lX\n", s->rsp, s->rbp, s->rsi, s->rdi); printf ("R8: 0x%08lX R9: 0x%08lX R10: 0x%08lX R11: 0x%08lX\n", s->r8, s->r9, s->r10, s->r11); printf ("R12: 0x%08lX R13: 0x%08lX R14: 0x%08lX R15: 0x%08lX\n", s->r12, s->r13, s->r14, s->r15); printf ("ES: 0x%04lX CS: 0x%04lX SS: 0x%04lX DS: 0x%04lX", s->es & 0xFFFF, s->cs & 0xFFFF, s->ss & 0xFFFF, s->ds & 0xFFFF); printf (" FS: 0x%04lX GS: 0x%04lX\n", s->fs & 0xFFFF, s->gs & 0xFFFF); } static void int_fatal (struct int_stack *s) { if (s->vector == EXCEPTION_NMI) { goto stop; } if (!currentcpu_available()) { goto stop; } currentcpu->int_fatal++; if (currentcpu->int_fatal == 1) { process_kill (dec_nest, s); } stop: panic_int(s, "Fatal interrupt in VMM: 0x%02lX %s", s->vector, exception_name ((int)s->vector)); } asmlinkage void do_int (struct int_stack *s) { struct int_hook *hook; int_handler_t *handler; void *data; if (!current || !currentcpu_available()) { int_fatal(s); } /* * Interrupts are disabled by processor. */ currentcpu->disable_interrupt++; hook = current->int_hook + s->vector; spinlock_lock(&hook->lock); handler = hook->handler; data = hook->data; spinlock_unlock(&hook->lock); if (handler) { if (handler(s->vector, data)) { apic_write_eoi(); ASSERT(currentcpu->disable_interrupt > 0); currentcpu->disable_interrupt--; return; } } /* * We assume the vector of external interrupt is more than or * equal to EXT_INT_START(32). But there are exceptions. int 08 * (EXCEPTION_DF) is used for IRQ0(system timer) and int 09 is * used for IRQ1(keyboard data ready). */ if (s->vector < EXT_INT_START && !(s->vector == EXCEPTION_DF && s->s[0] != 0) && !(s->vector == EXCEPTION_COPROCESSOR_SEGMENT_OVERRUN)) { int_fatal(s); } extint_pend_interrupt (s->vector); ASSERT(currentcpu->disable_interrupt > 0); currentcpu->disable_interrupt--; } void set_exception_handler (int vector, void *handler) { set_int_handler (vector, handler); } void set_int_handler (int vector, void *handler) { u16 cs; asm_rdcs (&cs); init_intrgate (&intrdesctbl[vector], (ulong)handler, cs); } static void idt_init (void *p) { #ifdef __x86_64__ struct gatedesc64 *idt; #else struct gatedesc32 *idt; #endif u16 cs; asm_rdcs (&cs); idt = p; #define M(N) init_intrgate (&idt[N], (ulong)int##N##handler, cs) M(0x00); M(0x01); M(0x02); M(0x03); M(0x04); M(0x05); M(0x06); M(0x07); M(0x08); M(0x09); M(0x0A); M(0x0B); M(0x0C); M(0x0D); M(0x0E); M(0x0F); M(0x10); M(0x11); M(0x12); M(0x13); M(0x14); M(0x15); M(0x16); M(0x17); M(0x18); M(0x19); M(0x1A); M(0x1B); M(0x1C); M(0x1D); M(0x1E); M(0x1F); M(0x20); M(0x21); M(0x22); M(0x23); M(0x24); M(0x25); M(0x26); M(0x27); M(0x28); M(0x29); M(0x2A); M(0x2B); M(0x2C); M(0x2D); M(0x2E); M(0x2F); M(0x30); M(0x31); M(0x32); M(0x33); M(0x34); M(0x35); M(0x36); M(0x37); M(0x38); M(0x39); M(0x3A); M(0x3B); M(0x3C); M(0x3D); M(0x3E); M(0x3F); M(0x40); M(0x41); M(0x42); M(0x43); M(0x44); M(0x45); M(0x46); M(0x47); M(0x48); M(0x49); M(0x4A); M(0x4B); M(0x4C); M(0x4D); M(0x4E); M(0x4F); M(0x50); M(0x51); M(0x52); M(0x53); M(0x54); M(0x55); M(0x56); M(0x57); M(0x58); M(0x59); M(0x5A); M(0x5B); M(0x5C); M(0x5D); M(0x5E); M(0x5F); M(0x60); M(0x61); M(0x62); M(0x63); M(0x64); M(0x65); M(0x66); M(0x67); M(0x68); M(0x69); M(0x6A); M(0x6B); M(0x6C); M(0x6D); M(0x6E); M(0x6F); M(0x70); M(0x71); M(0x72); M(0x73); M(0x74); M(0x75); M(0x76); M(0x77); M(0x78); M(0x79); M(0x7A); M(0x7B); M(0x7C); M(0x7D); M(0x7E); M(0x7F); M(0x80); M(0x81); M(0x82); M(0x83); M(0x84); M(0x85); M(0x86); M(0x87); M(0x88); M(0x89); M(0x8A); M(0x8B); M(0x8C); M(0x8D); M(0x8E); M(0x8F); M(0x90); M(0x91); M(0x92); M(0x93); M(0x94); M(0x95); M(0x96); M(0x97); M(0x98); M(0x99); M(0x9A); M(0x9B); M(0x9C); M(0x9D); M(0x9E); M(0x9F); M(0xA0); M(0xA1); M(0xA2); M(0xA3); M(0xA4); M(0xA5); M(0xA6); M(0xA7); M(0xA8); M(0xA9); M(0xAA); M(0xAB); M(0xAC); M(0xAD); M(0xAE); M(0xAF); M(0xB0); M(0xB1); M(0xB2); M(0xB3); M(0xB4); M(0xB5); M(0xB6); M(0xB7); M(0xB8); M(0xB9); M(0xBA); M(0xBB); M(0xBC); M(0xBD); M(0xBE); M(0xBF); M(0xC0); M(0xC1); M(0xC2); M(0xC3); M(0xC4); M(0xC5); M(0xC6); M(0xC7); M(0xC8); M(0xC9); M(0xCA); M(0xCB); M(0xCC); M(0xCD); M(0xCE); M(0xCF); M(0xD0); M(0xD1); M(0xD2); M(0xD3); M(0xD4); M(0xD5); M(0xD6); M(0xD7); M(0xD8); M(0xD9); M(0xDA); M(0xDB); M(0xDC); M(0xDD); M(0xDE); M(0xDF); M(0xE0); M(0xE1); M(0xE2); M(0xE3); M(0xE4); M(0xE5); M(0xE6); M(0xE7); M(0xE8); M(0xE9); M(0xEA); M(0xEB); M(0xEC); M(0xED); M(0xEE); M(0xEF); M(0xF0); M(0xF1); M(0xF2); M(0xF3); M(0xF4); M(0xF5); M(0xF6); M(0xF7); M(0xF8); M(0xF9); M(0xFA); M(0xFB); M(0xFC); M(0xFD); M(0xFE); M(0xFF); #undef M } void int_init_ap (void) { asm_wridtr ((u32)(ulong)intrdesctbl, sizeof (intrdesctbl[0]) * NUM_OF_INT); } void int_init_hook(void) { struct int_hook *hook; int i; for (i = 0; i < NUM_OF_INT; i++) { hook = current->int_hook + i; spinlock_init(&hook->lock); hook->handler = NULL; } } void set_int_hook(vector_t vector, int_handler_t *handler, void *data) { struct int_hook *hook; hook = current->int_hook + vector; spinlock_lock(&hook->lock); hook->handler = handler; hook->data = data; spinlock_unlock(&hook->lock); } void clear_int_hook(vector_t vector) { set_int_hook(vector, NULL, NULL); } static void int_init_global (void) { idt_init (intrdesctbl); asm_wridtr ((u32)(ulong)intrdesctbl, sizeof (intrdesctbl[0]) * NUM_OF_INT); } INITFUNC ("global1", int_init_global); tinyvisor/vmm/core/callrealmode_asm.h0000644006644000001440000000504011733245403020251 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_CALLREALMODE_ASM_H #define _CORE_CALLREALMODE_ASM_H #include "callrealmode.h" #include #define CALLREALMODE_OFFSET 0xF000 extern char callrealmode_start[], callrealmode_end[]; enum callrealmode_func { CALLREALMODE_FUNC_PRINTMSG = 0x0, CALLREALMODE_FUNC_GETSYSMEMMAP = 0x1, CALLREALMODE_FUNC_GETSHIFTFLAGS = 0x2, CALLREALMODE_FUNC_SETVIDEOMODE = 0x3, CALLREALMODE_FUNC_REBOOT = 0x4, }; struct callrealmode_printmsg { u32 message; }; struct callrealmode_getsysmemmap { u32 ebx; u32 ebx_ret; u32 fail; struct e820map desc; } __attribute__ ((packed)); struct callrealmode_getshiftflags { u8 al_ret; }; struct callrealmode_setvideomode { u8 al; }; struct callrealmode_data { enum callrealmode_func func : 32; union { struct callrealmode_printmsg printmsg; struct callrealmode_getsysmemmap getsysmemmap; struct callrealmode_getshiftflags getshiftflags; struct callrealmode_setvideomode setvideomode; } u; } __attribute__ ((packed)); #endif tinyvisor/vmm/core/gbiosloader.h0000644006644000001440000000341012140421510017242 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #ifndef _CORE_GBIOSLOADER_H #define _CORE_GBIOSLOADER_H #include void gbios_save (u32 start, u32 size); void gbios_load (void); #endif tinyvisor/vmm/core/int_handler.s0000644006644000001440000000606111734615112017272 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ SEG_SEL_PCPU32 = (8 * 8) SEG_SEL_PCPU64 = (16 * 8) gs_inthandling = 0 .include "longmode.h" .text .globl int_handler .if longmode # 64bit .align 8 int_handler: push %gs push $SEG_SEL_PCPU64 pop %gs push $0 push $0 push $0 push $0 push %fs push %rax mov %es,%rax mov %rax,8*5(%rsp) mov %cs,%rax mov %rax,8*4(%rsp) mov %ss,%rax mov %rax,8*3(%rsp) mov %ds,%rax mov %rax,8*2(%rsp) push %rcx push %rdx push %rbx push %rsp push %rbp push %rsi push %rdi push %r8 push %r9 push %r10 push %r11 push %r12 push %r13 push %r14 push %r15 mov %ss,%rax mov %rax,%ds mov %rax,%es mov %rax,%fs mov %rsp,%rdi /* 1st param */ call do_int pop %r15 pop %r14 pop %r13 pop %r12 pop %r11 pop %r10 pop %r9 pop %r8 pop %rdi pop %rsi pop %rbp pop %rsp pop %rbx pop %rdx pop %rcx mov 8*2(%rsp),%rax mov %rax,%ds mov 8*5(%rsp),%rax mov %rax,%es # We can't mov rax to cs or ss. pop %rax pop %fs addq $(8*4),%rsp pop %gs addq $8,%rsp # Pop vector pushed by int0xXXhandler. iretq .else # 32bit .align 8 int_handler: push %gs push $SEG_SEL_PCPU32 pop %gs push %es push %cs push %ss push %ds push %fs pusha sub $32,%esp # Push dummy. mov %ss,%eax mov %eax,%ds mov %eax,%es mov %eax,%fs push %esp # Push 1st param call do_int add $36,%esp # Pop 1st param and dummy. popa pop %fs pop %ds pop %ss pop %es # We can't pop to cs pop %es pop %gs addl $4,%esp # Pop vector pushed by int0xXXhandler. iret .endif tinyvisor/vmm/core/msr_pass.h0000644006644000001440000000347011753454341016626 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2012 Yuichi Watanabe */ #ifndef _CORE_MSR_PASS_H #define _CORE_MSR_PASS_H #include bool msr_read(u32 msrindex, u64 *msrdata); bool msr_write(u32 msrindex, u64 msrdata); u32 msr_pte_to_cache_flag(u64 pte); #endif tinyvisor/vmm/core/vm.c0000644006644000001440000001641012206320117015375 0ustar yuichi_xyusers/* * Copyright (c) 2010-2013 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include #include #include #include #include "apic_pass.h" #include "current.h" #include "gbiosloader.h" #include "int.h" #include "pcpu.h" #include #include "vm.h" static size_t driver_data_size = 0; static int new_vm_called = 0; static LIST2_DEFINE_HEAD_INIT(struct vm, vm_list); static spinlock_t vm_list_lock = SPINLOCK_INITIALIZER; drvdata_hdl_t vm_alloc_driver_data(size_t size) { off_t offset; ASSERT(new_vm_called == 0); ASSERT(cpu_is_bsp()); offset = driver_data_size; driver_data_size += ROUND_UP(size, sizeof(u64)); return offset; } void * vm_get_driver_data(drvdata_hdl_t handle) { ASSERT(handle < driver_data_size); return (void *)((ulong)(current->vm->driver_data) + handle); } unsigned int vm_get_vcpu_count() { struct vm *vm; unsigned int vcpu_count; vm = current->vm; spinlock_lock(&vm->vcpu_list_lock); vcpu_count = vm->vcpu_count; spinlock_unlock(&vm->vcpu_list_lock); return vcpu_count; } char * vm_get_name() { return current->vm->name; } u32 vm_get_id(void) { char name[VM_NAME_BUF_SIZE]; u32 id = 0; int i = 0; vmmerr_t err; while ((err = param_get_str("vm", i++, name, VM_NAME_BUF_SIZE)) != VMMERR_NOTEXIST) { if (err != VMMERR_SUCCESS) { continue; } if (strcmp(name, VM0_NAME) != 0) { id++; } if (strcmp(name, vm_get_name()) == 0) { return id; } } return (u32)-1; } apic_id_t vm_vbsp_apic_id(void) { return current->vm->vbsp_apic_id; } static struct vm * vm_find_by_name(char *name) { struct vm *vm; spinlock_lock(&vm_list_lock); LIST2_FOREACH(vm_list, vm_list, vm) { if (strcmp(vm->name, name) == 0) { break; } } spinlock_unlock(&vm_list_lock); return vm; } static vmmerr_t vm_get_name_from_param(char *buf, size_t size) { char name[VM_NAME_BUF_SIZE]; char param_name[VM_NAME_BUF_SIZE + 4]; u32 apic_id; int i = 0; int j; vmmerr_t err; ASSERT(sizeof(u32) == sizeof(apic_id_t)); if (cpu_is_bsp()) { /* * CPU0 is always VM0. */ snprintf(buf, size, "%s", VM0_NAME); return VMMERR_SUCCESS; } if ((err = param_get_u32("shell", 0, &apic_id)) != VMMERR_NOTEXIST) { if (err != VMMERR_SUCCESS) { printf("Failed to get shell paramater. err 0x%x\n", err); } else { if (apic_id == get_apic_id()) { return VMMERR_NOTEXIST; } } } while ((err = param_get_str("vm", i++, name, VM_NAME_BUF_SIZE)) != VMMERR_NOTEXIST) { if (err != VMMERR_SUCCESS) { printf("Failed to get vm(%d) paramater. err 0x%x\n", i, err); continue; } snprintf(param_name, VM_NAME_BUF_SIZE + 4, "%s.cpu", name); j = 0; while ((err = param_get_u32(param_name, j++, &apic_id)) != VMMERR_NOTEXIST) { if (err != VMMERR_SUCCESS) { printf("Failed to get %s(%d) paramater. " "err 0x%x\n", param_name, j - 1, err); continue; } if (apic_id == get_apic_id()) { snprintf(buf, size, "%s", name); return VMMERR_SUCCESS; } } } /* * CPUs not specified by .cpu or shell parameter are VM0. */ snprintf(buf, size, "%s", VM0_NAME); return VMMERR_SUCCESS; } struct vm * vm_find(void) { char name[VM_NAME_BUF_SIZE]; vmmerr_t err; err = vm_get_name_from_param(name, VM_NAME_BUF_SIZE); if (err != VMMERR_SUCCESS) { return NULL; } return vm_find_by_name(name); } bool vm_current_is_vbsp(void) { char name[VM_NAME_BUF_SIZE]; char param_name[VM_NAME_BUF_SIZE + 4]; u32 apic_id; vmmerr_t err; if (cpu_is_bsp()) { /* * physical CPU0 is always vBSP of VM0. */ return true; } err = vm_get_name_from_param(name, VM_NAME_BUF_SIZE); if (err != VMMERR_SUCCESS) { return false; } snprintf(param_name, VM_NAME_BUF_SIZE + 4, "%s.cpu", name); err = param_get_u32(param_name, 0, &apic_id); if (err != VMMERR_SUCCESS) { if (err != VMMERR_NOTEXIST) { printf("Failed to get %s(0) paramater. " "err 0x%x\n", param_name, err); } return false; } if (apic_id == get_apic_id()) { return true; } else { return false; } } struct vm * vm_new(void) { struct vm *vm; vmmerr_t err; new_vm_called = 1; vm = (struct vm *)alloc(sizeof(struct vm) + driver_data_size); if (vm == NULL) { return NULL; } memset(vm, 0, sizeof(struct vm) + driver_data_size); err = vm_get_name_from_param(vm->name, VM_NAME_BUF_SIZE); if (err != VMMERR_SUCCESS) { free(vm); return NULL; } spinlock_init(&vm->vcpu_list_lock); LIST2_HEAD_INIT(vm->vcpu_list); spinlock_lock(&vm_list_lock); LIST2_ADD(vm_list, vm_list, vm); spinlock_unlock(&vm_list_lock); vm->vbsp_apic_id = get_apic_id(); return vm; } void vm_dump(void) { struct vm *vm; struct vcpu *vcpu; int index = 0; phys_t gphys; phys_t len; u32 type; static spinlock_t vm_dump_lock = SPINLOCK_INITIALIZER; spinlock_lock(&vm_dump_lock); vm = current->vm; printf("%s:", vm->name); vcpu = NULL; while ((vcpu = vcpu_next(vm, vcpu)) != NULL) { printf(" 0x%x", vcpu->apic_id); } printf("\n"); while (vm->gmm.get_mem_map(index++, &gphys, &len, &type)) { printf(" %016llx-%016llx 0x%x\n", gphys, gphys + len - 1, type); } pci_dump_assignment(); spinlock_unlock(&vm_dump_lock); return; } void vm_iommu_enabled(void) { current->vm->iommu_enabled = true; } vmmerr_t vm_reset(void) { if (current->vm->gmm.clear_mem == NULL || !current->vbsp) { return VMMERR_NOSUP; } printf("Reset %s\n", vm_get_name()); /* * Initialize other cpus. */ apic_send_init_others(); usleep(100*1000); /* * Reset vcpu and load guest BIOS. */ printf("Reset cpu 0x%x\n", get_cpu_id()); vcpu_reset(); vcpu_reset_apic(); current->vm->gmm.clear_mem(); gbios_load(); call_initfunc("resetvm"); return VMMERR_SUCCESS; } tinyvisor/vmm/core/acpi_dsdt.h0000644006644000001440000000326611733245403016727 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_ACPI_DSDT_H #define _CORE_ACPI_DSDT_H #include void acpi_dsdt_parse (ulong dsdt); #endif tinyvisor/vmm/core/callrealmode.h0000644006644000001440000000444611733245403017422 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_CALLREALMODE_H #define _CORE_CALLREALMODE_H #include #include #define GETSHIFTFLAGS_RSHIFT_BIT 0x1 #define GETSHIFTFLAGS_LSHIFT_BIT 0x2 #define GETSHIFTFLAGS_CTRL_BIT 0x4 #define GETSHIFTFLAGS_ALT_BIT 0x8 #define GETSHIFTFLAGS_SCROLLLOCK_BIT 0x10 #define GETSHIFTFLAGS_NUMLOCK_BIT 0x20 #define GETSHIFTFLAGS_CAPSLOCK_BIT 0x40 #define GETSHIFTFLAGS_INSERT_BIT 0x80 #define VIDEOMODE_80x25TEXT_16COLORS 0x03 struct e820map { u64 base; u64 len; u32 type; }; void callrealmode_printmsg (u32 message); int callrealmode_getsysmemmap (u32 ebx, struct e820map *m, u32 *ebx_ret); int callrealmode_getshiftflags (void); void callrealmode_setvideomode (int mode); void callrealmode_reboot (void); #endif tinyvisor/vmm/core/svm_regs.h0000644006644000001440000000506011733245403016614 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_SVM_REGS_H #define _CORE_SVM_REGS_H #include "asm.h" #include "cpu_seg.h" #include "regs.h" void svm_read_general_reg (enum general_reg reg, ulong *val); void svm_write_general_reg (enum general_reg reg, ulong val); void svm_read_control_reg (enum control_reg reg, ulong *val); void svm_write_control_reg (enum control_reg reg, ulong val); void svm_read_sreg_sel (enum sreg s, u16 *val); void svm_read_sreg_acr (enum sreg s, ulong *val); void svm_read_sreg_base (enum sreg s, ulong *val); void svm_read_sreg_limit (enum sreg s, ulong *val); void svm_spt_setcr3 (ulong cr3); void svm_read_ip (ulong *val); void svm_write_ip (ulong val); void svm_read_flags (ulong *val); void svm_write_flags (ulong val); void svm_read_gdtr (ulong *base, ulong *limit); void svm_write_gdtr (ulong base, ulong limit); void svm_read_idtr (ulong *base, ulong *limit); void svm_write_idtr (ulong base, ulong limit); void svm_write_realmode_seg (enum sreg s, u16 val); vmmerr_t svm_writing_sreg (enum sreg s); #endif tinyvisor/vmm/core/vmmcall_dbgsh.c0000644006644000001440000000754611733245403017577 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include "constants.h" #include "current.h" #include "panic.h" #include "process.h" #include "thread.h" #include "vmmcall.h" static volatile int send, receive; static spinlock_t dbgsh_lock = SPINLOCK_INITIALIZER; static spinlock_t dbgsh_lock2 = SPINLOCK_INITIALIZER; static bool stopped; static tid_t tid; static bool initialized; static int dbgsh_ttyin_msghandler (int m, int c) { int tmp; if (m == 0) { retry: send = 0; while (receive == -1 || send != -1) { spinlock_lock (&dbgsh_lock2); stopped = true; thread_will_stop (); spinlock_unlock (&dbgsh_lock2); schedule (); } tmp = receive; receive = -1; if (tmp == 0) goto retry; return tmp; } return 0; } static int dbgsh_ttyout_msghandler (int m, int c) { if (m == 0) { if (c == 0) c = ' '; send = c; while (receive == -1 || send != -1) { spinlock_lock (&dbgsh_lock2); stopped = true; thread_will_stop (); spinlock_unlock (&dbgsh_lock2); schedule (); } receive = -1; } return 0; } static void dbgsh_thread (void *arg) { int shell, ttyin, ttyout; msgregister ("dbgsh_ttyin", dbgsh_ttyin_msghandler); msgregister ("dbgsh_ttyout", dbgsh_ttyout_msghandler); ttyin = msgopen ("dbgsh_ttyin"); ttyout = msgopen ("dbgsh_ttyout"); for (;;) { shell = newprocess ("shell"); if (ttyin < 0 || ttyout < 0 || shell < 0) panic ("dbgsh_thread"); msgsenddesc (shell, ttyin); msgsenddesc (shell, ttyout); msgsendint (shell, 0); msgclose (shell); schedule (); } } static void dbgsh (void) { ulong rbx; int input; spinlock_lock (&dbgsh_lock); if (!initialized) { tid = thread_new (dbgsh_thread, NULL, PAGESIZE); initialized = true; } spinlock_unlock (&dbgsh_lock); current->vmctl.read_general_reg (GENERAL_REG_RBX, &rbx); input = (int)rbx; if (input != -1) { receive = input; send = -1; spinlock_lock (&dbgsh_lock2); if (stopped) thread_wakeup (tid); spinlock_unlock (&dbgsh_lock2); } current->vmctl.write_general_reg (GENERAL_REG_RAX, (ulong)send); } static void vmmcall_dbgsh_init (void) { send = receive = -1; initialized = false; stopped = false; vmmcall_register ("dbgsh", dbgsh); } INITFUNC ("vmmcal0", vmmcall_dbgsh_init); tinyvisor/vmm/core/reboot.c0000644006644000001440000000471412167264643016272 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include "asm.h" #include "current.h" #include "callrealmode.h" #include "panic.h" #include "reboot.h" #include #include "smp.h" static void do_reboot (void) { int i; u8 data; printf ("Rebooting...\n"); for (i = 0; i < 0x10000; i++) { asm_inb(0x64, &data); if (!(data & 0x02)) { break; } usleep(2); } usleep(50); asm_outb(0x64, 0xfe); freeze(); } static int reboot_msghandler (int m, int c) { if (m == 0) { /* * To reboot machine, we seem to need to * execute vmxoff. */ if (current && current->vmctl.vmexit) { current->vmctl.vmexit(); } do_reboot (); } return 0; } static void reboot_init_msg (void) { msgregister ("reboot", reboot_msghandler); } void reboot (void) { do_reboot (); } INITFUNC ("msg0", reboot_init_msg); tinyvisor/vmm/core/acpi.c0000644006644000001440000002713012167264643015711 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include "acpi.h" #include "asm.h" #include "acpi_dsdt.h" #include "beep.h" #include "constants.h" #include "io_io.h" #include "mm.h" #include "panic.h" #include #define FIND_RSDP_NOT_FOUND 0xFFFFFFFFFFFFFFFFULL #define RSDP_SIGNATURE "RSD PTR" #define RSDP_SIGNATURE_LEN 7 #define ADDRESS_SPACE_ID_MEM 0 #define ADDRESS_SPACE_ID_IO 1 #define SIGNATURE_LEN 4 #define RSDT_SIGNATURE "RSDT" #define FACP_SIGNATURE "FACP" #define FACS_SIGNATURE "FACS" #define PM1_CNT_SLP_TYPX_MASK 0x1C00 #define PM1_CNT_SLP_TYPX_SHIFT 10 #define PM1_CNT_SLP_EN_BIT 0x2000 #define IS_STRUCT_SIZE_OK(l, h, m) \ ((l) >= ((u8 *)&(m) - (u8 *)(h)) + sizeof (m)) #define PARSERS_MAX_NUM 8 struct acpi_parser { char signature[SIGNATURE_LEN]; acpi_parser_t *func; }; struct rsdp { u8 signature[8]; u8 checksum; u8 oemid[6]; u8 revision; u32 rsdt_address; } __attribute__ ((packed)); struct rsdt { struct acpi_desc_header header; u32 entry[]; } __attribute__ ((packed)); struct gas { u8 address_space_id; u8 register_bit_width; u8 register_bit_offset; u8 access_size; u64 address; } __attribute__ ((packed)); struct facp { struct acpi_desc_header header; u32 firmware_ctrl; u32 dsdt; u8 reserved1; u8 preferred_pm_profile; u16 sci_int; u32 sci_cmd; u8 acpi_enable; u8 acpi_disable; u8 s4bios_req; u8 pstate_cnt; u32 pm1a_evt_blk; u32 pm1b_evt_blk; u32 pm1a_cnt_blk; u32 pm1b_cnt_blk; u32 pm2_cnt_blk; u32 pm_tmr_blk; u32 gpe0_blk; u32 gpe1_blk; u8 pm1_evt_len; u8 pm1_cnt_len; u8 pm2_cnt_len; u8 pm_tmr_len; u8 gpe0_blk_len; u8 gpe1_blk_len; u8 gpe1_base; u8 cst_cnt; u16 p_lvl2_lat; u16 p_lvl3_lat; u16 flush_size; u16 flush_stride; u8 duty_offset; u8 duty_width; u8 day_alrm; u8 mon_alrm; u8 century; u16 iapc_boot_arch; u8 reserved2; u32 flags; u8 reset_reg[12]; u8 reset_value; u8 reserved3[3]; u64 x_firmware_ctrl; u64 x_dsdt; struct gas x_pm1a_evt_blk; struct gas x_pm1b_evt_blk; struct gas x_pm1a_cnt_blk; struct gas x_pm1b_cnt_blk; struct gas x_pm2_cnt_blk; struct gas x_pm_tmr_blk; struct gas x_gpe0_blk; struct gas x_gpe1_blk; } __attribute__ ((packed)); struct facs { u8 signature[4]; u32 length; u8 hardware_signature[4]; u32 firmware_waking_vector; u32 global_lock; u32 flags; u64 x_firmware_waking_vector; u8 version; u8 reserved[31]; } __attribute__ ((packed)); static bool rsdp_found; static struct rsdp rsdp_copy; static struct acpi_parser parsers[PARSERS_MAX_NUM]; static uint parsers_num = 0; static bool pm1a_cnt_found; static ioport_t pm1a_cnt_ioaddr; static u64 facs_addr; unsigned char acpi_dsdt_system_state[6][5]; static u8 acpi_checksum (void *p, int len) { u8 *q, s; s = 0; for (q = p; len > 0; len--) s += *q++; return s; } static void * acpi_mapmem (u64 addr, int len) { static void *oldmap; static int oldlen = 0; if (oldlen) unmapmem (oldmap, oldlen); oldlen = len; oldmap = mapmem (MAPMEM_HPHYS | MAPMEM_WRITE, addr, len); if (oldmap == NULL) { panic("Failed to map address 0x%llx", addr); } return oldmap; } void acpi_register_parser(char *signature, acpi_parser_t *func) { struct rsdt *rsdt; struct acpi_desc_header *header; struct acpi_parser *parser; int i, n, len; u32 entry; if (parsers_num >= PARSERS_MAX_NUM) { panic("Too many acpi parser"); } parser = parsers + parsers_num; memcpy(parser->signature, signature, SIGNATURE_LEN); parser->func = func; parsers_num++; if (!rsdp_found) return; rsdt = acpi_mapmem(rsdp_copy.rsdt_address, sizeof *rsdt); if (memcmp(rsdt->header.signature, RSDT_SIGNATURE, SIGNATURE_LEN)) return; len = rsdt->header.length; rsdt = acpi_mapmem(rsdp_copy.rsdt_address, len); if (acpi_checksum(rsdt, len)) return; n = (rsdt->header.length - sizeof rsdt->header) / sizeof entry; for (i = 0; i < n; i++) { rsdt = acpi_mapmem (rsdp_copy.rsdt_address, len); entry = rsdt->entry[i]; header = acpi_mapmem (entry, sizeof *header); if (memcmp(header->signature, parser->signature, SIGNATURE_LEN)) continue; header = acpi_mapmem(entry, header->length); if (acpi_checksum (header, header->length)) continue; parser->func(header, header->length); } } static u64 get_ebda_address (void) { u16 *p; p = acpi_mapmem (0x40E, sizeof *p); return ((u64)*p) << 4; } static u64 find_rsdp_iapc_sub (u64 start, u64 end) { struct rsdp *p; u64 i; for (i = start; i < end; i += 16) { p = acpi_mapmem (i, sizeof *p); if (!memcmp (p->signature, RSDP_SIGNATURE, RSDP_SIGNATURE_LEN) && !acpi_checksum (p, sizeof *p)) return i; } return FIND_RSDP_NOT_FOUND; } static u64 find_rsdp_iapc (void) { u64 ebda; u64 rsdp; ebda = get_ebda_address (); rsdp = find_rsdp_iapc_sub (ebda, ebda + 0x3FF); if (rsdp == FIND_RSDP_NOT_FOUND) rsdp = find_rsdp_iapc_sub (0xE0000, 0xFFFFF); return rsdp; } static u64 find_rsdp (void) { return find_rsdp_iapc (); } static void parse_tables(void) { struct rsdt *rsdt; struct acpi_desc_header *header; struct acpi_parser *parser; int i, j, n, len; u32 entry; if (!rsdp_found) return; rsdt = acpi_mapmem(rsdp_copy.rsdt_address, sizeof *rsdt); if (memcmp(rsdt->header.signature, RSDT_SIGNATURE, SIGNATURE_LEN)) return; len = rsdt->header.length; rsdt = acpi_mapmem(rsdp_copy.rsdt_address, len); if (acpi_checksum(rsdt, len)) return; n = (rsdt->header.length - sizeof rsdt->header) / sizeof entry; for (i = 0; i < n; i++) { rsdt = acpi_mapmem (rsdp_copy.rsdt_address, len); entry = rsdt->entry[i]; header = acpi_mapmem (entry, sizeof *header); if (acpi_checksum (header, header->length)) continue; for (j = 0; j < parsers_num; j++) { parser = parsers + j; if (memcmp(header->signature, parser->signature, SIGNATURE_LEN)) continue; header = acpi_mapmem(entry, header->length); parser->func(header, header->length); } } } static void debug_dump (void *p, int len) { u8 *q; int i, j; q = p; for (i = 0; i < len; i += 16) { printf ("%08X ", i); for (j = 0; j < 16; j++) printf ("%02X%c", q[i + j], j == 7 ? '-' : ' '); for (j = 0; j < 16; j++) printf ("%c", q[i + j] >= 0x20 && q[i + j] <= 0x7E ? q[i + j] : '.'); printf ("\n"); } } static void acpi_poweroff (void) { u32 data, typx; if (!pm1a_cnt_found) return; if (!acpi_dsdt_system_state[5][0]) return; typx = acpi_dsdt_system_state[5][1] << PM1_CNT_SLP_TYPX_SHIFT; /* FIXME: how to handle pm1b_cnt? */ asm_inl (pm1a_cnt_ioaddr, &data); data &= ~PM1_CNT_SLP_TYPX_MASK; data |= typx & PM1_CNT_SLP_TYPX_MASK; data |= PM1_CNT_SLP_EN_BIT; asm_outl (pm1a_cnt_ioaddr, data); } static void acpi_pm1_sleep (u32 v) { struct facs *facs; #ifdef ACPI_DSDT bool m[6]; int i; u8 n; #endif #ifdef ACPI_DSDT n = (v & PM1_CNT_SLP_TYPX_MASK) >> PM1_CNT_SLP_TYPX_SHIFT; for (i = 0; i <= 5; i++) { if (acpi_dsdt_system_state[i][0] && acpi_dsdt_system_state[i][1] == n) m[i] = true; else m[i] = false; } if (!m[2] && !m[3]) return; #endif facs = acpi_mapmem (facs_addr, sizeof *facs); if (IS_STRUCT_SIZE_OK (facs->length, facs, facs->x_firmware_waking_vector)) facs->x_firmware_waking_vector = 0; if (IS_STRUCT_SIZE_OK (facs->length, facs, facs->firmware_waking_vector)) facs->firmware_waking_vector = 0xFFFF0; else for (;;); /* FIXME: ERROR */ /* DEBUG */ /* the computer is going to sleep */ /* most devices are suspended */ /* vmm can't write anything to a screen here */ /* vmm can't input from/output to a keyboard here */ /* vmm can beep! */ beep_on (); beep_set_freq (880); usleep (500000); beep_set_freq (440); usleep (500000); beep_set_freq (880); usleep (500000); beep_set_freq (440); usleep (500000); beep_set_freq (880); usleep (500000); beep_set_freq (440); usleep (500000); beep_set_freq (880); acpi_poweroff (); } static int acpi_io_monitor (iotype_t type, ioport_t port, void *data) { u32 v; if (pm1a_cnt_found && port == pm1a_cnt_ioaddr) { switch (type) { case IOTYPE_OUTB: v = *(u8 *)data; break; case IOTYPE_OUTW: v = *(u16 *)data; break; case IOTYPE_OUTL: v = *(u32 *)data; break; default: goto def; } if (v & PM1_CNT_SLP_EN_BIT) acpi_pm1_sleep (v); } def: return 0; /* pass */ } static void acpi_iohook (void) { if (pm1a_cnt_found) set_iofunc (pm1a_cnt_ioaddr, acpi_io_monitor); } static void get_pm1a_cnt_ioaddr (struct facp *q) { if (IS_STRUCT_SIZE_OK (q->header.length, q, q->x_pm1a_cnt_blk)) { if (q->x_pm1a_cnt_blk.address_space_id != ADDRESS_SPACE_ID_IO) panic ("X_PM1a_CNT_BLK is not I/O address"); if (q->x_pm1a_cnt_blk.address > 0xFFFF) { panic ("X_PM1a_CNT_BLK > 0xFFFF"); } pm1a_cnt_ioaddr = q->x_pm1a_cnt_blk.address; } else if (IS_STRUCT_SIZE_OK (q->header.length, q, q->pm1a_cnt_blk)) { if (q->pm1a_cnt_blk > 0xFFFF) { panic ("pm1a_cnt_blk > 0xFFFF"); } pm1a_cnt_ioaddr = q->pm1a_cnt_blk; } else { panic ("ACPI FACP is too short"); } } static void get_facs_addr (struct facp *facp) { if (IS_STRUCT_SIZE_OK (facp->header.length, facp, facp->x_firmware_ctrl)) facs_addr = facp->x_firmware_ctrl; else if (IS_STRUCT_SIZE_OK (facp->header.length, facp, facp->firmware_ctrl)) facs_addr = facp->firmware_ctrl; else panic ("ACPI FACP is too short"); } static acpi_parser_t parse_facp; static void parse_facp(void *table, u32 length) { struct facp *facp = (struct facp *)table; #ifdef ACPI_DSDT acpi_dsdt_parse(facp->dsdt); #endif get_pm1a_cnt_ioaddr(facp); get_facs_addr(facp); if (0) debug_dump(facp, facp->header.length); if (0) printf("PM1a control port is 0x%X\n", pm1a_cnt_ioaddr); pm1a_cnt_found = true; } static void acpi_init_global (void) { u64 rsdp; struct rsdp *p; rsdp_found = false; pm1a_cnt_found = false; acpi_register_parser(FACP_SIGNATURE, parse_facp); rsdp = find_rsdp (); if (rsdp == FIND_RSDP_NOT_FOUND) { printf ("ACPI RSDP not found.\n"); return; } p = acpi_mapmem (rsdp, sizeof *p); memcpy (&rsdp_copy, p, sizeof *p); rsdp_found = true; parse_tables(); } INITFUNC ("global3", acpi_init_global); INITFUNC ("passvm1", acpi_iohook); tinyvisor/vmm/core/svm_panic.h0000644006644000001440000000322611733227577016764 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_SVM_PANIC_H #define _CORE_SVM_PANIC_H void svm_panic_dump (void); #endif tinyvisor/vmm/core/io_io.c0000644006644000001440000001364611733245403016071 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include "asm.h" #include "constants.h" #include "cpu_interpreter.h" #include "cpu_mmu.h" #include "current.h" #include "io_io.h" #include "panic.h" /* #define IOIO_DEBUG */ #ifdef IOIO_DEBUG #include #define IOIO_DBG(...) \ do { \ printf(__VA_ARGS__); \ } while (0) #else #define IOIO_DBG(...) #endif struct call_iopass_data { ioport_t port; bool pass; }; int do_io_nothing (iotype_t type, ioport_t port, void *data) { switch (type) { case IOTYPE_INB: *(u8 *)data = 0xFF; break; case IOTYPE_INW: *(u16 *)data = 0xFFFF; break; case IOTYPE_INL: *(u32 *)data = 0xFFFFFFFF; break; case IOTYPE_OUTB: case IOTYPE_OUTW: case IOTYPE_OUTL: break; default: panic ("do_io_nothing: Bad type"); } return 1; /* no pass */ } int do_io_pass (iotype_t type, ioport_t port, void *data) { switch (type) { case IOTYPE_INB: asm_inb (port, (u8 *)data); #ifdef IOIO_DEBUG if (port > 0x1000) { IOIO_DBG("ioio: inb port 0x%x data 0x%x\n", port, *(u8 *)data); } #endif break; case IOTYPE_INW: asm_inw (port, (u16 *)data); #ifdef IOIO_DEBUG if (port > 0x1000) { IOIO_DBG("ioio: inw port 0x%x data 0x%x\n", port, *(u16 *)data); } #endif break; case IOTYPE_INL: asm_inl (port, (u32 *)data); #ifdef IOIO_DEBUG if (port > 0x1000) { IOIO_DBG("ioio: inl port 0x%x data 0x%x\n", port, *(u32 *)data); } #endif break; case IOTYPE_OUTB: #ifdef IOIO_DEBUG if (port > 0x1000) { IOIO_DBG("ioio: outb port 0x%x data 0x%x\n", port, *(u8 *)data); } #endif asm_outb (port, *(u8 *)data); break; case IOTYPE_OUTW: #ifdef IOIO_DEBUG if (port > 0x1000) { IOIO_DBG("ioio: outw port 0x%x data 0x%x\n", port, *(u16 *)data); } #endif asm_outw (port, *(u16 *)data); break; case IOTYPE_OUTL: #ifdef IOIO_DEBUG if (port > 0x1000) { IOIO_DBG("ioio: outl port 0x%x data 0x%x\n", port, *(u32 *)data); } #endif asm_outl (port, *(u32 *)data); break; default: panic ("do_iopass_default: Bad type"); } return 1; /* no pass */ } static bool call_iopass (struct vcpu *p, void *q) { struct call_iopass_data *d; d = q; p->vmctl.extern_iopass (p, d->port, d->pass); return false; } iofunc_t set_iofunc (ioport_t port, iofunc_t func) { iofunc_t old, *p; struct call_iopass_data d; p = ¤t->vm->io.iofunc[port & 0xFFFF]; /* old = *p; *p = func; */ old = (iofunc_t)asm_lock_swap_ulong ((ulong *)p, (ulong)func); d.port = port; if (func == do_io_pass) d.pass = true; else d.pass = false; vcpu_list_foreach (current->vm, call_iopass, &d); return old; } void iotype_to_size_wr(iotype_t type, ioport_t *size, bool *wr) { switch (type) { case IOTYPE_INB: *wr = false; *size = 1; break; case IOTYPE_INW: *wr = false; *size = 2; break; case IOTYPE_INL: *wr = false; *size = 4; break; case IOTYPE_OUTB: *wr = true; *size = 1; break; case IOTYPE_OUTW: *wr = true; *size = 2; break; case IOTYPE_OUTL: *wr = true; *size = 4; break; default: panic("iotype_to_size_wr: Invalid type. type %d", type); } } void call_io (iotype_t type, ioport_t port, void *data) { int no_pass; iofunc_t func; iotype_t smalltype; /* * Divide a unaligned access to two, three aligned accesses. */ if (type == IOTYPE_INW || type == IOTYPE_OUTW) { if (port & 0x1) { smalltype = IOTYPE_INW ? IOTYPE_INB : IOTYPE_OUTB; call_io(smalltype, port, data); call_io(smalltype, port + 1, (void *)((ulong)data + 1)); return; } } else if (type == IOTYPE_INL || type == IOTYPE_OUTL) { switch (port & 0x3) { case 0: break; case 1: case 3: smalltype = IOTYPE_INL ? IOTYPE_INB : IOTYPE_OUTB; call_io(smalltype, port, data); smalltype = IOTYPE_INL ? IOTYPE_INW : IOTYPE_OUTW; call_io(smalltype, port + 1, (void *)((ulong)data + 1)); smalltype = IOTYPE_INL ? IOTYPE_INB : IOTYPE_OUTB; call_io(smalltype, port + 3, (void *)((ulong)data + 3)); return; case 2: smalltype = IOTYPE_INL ? IOTYPE_INW : IOTYPE_OUTW; call_io(smalltype, port, data); call_io(smalltype, port + 2, (void *)((ulong)data + 2)); return; } } /* * Return all F on reading by default. */ do_io_nothing(type, port, data); func = current->vm->io.iofunc[port & 0xFFFF]; if (func == NULL) { return; } no_pass = func(type, port & 0xFFFF, data); if (!no_pass) { do_io_pass(type, port & 0xFFFF, data); } } tinyvisor/vmm/core/mm_alloc.c0000644006644000001440000001653511733245403016556 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include "mm.h" #include "panic.h" #include #define NUM_OF_ALLOCSIZE 13 #define NUM_OF_ALLOCLIST 7 #define ALLOCLIST_SIZE(n) ((1 << (n)) * 16) #define ALLOCLIST_DATABIT(n) (PAGESIZE / ALLOCLIST_SIZE (n)) #define ALLOCLIST_DATASIZE(n) ((ALLOCLIST_DATABIT (n) + 7) / 8) #define ALLOCLIST_HEADERSIZE(n) (sizeof (struct allocdata) + \ ALLOCLIST_DATASIZE(n) - 1) struct allocdata { LIST1_DEFINE (struct allocdata); u8 n, data[1]; }; static LIST1_DEFINE_HEAD (struct page, freepage_list[NUM_OF_ALLOCSIZE]); static LIST1_DEFINE_HEAD (struct allocdata, alloclist[NUM_OF_ALLOCLIST]); static int allocsize[NUM_OF_ALLOCSIZE]; static spinlock_t mm_lock, mm_lock2; /* * * Page Allocator * */ struct page * mm_page_alloc_internal(int n) { int s; virt_t virt; struct page *p, *q; if (n >= NUM_OF_ALLOCSIZE) { return NULL; } s = allocsize[n]; while ((p = LIST1_POP (freepage_list[n])) == NULL) { p = mm_page_alloc_internal (n + 1); if (p == NULL) { return NULL; } virt = page_to_virt (p); q = virt_to_page (virt ^ s); p->allocsize = n; p->type = PAGE_TYPE_FREE; q->type = PAGE_TYPE_FREE; LIST1_ADD (freepage_list[n], p); LIST1_ADD (freepage_list[n], q); } p->type = PAGE_TYPE_ALLOCATED; return p; } struct page * mm_page_alloc(int n) { struct page *page; spinlock_lock (&mm_lock); page = mm_page_alloc_internal(n); spinlock_unlock (&mm_lock); return page; } void mm_page_free (struct page *p) { int s, n; struct page *q, *tmp; virt_t virt; spinlock_lock (&mm_lock); n = p->allocsize; p->type = PAGE_TYPE_FREE; LIST1_ADD (freepage_list[n], p); s = allocsize[n]; virt = page_to_virt (p); while (n < (NUM_OF_ALLOCSIZE - 1) && (q = virt_to_page (virt ^ s))->type == PAGE_TYPE_FREE && q->allocsize == n) { if (virt & s) { tmp = p; p = q; q = tmp; } LIST1_DEL (freepage_list[n], p); LIST1_DEL (freepage_list[n], q); q->type = PAGE_TYPE_NOT_HEAD; n = ++p->allocsize; LIST1_ADD (freepage_list[n], p); s = allocsize[n]; virt = page_to_virt (p); } spinlock_unlock (&mm_lock); } /* returns number of available pages */ int num_of_available_pages (void) { int i, r, n; struct page *p; spinlock_lock (&mm_lock); r = 0; for (i = 0; i < NUM_OF_ALLOCSIZE; i++) { n = 0; LIST1_FOREACH (freepage_list[i], p) n++; r += n * (allocsize[i] >> PAGESIZE_SHIFT); } spinlock_unlock (&mm_lock); return r; } /* allocate n or more pages */ vmmerr_t alloc_pages (void **virt, phys_t *phys, int n) { struct page *p; int i, s; s = n * PAGESIZE; for (i = 0; i < NUM_OF_ALLOCSIZE; i++) if (allocsize[i] >= s) goto found; /* panic ("alloc_pages (%d) failed.", n); */ return VMMERR_NOMEM; found: p = mm_page_alloc (i); if (p == NULL) { return VMMERR_NOMEM; } if (virt) *virt = (void *)page_to_virt (p); if (phys) *phys = page_to_phys (p); return 0; } /* allocate a page */ vmmerr_t alloc_page (void **virt, u64 *phys) { return alloc_pages (virt, phys, 1); } /* free pages */ void free_page (void *virt) { mm_page_free (virt_to_page ((virt_t)virt)); } /* free pages addressed by physical address */ void free_page_phys (phys_t phys) { mm_page_free (phys_to_page (phys)); } /* * * Memory Allocator * */ static struct allocdata * alloclist_new (int n) { struct allocdata *r; uint i, headlen; void *tmp; vmmerr_t err; err = alloc_page (&tmp, NULL); if (err) { return NULL; } r = tmp; headlen = ALLOCLIST_HEADERSIZE (n); memset (r, 0, headlen); r->n = n; for (i = 0; i * ALLOCLIST_SIZE (n) < headlen; i++) r->data[i / 8] |= 1 << (i % 8); return r; } static bool alloclist_alloc (struct allocdata *p, int n, void **r) { uint i, j, datalen, offset; datalen = ALLOCLIST_DATASIZE (n); for (i = 0; i < datalen; i++) { if (p->data[i] != 0xFF) goto found; } return false; found: for (j = 0; j < 8; j++) { if ((p->data[i] & (1 << j)) == 0) break; } if (i * 8 + j >= ALLOCLIST_DATABIT (n)) return false; p->data[i] |= (1 << j); offset = (i * 8 + j) * ALLOCLIST_SIZE (n); ASSERT (offset != 0); ASSERT (offset < PAGESIZE); *r = (u8 *)p + offset; return true; } static void alloclist_free (struct allocdata *p, int n, uint offset) { uint bit, i, j; bit = offset / ALLOCLIST_SIZE (n); i = bit / 8; j = bit % 8; ASSERT (p->data[i] & (1 << j)); /* double free check */ p->data[i] &= ~(1 << j); } /* allocate n bytes */ /* FIXME: bad implementation */ void * alloc (size_t len) { void *r; int i; struct allocdata *p; vmmerr_t err; for (i = 0; i < NUM_OF_ALLOCLIST; i++) { if (len <= ALLOCLIST_SIZE (i)) goto found; } /* allocate pages if len is larger than 1024 */ err = alloc_pages (&r, NULL, (len + 4095) / 4096); if (err) { return NULL; } return r; found: spinlock_lock (&mm_lock2); for (;;) { p = LIST1_POP (alloclist[i]); if (p == NULL) p = alloclist_new (i); if (p == NULL) { spinlock_unlock (&mm_lock2); return NULL; } if (alloclist_alloc (p, i, &r)) break; p->n |= 0x80; } LIST1_PUSH (alloclist[i], p); spinlock_unlock (&mm_lock2); return r; } /* free */ void free (void *virt) { struct allocdata *p; uint offset; offset = (virt_t)virt & PAGESIZE_MASK; if (offset == 0) { mm_page_free (virt_to_page ((virt_t)virt)); return; } spinlock_lock (&mm_lock2); p = (struct allocdata *)((virt_t)virt & ~PAGESIZE_MASK); if (p->n & 0x80) { p->n &= ~0x80; LIST1_PUSH (alloclist[p->n], p); } alloclist_free (p, p->n, offset); spinlock_unlock (&mm_lock2); } void mm_alloc_init (void) { int i; spinlock_init (&mm_lock); spinlock_init (&mm_lock2); for (i = 0; i < NUM_OF_ALLOCLIST; i++) LIST1_HEAD_INIT (alloclist[i]); for (i = 0; i < NUM_OF_ALLOCSIZE; i++) { allocsize[i] = 4096 << i; LIST1_HEAD_INIT (freepage_list[i]); } } tinyvisor/vmm/core/apic.h0000644006644000001440000000462012072152324015700 0ustar yuichi_xyusers/* * Copyright (c) 2011 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_APIC_H #define _CORE_APIC_H #include #include #include #include "pcpu.h" #define apic_g2v(gphys) \ (void *)((char *)apic_virt_base + ((gphys) - APIC_BASE_ADDRESS)) extern void *apic_virt_base; static inline void apic_write32(phys_t offset, u32 val) { write32(apic_virt_base + offset, val); } static inline u32 apic_read32(phys_t offset) { return read32(apic_virt_base + offset); } void apic_send_init(apic_id_t dest); void apic_wait_for_idle(void); apic_id_t apic_read_id(void); void apic_start_ap(phys_t apinit_addr); void apic_broadcast_nmi(void); bool apic_check_apic_interrupt(vector_t vector); void apic_write_eoi(void); u32 apic_read_icrh(void); void apic_send_ipi(vector_t vector, apic_id_t dest); void apic_enable(void); void apic_disable(void); #endif tinyvisor/vmm/core/svm_np.c0000644006644000001440000000720612165305216016267 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include "constants.h" #include "current.h" #include "mm.h" #include "panic.h" #include "svm_np.h" #define NUM_OF_NPTBL 128 struct svm_np { int cnt; void *ncr3tbl; phys_t ncr3tbl_phys; void *tbl[NUM_OF_NPTBL]; phys_t tbl_phys[NUM_OF_NPTBL]; }; void svm_np_init (void) { struct svm_np *np; int i; vmmerr_t err; np = alloc (sizeof (*np)); if (np == NULL) { panic("Failed to allocate memory for struct np."); } err = alloc_page (&np->ncr3tbl, &np->ncr3tbl_phys); if (err) { panic("Failed to allocate a nested page table."); } memset (np->ncr3tbl, 0, PAGESIZE); for (i = 0; i < NUM_OF_NPTBL; i++) { err = alloc_page (&np->tbl[i], &np->tbl_phys[i]); if (err) { panic("Failed to allocate a nested page table."); } } np->cnt = 0; current->u.svm.np = np; current->u.svm.vi.vmcb->n_cr3 = np->ncr3tbl_phys; } void svm_np_pagefault (ulong err, ulong gphys) { int l; pmap_t p; phys_t hphys; struct svm_np *np; struct vmcb *vmcb; np = current->u.svm.np; vmcb = current->u.svm.vi.vmcb; pmap_open_vmm (&p, np->ncr3tbl_phys, PMAP_LEVELS); pmap_setvirt (&p, gphys, 1); (void)pmap_read (&p); for (; (l = pmap_getreadlevel (&p)) > 1; pmap_read (&p)) { pmap_setlevel (&p, l); if (np->cnt == NUM_OF_NPTBL) { printf ("!"); pmap_setlevel (&p, PMAP_LEVELS); pmap_clear (&p); np->cnt = 0; vmcb->tlb_control = VMCB_TLB_CONTROL_FLUSH_TLB; continue; } pmap_write (&p, np->tbl_phys[np->cnt++] | PDE_P_BIT, PDE_P_BIT); pmap_setlevel (&p, l - 1); pmap_clear (&p); pmap_setlevel (&p, 1); } hphys = current->vm->gmm.gp2hp(gphys); if (hphys == GMM_NO_MAPPING) { /* * TODO: * Emulate accessing the address where memory does not exists. * Return All F on reading. Ignore on writing. */ panic("Guest software accessed no-mapping gphys address"); } hphys &= ~PAGESIZE_MASK; pmap_write(&p, hphys | PTE_P_BIT | PTE_RW_BIT, PTE_P_BIT | PTE_RW_BIT); pmap_close (&p); } bool svm_np_tlbflush (void) { return false; } void svm_np_updatecr3 (void) { } tinyvisor/vmm/core/apic_pass.c0000644006644000001440000002702012140554234016722 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #include #include #include #include #include #include #include #include #include "apic.h" #include "apic_regs.h" #include "asm.h" #include "cpu.h" #include "current.h" #include "extint.h" #include "panic.h" #include "vcpu.h" /* #define MWAIT_DEBUG */ #ifdef MWAIT_DEBUG #include #include #endif /* #define APIC_DEBUG */ #include #ifdef APIC_DEBUG #define APIC_DBG(...) \ do { \ printf("APIC: " __VA_ARGS__); \ } while (0) #else #define APIC_DBG(...) #endif #define FAKE_SIPI_VECTOR 0x31 void apic_read_cr8 (u64 *val) { #ifdef __x86_64__ asm_rdcr8 (val); #else panic ("apic_read_cr8 called on x86_32"); #endif } void apic_write_cr8 (u64 val) { #ifdef __x86_64__ asm_wrcr8 (val); #else panic ("apic_write_cr8 called on x86_32"); #endif } void apic_base_changed (ulong apic_base) { if (apic_base != APIC_BASE_ADDRESS) { panic ("apic_base_changed to %08lx", apic_base); } } void apic_enter_wait_for_sipi_state(void) { spinlock_lock(¤t->apic_data.lock); current->apic_data.sipi_pending = false; current->apic_data.sipi_vector = 0; current->apic_data.wait_for_sipi = true; spinlock_unlock(¤t->apic_data.lock); } static int fake_sipi_handler(vector_t vector, void *data) { int ret = 0; spinlock_lock(¤t->apic_data.lock); if (current->apic_data.fake_sipi) { current->apic_data.fake_sipi = false; ret = 1; } spinlock_unlock(¤t->apic_data.lock); return ret; } void apic_handle_wait_for_sipi_state (void) { ASSERT(currentcpu->disable_interrupt == 0); spinlock_lock(¤t->apic_data.lock); if (!current->apic_data.wait_for_sipi) { spinlock_unlock(¤t->apic_data.lock); return; } APIC_DBG("handle wait-for-sipi state\n"); apic_enable(); while (current->apic_data.wait_for_sipi) { if (!current->apic_data.sipi_pending) { /* Keep interrupts disabled on unlocking */ currentcpu->disable_interrupt++; spinlock_unlock(¤t->apic_data.lock); /* * Enable interrupts and halt. * Please note execution of STI with RFLAGS.IF = 0 * blocks interrupts for one instruction after * its execution. */ currentcpu->disable_interrupt--; asm_sti_and_hlt(); spinlock_lock(¤t->apic_data.lock); } if (current->apic_data.sipi_pending != 0) { current->vmctl.write_realmode_seg(SREG_CS, current->apic_data.sipi_vector << 8); current->vmctl.write_ip(0); current->apic_data.sipi_pending = false; current->apic_data.sipi_vector = 0; current->apic_data.wait_for_sipi = false; } } /* * Local apics of application processors are disabled by default. * Disable it. */ apic_disable(); APIC_DBG("Exit wait-for-sipi state\n"); spinlock_unlock(¤t->apic_data.lock); } static void send_init(struct vcpu *dest_vcpu) { spinlock_lock(&dest_vcpu->apic_data.lock); if (dest_vcpu->apic_data.wait_for_sipi) { spinlock_unlock(&dest_vcpu->apic_data.lock); return; } spinlock_unlock(&dest_vcpu->apic_data.lock); apic_send_init(dest_vcpu->apic_id); } static bool call_send_init(struct vcpu *dest_vcpu, void *data) { if (dest_vcpu == current) { return false; } send_init(dest_vcpu); return false; } void apic_send_init_others(void) { vcpu_list_foreach(current->vm, call_send_init, NULL); } static void send_sipi (struct vcpu *dest_vcpu, vector_t vector) { spinlock_lock(&dest_vcpu->apic_data.lock); if (dest_vcpu->apic_data.wait_for_sipi) { dest_vcpu->apic_data.sipi_pending = true; dest_vcpu->apic_data.sipi_vector = vector; if (!dest_vcpu->apic_data.fake_sipi) { dest_vcpu->apic_data.fake_sipi = true; apic_send_ipi(FAKE_SIPI_VECTOR, dest_vcpu->apic_id); } } spinlock_unlock(&dest_vcpu->apic_data.lock); } static bool call_send_sipi (struct vcpu *dest_vcpu, void *data) { if (dest_vcpu == current) { return false; } vector_t vector; vector = *(vector_t*)data; send_sipi(dest_vcpu, vector); return false; } static bool call_send_ipi (struct vcpu *dest_vcpu, void *data) { if (dest_vcpu == current) { return false; } vector_t vector; vector = *(vector_t*)data; apic_send_ipi(vector, dest_vcpu->apic_id); return false; } static int apic_mmio_ro(void *data, phys_t gphys, bool wr, void *buf, uint len, u32 flags) { if (wr) { APIC_DBG("Ignore writing to off 0x%llx\n", gphys - APIC_BASE_ADDRESS); } else { mmio_memcpy(buf, apic_g2v(gphys), len); } return 1; /* emulated */ } static int apic_mmio_pass(void *data, phys_t gphys, bool wr, void *buf, uint len, u32 flags) { if (wr) { mmio_memcpy(apic_g2v(gphys), buf, len); } else { mmio_memcpy(buf, apic_g2v(gphys), len); } return 1; /* emulated */ } static int icr_low_handler(u32 *buf, bool wr) { u32 icr_low; u32 icr_high; u32 delivery_mode; struct vcpu *dest_vcpu; vector_t vector; apic_id_t apic_id; u32 dsh; int emulated = 1; if (!wr) { *buf = (current->apic_data.icr_low & ~ICR_STATUS_BIT) | (apic_read32(APIC_ICR_LOW_OFFSET) & ICR_STATUS_BIT); return 1 /* emulated */; } icr_high = current->apic_data.icr_high; icr_low = current->apic_data.icr_low = *buf; delivery_mode = icr_low & ICR_DELIVERY_MODE_MASK; dsh = icr_low & ICR_DSH_MASK; switch (delivery_mode) { case ICR_DELIVERY_MODE_FIXED: case ICR_DELIVERY_MODE_LOWEST_PRI: switch (dsh) { case ICR_DSH_DEST: disable_interrupt(); apic_wait_for_idle(); apic_write32(APIC_ICR_HIGH_OFFSET, icr_high); apic_write32(APIC_ICR_LOW_OFFSET, icr_low); enable_interrupt(); break; case ICR_DSH_OTHER: vector = apic_get_vector (icr_low); vcpu_list_foreach(current->vm, call_send_ipi, &vector); break; default: APIC_DBG("Specified DSH is not supported on fixed int: CPU%d ICR %08x %08x\n", get_cpu_id(), icr_high, icr_low); } break; case ICR_DELIVERY_MODE_NMI: APIC_DBG("NMI is not supported: CPU%d ICR %08x %08x\n", get_cpu_id(), icr_high, icr_low); break; case ICR_DELIVERY_MODE_INIT: if ((icr_low & ICR_LEVEL_ASSERT) == 0) { break; } switch (dsh) { case ICR_DSH_DEST: if (apic_is_logical_dest_mode(icr_low)) { APIC_DBG("Logical dest mode is not supported on INIT: CPU%d ICR %08x %08x\n", get_cpu_id(), icr_high, icr_low); break; } apic_id = apic_get_apic_id(icr_high); dest_vcpu = find_vcpu_with_apic_id(current->vm, apic_id); if (!dest_vcpu) { break; } send_init(dest_vcpu); break; case ICR_DSH_OTHER: apic_send_init_others(); break; default: APIC_DBG("Specified DSH is not supported on INIT: CPU%d ICR %08x %08x\n", get_cpu_id(), icr_high, icr_low); } break; case ICR_DELIVERY_MODE_STARTUP: switch (dsh) { case ICR_DSH_DEST: if (apic_is_logical_dest_mode(icr_low)) { APIC_DBG("Logical dest mode is not supported on SIPI: CPU%d ICR %08x %08x\n", get_cpu_id(), icr_high, icr_low); break; } apic_id = apic_get_apic_id(icr_high); dest_vcpu = find_vcpu_with_apic_id(current->vm, apic_id); if (!dest_vcpu) { break; } vector = apic_get_vector(icr_low); send_sipi(dest_vcpu, vector); break; case ICR_DSH_OTHER: vector = apic_get_vector (icr_low); vcpu_list_foreach(current->vm, call_send_sipi, &vector); break; default: APIC_DBG("Specified DSH is not supported on SIPI: CPU%d ICR %08x %08x\n", get_cpu_id(), icr_high, icr_low); } break; default: break; } return emulated; } static int icr_high_handler(u32 *buf, bool wr) { if (wr) { current->apic_data.icr_high = *buf; } else { *buf = current->apic_data.icr_high; } return 1; /* emulated */ } static int eoi_handler(u32 *buf, bool wr) { if (!wr) { /* Read */ return 0; } extint_apic_eoi(); return 1; /* emulated */ } static int logical_apic_id_handler(u32 *buf, bool wr) { if (wr) { current->apic_data.ldr = *buf; APIC_DBG("Writing ldr 0x%x\n", current->apic_data.ldr); } else { *buf = current->apic_data.ldr; APIC_DBG("Reading ldr 0x%x\n", current->apic_data.ldr); } return 1; /* emulated */ } static int apic_privileged_mmio_handler(void *data, phys_t gphys, bool wr, void *buf, uint len, u32 flags) { int emulated = 0; if ((gphys & 0x3) != 0 || len != 4) { APIC_DBG("gphys 0x%llx len %d wr %d\n", gphys, len, wr); mmio_do_nothing(data, gphys, wr, buf, len, flags); } switch(gphys - APIC_BASE_ADDRESS) { case APIC_APIC_ID_OFFSET: emulated = apic_mmio_ro(data, gphys, wr, buf, len, flags); break; case APIC_EOI_OFFSET: emulated = eoi_handler(buf, wr); break; case APIC_ICR_LOW_OFFSET: emulated = icr_low_handler(buf, wr); break; case APIC_ICR_HIGH_OFFSET: emulated = icr_high_handler(buf, wr); break; } if (!emulated) { apic_mmio_pass(data, gphys, wr, buf, len, flags); } return 1; /* emulated */ } static int apic_mmio_handler(void *data, phys_t gphys, bool wr, void *buf, uint len, u32 flags) { int emulated = 0; if ((gphys & 0x3) != 0 || len != 4) { mmio_do_nothing(data, gphys, wr, buf, len, flags); } switch(gphys - APIC_BASE_ADDRESS) { case APIC_APIC_ID_OFFSET: case APIC_LVT_LINT0_OFFSET: emulated = apic_mmio_ro(data, gphys, wr, buf, len, flags); break; case APIC_EOI_OFFSET: emulated = eoi_handler(buf, wr); break; case APIC_LOGICAL_APIC_ID_OFFSET: emulated = logical_apic_id_handler(buf, wr); break; case APIC_ICR_LOW_OFFSET: emulated = icr_low_handler(buf, wr); break; case APIC_ICR_HIGH_OFFSET: emulated = icr_high_handler(buf, wr); break; } if (!emulated) { apic_mmio_pass(data, gphys, wr, buf, len, flags); } return 1; /* emulated */ } static void apic_pass_init(void) { spinlock_init(¤t->apic_data.lock); set_int_hook(FAKE_SIPI_VECTOR, fake_sipi_handler, NULL); } static void apic_initvm(void) { if (cpu_is_bsp()) { mmio_register(APIC_BASE_ADDRESS, APIC_MEM_SIZE, apic_privileged_mmio_handler, NULL); } else { mmio_register(APIC_BASE_ADDRESS, APIC_MEM_SIZE, apic_mmio_handler, NULL); } } INITFUNC ("passcpu0", apic_pass_init); INITFUNC ("passvm1", apic_initvm); tinyvisor/vmm/core/guest_boot.h0000644006644000001440000000341511733227577017157 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_GUEST_BOOT_H #define _CORE_GUEST_BOOT_H #define GUEST_BOOT_OFFSET 0x800 #define GUEST_BOOT_LENGTH (guest_boot_end - guest_boot_start) extern char guest_boot_start[], guest_boot_end[]; #endif tinyvisor/vmm/core/arith.s0000644006644000001440000001223711733227577016131 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ # multiple precision arithmetic .include "longmode.h" .text .globl mpumul_64_64 .globl mpudiv_128_32 .globl ipchecksum # void mpumul_64_64 (u64 m1, u64 m2, u64 ans[2]); # u32 mpudiv_128_32 (u64 d1[2], u32 d2, u64 quotient[2]); # u16 ipchecksum (void *buf, u32 len); .if longmode .code64 .align 16 mpumul_64_64: mov %rdi,%rax # m1 -> rax mov %rdx,%rdi # ans -> rdi mul %rsi # rax * m2 -> rdx:rax mov %rax,0(%rdi) # rax -> ans[0] mov %rdx,8(%rdi) # rdx -> ans[1] ret .align 16 mpudiv_128_32: mov %rdx,%rcx # quotient -> rcx xor %rdx,%rdx # 0 -> rdx mov %esi,%esi # d2 (32bit) -> rsi mov 8(%rdi),%rax # d1[1] -> rax div %rsi # rdx:rax % rsi -> rdx, rdx:rax / rsi -> rax mov %rax,8(%rcx) # rax -> quotient[1] mov 0(%rdi),%rax # d1[0] -> rax div %rsi # rdx:rax % rsi -> rdx, rdx:rax / rsi -> rax mov %rax,0(%rcx) # rax -> quotient[0] mov %rdx,%rax # return rdx ret .align 16 ipchecksum: mov %esi,%ecx # len (32bit) -> rcx mov %rdi,%rsi # buf -> rsi mov $-1,%rdi xor %rdx,%rdx cld 1: shr %ecx # len bit0 test jnc 1f shl $8,%rdi 1: test $6,%esi # rsi bit1 and bit2 test je 1f test %ecx,%ecx je 1f xor %eax,%eax 2: lodsw add %eax,%edx sub $1,%ecx je 1f test $6,%esi jne 2b 1: shr %ecx # len bit1 test jnc 1f shl $16,%rdi 1: shr %ecx # len bit2 test jnc 1f shl $32,%rdi 1: not %rdi test %ecx,%ecx je 1f 2: lodsq add %rax,%rdx adc $0,%rdx sub $1,%ecx jne 2b 1: lodsq and %rdi,%rax add %rdx,%rax adc $0,%rax mov %eax,%edx shr $32,%rax add %edx,%eax adc $0,%eax mov %eax,%edx shr $16,%eax add %dx,%ax adc $0,%ax 1: xor $~0,%ax je 1b ret .else .code32 # 0=ret 4=m1l 8=m1h 12=m2l 16=m2h 20=ans[] .align 16 mpumul_64_64: mov 20(%esp),%ecx # ans mov 4(%esp),%eax # m1l mov 12(%esp),%edx # m2l mul %edx # m1l * m2l mov %eax,0(%ecx) mov %edx,4(%ecx) mov 8(%esp),%eax # m1h mov 16(%esp),%edx # m2h mul %edx # m1h * m2h mov %eax,8(%ecx) mov %edx,12(%ecx) mov 4(%esp),%eax # m1l mov 16(%esp),%edx # m2h mul %edx # m1l * m2h add %eax,4(%ecx) adc %edx,8(%ecx) adcl $0,12(%ecx) mov 8(%esp),%eax # m1h mov 12(%esp),%edx # m2l mul %edx # m1h * m2l add %eax,4(%ecx) adc %edx,8(%ecx) adcl $0,12(%ecx) ret .align 16 mpudiv_128_32: push %edi push %esi # 8=ret 12=d1[] 16=d2 20=quotient[] mov 12(%esp),%edi # d1 -> edi mov 16(%esp),%esi # d2 -> esi mov 20(%esp),%ecx # quotient -> ecx xor %edx,%edx # 0 -> edx mov 12(%edi),%eax # ((u32*)d1)[3] -> eax div %esi # edx:eax % esi -> edx, edx:eax / esi -> eax mov %eax,12(%ecx) # eax -> ((u32*)quotient)[3] mov 8(%edi),%eax # ((u32*)d1)[2] -> eax div %esi # edx:eax % esi -> edx, edx:eax / esi -> eax mov %eax,8(%ecx) # eax -> ((u32*)quotient)[2] mov 4(%edi),%eax # ((u32*)d1)[1] -> eax div %esi # edx:eax % esi -> edx, edx:eax / esi -> eax mov %eax,4(%ecx) # eax -> ((u32*)quotient)[1] mov 0(%edi),%eax # ((u32*)d1)[0] -> eax div %esi # edx:eax % esi -> edx, edx:eax / esi -> eax mov %eax,0(%ecx) # eax -> ((u32*)quotient)[0] mov %edx,%eax # return edx pop %esi pop %edi ret .align 16 ipchecksum: push %edi push %esi mov 16(%esp),%ecx # len -> ecx mov 12(%esp),%esi # buf -> esi mov $-1,%edi xor %edx,%edx cld 1: shr %ecx # len bit0 test jnc 1f shl $8,%edi 1: test $2,%esi # esi bit1 test je 1f test %ecx,%ecx je 1f xor %eax,%eax 2: lodsw add %eax,%edx sub $1,%ecx je 1f test $2,%esi jne 2b 1: shr %ecx # len bit1 test jnc 1f shl $16,%edi 1: not %edi test %ecx,%ecx je 1f 2: lodsl add %eax,%edx adc $0,%edx sub $1,%ecx jne 2b 1: lodsl and %edi,%eax add %edx,%eax adc $0,%eax mov %eax,%edx shr $16,%eax add %dx,%ax adc $0,%ax 1: xor $~0,%ax je 1b pop %esi pop %edi ret .endif tinyvisor/vmm/core/io_iopass.c0000644006644000001440000000575311733245403016760 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include #include "io_io.h" /* #define IOPASS_DEBUG */ #ifdef IOPASS_DEBUG #include #define IOPASS_DBG(...) \ do { \ printf(__VA_ARGS__); \ } while (0) #else #define IOPASS_DBG(...) #endif static int restricted_io(iotype_t type, ioport_t port, void *data) { ioport_t assigned_len; #ifdef ENABLE_ASSERT bool write; ioport_t access_size; #endif if (pci_assigned_ioport(port, &assigned_len)) { #ifdef IOPASS_DEBUG if (port > 0x1000) { IOPASS_DBG("pass: type %d port 0x%x\n", type, port); } #endif /* * A I/O access is aligned to it's access size. * A I/O resource is assngined on 4 byte granularity. * So access_size should be equal to or less than assigned_len. */ #ifdef ENABLE_ASSERT iotype_to_size_wr(type, &access_size, &write); #endif ASSERT(access_size <= assigned_len); return 0; /* pass */ } #ifdef IOPASS_DEBUG if (port > 0x1000) { IOPASS_DBG("block: type %d port 0x%x\n", type, port); } #endif return 1; /* no pass */ } static void io_iopass_init (void) { u32 i; if (cpu_is_bsp()) { for (i = 0; i < NUM_OF_IOPORT; i++) { set_iofunc(i, do_io_pass); } } else { for (i = 0; i < NUM_OF_IOPORT; i++) { set_iofunc(i, restricted_io); } } } INITFUNC ("passvm0", io_iopass_init); tinyvisor/vmm/core/initfunc.c0000644006644000001440000000622212011203114016561 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include "initfunc.h" /* #define INIT_DEBUG */ #ifdef INIT_DEBUG #define INIT_DBG(...) \ do { \ printf("INIT: " __VA_ARGS__); \ } while (0) #else #define INIT_DBG(...) #endif extern struct initfunc_data __initfunc_start[], __initfunc_end[]; static void debug_print1 (struct initfunc_data *p) { char tmp[9]; memcpy (tmp, p->id, sizeof p->id); tmp[8] = '\0'; printf ("initfunc_data@%p: %s %p\n", p, tmp, p->func); } static void debug_print (void) { struct initfunc_data *p; for (p = __initfunc_start; p != __initfunc_end; p++) debug_print1 (p); } static void swap_initfunc_data (struct initfunc_data *p, struct initfunc_data *q) { struct initfunc_data tmp; memcpy (&tmp, p, sizeof (struct initfunc_data)); memcpy (p, q, sizeof (struct initfunc_data)); memcpy (q, &tmp, sizeof (struct initfunc_data)); } void call_initfunc (char *id) { int l; struct initfunc_data *p; l = strlen (id); for (p = __initfunc_start; p != __initfunc_end; p++) if (memcmp (p->id, id, l) == 0) { INIT_DBG("CPU%d: Calling %s %p\n", get_cpu_id(), p->id, p->func); p->func (); INIT_DBG("CPU%d: Returned from %s %p\n", get_cpu_id(), p->id, p->func); } } void initfunc_init (void) { struct initfunc_data *p, *q; /* sort initfunc data */ for (p = __initfunc_start; p != __initfunc_end; p++) for (q = p + 1; q != __initfunc_end; q++) if (memcmp (p->id, q->id, sizeof (p->id)) > 0) swap_initfunc_data (p, q); if (false) debug_print (); } tinyvisor/vmm/core/cpu_interpreter.c0000644006644000001440000020657612000734676020216 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include "asm.h" #include "comphappy.h" #include "constants.h" #include "cpu_emul.h" #include "cpu_interpreter.h" #include "cpu_mmu.h" #include "cpu_seg.h" #include "cpu_stack.h" #include "current.h" #include "io_io.h" #include "misc.h" #include "panic.h" #define PREFIX_LOCK 0xF0 #define PREFIX_REPNE 0xF2 #define PREFIX_REPE 0xF3 #define PREFIX_ES 0x26 #define PREFIX_CS 0x2E #define PREFIX_SS 0x36 #define PREFIX_DS 0x3E #define PREFIX_FS 0x64 #define PREFIX_GS 0x65 #define PREFIX_OPERAND_SIZE 0x66 #define PREFIX_ADDRESS_SIZE 0x67 #define PREFIX_REX_MIN 0x40 #define PREFIX_REX_MAX 0x4F #define OPCODE_0x0F 0x0F #define OPCODE_0x0F_MOV_TO_CR 0x22 #define OPCODE_0x0F_MOV_FROM_CR 0x20 #define OPCODE_0x0F_MOV_TO_DR 0x23 #define OPCODE_0x0F_MOV_FROM_DR 0x21 #define OPCODE_0x0F_CLTS 0x06 #define OPCODE_HLT 0xF4 #define OPCODE_CLI 0xFA #define OPCODE_STI 0xFB #define OPCODE_PUSHF 0x9C #define OPCODE_POPF 0x9D #define OPCODE_IRET 0xCF #define OPCODE_0x0F_INVD 0x08 #define OPCODE_0x0F_WBINVD 0x09 #define OPCODE_0x0F_0x01 0x01 #define OPCODE_0x0F_0x01_LGDT 0x2 #define OPCODE_0x0F_0x01_LIDT 0x3 #define OPCODE_0x0F_0x01_SMSW 0x4 #define OPCODE_0x0F_0x01_LMSW 0x6 #define OPCODE_0x0F_0x01_INVLPG 0x7 #define OPCODE_0x0F_RDMSR 0x32 #define OPCODE_0x0F_WRMSR 0x30 #define OPCODE_INT 0xCD #define OPCODE_INT3 0xCC #define OPCODE_INTO 0xCE #define OPCODE_INB_IMM 0xE4 #define OPCODE_IN_IMM 0xE5 #define OPCODE_INB_DX 0xEC #define OPCODE_IN_DX 0xED #define OPCODE_INSB 0x6C #define OPCODE_INS 0x6D #define OPCODE_OUTB_IMM 0xE6 #define OPCODE_OUT_IMM 0xE7 #define OPCODE_OUTB_DX 0xEE #define OPCODE_OUT_DX 0xEF #define OPCODE_OUTSB 0x6E #define OPCODE_OUTS 0x6F #define OPCODE_MOV_FROM_SR 0x8C #define OPCODE_MOV_TO_SR 0x8E #define OPCODE_PUSH_ES 0x06 #define OPCODE_PUSH_CS 0x0E #define OPCODE_PUSH_SS 0x16 #define OPCODE_PUSH_DS 0x1E #define OPCODE_0x0F_PUSH_FS 0xA0 #define OPCODE_0x0F_PUSH_GS 0xA8 #define OPCODE_POP_ES 0x07 #define OPCODE_POP_CS 0x0F /* i8086 and i8088 only */ #define OPCODE_POP_SS 0x17 #define OPCODE_POP_DS 0x1F #define OPCODE_0x0F_POP_FS 0xA1 #define OPCODE_0x0F_POP_GS 0xA9 #define OPCODE_JMP_FAR_DIRECT 0xEA #define OPCODE_0xFF 0xFF #define OPCODE_0xFF_JMP_FAR_INDIRECT 0x05 #define OPCODE_RETF 0xCB #define OPCODE_0x0F_LSS 0xB2 /* --- for MMIO --- */ #define OPCODE_MOVSB 0xA4 #define OPCODE_MOVS 0xA5 #define OPCODE_STOSB 0xAA #define OPCODE_STOS 0xAB #define OPCODE_0x0F_MOVZX_RM8_TO_R 0xB6 #define OPCODE_0x0F_MOVZX_RM16_TO_R 0xB7 #define OPCODE_0xFF_PUSH 0x06 #define OPCODE_0x8F 0x8F #define OPCODE_0x8F_POP 0x00 enum addrtype { ADDRTYPE_16BIT, ADDRTYPE_32BIT, ADDRTYPE_64BIT, }; enum reptype { REPTYPE_16BIT, REPTYPE_32BIT, REPTYPE_64BIT, }; enum reg { REG_NO = -1, REG_AX = 0, /* AX/EAX/RAX */ REG_CX = 1, /* CX/ECX/RCX */ REG_DX = 2, /* DX/EDX/RDX */ REG_BX = 3, /* BX/EBX/RBX */ REG_SP = 4, /* SP/ESP/RSP */ REG_BP = 5, /* BP/EBP/RBP */ REG_SI = 6, /* SI/ESI/RSI */ REG_DI = 7, /* DI/EDI/RDI */ REG_08 = 8, /* R8 */ REG_09 = 9, /* R9 */ REG_10 = 10, /* R10 */ REG_11 = 11, /* R11 */ REG_12 = 12, /* R12 */ REG_13 = 13, /* R13 */ REG_14 = 14, /* R14 */ REG_15 = 15, /* R15 */ }; enum reg8 { REG_AL = 0, REG_CL = 1, REG_DL = 2, REG_BL = 3, REG_AH = 4, REG_CH = 5, REG_DH = 6, REG_BH = 7, }; enum idata_type { I_ZERO, /* not implemented */ I_MODRM, /* Mod R/M byte */ I_IMME1, /* Immediate 1 byte */ I_IMME2, /* Immediate 2/4 byte */ I_MIMM1, /* Mod R/M byte and Immediate 1 byte */ I_MIMM2, /* Mod R/M byte and Immediate 2/4 byte */ I_MOFFS, /* displacement */ I_MGRP3, /* Group 3 special */ I_IMMED, /* Immediate (for Group 3) */ I_NOMOR, /* there are no more bytes (for Group 3) */ }; enum idata_operand { O_ZERO, /* no operands */ O_M, /* memory or register by Mod-R/M */ O_R, /* register by bit3-5 of Mod-R/M */ O_A, /* AL/AX/EAX register */ O_I, /* Immediate */ O_1, /* constant 1 (for bit shift) */ O_C, /* CL register (for bit shift) */ }; enum idata_function { F_ZERO, F_ADD, F_OR, F_ADC, F_SBB, F_AND, F_SUB, F_XOR, F_CMP, F_TEST, F_XCHG, F_MOV, F_NOT, F_NEG, F_ROL, F_ROR, F_RCL, F_RCR, F_SHL, F_SHR, F_SAR, F_GRP1, F_GRP2, F_GRP11, }; struct prefix { enum sreg seg : 3; unsigned int lock : 1; unsigned int repne : 1; unsigned int repe : 1; unsigned int opsize : 1; unsigned int addrsize : 1; union { struct { unsigned int b : 1; unsigned int x : 1; unsigned int r : 1; unsigned int w : 1; } b; struct { unsigned int val : 4; } v; } rex; }; struct modrm { unsigned int rm : 3; unsigned int reg : 3; unsigned int mod : 2; }; struct sib { unsigned int base : 3; unsigned int index : 3; unsigned int scale : 2; }; struct op { struct prefix prefix; struct modrm modrm; struct sib sib; i32 disp; /* maximum size of a displacement is 32bit */ u64 imm; enum reg rm_reg; /* register specified by rm field in modrm. */ enum sreg rm_seg; u64 rm_off; enum reg reg; enum cpumode mode; enum addrtype addrtype; enum optype optype; enum reptype reptype; ulong ip; uint ip_off; struct realmode_sysregs *rsr; bool longmode; }; struct modrm_info { int displen; enum reg reg1, reg2; enum sreg defseg; unsigned int sibflag : 1; unsigned int ripflag : 1; }; struct sibbase_info { int displen; enum reg reg; enum sreg defseg; }; struct sibscale_info { enum reg reg; }; struct execinst_io_data { iotype_t type; }; struct idata { enum idata_type type : 4; int len : 4; enum idata_operand dst : 4; enum idata_operand src : 4; enum idata_function func : 16; }; static struct modrm_info modrmmatrix16[3][8] = { /* [mod][rm] */ /* displen, reg1, reg2, defseg, sibflag, ripflag */ { { 0, REG_BX, REG_SI, SREG_DS, 0, 0 }, { 0, REG_BX, REG_DI, SREG_DS, 0, 0 }, { 0, REG_BP, REG_SI, SREG_SS, 0, 0 }, { 0, REG_BP, REG_DI, SREG_SS, 0, 0 }, { 0, REG_SI, REG_NO, SREG_DS, 0, 0 }, { 0, REG_DI, REG_NO, SREG_DS, 0, 0 }, { 2, REG_NO, REG_NO, SREG_DS, 0, 0 }, { 0, REG_BX, REG_NO, SREG_DS, 0, 0 }, }, { { 1, REG_BX, REG_SI, SREG_DS, 0, 0 }, { 1, REG_BX, REG_DI, SREG_DS, 0, 0 }, { 1, REG_BP, REG_SI, SREG_SS, 0, 0 }, { 1, REG_BP, REG_DI, SREG_SS, 0, 0 }, { 1, REG_SI, REG_NO, SREG_DS, 0, 0 }, { 1, REG_DI, REG_NO, SREG_DS, 0, 0 }, { 1, REG_BP, REG_NO, SREG_SS, 0, 0 }, { 1, REG_BX, REG_NO, SREG_DS, 0, 0 }, }, { { 2, REG_BX, REG_SI, SREG_DS, 0, 0 }, { 2, REG_BX, REG_DI, SREG_DS, 0, 0 }, { 2, REG_BP, REG_SI, SREG_SS, 0, 0 }, { 2, REG_BP, REG_DI, SREG_SS, 0, 0 }, { 2, REG_SI, REG_NO, SREG_DS, 0, 0 }, { 2, REG_DI, REG_NO, SREG_DS, 0, 0 }, { 2, REG_BP, REG_NO, SREG_SS, 0, 0 }, { 2, REG_BX, REG_NO, SREG_DS, 0, 0 }, }, }; static struct modrm_info modrmmatrix32[3][2][8] = { /* [mod][rex.b][rm] */ /* displen, reg1, reg2, defseg, sibflag, ripflag */ { { { 0, REG_AX, REG_NO, SREG_DS, 0, 0 }, { 0, REG_CX, REG_NO, SREG_DS, 0, 0 }, { 0, REG_DX, REG_NO, SREG_DS, 0, 0 }, { 0, REG_BX, REG_NO, SREG_DS, 0, 0 }, { 0, REG_NO, REG_NO, SREG_DS, 1, 0 }, { 4, REG_NO, REG_NO, SREG_DS, 0, 1 }, { 0, REG_SI, REG_NO, SREG_DS, 0, 0 }, { 0, REG_DI, REG_NO, SREG_DS, 0, 0 }, }, { { 0, REG_08, REG_NO, SREG_DS, 0, 0 }, { 0, REG_09, REG_NO, SREG_DS, 0, 0 }, { 0, REG_10, REG_NO, SREG_DS, 0, 0 }, { 0, REG_11, REG_NO, SREG_DS, 0, 0 }, { 0, REG_NO, REG_NO, SREG_DS, 1, 0 }, { 4, REG_NO, REG_NO, SREG_DS, 0, 1 }, { 0, REG_14, REG_NO, SREG_DS, 0, 0 }, { 0, REG_15, REG_NO, SREG_DS, 0, 0 }, }, }, { { { 1, REG_AX, REG_NO, SREG_DS, 0, 0 }, { 1, REG_CX, REG_NO, SREG_DS, 0, 0 }, { 1, REG_DX, REG_NO, SREG_DS, 0, 0 }, { 1, REG_BX, REG_NO, SREG_DS, 0, 0 }, { 1, REG_NO, REG_NO, SREG_DS, 1, 0 }, { 1, REG_BP, REG_NO, SREG_SS, 0, 0 }, { 1, REG_SI, REG_NO, SREG_DS, 0, 0 }, { 1, REG_DI, REG_NO, SREG_DS, 0, 0 }, }, { { 1, REG_08, REG_NO, SREG_DS, 0, 0 }, { 1, REG_09, REG_NO, SREG_DS, 0, 0 }, { 1, REG_10, REG_NO, SREG_DS, 0, 0 }, { 1, REG_11, REG_NO, SREG_DS, 0, 0 }, { 1, REG_NO, REG_NO, SREG_DS, 1, 0 }, { 1, REG_13, REG_NO, SREG_SS, 0, 0 }, { 1, REG_14, REG_NO, SREG_DS, 0, 0 }, { 1, REG_15, REG_NO, SREG_DS, 0, 0 }, }, }, { { { 4, REG_AX, REG_NO, SREG_DS, 0, 0 }, { 4, REG_CX, REG_NO, SREG_DS, 0, 0 }, { 4, REG_DX, REG_NO, SREG_DS, 0, 0 }, { 4, REG_BX, REG_NO, SREG_DS, 0, 0 }, { 4, REG_NO, REG_NO, SREG_DS, 1, 0 }, { 4, REG_BP, REG_NO, SREG_SS, 0, 0 }, { 4, REG_SI, REG_NO, SREG_DS, 0, 0 }, { 4, REG_DI, REG_NO, SREG_DS, 0, 0 }, }, { { 4, REG_08, REG_NO, SREG_DS, 0, 0 }, { 4, REG_09, REG_NO, SREG_DS, 0, 0 }, { 4, REG_10, REG_NO, SREG_DS, 0, 0 }, { 4, REG_11, REG_NO, SREG_DS, 0, 0 }, { 4, REG_NO, REG_NO, SREG_DS, 1, 0 }, { 4, REG_13, REG_NO, SREG_SS, 0, 0 }, { 4, REG_14, REG_NO, SREG_DS, 0, 0 }, { 4, REG_15, REG_NO, SREG_DS, 0, 0 }, }, }, }; static struct sibbase_info sibmatrix_base[3][2][8] = { /* [mod][rex.b][base] */ /* displen (override), reg, defseg (override) */ { { { 0, REG_AX, SREG_DS }, { 0, REG_CX, SREG_DS }, { 0, REG_DX, SREG_DS }, { 0, REG_BX, SREG_DS }, { 0, REG_SP, SREG_SS }, { 4, REG_NO, SREG_DS }, /* [*] */ { 0, REG_SI, SREG_DS }, { 0, REG_DI, SREG_DS }, }, { { 0, REG_08, SREG_DS }, { 0, REG_09, SREG_DS }, { 0, REG_10, SREG_DS }, { 0, REG_11, SREG_DS }, { 0, REG_12, SREG_SS }, { 4, REG_NO, SREG_DS }, /* [*] */ { 0, REG_14, SREG_DS }, { 0, REG_15, SREG_DS }, }, }, { { { 1, REG_AX, SREG_DS }, { 1, REG_CX, SREG_DS }, { 1, REG_DX, SREG_DS }, { 1, REG_BX, SREG_DS }, { 1, REG_SP, SREG_SS }, { 1, REG_BP, SREG_SS }, { 1, REG_SI, SREG_DS }, { 1, REG_DI, SREG_DS }, }, { { 1, REG_08, SREG_DS }, { 1, REG_09, SREG_DS }, { 1, REG_10, SREG_DS }, { 1, REG_11, SREG_DS }, { 1, REG_12, SREG_SS }, { 1, REG_13, SREG_SS }, { 1, REG_14, SREG_DS }, { 1, REG_15, SREG_DS }, }, }, { { { 4, REG_AX, SREG_DS }, { 4, REG_CX, SREG_DS }, { 4, REG_DX, SREG_DS }, { 4, REG_BX, SREG_DS }, { 4, REG_SP, SREG_SS }, { 4, REG_BP, SREG_SS }, { 4, REG_SI, SREG_DS }, { 4, REG_DI, SREG_DS }, }, { { 4, REG_08, SREG_DS }, { 4, REG_09, SREG_DS }, { 4, REG_10, SREG_DS }, { 4, REG_11, SREG_DS }, { 4, REG_12, SREG_SS }, { 4, REG_13, SREG_SS }, { 4, REG_14, SREG_DS }, { 4, REG_15, SREG_DS }, }, }, }; static struct sibscale_info sib_scale[2][8] = { /* [rex.x][index] */ /* reg */ { { REG_AX }, { REG_CX }, { REG_DX }, { REG_BX }, { REG_NO }, { REG_BP }, { REG_SI }, { REG_DI }, }, { { REG_08 }, { REG_09 }, { REG_10 }, { REG_11 }, { REG_12 }, { REG_13 }, { REG_14 }, { REG_15 }, }, }; static struct idata idata[256] = { { I_MODRM, 1, O_M, O_R, F_ADD }, /* 0x00 */ { I_MODRM, 2, O_M, O_R, F_ADD }, /* 0x01 */ { I_MODRM, 1, O_R, O_M, F_ADD }, /* 0x02 */ { I_MODRM, 2, O_R, O_M, F_ADD }, /* 0x03 */ { I_IMME1, 1, O_A, O_I, F_ADD }, /* 0x04 */ { I_IMME2, 2, O_A, O_I, F_ADD }, /* 0x05 */ { 0, 0, 0, 0, 0 }, /* 0x06 */ { 0, 0, 0, 0, 0 }, /* 0x07 */ { I_MODRM, 1, O_M, O_R, F_OR }, /* 0x08 */ { I_MODRM, 2, O_M, O_R, F_OR }, /* 0x09 */ { I_MODRM, 1, O_R, O_M, F_OR }, /* 0x0A */ { I_MODRM, 2, O_R, O_M, F_OR }, /* 0x0B */ { I_IMME1, 1, O_A, O_I, F_OR }, /* 0x0C */ { I_IMME2, 2, O_A, O_I, F_OR }, /* 0x0D */ { 0, 0, 0, 0, 0 }, /* 0x0E */ { 0, 0, 0, 0, 0 }, /* 0x0F */ { I_MODRM, 1, O_M, O_R, F_ADC }, /* 0x10 */ { I_MODRM, 2, O_M, O_R, F_ADC }, /* 0x11 */ { I_MODRM, 1, O_R, O_M, F_ADC }, /* 0x12 */ { I_MODRM, 2, O_R, O_M, F_ADC }, /* 0x13 */ { I_IMME1, 1, O_A, O_I, F_ADC }, /* 0x14 */ { I_IMME2, 2, O_A, O_I, F_ADC }, /* 0x15 */ { 0, 0, 0, 0, 0 }, /* 0x16 */ { 0, 0, 0, 0, 0 }, /* 0x17 */ { I_MODRM, 1, O_M, O_R, F_SBB }, /* 0x18 */ { I_MODRM, 2, O_M, O_R, F_SBB }, /* 0x19 */ { I_MODRM, 1, O_R, O_M, F_SBB }, /* 0x1A */ { I_MODRM, 2, O_R, O_M, F_SBB }, /* 0x1B */ { I_IMME1, 1, O_A, O_I, F_SBB }, /* 0x1C */ { I_IMME2, 2, O_A, O_I, F_SBB }, /* 0x1D */ { 0, 0, 0, 0, 0 }, /* 0x1E */ { 0, 0, 0, 0, 0 }, /* 0x1F */ { I_MODRM, 1, O_M, O_R, F_AND }, /* 0x20 */ { I_MODRM, 2, O_M, O_R, F_AND }, /* 0x21 */ { I_MODRM, 1, O_R, O_M, F_AND }, /* 0x22 */ { I_MODRM, 2, O_R, O_M, F_AND }, /* 0x23 */ { I_IMME1, 1, O_A, O_I, F_AND }, /* 0x24 */ { I_IMME2, 2, O_A, O_I, F_AND }, /* 0x25 */ { 0, 0, 0, 0, 0 }, /* 0x26 */ { 0, 0, 0, 0, 0 }, /* 0x27 */ { I_MODRM, 1, O_M, O_R, F_SUB }, /* 0x28 */ { I_MODRM, 2, O_M, O_R, F_SUB }, /* 0x29 */ { I_MODRM, 1, O_R, O_M, F_SUB }, /* 0x2A */ { I_MODRM, 2, O_R, O_M, F_SUB }, /* 0x2B */ { I_IMME1, 1, O_A, O_I, F_SUB }, /* 0x2C */ { I_IMME2, 2, O_A, O_I, F_SUB }, /* 0x2D */ { 0, 0, 0, 0, 0 }, /* 0x2E */ { 0, 0, 0, 0, 0 }, /* 0x2F */ { I_MODRM, 1, O_M, O_R, F_XOR }, /* 0x30 */ { I_MODRM, 2, O_M, O_R, F_XOR }, /* 0x31 */ { I_MODRM, 1, O_R, O_M, F_XOR }, /* 0x32 */ { I_MODRM, 2, O_R, O_M, F_XOR }, /* 0x33 */ { I_IMME1, 1, O_A, O_I, F_XOR }, /* 0x34 */ { I_IMME2, 2, O_A, O_I, F_XOR }, /* 0x35 */ { 0, 0, 0, 0, 0 }, /* 0x36 */ { 0, 0, 0, 0, 0 }, /* 0x37 */ { I_MODRM, 1, O_M, O_R, F_CMP }, /* 0x38 */ { I_MODRM, 2, O_M, O_R, F_CMP }, /* 0x39 */ { I_MODRM, 1, O_R, O_M, F_CMP }, /* 0x3A */ { I_MODRM, 2, O_R, O_M, F_CMP }, /* 0x3B */ { I_IMME1, 1, O_A, O_I, F_CMP }, /* 0x3C */ { I_IMME2, 2, O_A, O_I, F_CMP }, /* 0x3D */ { 0, 0, 0, 0, 0 }, /* 0x3E */ { 0, 0, 0, 0, 0 }, /* 0x3F */ { 0, 0, 0, 0, 0 }, /* 0x40 */ { 0, 0, 0, 0, 0 }, /* 0x41 */ { 0, 0, 0, 0, 0 }, /* 0x42 */ { 0, 0, 0, 0, 0 }, /* 0x43 */ { 0, 0, 0, 0, 0 }, /* 0x44 */ { 0, 0, 0, 0, 0 }, /* 0x45 */ { 0, 0, 0, 0, 0 }, /* 0x46 */ { 0, 0, 0, 0, 0 }, /* 0x47 */ { 0, 0, 0, 0, 0 }, /* 0x48 */ { 0, 0, 0, 0, 0 }, /* 0x49 */ { 0, 0, 0, 0, 0 }, /* 0x4A */ { 0, 0, 0, 0, 0 }, /* 0x4B */ { 0, 0, 0, 0, 0 }, /* 0x4C */ { 0, 0, 0, 0, 0 }, /* 0x4D */ { 0, 0, 0, 0, 0 }, /* 0x4E */ { 0, 0, 0, 0, 0 }, /* 0x4F */ { 0, 0, 0, 0, 0 }, /* 0x50 */ { 0, 0, 0, 0, 0 }, /* 0x51 */ { 0, 0, 0, 0, 0 }, /* 0x52 */ { 0, 0, 0, 0, 0 }, /* 0x53 */ { 0, 0, 0, 0, 0 }, /* 0x54 */ { 0, 0, 0, 0, 0 }, /* 0x55 */ { 0, 0, 0, 0, 0 }, /* 0x56 */ { 0, 0, 0, 0, 0 }, /* 0x57 */ { 0, 0, 0, 0, 0 }, /* 0x58 */ { 0, 0, 0, 0, 0 }, /* 0x59 */ { 0, 0, 0, 0, 0 }, /* 0x5A */ { 0, 0, 0, 0, 0 }, /* 0x5B */ { 0, 0, 0, 0, 0 }, /* 0x5C */ { 0, 0, 0, 0, 0 }, /* 0x5D */ { 0, 0, 0, 0, 0 }, /* 0x5E */ { 0, 0, 0, 0, 0 }, /* 0x5F */ { 0, 0, 0, 0, 0 }, /* 0x60 */ { 0, 0, 0, 0, 0 }, /* 0x61 */ { 0, 0, 0, 0, 0 }, /* 0x62 */ { 0, 0, 0, 0, 0 }, /* 0x63 */ { 0, 0, 0, 0, 0 }, /* 0x64 */ { 0, 0, 0, 0, 0 }, /* 0x65 */ { 0, 0, 0, 0, 0 }, /* 0x66 */ { 0, 0, 0, 0, 0 }, /* 0x67 */ { 0, 0, 0, 0, 0 }, /* 0x68 */ { 0, 0, 0, 0, 0 }, /* 0x69 */ { 0, 0, 0, 0, 0 }, /* 0x6A */ { 0, 0, 0, 0, 0 }, /* 0x6B */ { 0, 0, 0, 0, 0 }, /* 0x6C */ { 0, 0, 0, 0, 0 }, /* 0x6D */ { 0, 0, 0, 0, 0 }, /* 0x6E */ { 0, 0, 0, 0, 0 }, /* 0x6F */ { 0, 0, 0, 0, 0 }, /* 0x70 */ { 0, 0, 0, 0, 0 }, /* 0x71 */ { 0, 0, 0, 0, 0 }, /* 0x72 */ { 0, 0, 0, 0, 0 }, /* 0x73 */ { 0, 0, 0, 0, 0 }, /* 0x74 */ { 0, 0, 0, 0, 0 }, /* 0x75 */ { 0, 0, 0, 0, 0 }, /* 0x76 */ { 0, 0, 0, 0, 0 }, /* 0x77 */ { 0, 0, 0, 0, 0 }, /* 0x78 */ { 0, 0, 0, 0, 0 }, /* 0x79 */ { 0, 0, 0, 0, 0 }, /* 0x7A */ { 0, 0, 0, 0, 0 }, /* 0x7B */ { 0, 0, 0, 0, 0 }, /* 0x7C */ { 0, 0, 0, 0, 0 }, /* 0x7D */ { 0, 0, 0, 0, 0 }, /* 0x7E */ { 0, 0, 0, 0, 0 }, /* 0x7F */ { I_MIMM1, 1, O_M, O_I, F_GRP1 }, /* 0x80 */ { I_MIMM2, 2, O_M, O_I, F_GRP1 }, /* 0x81 */ { I_MIMM1, 1, O_M, O_I, F_GRP1 }, /* 0x82 */ { I_MIMM1, 2, O_M, O_I, F_GRP1 }, /* 0x83 */ { I_MODRM, 1, O_M, O_R, F_TEST }, /* 0x84 */ { I_MODRM, 2, O_M, O_R, F_TEST }, /* 0x85 */ { I_MODRM, 1, O_M, O_R, F_XCHG }, /* 0x86 */ { I_MODRM, 2, O_M, O_R, F_XCHG }, /* 0x87 */ { I_MODRM, 1, O_M, O_R, F_MOV }, /* 0x88 */ { I_MODRM, 2, O_M, O_R, F_MOV }, /* 0x89 */ { I_MODRM, 1, O_R, O_M, F_MOV }, /* 0x8A */ { I_MODRM, 2, O_R, O_M, F_MOV }, /* 0x8B */ { 0, 0, 0, 0, 0 }, /* 0x8C */ { 0, 0, 0, 0, 0 }, /* 0x8D */ { 0, 0, 0, 0, 0 }, /* 0x8E */ { 0, 0, 0, 0, 0 }, /* 0x8F */ { 0, 0, 0, 0, 0 }, /* 0x90 */ { 0, 0, 0, 0, 0 }, /* 0x91 */ { 0, 0, 0, 0, 0 }, /* 0x92 */ { 0, 0, 0, 0, 0 }, /* 0x93 */ { 0, 0, 0, 0, 0 }, /* 0x94 */ { 0, 0, 0, 0, 0 }, /* 0x95 */ { 0, 0, 0, 0, 0 }, /* 0x96 */ { 0, 0, 0, 0, 0 }, /* 0x97 */ { 0, 0, 0, 0, 0 }, /* 0x98 */ { 0, 0, 0, 0, 0 }, /* 0x99 */ { 0, 0, 0, 0, 0 }, /* 0x9A */ { 0, 0, 0, 0, 0 }, /* 0x9B */ { 0, 0, 0, 0, 0 }, /* 0x9C */ { 0, 0, 0, 0, 0 }, /* 0x9D */ { 0, 0, 0, 0, 0 }, /* 0x9E */ { 0, 0, 0, 0, 0 }, /* 0x9F */ { I_MOFFS, 1, O_A, O_M, F_MOV }, /* 0xA0 */ { I_MOFFS, 2, O_A, O_M, F_MOV }, /* 0xA1 */ { I_MOFFS, 1, O_M, O_A, F_MOV }, /* 0xA2 */ { I_MOFFS, 2, O_M, O_A, F_MOV }, /* 0xA3 */ { 0, 0, 0, 0, 0 }, /* 0xA4 */ { 0, 0, 0, 0, 0 }, /* 0xA5 */ { 0, 0, 0, 0, 0 }, /* 0xA6 */ { 0, 0, 0, 0, 0 }, /* 0xA7 */ { 0, 0, 0, 0, 0 }, /* 0xA8 */ { 0, 0, 0, 0, 0 }, /* 0xA9 */ { 0, 0, 0, 0, 0 }, /* 0xAA */ { 0, 0, 0, 0, 0 }, /* 0xAB */ { 0, 0, 0, 0, 0 }, /* 0xAC */ { 0, 0, 0, 0, 0 }, /* 0xAD */ { 0, 0, 0, 0, 0 }, /* 0xAE */ { 0, 0, 0, 0, 0 }, /* 0xAF */ { 0, 0, 0, 0, 0 }, /* 0xB0 */ { 0, 0, 0, 0, 0 }, /* 0xB1 */ { 0, 0, 0, 0, 0 }, /* 0xB2 */ { 0, 0, 0, 0, 0 }, /* 0xB3 */ { 0, 0, 0, 0, 0 }, /* 0xB4 */ { 0, 0, 0, 0, 0 }, /* 0xB5 */ { 0, 0, 0, 0, 0 }, /* 0xB6 */ { 0, 0, 0, 0, 0 }, /* 0xB7 */ { 0, 0, 0, 0, 0 }, /* 0xB8 */ { 0, 0, 0, 0, 0 }, /* 0xB9 */ { 0, 0, 0, 0, 0 }, /* 0xBA */ { 0, 0, 0, 0, 0 }, /* 0xBB */ { 0, 0, 0, 0, 0 }, /* 0xBC */ { 0, 0, 0, 0, 0 }, /* 0xBD */ { 0, 0, 0, 0, 0 }, /* 0xBE */ { 0, 0, 0, 0, 0 }, /* 0xBF */ { I_MIMM1, 1, O_M, O_I, F_GRP2 }, /* 0xC0 */ { I_MIMM1, 2, O_M, O_I, F_GRP2 }, /* 0xC1 */ { 0, 0, 0, 0, 0 }, /* 0xC2 */ { 0, 0, 0, 0, 0 }, /* 0xC3 */ { 0, 0, 0, 0, 0 }, /* 0xC4 */ { 0, 0, 0, 0, 0 }, /* 0xC5 */ { I_MIMM1, 1, O_M, O_I, F_GRP11 }, /* 0xC6 */ { I_MIMM2, 2, O_M, O_I, F_GRP11 }, /* 0xC7 */ { 0, 0, 0, 0, 0 }, /* 0xC8 */ { 0, 0, 0, 0, 0 }, /* 0xC9 */ { 0, 0, 0, 0, 0 }, /* 0xCA */ { 0, 0, 0, 0, 0 }, /* 0xCB */ { 0, 0, 0, 0, 0 }, /* 0xCC */ { 0, 0, 0, 0, 0 }, /* 0xCD */ { 0, 0, 0, 0, 0 }, /* 0xCE */ { 0, 0, 0, 0, 0 }, /* 0xCF */ { I_MODRM, 1, O_M, O_1, F_GRP2 }, /* 0xD0 */ { I_MODRM, 2, O_M, O_1, F_GRP2 }, /* 0xD1 */ { I_MODRM, 1, O_M, O_C, F_GRP2 }, /* 0xD2 */ { I_MODRM, 2, O_M, O_C, F_GRP2 }, /* 0xD3 */ { 0, 0, 0, 0, 0 }, /* 0xD4 */ { 0, 0, 0, 0, 0 }, /* 0xD5 */ { 0, 0, 0, 0, 0 }, /* 0xD6 */ { 0, 0, 0, 0, 0 }, /* 0xD7 */ { 0, 0, 0, 0, 0 }, /* 0xD8 */ { 0, 0, 0, 0, 0 }, /* 0xD9 */ { 0, 0, 0, 0, 0 }, /* 0xDA */ { 0, 0, 0, 0, 0 }, /* 0xDB */ { 0, 0, 0, 0, 0 }, /* 0xDC */ { 0, 0, 0, 0, 0 }, /* 0xDD */ { 0, 0, 0, 0, 0 }, /* 0xDE */ { 0, 0, 0, 0, 0 }, /* 0xDF */ { 0, 0, 0, 0, 0 }, /* 0xE0 */ { 0, 0, 0, 0, 0 }, /* 0xE1 */ { 0, 0, 0, 0, 0 }, /* 0xE2 */ { 0, 0, 0, 0, 0 }, /* 0xE3 */ { 0, 0, 0, 0, 0 }, /* 0xE4 */ { 0, 0, 0, 0, 0 }, /* 0xE5 */ { 0, 0, 0, 0, 0 }, /* 0xE6 */ { 0, 0, 0, 0, 0 }, /* 0xE7 */ { 0, 0, 0, 0, 0 }, /* 0xE8 */ { 0, 0, 0, 0, 0 }, /* 0xE9 */ { 0, 0, 0, 0, 0 }, /* 0xEA */ { 0, 0, 0, 0, 0 }, /* 0xEB */ { 0, 0, 0, 0, 0 }, /* 0xEC */ { 0, 0, 0, 0, 0 }, /* 0xED */ { 0, 0, 0, 0, 0 }, /* 0xEE */ { 0, 0, 0, 0, 0 }, /* 0xEF */ { 0, 0, 0, 0, 0 }, /* 0xF0 */ { 0, 0, 0, 0, 0 }, /* 0xF1 */ { 0, 0, 0, 0, 0 }, /* 0xF2 */ { 0, 0, 0, 0, 0 }, /* 0xF3 */ { 0, 0, 0, 0, 0 }, /* 0xF4 */ { 0, 0, 0, 0, 0 }, /* 0xF5 */ { I_MGRP3, 1, 0, 0, 0 }, /* 0xF6 */ { I_MGRP3, 2, 0, 0, 0 }, /* 0xF7 */ { 0, 0, 0, 0, 0 }, /* 0xF8 */ { 0, 0, 0, 0, 0 }, /* 0xF9 */ { 0, 0, 0, 0, 0 }, /* 0xFA */ { 0, 0, 0, 0, 0 }, /* 0xFB */ { 0, 0, 0, 0, 0 }, /* 0xFC */ { 0, 0, 0, 0, 0 }, /* 0xFD */ { 0, 0, 0, 0, 0 }, /* 0xFE */ { 0, 0, 0, 0, 0 }, /* 0xFF */ }; static struct idata grp3[8] = { { I_IMMED, 0, O_M, O_I, F_TEST }, { 0, 0, 0, 0, 0 }, { I_NOMOR, 0, O_M, 0, F_NOT }, { I_NOMOR, 0, O_M, 0, F_NEG }, { 0, 0, 0, 0, 0 }, { 0, 0, 0, 0, 0 }, { 0, 0, 0, 0, 0 }, { 0, 0, 0, 0, 0 }, }; #define READ_NEXT_B(op,code) do { \ vmmerr_t err; \ err = read_next_b (op, (u8 *)(code)); \ if (err) \ return err; \ } while (0) #define READ_NEXT_W(op,code) do { \ READ_NEXT_B (op, ((u8 *)(code)) + 0); \ READ_NEXT_B (op, ((u8 *)(code)) + 1); \ } while (0) #define READ_NEXT_L(op,code) do { \ READ_NEXT_W (op, ((u8 *)(code)) + 0); \ READ_NEXT_W (op, ((u8 *)(code)) + 2); \ } while (0) #define GET_MODRM(op) do { \ vmmerr_t err; \ err = get_modrm (op); \ if (err) \ return err; \ } while (0) #define UPDATE_IP(op) current->vmctl.write_ip (op->ip + op->ip_off) #define LGUESTSEG_READ_B(op,p,offset,data) do { \ if (op->longmode) { \ ulong base; \ current->vmctl.read_sreg_base (p, &base); \ RIE (read_linearaddr_b (base + (offset), (data))); \ } else { \ GUESTSEG_READ_B (p, offset, data); \ } \ } while (0) #define LGUESTSEG_READ_W(op,p,offset,data) do { \ if (op->longmode) { \ ulong base; \ current->vmctl.read_sreg_base (p, &base); \ RIE (read_linearaddr_w (base + (offset), (data))); \ } else { \ GUESTSEG_READ_W (p, offset, data); \ } \ } while (0) #define LGUESTSEG_READ_L(op,p,offset,data) do { \ if (op->longmode) { \ ulong base; \ current->vmctl.read_sreg_base (p, &base); \ RIE (read_linearaddr_l (base + (offset), (data))); \ } else { \ GUESTSEG_READ_L (p, offset, data); \ } \ } while (0) #define LGUESTSEG_READ_Q(op,p,offset,data) do { \ if (op->longmode) { \ ulong base; \ current->vmctl.read_sreg_base (p, &base); \ RIE (read_linearaddr_q (base + (offset), (data))); \ } else { \ GUESTSEG_READ_Q (p, offset, data); \ } \ } while (0) #define LGUESTSEG_WRITE_B(op,p,offset,data) do { \ if (op->longmode) { \ ulong base; \ current->vmctl.read_sreg_base (p, &base); \ RIE (write_linearaddr_b (base + (offset), (data))); \ } else { \ GUESTSEG_WRITE_B (p, offset, data); \ } \ } while (0) #define LGUESTSEG_WRITE_W(op,p,offset,data) do { \ if (op->longmode) { \ ulong base; \ current->vmctl.read_sreg_base (p, &base); \ RIE (write_linearaddr_w (base + (offset), (data))); \ } else { \ GUESTSEG_WRITE_W (p, offset, data); \ } \ } while (0) #define LGUESTSEG_WRITE_L(op,p,offset,data) do { \ if (op->longmode) { \ ulong base; \ current->vmctl.read_sreg_base (p, &base); \ RIE (write_linearaddr_l (base + (offset), (data))); \ } else { \ GUESTSEG_WRITE_L (p, offset, data); \ } \ } while (0) #define LGUESTSEG_WRITE_Q(op,p,offset,data) do { \ if (op->longmode) { \ ulong base; \ current->vmctl.read_sreg_base (p, &base); \ RIE (write_linearaddr_q (base + (offset), (data))); \ } else { \ GUESTSEG_WRITE_Q (p, offset, data); \ } \ } while (0) static vmmerr_t read_next_b (struct op *op, u8 *data) { return cpu_seg_read_b (SREG_CS, op->ip + op->ip_off++, data); } static ulong get_reg (struct op *op, enum reg reg) { ulong tmp; VAR_IS_INITIALIZED(tmp); switch (reg) { case REG_AX: current->vmctl.read_general_reg (GENERAL_REG_RAX, &tmp); break; case REG_CX: current->vmctl.read_general_reg (GENERAL_REG_RCX, &tmp); break; case REG_DX: current->vmctl.read_general_reg (GENERAL_REG_RDX, &tmp); break; case REG_BX: current->vmctl.read_general_reg (GENERAL_REG_RBX, &tmp); break; case REG_SP: current->vmctl.read_general_reg (GENERAL_REG_RSP, &tmp); break; case REG_BP: current->vmctl.read_general_reg (GENERAL_REG_RBP, &tmp); break; case REG_SI: current->vmctl.read_general_reg (GENERAL_REG_RSI, &tmp); break; case REG_DI: current->vmctl.read_general_reg (GENERAL_REG_RDI, &tmp); break; case REG_08: current->vmctl.read_general_reg (GENERAL_REG_R8, &tmp); break; case REG_09: current->vmctl.read_general_reg (GENERAL_REG_R9, &tmp); break; case REG_10: current->vmctl.read_general_reg (GENERAL_REG_R10, &tmp); break; case REG_11: current->vmctl.read_general_reg (GENERAL_REG_R11, &tmp); break; case REG_12: current->vmctl.read_general_reg (GENERAL_REG_R12, &tmp); break; case REG_13: current->vmctl.read_general_reg (GENERAL_REG_R13, &tmp); break; case REG_14: current->vmctl.read_general_reg (GENERAL_REG_R14, &tmp); break; case REG_15: current->vmctl.read_general_reg (GENERAL_REG_R15, &tmp); break; case REG_NO: tmp = 0; break; } return tmp; } static void set_reg64 (struct op *op, enum reg reg, ulong data) { switch (reg) { case REG_AX: current->vmctl.write_general_reg (GENERAL_REG_RAX, data); break; case REG_CX: current->vmctl.write_general_reg (GENERAL_REG_RCX, data); break; case REG_DX: current->vmctl.write_general_reg (GENERAL_REG_RDX, data); break; case REG_BX: current->vmctl.write_general_reg (GENERAL_REG_RBX, data); break; case REG_SP: current->vmctl.write_general_reg (GENERAL_REG_RSP, data); break; case REG_BP: current->vmctl.write_general_reg (GENERAL_REG_RBP, data); break; case REG_SI: current->vmctl.write_general_reg (GENERAL_REG_RSI, data); break; case REG_DI: current->vmctl.write_general_reg (GENERAL_REG_RDI, data); break; case REG_08: current->vmctl.write_general_reg (GENERAL_REG_R8, data); break; case REG_09: current->vmctl.write_general_reg (GENERAL_REG_R9, data); break; case REG_10: current->vmctl.write_general_reg (GENERAL_REG_R10, data); break; case REG_11: current->vmctl.write_general_reg (GENERAL_REG_R11, data); break; case REG_12: current->vmctl.write_general_reg (GENERAL_REG_R12, data); break; case REG_13: current->vmctl.write_general_reg (GENERAL_REG_R13, data); break; case REG_14: current->vmctl.write_general_reg (GENERAL_REG_R14, data); break; case REG_15: current->vmctl.write_general_reg (GENERAL_REG_R15, data); break; case REG_NO: break; } } static void set_reg16 (struct op *op, enum reg reg, u16 d16) { ulong dlong; dlong = get_reg (op, reg); dlong = modify_ulong_u16(dlong, d16); set_reg64 (op, reg, dlong); } static void set_reg32 (struct op *op, enum reg reg, u32 d32) { ulong dlong; dlong = get_reg (op, reg); dlong = modify_ulong_u32(dlong, d32); set_reg64 (op, reg, dlong); } static vmmerr_t get_modrm (struct op *op) { struct modrm_info *m; struct sibbase_info *sb; struct sibscale_info *ss; int displen; enum sreg defseg; u64 addr; i8 tmp1; i16 tmp2; op->reg = op->modrm.reg + (op->prefix.rex.b.r << 3); if (op->modrm.mod == 3) { /* Register-Register Addressing (No Memory Operand) */ op->rm_reg = op->modrm.rm + (op->prefix.rex.b.b << 3); return VMMERR_SUCCESS; } op->rm_reg = REG_NO; if (op->addrtype == ADDRTYPE_16BIT) m = &modrmmatrix16[op->modrm.mod][op->modrm.rm]; else m = &modrmmatrix32[op->modrm.mod][op->prefix.rex.b.b] [op->modrm.rm]; displen = m->displen; defseg = m->defseg; if (m->sibflag) { READ_NEXT_B (op, &op->sib); sb = &sibmatrix_base[op->modrm.mod][op->prefix.rex.b.b] [op->sib.base]; ss = &sib_scale[op->prefix.rex.b.x][op->sib.index]; displen = sb->displen; defseg = sb->defseg; addr = (get_reg (op, ss->reg) << op->sib.scale) + get_reg (op, sb->reg); } else { addr = get_reg (op, m->reg1) + get_reg (op, m->reg2); } switch (displen) { case 1: READ_NEXT_B (op, &tmp1); op->disp = tmp1; break; case 2: READ_NEXT_W (op, &tmp2); op->disp = tmp2; break; case 4: READ_NEXT_L (op, &op->disp); break; default: op->disp = 0; } addr += op->disp; if (op->longmode && m->ripflag) addr += op->ip + op->ip_off; /* DONT USE READ_NEXT AFTER THIS */ if (op->addrtype == ADDRTYPE_16BIT) addr &= 0xFFFF; else if (op->addrtype == ADDRTYPE_32BIT) addr &= 0xFFFFFFFF; op->rm_off = addr; if (op->prefix.seg != SREG_DEFAULT) op->rm_seg = op->prefix.seg; else op->rm_seg = defseg; return VMMERR_SUCCESS; } static vmmerr_t read_moffs (struct op *op) { u32 moffs = 0; op->rm_reg = REG_NO; if (op->addrtype == ADDRTYPE_16BIT) READ_NEXT_W (op, &moffs); else READ_NEXT_L (op, &moffs); op->rm_off = moffs; if (op->prefix.seg != SREG_DEFAULT) op->rm_seg = op->prefix.seg; else op->rm_seg = SREG_DS; return VMMERR_SUCCESS; } static void clear_prefix (struct prefix *p) { p->seg = SREG_DEFAULT; p->lock = 0; p->repne = 0; p->repe = 0; p->opsize = 0; p->addrsize = 0; p->rex.v.val = 0; } #define DEBUG_UNIMPLEMENTED() do { \ panic ("DEBUG: file %s line %d function %s NOT IMPLEMENTED", \ __FILE__, __LINE__, __FUNCTION__); \ } while (0) /* #define DEBUG_UNSUPPORTED(fmt, args...) do { \ printf("DEBUG: " fmt, args); \ } while (0) */ #define DEBUG_UNSUPPORTED(fmt, args...); static vmmerr_t opcode_hlt (struct op *op) { UPDATE_IP (op); cpu_emul_hlt (); return VMMERR_SUCCESS; } static vmmerr_t opcode_cli (struct op *op) { UPDATE_IP (op); cpu_emul_cli (); return VMMERR_SUCCESS; } static vmmerr_t opcode_sti (struct op *op) { UPDATE_IP (op); cpu_emul_sti (); return VMMERR_SUCCESS; } static vmmerr_t opcode_pushf (struct op *op) { ulong rflags; struct cpu_stack st; if (op->longmode) panic ("64bit PUSHF not supported"); RIE (cpu_stack_get (&st)); current->vmctl.read_flags (&rflags); rflags &= ~(RFLAGS_VM_BIT | RFLAGS_RF_BIT); RIE (cpu_stack_push (&st, &rflags, op->optype)); RIE (cpu_stack_set (&st)); UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_popf (struct op *op) { ulong rflags, orflags; struct cpu_stack st; if (op->longmode) panic ("64bit POPF not supported"); RIE (cpu_stack_get (&st)); current->vmctl.read_flags (&rflags); orflags = rflags; RIE (cpu_stack_pop (&st, &rflags, op->optype)); rflags &= RFLAGS_SYS_MASK | RFLAGS_NONSYS_MASK; rflags |= RFLAGS_ALWAYS1_BIT; rflags &= ~(RFLAGS_RF_BIT | RFLAGS_VM_BIT | RFLAGS_VIF_BIT | RFLAGS_VIP_BIT | RFLAGS_IOPL_MASK); rflags |= orflags & (RFLAGS_RF_BIT | RFLAGS_VM_BIT | RFLAGS_VIF_BIT | RFLAGS_VIP_BIT | RFLAGS_IOPL_MASK); current->vmctl.write_flags (rflags); UPDATE_IP (op); RIE (cpu_stack_set (&st)); if (rflags & RFLAGS_IF_BIT) { /* FIXME: interrupts must be delayed */ cpu_emul_sti (); } return VMMERR_SUCCESS; } static vmmerr_t opcode_iret (struct op *op) { ulong rip, rflags, orflags; u16 cs; struct cpu_stack st; if (op->longmode) panic ("64bit IRET not supported"); if (op->mode == CPUMODE_REAL) { RIE (cpu_stack_get (&st)); current->vmctl.read_flags (&rflags); orflags = rflags; rip = 0; cs = 0; RIE (cpu_stack_pop (&st, &rip, op->optype)); RIE (cpu_stack_pop (&st, &cs, op->optype)); RIE (cpu_stack_pop (&st, &rflags, op->optype)); cs &= 0xFFFF; rflags &= RFLAGS_SYS_MASK | RFLAGS_NONSYS_MASK; rflags |= RFLAGS_ALWAYS1_BIT; rflags &= ~(RFLAGS_RF_BIT | RFLAGS_VM_BIT | RFLAGS_VIF_BIT | RFLAGS_VIP_BIT | RFLAGS_IOPL_MASK); rflags |= orflags & (RFLAGS_RF_BIT | RFLAGS_VM_BIT | RFLAGS_VIF_BIT | RFLAGS_VIP_BIT | RFLAGS_IOPL_MASK); current->vmctl.write_flags (rflags); current->vmctl.write_realmode_seg (SREG_CS, cs); current->vmctl.write_ip (rip); RIE (cpu_stack_set (&st)); if (rflags & RFLAGS_IF_BIT) { cpu_emul_sti (); } return VMMERR_SUCCESS; } DEBUG_UNIMPLEMENTED (); return VMMERR_UNIMPLEMENTED_OPCODE; } static vmmerr_t opcode_int (struct op *op) { op->imm &= 0xFF; if (op->mode == CPUMODE_REAL) { UPDATE_IP (op); RET_IF_ERR (cpu_emul_realmode_int (op->imm)); return VMMERR_SUCCESS; } DEBUG_UNIMPLEMENTED (); return VMMERR_UNIMPLEMENTED_OPCODE; } static vmmerr_t opcode_int3 (struct op *op) { if (op->mode == CPUMODE_REAL) { UPDATE_IP (op); RET_IF_ERR (cpu_emul_realmode_int (3)); return VMMERR_SUCCESS; } DEBUG_UNIMPLEMENTED (); return VMMERR_UNIMPLEMENTED_OPCODE; } static vmmerr_t opcode_into (struct op *op) { DEBUG_UNIMPLEMENTED (); return VMMERR_UNIMPLEMENTED_OPCODE; } static void execinst_io (void *execdata, void *data, u32 len) { struct execinst_io_data *e; ulong rdx; e = (struct execinst_io_data *)execdata; current->vmctl.read_general_reg (GENERAL_REG_RDX, &rdx); call_io (e->type, rdx & 0xFFFF, data); } static vmmerr_t string_instruction (struct op *op, bool rd, bool wr, u32 len, void *execdata, void (*execinst) (void *execdata, void *data, u32 len)) { u64 data; enum sreg segr, segw; ulong offr, offw; ulong rflags; ulong cnt; ulong regr, regw, rcx; enum general_reg regrn, regwn; int loopcount = 16; /* no interrupts are accepted in this loop */ VAR_IS_INITIALIZED (segr); VAR_IS_INITIALIZED (offr); VAR_IS_INITIALIZED (offw); current->vmctl.read_flags (&rflags); if (wr) { segw = SREG_ES; regwn = GENERAL_REG_RDI; current->vmctl.read_general_reg (regwn, ®w); } if (rd) { if (op->prefix.seg == SREG_DEFAULT) segr = SREG_DS; else segr = op->prefix.seg; regrn = GENERAL_REG_RSI; current->vmctl.read_general_reg (regrn, ®r); } reploop: if (op->prefix.repe || op->prefix.repne) { current->vmctl.read_general_reg (GENERAL_REG_RCX, &rcx); cnt = rcx; if (op->reptype == REPTYPE_16BIT) cnt &= 0xFFFF; else if (op->reptype == REPTYPE_32BIT) cnt &= 0xFFFFFFFF; if (!cnt) goto rcxz; } else { cnt = 0; } if (rd) { if (op->addrtype == ADDRTYPE_16BIT) offr = regr & 0xffff; else if (op->addrtype == ADDRTYPE_32BIT) offr = regr & 0xffffffff; else offr = regr; switch (len) { case 1: LGUESTSEG_READ_B(op, segr, offr, (u8 *)(void *)&data); break; case 2: LGUESTSEG_READ_W(op, segr, offr, (u16 *)(void *)&data); break; case 4: LGUESTSEG_READ_L(op, segr, offr, (u32 *)(void *)&data); break; case 8: LGUESTSEG_READ_Q(op, segr, offr, (u64 *)(void *)&data); break; } } execinst (execdata, &data, len); if (wr) { if (op->addrtype == ADDRTYPE_16BIT) offw = regw & 0xffff; else if (op->addrtype == ADDRTYPE_32BIT) offw = regw & 0xffffffff; else offw = regw; switch (len) { case 1: LGUESTSEG_WRITE_B (op, segw, offw, data); break; case 2: LGUESTSEG_WRITE_W (op, segw, offw, data); break; case 4: LGUESTSEG_WRITE_L (op, segw, offw, data); break; case 8: LGUESTSEG_WRITE_Q (op, segw, offw, data); break; } } if (op->prefix.repe || op->prefix.repne) { cnt--; if (op->reptype == REPTYPE_16BIT) rcx = modify_ulong_u16(rcx, cnt); else if (op->reptype == REPTYPE_32BIT) rcx = modify_ulong_u32(rcx, cnt); else rcx = cnt; current->vmctl.write_general_reg (GENERAL_REG_RCX, rcx); } if (rflags & RFLAGS_DF_BIT) { if (rd) offr -= len; if (wr) offw -= len; } else { if (rd) offr += len; if (wr) offw += len; } if (op->addrtype == ADDRTYPE_16BIT) { if (rd) regr = modify_ulong_u16(regr, offr); if (wr) regw = modify_ulong_u16(regr, offw); } else if (op->addrtype == ADDRTYPE_32BIT) { if (rd) regr = modify_ulong_u32(regr, offr); if (wr) regw = modify_ulong_u32(regr, offw); } else { if (rd) regr = offr; if (wr) regw = offw; } if (cnt && loopcount) { if (rflags & RFLAGS_IF_BIT) loopcount--; goto reploop; } if (rd) current->vmctl.write_general_reg (regrn, regr); if (wr) current->vmctl.write_general_reg (regwn, regw); rcxz: if (!cnt) UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t io_str (struct op *op, iotype_t type, u32 len) { struct execinst_io_data d; bool wr; d.type = type; switch (type) { case IOTYPE_INB: case IOTYPE_INW: case IOTYPE_INL: wr = true; break; case IOTYPE_OUTB: case IOTYPE_OUTW: case IOTYPE_OUTL: wr = false; break; default: return VMMERR_AVOID_COMPILER_WARNING; } return string_instruction (op, !wr, wr, len, &d, execinst_io); } static vmmerr_t opcode_inb_imm (struct op *op) { ulong rax; current->vmctl.read_general_reg (GENERAL_REG_RAX, &rax); current->updateip = false; call_io (IOTYPE_INB, op->imm & 0xFF, &rax); current->vmctl.write_general_reg (GENERAL_REG_RAX, rax); if (!current->updateip) UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_in_imm (struct op *op) { ulong rax; if (op->optype == OPTYPE_64BIT) op->optype = OPTYPE_32BIT; if (op->optype == OPTYPE_32BIT) rax = 0; else current->vmctl.read_general_reg (GENERAL_REG_RAX, &rax); current->updateip = false; if (op->optype == OPTYPE_16BIT) call_io (IOTYPE_INW, op->imm & 0xFF, &rax); else call_io (IOTYPE_INL, op->imm & 0xFF, &rax); current->vmctl.write_general_reg (GENERAL_REG_RAX, rax); if (!current->updateip) UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_inb_dx (struct op *op) { ulong rax, rdx; current->vmctl.read_general_reg (GENERAL_REG_RAX, &rax); current->vmctl.read_general_reg (GENERAL_REG_RDX, &rdx); current->updateip = false; call_io (IOTYPE_INB, rdx & 0xFFFF, &rax); current->vmctl.write_general_reg (GENERAL_REG_RAX, rax); if (!current->updateip) UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_in_dx (struct op *op) { ulong rax, rdx; current->vmctl.read_general_reg (GENERAL_REG_RDX, &rdx); if (op->optype == OPTYPE_64BIT) op->optype = OPTYPE_32BIT; if (op->optype == OPTYPE_32BIT) rax = 0; else current->vmctl.read_general_reg (GENERAL_REG_RAX, &rax); current->updateip = false; if (op->optype == OPTYPE_16BIT) call_io (IOTYPE_INW, rdx & 0xFFFF, &rax); else call_io (IOTYPE_INL, rdx & 0xFFFF, &rax); current->vmctl.write_general_reg (GENERAL_REG_RAX, rax); if (!current->updateip) UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_insb (struct op *op) { return io_str (op, IOTYPE_INB, 1); } static vmmerr_t opcode_ins (struct op *op) { if (op->optype == OPTYPE_64BIT) op->optype = OPTYPE_32BIT; if (op->optype == OPTYPE_16BIT) return io_str (op, IOTYPE_INW, 2); else return io_str (op, IOTYPE_INL, 4); } static vmmerr_t opcode_outb_imm (struct op *op) { ulong rax; current->vmctl.read_general_reg (GENERAL_REG_RAX, &rax); current->updateip = false; call_io (IOTYPE_OUTB, op->imm & 0xFF, &rax); if (!current->updateip) UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_out_imm (struct op *op) { ulong rax; current->vmctl.read_general_reg (GENERAL_REG_RAX, &rax); if (op->optype == OPTYPE_64BIT) op->optype = OPTYPE_32BIT; current->updateip = false; if (op->optype == OPTYPE_16BIT) call_io (IOTYPE_OUTW, op->imm & 0xFF, &rax); else call_io (IOTYPE_OUTL, op->imm & 0xFF, &rax); if (!current->updateip) UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_outb_dx (struct op *op) { ulong rax, rdx; current->vmctl.read_general_reg (GENERAL_REG_RAX, &rax); current->vmctl.read_general_reg (GENERAL_REG_RDX, &rdx); current->updateip = false; call_io (IOTYPE_OUTB, rdx & 0xFFFF, &rax); if (!current->updateip) UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_out_dx (struct op *op) { ulong rax, rdx; current->vmctl.read_general_reg (GENERAL_REG_RAX, &rax); current->vmctl.read_general_reg (GENERAL_REG_RDX, &rdx); if (op->optype == OPTYPE_64BIT) op->optype = OPTYPE_32BIT; current->updateip = false; if (op->optype == OPTYPE_16BIT) call_io (IOTYPE_OUTW, rdx & 0xFFFF, &rax); else call_io (IOTYPE_OUTL, rdx & 0xFFFF, &rax); if (!current->updateip) UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_outsb (struct op *op) { return io_str (op, IOTYPE_OUTB, 1); } static vmmerr_t opcode_outs (struct op *op) { if (op->optype == OPTYPE_64BIT) op->optype = OPTYPE_32BIT; if (op->optype == OPTYPE_16BIT) return io_str (op, IOTYPE_OUTW, 2); else return io_str (op, IOTYPE_OUTL, 4); } static vmmerr_t opcode_mov_to_cr (struct op *op) { ulong cr; if (op->modrm.mod != 3) return VMMERR_EXCEPTION_UD; cr = get_reg (op, op->rm_reg); if (op->addrtype != ADDRTYPE_64BIT) cr &= 0xFFFFFFFF; current->vmctl.write_control_reg (op->reg, cr); UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_mov_from_cr (struct op *op) { ulong cr; if (op->modrm.mod != 3) return VMMERR_EXCEPTION_UD; current->vmctl.read_control_reg (op->reg, &cr); set_reg64 (op, op->rm_reg, cr); UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_mov_to_dr (struct op *op) { DEBUG_UNIMPLEMENTED (); return VMMERR_UNIMPLEMENTED_OPCODE; } static vmmerr_t opcode_mov_from_dr (struct op *op) { DEBUG_UNIMPLEMENTED (); return VMMERR_UNIMPLEMENTED_OPCODE; } static vmmerr_t opcode_clts (struct op *op) { ulong val; current->vmctl.read_control_reg (CONTROL_REG_CR0, &val); val &= ~CR0_TS_BIT; current->vmctl.write_control_reg (CONTROL_REG_CR0, val); UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_invd (struct op *op) { DEBUG_UNIMPLEMENTED (); return VMMERR_UNIMPLEMENTED_OPCODE; } static vmmerr_t opcode_wbinvd (struct op *op) { asm_wbinvd (); UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_rdmsr (struct op *op) { if (cpu_emul_rdmsr ()) return VMMERR_MSR_FAULT; UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_wrmsr (struct op *op) { if (cpu_emul_wrmsr ()) return VMMERR_MSR_FAULT; UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_lgdt (struct op *op) { u16 limit; u32 base; if (op->rm_reg != REG_NO) return VMMERR_EXCEPTION_UD; if (op->optype == OPTYPE_64BIT) panic ("64bit LGDT not supported"); if (op->optype == OPTYPE_16BIT) { RIE (cpu_seg_read_w (op->rm_seg, op->rm_off, &limit)); RIE (cpu_seg_read_l (op->rm_seg, op->rm_off + 2, &base)); base &= 0x00FFFFFF; } else { RIE (cpu_seg_read_w (op->rm_seg, op->rm_off, &limit)); RIE (cpu_seg_read_l (op->rm_seg, op->rm_off + 2, &base)); } current->vmctl.write_gdtr (base, limit); UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_lidt (struct op *op) { u16 limit; u32 base; if (op->rm_reg != REG_NO) return VMMERR_EXCEPTION_UD; if (op->optype == OPTYPE_64BIT) panic ("64bit LIDT not supported"); if (op->optype == OPTYPE_16BIT) { RIE (cpu_seg_read_w (op->rm_seg, op->rm_off, &limit)); RIE (cpu_seg_read_l (op->rm_seg, op->rm_off + 2, &base)); base &= 0x00FFFFFF; } else { RIE (cpu_seg_read_w (op->rm_seg, op->rm_off, &limit)); RIE (cpu_seg_read_l (op->rm_seg, op->rm_off + 2, &base)); } current->vmctl.write_idtr (base, limit); UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_smsw (struct op *op) { ulong cr; current->vmctl.read_control_reg (CONTROL_REG_CR0, &cr); if (op->rm_reg == REG_NO) LGUESTSEG_WRITE_W (op, op->rm_seg, op->rm_off, cr); else set_reg64 (op, op->rm_reg, cr); UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_lmsw (struct op *op) { u16 data; ulong cr; if (op->rm_reg == REG_NO) LGUESTSEG_READ_W (op, op->rm_seg, op->rm_off, &data); else data = get_reg (op, op->rm_reg); current->vmctl.read_control_reg (CONTROL_REG_CR0, &cr); cr &= ~0xFFFF; cr |= data & 0xFFFF; current->vmctl.write_control_reg (CONTROL_REG_CR0, cr); UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_invlpg (struct op *op) { ulong base; current->vmctl.read_sreg_base (op->rm_seg, &base); current->vmctl.invlpg (base + op->rm_off); UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_mov_from_sr (struct op *op) { u16 sel; current->vmctl.read_sreg_sel (op->reg, &sel); if (op->rm_reg == REG_NO) LGUESTSEG_WRITE_W (op, op->rm_seg, op->rm_off, sel); else if (op->optype == OPTYPE_16BIT) set_reg16 (op, op->rm_reg, sel); else set_reg64 (op, op->rm_reg, sel); UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_mov_to_sr (struct op *op) { vmmerr_t err; /* FIXME: interrupts must be delayed after writing SS register */ err = current->vmctl.writing_sreg ((enum sreg)op->reg); if (err == VMMERR_SW) return err; DEBUG_UNIMPLEMENTED (); return VMMERR_UNIMPLEMENTED_OPCODE; } static vmmerr_t opcode_push_sr (struct op *op, enum sreg seg) { u32 sel32; u16 sel16; struct cpu_stack st; if (op->longmode) panic ("64bit PUSH SREG not supported"); current->vmctl.read_sreg_sel (seg, &sel16); sel32 = sel16; RIE (cpu_stack_get (&st)); RIE (cpu_stack_push (&st, &sel32, op->optype)); RIE (cpu_stack_set (&st)); UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_pop_sr (struct op *op, enum sreg seg) { vmmerr_t err; if (op->longmode) panic ("64bit POP SREG not supported"); /* FIXME: interrupts must be delayed after writing SS register */ err = current->vmctl.writing_sreg (seg); if (err == VMMERR_SW) return err; DEBUG_UNIMPLEMENTED (); return VMMERR_UNIMPLEMENTED_OPCODE; } static vmmerr_t opcode_jmp_far_direct (struct op *op) { vmmerr_t err; err = current->vmctl.writing_sreg (SREG_CS); if (err == VMMERR_SW) return err; DEBUG_UNIMPLEMENTED (); return VMMERR_UNIMPLEMENTED_OPCODE; } static vmmerr_t opcode_jmp_far_indirect (struct op *op) { vmmerr_t err; err = current->vmctl.writing_sreg (SREG_CS); if (err == VMMERR_SW) return err; DEBUG_UNIMPLEMENTED (); return VMMERR_UNIMPLEMENTED_OPCODE; } static vmmerr_t opcode_retf (struct op *op) { vmmerr_t err; err = current->vmctl.writing_sreg (SREG_CS); if (err == VMMERR_SW) return err; DEBUG_UNIMPLEMENTED (); return VMMERR_UNIMPLEMENTED_OPCODE; } static void execinst_stos (void *execdata, void *data, u32 len) { current->vmctl.read_general_reg (GENERAL_REG_RAX, data); } static void execinst_movs (void *execdata, void *data, u32 len) { } static vmmerr_t opcode_stosb (struct op *op) { return string_instruction (op, false, true, 1, NULL, execinst_stos); } static vmmerr_t opcode_stos (struct op *op) { u32 len; if (op->optype == OPTYPE_16BIT) len = 2; else if (op->optype == OPTYPE_32BIT) len = 4; else len = 8; return string_instruction (op, false, true, len, NULL, execinst_stos); } static vmmerr_t opcode_movsb (struct op *op) { return string_instruction (op, true, true, 1, NULL, execinst_movs); } static vmmerr_t opcode_movs (struct op *op) { u32 len; if (op->optype == OPTYPE_16BIT) len = 2; else if (op->optype == OPTYPE_32BIT) len = 4; else len = 8; return string_instruction (op, true, true, len, NULL, execinst_movs); } static enum general_reg reg8_general_reg (enum reg8 r8) { switch (r8) { case REG_AL: case REG_AH: return GENERAL_REG_RAX; case REG_CL: case REG_CH: return GENERAL_REG_RCX; case REG_DL: case REG_DH: return GENERAL_REG_RDX; case REG_BL: case REG_BH: return GENERAL_REG_RBX; } return 0; } static u8 * reg8_dp (enum reg8 r8, ulong *data) { switch (r8) { case REG_AL: case REG_CL: case REG_DL: case REG_BL: return &((u8 *)data)[0]; case REG_AH: case REG_CH: case REG_DH: case REG_BH: return &((u8 *)data)[1]; } return NULL; } static u8 get_reg8 (struct op *op, enum reg8 r8) { ulong dlong; enum general_reg reg; u8 *dp; reg = reg8_general_reg (r8); dp = reg8_dp (r8, &dlong); current->vmctl.read_general_reg (reg, &dlong); return *dp; } static void set_reg8 (struct op *op, enum reg8 r8, u8 d8) { ulong dlong; enum general_reg reg; u8 *dp; reg = reg8_general_reg (r8); dp = reg8_dp (r8, &dlong); current->vmctl.read_general_reg (reg, &dlong); *dp = d8; current->vmctl.write_general_reg (reg, dlong); } static vmmerr_t read_rm8 (struct op *op, u8 *d8) { if (op->rm_reg == REG_NO) LGUESTSEG_READ_B (op, op->rm_seg, op->rm_off, d8); else *d8 = get_reg8 (op, op->rm_reg); return VMMERR_SUCCESS; } static vmmerr_t read_rm16 (struct op *op, u16 *d16) { if (op->rm_reg == REG_NO) LGUESTSEG_READ_W (op, op->rm_seg, op->rm_off, d16); else *d16 = get_reg (op, op->rm_reg); return VMMERR_SUCCESS; } static vmmerr_t read_rm32 (struct op *op, u32 *d) { if (op->rm_reg == REG_NO) LGUESTSEG_READ_L (op, op->rm_seg, op->rm_off, d); else *d = get_reg (op, op->rm_reg); return VMMERR_SUCCESS; } static vmmerr_t read_rm64 (struct op *op, u64 *d64) { if (op->rm_reg == REG_NO) LGUESTSEG_READ_Q (op, op->rm_seg, op->rm_off, d64); else *d64 = get_reg (op, op->rm_reg); return VMMERR_SUCCESS; } static vmmerr_t write_rm8 (struct op *op, u8 d8) { if (op->rm_reg == REG_NO) LGUESTSEG_WRITE_B (op, op->rm_seg, op->rm_off, d8); else set_reg8 (op, op->rm_reg, d8); return VMMERR_SUCCESS; } static vmmerr_t write_rm16 (struct op *op, u16 d16) { if (op->rm_reg == REG_NO) LGUESTSEG_WRITE_W (op, op->rm_seg, op->rm_off, d16); else set_reg16 (op, op->rm_reg, d16); return VMMERR_SUCCESS; } static vmmerr_t write_rm32 (struct op *op, u32 d) { if (op->rm_reg == REG_NO) LGUESTSEG_WRITE_L (op, op->rm_seg, op->rm_off, d); else set_reg32 (op, op->rm_reg, d); return VMMERR_SUCCESS; } static vmmerr_t write_rm64 (struct op *op, u64 d64) { if (op->rm_reg == REG_NO) LGUESTSEG_WRITE_Q (op, op->rm_seg, op->rm_off, d64); else set_reg64 (op, op->rm_reg, d64); return VMMERR_SUCCESS; } static vmmerr_t opcode_movzx_rm8_to_r (struct op *op) { u8 d8; u64 d; RIE (read_rm8 (op, &d8)); d = d8; switch (op->optype) { case OPTYPE_16BIT: set_reg16 (op, op->reg, d); break; case OPTYPE_32BIT: set_reg32 (op, op->reg, d); break; case OPTYPE_64BIT: set_reg64 (op, op->reg, d); break; default: panic ("opcode_movzx_rm8_to_r: Invalid optype %d", op->optype); } UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_movzx_rm16_to_r (struct op *op) { u16 d16; u64 d; RIE (read_rm16 (op, &d16)); d = d16; switch (op->optype) { case OPTYPE_16BIT: set_reg16 (op, op->reg, d); break; case OPTYPE_32BIT: set_reg32 (op, op->reg, d); break; case OPTYPE_64BIT: set_reg64 (op, op->reg, d); break; default: panic ("opcode_movzx_rm8_to_r: Invalid optype %d", op->optype); } UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_ff_push (struct op *op) { u32 data; u16 data16; struct cpu_stack st; if (op->longmode) panic ("64bit PUSH not supported"); if (op->optype == OPTYPE_16BIT) { RIE (read_rm16 (op, &data16)); data = data16; } else { RIE (read_rm32 (op, &data)); } RIE (cpu_stack_get (&st)); RIE (cpu_stack_push (&st, &data, op->optype)); RIE (cpu_stack_set (&st)); UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t opcode_8f_pop (struct op *op) { u32 data; u16 data16; struct cpu_stack st; if (op->longmode) panic ("64bit POP not supported"); RIE (cpu_stack_get (&st)); RIE (cpu_stack_pop (&st, &data, op->optype)); if (op->optype == OPTYPE_16BIT) { data16 = data; RIE (write_rm16 (op, data16)); } else { RIE (write_rm32 (op, data)); } UPDATE_IP (op); RIE (cpu_stack_set (&st)); return VMMERR_SUCCESS; } static vmmerr_t opcode_0f_lss (struct op *op) { u32 data; u16 data16; u16 seg; if (op->longmode) panic ("64bit LSS(0F) not supported"); if (op->rm_reg != REG_NO) panic ("LSS(0F) reg"); if (op->mode != CPUMODE_REAL) panic ("LSS(0F) protected mode"); if (op->optype == OPTYPE_16BIT) { RIE (read_rm16 (op, &data16)); op->rm_off += 2; RIE (read_rm16 (op, &seg)); current->vmctl.write_realmode_seg (SREG_SS, seg); set_reg16 (op, op->reg, data16); } else { RIE (read_rm32 (op, &data)); op->rm_off += 4; RIE (read_rm16 (op, &seg)); current->vmctl.write_realmode_seg (SREG_SS, seg); set_reg32 (op, op->reg, data); } UPDATE_IP (op); return VMMERR_SUCCESS; } static vmmerr_t idata_rd (struct op *op, enum idata_operand operand, int length, void *pointer) { switch (operand) { case O_ZERO: default: panic ("idata_rd operand %d error!", operand); case O_M: if (length == 1) RIE (read_rm8 (op, (u8 *)pointer)); else if (op->optype == OPTYPE_16BIT) RIE (read_rm16 (op, (u16 *)pointer)); else if (op->optype == OPTYPE_32BIT) RIE (read_rm32 (op, (u32 *)pointer)); else RIE (read_rm64 (op, (u64 *)pointer)); break; case O_R: if (length == 1) *(u8 *)pointer = get_reg8 (op, (enum reg8) op->reg); else if (op->optype == OPTYPE_16BIT) *(u16 *)pointer = get_reg (op, op->reg); else if (op->optype == OPTYPE_32BIT) *(u32 *)pointer = get_reg (op, op->reg); else *(u64 *)pointer = get_reg (op, op->reg); break; case O_A: if (length == 1) *(u8 *)pointer = get_reg8 (op, REG_AL); else if (op->optype == OPTYPE_16BIT) *(u16 *)pointer = get_reg (op, REG_AX); else if (op->optype == OPTYPE_32BIT) *(u32 *)pointer = get_reg (op, REG_AX); else *(u64 *)pointer = get_reg (op, REG_AX); break; case O_I: if (length == 1) *(u8 *)pointer = op->imm; else if (op->optype == OPTYPE_16BIT) *(u16 *)pointer = op->imm; else if (op->optype == OPTYPE_32BIT) *(u32 *)pointer = op->imm; else *(u64 *)pointer = op->imm; break; case O_1: if (length == 1) *(u8 *)pointer = 1; else if (op->optype == OPTYPE_16BIT) *(u16 *)pointer = 1; else if (op->optype == OPTYPE_32BIT) *(u32 *)pointer = 1; else *(u64 *)pointer = 1; break; case O_C: if (length == 1) *(u8 *)pointer = get_reg8 (op, REG_CL); else panic ("read CX/ECX/RCX?"); break; } return VMMERR_SUCCESS; } static vmmerr_t idata_wr (struct op *op, enum idata_operand operand, int length, void *pointer) { switch (operand) { case O_ZERO: case O_I: case O_1: case O_C: default: panic ("idata_wr operand %d error!", operand); case O_M: if (length == 1) RIE (write_rm8 (op, *(u8 *)pointer)); else if (op->optype == OPTYPE_16BIT) RIE (write_rm16 (op, *(u16 *)pointer)); else if (op->optype == OPTYPE_32BIT) RIE (write_rm32 (op, *(u32 *)pointer)); else RIE (write_rm64 (op, *(u64 *)pointer)); break; case O_R: if (length == 1) set_reg8 (op, (enum reg8)op->reg, *(u8 *)pointer); else if (op->optype == OPTYPE_16BIT) set_reg16 (op, op->reg, *(u16 *)pointer); else if (op->optype == OPTYPE_32BIT) set_reg32 (op, op->reg, *(u32 *)pointer); else set_reg64 (op, op->reg, *(u64 *)pointer); break; case O_A: if (length == 1) set_reg8 (op, REG_AL, *(u8 *)pointer); else if (op->optype == OPTYPE_16BIT) set_reg16 (op, REG_AX, *(u16 *)pointer); else if (op->optype == OPTYPE_32BIT) set_reg32 (op, REG_AX, *(u32 *)pointer); else set_reg64 (op, REG_AX, *(u64 *)pointer); break; } return VMMERR_SUCCESS; } static vmmerr_t opcode_idata (struct op *op, struct idata id) { enum idata_function grp1[8] = { F_ADD, F_OR, F_ADC, F_SBB, F_AND, F_SUB, F_XOR, F_CMP, }; enum idata_function grp2[8] = { F_ROL, F_ROR, F_RCL, F_RCR, F_SHL, F_SHR, F_SHL, F_SAR, }; #ifdef __x86_64__ u64 src, dst; #else u32 src, dst; #endif const ulong flagmask = RFLAGS_CF_BIT | RFLAGS_PF_BIT | RFLAGS_AF_BIT | RFLAGS_ZF_BIT | RFLAGS_SF_BIT | RFLAGS_DF_BIT | RFLAGS_OF_BIT; ulong flags, newflags = ~(0UL), tmp; bool update_flags = false; #define DO_IDATA(op, rd1, rd2, doit, wr1, wr2) do { \ ID_RD_##rd1 (op); \ ID_RD_##rd2 (op); \ ID_##doit; \ ID_WR_##wr1 (op); \ ID_WR_##wr2 (op); \ } while (0) #define ID_RD_src(op) RIE (idata_rd (op, id.src, id.len, &src)) #define ID_RD_dst(op) RIE (idata_rd (op, id.dst, id.len, &dst)) #define ID_WR_src(op) RIE (idata_wr (op, id.src, id.len, &src)) #define ID_WR_dst(op) RIE (idata_wr (op, id.dst, id.len, &dst)) #define ID_RD_(op) do; while (0) #define ID_WR_(op) do; while (0) #ifdef __x86_64__ #define ID_2OP_2(INSTRUCTION, size, prefix, suffix, src, dst) do { \ current->vmctl.read_flags (&flags); \ asm volatile ("pushfq \n" \ "andq %2, (%%rsp) \n" \ "orq %3, (%%rsp) \n" \ "popfq \n" \ INSTRUCTION size " %%" prefix "b" suffix ", %%" prefix "a" suffix " \n" \ "pushfq \n" \ "popq %0 \n" \ : "=&rm" (newflags) \ , "=&a" (dst) \ : "i" (~flagmask) \ , "r" (flags & flagmask) \ , "b" (src) \ , "1" (dst) \ : "cc"); \ newflags = (flags & ~flagmask) | (newflags & flagmask); \ update_flags = true; \ } while (0) #define ID_2OP(INSTRUCTION) do { \ if (id.len == 1) \ ID_2OP_2 (INSTRUCTION, "b", "", "l", src, dst); \ else if (op->optype == OPTYPE_16BIT) \ ID_2OP_2 (INSTRUCTION, "w", "", "x", src, dst); \ else if (op->optype == OPTYPE_32BIT) \ ID_2OP_2 (INSTRUCTION, "l", "e", "x", src, dst); \ else \ ID_2OP_2 (INSTRUCTION, "q", "r", "x", src, dst); \ } while (0) #else /* __x86_64__ */ #define ID_2OP_2(INSTRUCTION, size, prefix, suffix, src, dst) do { \ current->vmctl.read_flags (&flags); \ asm volatile ("pushfl \n" \ "andl %2, (%%esp) \n" \ "orl %3, (%%esp) \n" \ "popfl \n" \ INSTRUCTION size " %%" prefix "b" suffix ", %%" prefix "a" suffix " \n" \ "pushfl \n" \ "popl %0 \n" \ : "=&rm" (newflags) \ , "=&a" (dst) \ : "i" (~flagmask) \ , "r" (flags & flagmask) \ , "b" (src) \ , "1" (dst) \ : "cc"); \ newflags = (flags & ~flagmask) | (newflags & flagmask); \ update_flags = true; \ } while (0) #define ID_2OP(INSTRUCTION) do { \ if (id.len == 1) \ ID_2OP_2 (INSTRUCTION, "b", "", "l", src, dst); \ else if (op->optype == OPTYPE_16BIT) \ ID_2OP_2 (INSTRUCTION, "w", "", "x", src, dst); \ else \ ID_2OP_2 (INSTRUCTION, "l", "e", "x", src, dst); \ } while (0) #endif /* __x86_64__*/ #define ID_XCHG() do { \ tmp = dst; \ dst = src; \ src = tmp; \ } while (0) #define ID_MOV() dst = src grp_special: switch (id.func) { case F_ZERO: case F_NOT: case F_NEG: case F_ROL: case F_ROR: case F_RCL: case F_RCR: case F_SHL: case F_SHR: case F_SAR: default: DEBUG_UNSUPPORTED ("Unsupported opcode (func %d)\n", id.func); return VMMERR_UNSUPPORTED_OPCODE; case F_GRP1: id.func = grp1[op->modrm.reg]; goto grp_special; case F_GRP2: id.func = grp2[op->modrm.reg]; goto grp_special; case F_GRP11: if (op->reg == 0) id.func = F_MOV; else id.func = F_ZERO; goto grp_special; case F_ADD: DO_IDATA (op, src, dst, 2OP ("add"), , dst); break; case F_OR: DO_IDATA (op, src, dst, 2OP ("or"), , dst); break; case F_ADC: DO_IDATA (op, src, dst, 2OP ("adc"), , dst); break; case F_SBB: DO_IDATA (op, src, dst, 2OP ("sbb"), , dst); break; case F_AND: DO_IDATA (op, src, dst, 2OP ("and"), , dst); break; case F_SUB: DO_IDATA (op, src, dst, 2OP ("sub"), , dst); break; case F_XOR: DO_IDATA (op, src, dst, 2OP ("xor"), , dst); break; case F_CMP: DO_IDATA (op, src, dst, 2OP ("cmp"), , ); break; case F_TEST: DO_IDATA (op, src, dst, 2OP ("test"), , ); break; case F_XCHG: DO_IDATA (op, src, dst, XCHG () ,src , dst); break; case F_MOV: DO_IDATA (op, src, , MOV () , , dst); break; } if (update_flags) current->vmctl.write_flags (newflags); UPDATE_IP (op); return VMMERR_SUCCESS; } vmmerr_t cpu_interpreter (void) { struct op *op, op1; u8 code; int i; ulong acr; struct idata idat; ulong cr0; u64 efer; op = &op1; current->vmctl.read_control_reg (CONTROL_REG_CR0, &cr0); current->vmctl.read_msr (MSR_IA32_EFER, &efer); if (cr0 & CR0_PE_BIT) op->mode = CPUMODE_PROTECTED; else op->mode = CPUMODE_REAL; op->longmode = false; current->vmctl.read_ip (&op->ip); op->ip_off = 0; READ_NEXT_B (op, &code); clear_prefix (&op->prefix); for (i = 0; i < 4; i++) { switch (code) { case PREFIX_LOCK: op->prefix.lock = 1; panic ("LOCK"); break; case PREFIX_REPNE: op->prefix.repne = 1; break; case PREFIX_REPE: op->prefix.repe = 1; break; case PREFIX_ES: op->prefix.seg = SREG_ES; break; case PREFIX_CS: op->prefix.seg = SREG_CS; break; case PREFIX_SS: op->prefix.seg = SREG_SS; break; case PREFIX_DS: op->prefix.seg = SREG_DS; break; case PREFIX_FS: op->prefix.seg = SREG_FS; break; case PREFIX_GS: op->prefix.seg = SREG_GS; break; case PREFIX_OPERAND_SIZE: op->prefix.opsize = 1; break; case PREFIX_ADDRESS_SIZE: op->prefix.addrsize = 1; break; default: goto parse_opcode; } READ_NEXT_B (op, &code); } return VMMERR_PREFIX_TOO_LONG; parse_opcode: current->vmctl.read_sreg_acr (SREG_CS, &acr); if ((efer & MSR_IA32_EFER_LMA_BIT) && (acr & ACCESS_RIGHTS_L_BIT)) { op->longmode = true; if (code >= PREFIX_REX_MIN && code <= PREFIX_REX_MAX) { op->prefix.rex.v.val = code; READ_NEXT_B (op, &code); } op->reptype = REPTYPE_64BIT; op->optype = op->prefix.rex.b.w ? OPTYPE_64BIT : !op->prefix.opsize ? OPTYPE_32BIT : OPTYPE_16BIT; op->addrtype = !op->prefix.addrsize ? ADDRTYPE_64BIT : ADDRTYPE_32BIT; } else if (acr & ACCESS_RIGHTS_D_B_BIT) { op->reptype = REPTYPE_32BIT; op->optype = !op->prefix.opsize ? OPTYPE_32BIT : OPTYPE_16BIT; op->addrtype = !op->prefix.addrsize ? ADDRTYPE_32BIT : ADDRTYPE_16BIT; } else { op->reptype = REPTYPE_16BIT; op->optype = !op->prefix.opsize ? OPTYPE_16BIT : OPTYPE_32BIT; op->addrtype = !op->prefix.addrsize ? ADDRTYPE_16BIT : ADDRTYPE_32BIT; } switch (code) { case OPCODE_0x0F: READ_NEXT_B (op, &code); goto parse_opcode_0x0f; case OPCODE_HLT: return opcode_hlt (op); case OPCODE_CLI: return opcode_cli (op); case OPCODE_STI: return opcode_sti (op); case OPCODE_PUSHF: return opcode_pushf (op); case OPCODE_POPF: return opcode_popf (op); case OPCODE_IRET: return opcode_iret (op); case OPCODE_INT: READ_NEXT_B (op, &op->imm); return opcode_int (op); case OPCODE_INT3: return opcode_int3 (op); case OPCODE_INTO: return opcode_into (op); case OPCODE_INB_IMM: READ_NEXT_B (op, &op->imm); return opcode_inb_imm (op); case OPCODE_IN_IMM: READ_NEXT_B (op, &op->imm); return opcode_in_imm (op); case OPCODE_INB_DX: return opcode_inb_dx (op); case OPCODE_IN_DX: return opcode_in_dx (op); case OPCODE_INSB: return opcode_insb (op); case OPCODE_INS: return opcode_ins (op); case OPCODE_OUTB_IMM: READ_NEXT_B (op, &op->imm); return opcode_outb_imm (op); case OPCODE_OUT_IMM: READ_NEXT_B (op, &op->imm); return opcode_out_imm (op); case OPCODE_OUTB_DX: return opcode_outb_dx (op); case OPCODE_OUT_DX: return opcode_out_dx (op); case OPCODE_OUTSB: return opcode_outsb (op); case OPCODE_OUTS: return opcode_outs (op); case OPCODE_MOV_FROM_SR: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); return opcode_mov_from_sr (op); case OPCODE_MOV_TO_SR: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); return opcode_mov_to_sr (op); case OPCODE_PUSH_ES: return opcode_push_sr (op, SREG_ES); case OPCODE_PUSH_CS: return opcode_push_sr (op, SREG_CS); case OPCODE_PUSH_SS: return opcode_push_sr (op, SREG_SS); case OPCODE_PUSH_DS: return opcode_push_sr (op, SREG_DS); case OPCODE_POP_ES: return opcode_pop_sr (op, SREG_ES); case OPCODE_POP_SS: return opcode_pop_sr (op, SREG_SS); case OPCODE_POP_DS: return opcode_pop_sr (op, SREG_DS); case OPCODE_JMP_FAR_DIRECT: return opcode_jmp_far_direct (op); case OPCODE_0xFF: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); goto parse_opcode_0xff; case OPCODE_0x8F: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); goto parse_opcode_0x8f; case OPCODE_RETF: return opcode_retf (op); case OPCODE_MOVSB: return opcode_movsb (op); case OPCODE_MOVS: return opcode_movs (op); case OPCODE_STOSB: return opcode_stosb (op); case OPCODE_STOS: return opcode_stos (op); } idat = idata[code]; grp_special: switch (idat.type) { case I_MODRM: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); return opcode_idata (op, idat); case I_MIMM1: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); /* fall through */ case I_IMME1: grp_imme1: op->imm = 0; READ_NEXT_B (op, &op->imm); if (idat.len == 2 && (op->imm & 0x80)) op->imm |= 0xFFFFFF00; return opcode_idata (op, idat); case I_MIMM2: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); /* fall through */ case I_IMME2: grp_imme2: if (op->optype == OPTYPE_16BIT) READ_NEXT_W (op, &op->imm); else READ_NEXT_L (op, &op->imm); return opcode_idata (op, idat); case I_MOFFS: RIE (read_moffs (op)); return opcode_idata (op, idat); case I_MGRP3: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); idat.type = grp3[op->modrm.reg].type; idat.dst = grp3[op->modrm.reg].dst; idat.src = grp3[op->modrm.reg].src; idat.func = grp3[op->modrm.reg].func; goto grp_special; case I_IMMED: if (idat.len == 1) goto grp_imme1; else goto grp_imme2; break; case I_NOMOR: return opcode_idata (op, idat); case I_ZERO: default: break; } op->ip_off += 16; DEBUG_UNSUPPORTED ("Unsupported opcode: 0x%02x (type %d)\n", code, idat.type); return VMMERR_UNSUPPORTED_OPCODE; parse_opcode_0x0f: switch (code) { case OPCODE_0x0F_0x01: READ_NEXT_B (op, &op->modrm); goto parse_opcode_0x0f_0x01; case OPCODE_0x0F_MOV_TO_CR: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); return opcode_mov_to_cr (op); case OPCODE_0x0F_MOV_FROM_CR: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); return opcode_mov_from_cr (op); case OPCODE_0x0F_MOV_TO_DR: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); return opcode_mov_to_dr (op); case OPCODE_0x0F_MOV_FROM_DR: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); return opcode_mov_from_dr (op); case OPCODE_0x0F_CLTS: return opcode_clts (op); case OPCODE_0x0F_INVD: return opcode_invd (op); case OPCODE_0x0F_WBINVD: return opcode_wbinvd (op); case OPCODE_0x0F_RDMSR: return opcode_rdmsr (op); case OPCODE_0x0F_WRMSR: return opcode_wrmsr (op); } switch (code) { case OPCODE_0x0F_PUSH_FS: return opcode_push_sr (op, SREG_FS); case OPCODE_0x0F_PUSH_GS: return opcode_push_sr (op, SREG_GS); case OPCODE_0x0F_POP_FS: return opcode_pop_sr (op, SREG_FS); case OPCODE_0x0F_POP_GS: return opcode_pop_sr (op, SREG_GS); case OPCODE_0x0F_MOVZX_RM8_TO_R: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); return opcode_movzx_rm8_to_r (op); case OPCODE_0x0F_MOVZX_RM16_TO_R: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); return opcode_movzx_rm16_to_r (op); case OPCODE_0x0F_LSS: READ_NEXT_B (op, &op->modrm); GET_MODRM (op); return opcode_0f_lss (op); } op->ip_off += 16; DEBUG_UNSUPPORTED ("Unsupported opcode: 0x0f 0x%02x\n", code); return VMMERR_UNSUPPORTED_OPCODE; parse_opcode_0x0f_0x01: switch (op->modrm.reg) { case OPCODE_0x0F_0x01_LGDT: GET_MODRM (op); return opcode_lgdt (op); case OPCODE_0x0F_0x01_LIDT: GET_MODRM (op); return opcode_lidt (op); case OPCODE_0x0F_0x01_SMSW: GET_MODRM (op); return opcode_smsw (op); case OPCODE_0x0F_0x01_LMSW: GET_MODRM (op); return opcode_lmsw (op); case OPCODE_0x0F_0x01_INVLPG: GET_MODRM (op); return opcode_invlpg (op); } op->ip_off += 16; DEBUG_UNSUPPORTED ("Unsupported opcode: 0x0f 0x01 (modrm.reg 0x%x)\n", op->modrm.reg); return VMMERR_UNSUPPORTED_OPCODE; parse_opcode_0xff: switch (op->modrm.reg) { case OPCODE_0xFF_JMP_FAR_INDIRECT: return opcode_jmp_far_indirect (op); case OPCODE_0xFF_PUSH: return opcode_ff_push (op); } op->ip_off += 16; DEBUG_UNSUPPORTED ("Unsupported opcode: 0xff (modrm.reg 0x%x)\n", op->modrm.reg); return VMMERR_UNSUPPORTED_OPCODE; parse_opcode_0x8f: switch (op->modrm.reg) { case OPCODE_0x8F_POP: return opcode_8f_pop (op); } op->ip_off += 16; DEBUG_UNSUPPORTED ("Unsupported opcode: 0xff (modrm.reg 0x%x)\n", op->modrm.reg); return VMMERR_UNSUPPORTED_OPCODE; } tinyvisor/vmm/core/misc.h0000644006644000001440000000347311733245403015730 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_MISC_H #define _CORE_MISC_H #include static inline ulong modify_ulong_u16(ulong data, u16 val) { return (data & ~0xffffl) | val; } static inline ulong modify_ulong_u32(ulong data, u32 val) { return (data & ~0xffffffffl) | val; } #endif tinyvisor/vmm/core/Makefile0000644006644000001440000000533212071455154016262 0ustar yuichi_xyusersTOPDIR = .. include $(TOPDIR)/Makefile.master # config macros CONSTANTS-$(CONFIG_64) += CONSTANTS-$(CONFIG_SPINLOCK_DEBUG) += -DSPINLOCK_DEBUG CONSTANTS-$(CONFIG_TTY_SERIAL) += -DTTY_SERIAL CONSTANTS-$(CONFIG_PS2KBD_F11PANIC) += -DF11PANIC CONSTANTS-$(CONFIG_PS2KBD_F12MSG) += -DF12MSG CONSTANTS-$(CONFIG_ACPI_DSDT) += -DACPI_DSDT CONSTANTS-$(CONFIG_DISABLE_SLEEP) += -DDISABLE_SLEEP CONSTANTS-$(CONFIG_ENABLE_ASSERT) += -DENABLE_ASSERT CONSTANTS-$(CONFIG_VT_EPT) += -DCONFIG_VT_EPT CONSTANTS-$(CONFIG_IO_HOOK) += -DCONFIG_IO_HOOK CONSTANTS-$(CONFIG_SPT3) += -DCONFIG_SPT3 OBJS-1 = \ acpi.o \ acpi_madt.o \ apic.o \ apic_pass.o \ arith.o \ asm.o \ assert.o \ beep.o \ callrealmode.o \ callrealmode_asm.o \ cpu.o \ cpu_emul.o \ cpu_interpreter.o \ cpu_mmu.o \ cpu_seg.o \ cpu_stack.o \ cpuid.o \ current.o \ debug.o \ entry.o \ extint.o \ gbiosloader.o \ gmm.o \ gmm_access.o \ gmm_ident.o \ gmm_trans.o \ guest_boot.o \ initfunc.o \ int.o \ int_handler.o \ io_io.o \ io_iopass.o \ keyboard.o \ main.o \ mm.o \ mm_access.o \ mm_alloc.o \ mm_process.o \ mmio.o \ msg.o \ msr_pass.o \ mtrr.o \ panic.o \ param.o \ pcpu.o \ printf.o \ process.o \ process_sysenter.o \ putchar.o \ reboot.o \ rm.o \ seg.o \ sleep.o \ smp.o \ string.o \ svm.o \ svm_exitcode.o \ svm_init.o \ svm_io.o \ svm_main.o \ svm_msr.o \ svm_np.o \ svm_panic.o \ svm_regs.o \ thread.o \ thread_switch.o \ time.o \ timer.o \ tty.o \ vcpu.o \ vm.o \ vmmcall.o \ vmmcall_status.o \ vramwrite.o \ vt.o \ vt_exitreason.o \ vt_init.o \ vt_io.o \ vt_main.o \ vt_msr.o \ vt_panic.o \ vt_regs.o OBJS-$(CONFIG_SPT3) += cpu_mmu_spt3.o OBJS-1-$(CONFIG_SPT3) += cpu_mmu_spt.o OBJS-1 += $(OBJS-1-0) OBJS-$(CONFIG_IO_HOOK) += io_iohook.o OBJS-$(CONFIG_TTY_SERIAL) += serial.o OBJS-$(CONFIG_DBGSH) += vmmcall_dbgsh.o OBJS-$(CONFIG_LOG_TO_GUEST) += vmmcall_log.o OBJS-$(CONFIG_ACPI_DSDT) += acpi_dsdt.o OBJS-$(CONFIG_VT_EPT) += vt_ept.o HEADERS += $(wildcard *.h) OBJ_BUILTIN = ./builtin/process_builtin.o CFLAGS += $(CONSTANTS-1) #CFLAGS += -O LINTFLAGS += $(CONSTANTS-1) ASFLAGS = --$(BITS-$(CONFIG_64)) LDFLAGS += -r OUT_OBJ = core.o .PHONY : all clean $(OBJ_BUILTIN) lint all : $(OUT_OBJ) clean : $(MAKE) -C ./builtin clean rm -f $(OUT_OBJ) *.o *~ lint: splint $(LINTFLAGS) *.c $(OBJ_BUILTIN) : $(MAKE) -C ./builtin $(OUT_OBJ) : $(OBJS-1) $(OBJ_BUILTIN) $(CONFIG) $(LD) $(LDFLAGS) -o $(OUT_OBJ) $(OBJS-1) $(OBJ_BUILTIN) $(OBJS-1) : $(HEADERS) $(CONFIG) Makefile # cpu_mmu_spt.o: $(HEADERS) $(CONFIG) $(@:.o=.c) # $(CC) -c $(CPPFLAGS) $(CFLAGS) -O -o $@ $(@:.o=.c) check-syntax: gcc -fsyntax-only $(CPPFLAGS) $(CFLAGS) $(CHK_SOURCES) # splint $(LINTFLAGS) $(CHK_SOURCES) tinyvisor/vmm/core/msg.h0000644006644000001440000000410311733245403015552 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_MSG_H #define _CORE_MSG_H #include #include typedef int kmfunc_t (void *arg, void *data, unsigned int len); #define MSG_NAMELEN 16 struct msg_data { LIST1_DEFINE (struct msg_data); char name[MSG_NAMELEN]; int pid, gen, desc; }; int msg_register (char *name, int pid, int gen, int desc); int msg_unregister (char *name); int msg_unregister2 (int pid, int desc); int msg_findname (char *name, int *pid, int *gen, int *desc); void msg_unregisterall (int pid); #endif tinyvisor/vmm/core/process_builtin.h0000644006644000001440000000356611733245403020204 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_PROCESS_BUILTIN_H #define _CORE_PROCESS_BUILTIN_H #include struct process_builtin_data { char *name __attribute__ ((aligned (8))); void *bin __attribute__ ((aligned (8))); ulong len __attribute__ ((aligned (8))); }; extern struct process_builtin_data process_builtin[]; #endif tinyvisor/vmm/core/seg.h0000644006644000001440000000453411733245403015552 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_SEG_H #define _CORE_SEG_H #include #define SEG_SEL_NULL 0 #define SEG_SEL_CODE32 ( 1 * 8) #define SEG_SEL_DATA32 ( 2 * 8) #define SEG_SEL_CODE32U ( 3 * 8 + 3) #define SEG_SEL_DATA32U ( 4 * 8 + 3) #define SEG_SEL_TSS32 ( 5 * 8) #define SEG_SEL_CODE16 ( 6 * 8) #define SEG_SEL_DATA16 ( 7 * 8) #define SEG_SEL_PCPU32 ( 8 * 8) #define SEG_SEL_CALLGATE32 ( 9 * 8) #define SEG_SEL_CODE64 (10 * 8) #define SEG_SEL_DATA64 (11 * 8) #define SEG_SEL_CODE64U (12 * 8 + 3) #define SEG_SEL_DATA64U (13 * 8 + 3) #define SEG_SEL_TSS64 (14 * 8) #define SEG_SEL_TSS64_ (15 * 8) /* Reserved */ #define SEG_SEL_PCPU64 (16 * 8) void get_seg_base (ulong gdtbase, u16 ldtr, u16 sel, ulong *segbase); u32 get_seg_access_rights (u16 sel); void segment_init_ap (void); #endif tinyvisor/vmm/core/vt_panic.c0000644006644000001440000002053212140421510016552 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2012-2013 Yuichi Watanabe */ #include #include #include "asm.h" #include "constants.h" #include "current.h" #include "seg.h" #include "vt_internal.h" static void vt_panic_dump2 (void) { } #define DUMP_VMCS_FIELD(reg_name) \ do { \ ulong reg_val; \ asm_vmread(reg_name, ®_val); \ printf(" %s 0x%lx\n", #reg_name, reg_val); \ } while(0) static void vt_dump_vmcs(void) { printf("32-Bit Control Fields\n"); DUMP_VMCS_FIELD(VMCS_PIN_BASED_VMEXEC_CTL); DUMP_VMCS_FIELD(VMCS_PROC_BASED_VMEXEC_CTL); DUMP_VMCS_FIELD(VMCS_EXCEPTION_BMP); DUMP_VMCS_FIELD(VMCS_PAGEFAULT_ERRCODE_MASK); DUMP_VMCS_FIELD(VMCS_PAGEFAULT_ERRCODE_MATCH); DUMP_VMCS_FIELD(VMCS_CR3_TARGET_COUNT); DUMP_VMCS_FIELD(VMCS_VMEXIT_CTL); DUMP_VMCS_FIELD(VMCS_VMEXIT_MSR_STORE_COUNT); DUMP_VMCS_FIELD(VMCS_VMEXIT_MSR_LOAD_COUNT); DUMP_VMCS_FIELD(VMCS_VMENTRY_CTL); DUMP_VMCS_FIELD(VMCS_VMENTRY_MSR_LOAD_COUNT); DUMP_VMCS_FIELD(VMCS_VMENTRY_INTR_INFO_FIELD); DUMP_VMCS_FIELD(VMCS_VMENTRY_EXCEPTION_ERRCODE); DUMP_VMCS_FIELD(VMCS_VMENTRY_INSTRUCTION_LEN); DUMP_VMCS_FIELD(VMCS_TPR_THRESHOLD); printf("64-Bit Control Fields\n"); DUMP_VMCS_FIELD(VMCS_ADDR_IOBMP_A); DUMP_VMCS_FIELD(VMCS_ADDR_IOBMP_A_HIGH); DUMP_VMCS_FIELD(VMCS_ADDR_IOBMP_B); DUMP_VMCS_FIELD(VMCS_ADDR_IOBMP_B_HIGH); DUMP_VMCS_FIELD(VMCS_ADDR_MSRBMP); DUMP_VMCS_FIELD(VMCS_ADDR_MSRBMP_HIGH); DUMP_VMCS_FIELD(VMCS_VMEXIT_MSRSTORE_ADDR); DUMP_VMCS_FIELD(VMCS_VMEXIT_MSRSTORE_ADDR_HIGH); DUMP_VMCS_FIELD(VMCS_VMEXIT_MSRLOAD_ADDR); DUMP_VMCS_FIELD(VMCS_VMEXIT_MSRLOAD_ADDR_HIGH); DUMP_VMCS_FIELD(VMCS_VMENTRY_MSRLOAD_ADDR); DUMP_VMCS_FIELD(VMCS_VMENTRY_MSRLOAD_ADDR_HIGH); DUMP_VMCS_FIELD(VMCS_EXEC_VMCS_POINTER); DUMP_VMCS_FIELD(VMCS_EXEC_VMCS_POINTER_HIGH); DUMP_VMCS_FIELD(VMCS_TSC_OFFSET); DUMP_VMCS_FIELD(VMCS_TSC_OFFSET_HIGH); printf("Natural-Width Control Fields\n"); DUMP_VMCS_FIELD(VMCS_CR0_GUESTHOST_MASK); DUMP_VMCS_FIELD(VMCS_CR4_GUESTHOST_MASK); DUMP_VMCS_FIELD(VMCS_CR0_READ_SHADOW); DUMP_VMCS_FIELD(VMCS_CR4_READ_SHADOW); DUMP_VMCS_FIELD(VMCS_CR3_TARGET_VALUE_0); DUMP_VMCS_FIELD(VMCS_CR3_TARGET_VALUE_1); DUMP_VMCS_FIELD(VMCS_CR3_TARGET_VALUE_2); DUMP_VMCS_FIELD(VMCS_CR3_TARGET_VALUE_3); printf("16-Bit Host-State Fields\n"); DUMP_VMCS_FIELD(VMCS_HOST_ES_SEL); DUMP_VMCS_FIELD(VMCS_HOST_CS_SEL); DUMP_VMCS_FIELD(VMCS_HOST_SS_SEL); DUMP_VMCS_FIELD(VMCS_HOST_DS_SEL); DUMP_VMCS_FIELD(VMCS_HOST_FS_SEL); DUMP_VMCS_FIELD(VMCS_HOST_GS_SEL); DUMP_VMCS_FIELD(VMCS_HOST_TR_SEL); printf("32-Bit Host-State Field\n"); DUMP_VMCS_FIELD(VMCS_HOST_IA32_SYSENTER_CS); printf("Natural-Width Host-State Fields\n"); DUMP_VMCS_FIELD(VMCS_HOST_CR0); DUMP_VMCS_FIELD(VMCS_HOST_CR3); DUMP_VMCS_FIELD(VMCS_HOST_CR4); DUMP_VMCS_FIELD(VMCS_HOST_FS_BASE); DUMP_VMCS_FIELD(VMCS_HOST_GS_BASE); DUMP_VMCS_FIELD(VMCS_HOST_TR_BASE); DUMP_VMCS_FIELD(VMCS_HOST_GDTR_BASE); DUMP_VMCS_FIELD(VMCS_HOST_IDTR_BASE); DUMP_VMCS_FIELD(VMCS_HOST_IA32_SYSENTER_ESP); DUMP_VMCS_FIELD(VMCS_HOST_IA32_SYSENTER_EIP); DUMP_VMCS_FIELD(VMCS_HOST_RSP); DUMP_VMCS_FIELD(VMCS_HOST_RIP); printf("16-Bit Guest-State Fields\n"); DUMP_VMCS_FIELD(VMCS_GUEST_ES_SEL); DUMP_VMCS_FIELD(VMCS_GUEST_CS_SEL); DUMP_VMCS_FIELD(VMCS_GUEST_SS_SEL); DUMP_VMCS_FIELD(VMCS_GUEST_DS_SEL); DUMP_VMCS_FIELD(VMCS_GUEST_FS_SEL); DUMP_VMCS_FIELD(VMCS_GUEST_GS_SEL); DUMP_VMCS_FIELD(VMCS_GUEST_LDTR_SEL); DUMP_VMCS_FIELD(VMCS_GUEST_TR_SEL); printf("32-Bit Guest-State Fields\n"); DUMP_VMCS_FIELD(VMCS_GUEST_ES_LIMIT); DUMP_VMCS_FIELD(VMCS_GUEST_CS_LIMIT); DUMP_VMCS_FIELD(VMCS_GUEST_SS_LIMIT); DUMP_VMCS_FIELD(VMCS_GUEST_DS_LIMIT); DUMP_VMCS_FIELD(VMCS_GUEST_FS_LIMIT); DUMP_VMCS_FIELD(VMCS_GUEST_GS_LIMIT); DUMP_VMCS_FIELD(VMCS_GUEST_LDTR_LIMIT); DUMP_VMCS_FIELD(VMCS_GUEST_TR_LIMIT); DUMP_VMCS_FIELD(VMCS_GUEST_GDTR_LIMIT); DUMP_VMCS_FIELD(VMCS_GUEST_IDTR_LIMIT); DUMP_VMCS_FIELD(VMCS_GUEST_ES_ACCESS_RIGHTS); DUMP_VMCS_FIELD(VMCS_GUEST_CS_ACCESS_RIGHTS); DUMP_VMCS_FIELD(VMCS_GUEST_SS_ACCESS_RIGHTS); DUMP_VMCS_FIELD(VMCS_GUEST_DS_ACCESS_RIGHTS); DUMP_VMCS_FIELD(VMCS_GUEST_FS_ACCESS_RIGHTS); DUMP_VMCS_FIELD(VMCS_GUEST_GS_ACCESS_RIGHTS); DUMP_VMCS_FIELD(VMCS_GUEST_LDTR_ACCESS_RIGHTS); DUMP_VMCS_FIELD(VMCS_GUEST_TR_ACCESS_RIGHTS); DUMP_VMCS_FIELD(VMCS_GUEST_INTERRUPTIBILITY_STATE); DUMP_VMCS_FIELD(VMCS_GUEST_ACTIVITY_STATE); DUMP_VMCS_FIELD(VMCS_GUEST_IA32_SYSENTER_CS); printf("64-Bit Guest-State Fields\n"); DUMP_VMCS_FIELD(VMCS_VMCS_LINK_POINTER); DUMP_VMCS_FIELD(VMCS_VMCS_LINK_POINTER_HIGH); DUMP_VMCS_FIELD(VMCS_GUEST_IA32_DEBUGCTL); DUMP_VMCS_FIELD(VMCS_GUEST_IA32_DEBUGCTL_HIGH); printf("Natural-Width Guest-State Fields\n"); DUMP_VMCS_FIELD(VMCS_GUEST_CR0); DUMP_VMCS_FIELD(VMCS_GUEST_CR3); DUMP_VMCS_FIELD(VMCS_GUEST_CR4); DUMP_VMCS_FIELD(VMCS_GUEST_ES_BASE); DUMP_VMCS_FIELD(VMCS_GUEST_CS_BASE); DUMP_VMCS_FIELD(VMCS_GUEST_SS_BASE); DUMP_VMCS_FIELD(VMCS_GUEST_DS_BASE); DUMP_VMCS_FIELD(VMCS_GUEST_FS_BASE); DUMP_VMCS_FIELD(VMCS_GUEST_GS_BASE); DUMP_VMCS_FIELD(VMCS_GUEST_LDTR_BASE); DUMP_VMCS_FIELD(VMCS_GUEST_TR_BASE); DUMP_VMCS_FIELD(VMCS_GUEST_GDTR_BASE); DUMP_VMCS_FIELD(VMCS_GUEST_IDTR_BASE); DUMP_VMCS_FIELD(VMCS_GUEST_DR7); DUMP_VMCS_FIELD(VMCS_GUEST_RSP); DUMP_VMCS_FIELD(VMCS_GUEST_RIP); DUMP_VMCS_FIELD(VMCS_GUEST_RFLAGS); DUMP_VMCS_FIELD(VMCS_GUEST_PENDING_DEBUG_EXCEPTIONS); DUMP_VMCS_FIELD(VMCS_GUEST_IA32_SYSENTER_ESP); DUMP_VMCS_FIELD(VMCS_GUEST_IA32_SYSENTER_EIP); } void vt_panic_dump (void) { ulong tmp, tmp2; ulong reason; current->vmctl.panic_dump = vt_panic_dump2; printf("Exit reason: "); asm_vmread(VMCS_EXIT_REASON, &reason); printexitreason(reason); asm_vmread (VMCS_EXIT_QUALIFICATION, &tmp); printf("Exit qualification %08lx ", tmp); asm_vmread(VMCS_VMEXIT_INTR_INFO, &tmp); printf("Exit intr info %08lx\n", tmp); asm_vmread(VMCS_VMEXIT_INTR_ERRCODE, &tmp); printf("Exit intr errcode %08lx ", tmp); asm_vmread(VMCS_GUEST_IDTR_BASE, &tmp); asm_vmread(VMCS_GUEST_IDTR_LIMIT, &tmp2); printf("VMCS IDTR %08lx+%08lx ", tmp, tmp2); asm_vmread(VMCS_GUEST_RFLAGS, &tmp); printf("VMCS RFLAGS %08lx\n", tmp); if (reason == EXIT_REASON_EPT_VIOLATION) { asm_vmread(VMCS_GUEST_PHYS_ADDR, &tmp); printf("Guest phys addr %08lx ", tmp); asm_vmread(VMCS_GUEST_LINEAR_ADDR, &tmp); printf("Guest linear addr %08lx\n", tmp); } if (reason == EXIT_REASON_EPT_MISCONFIG) { asm_vmread(VMCS_GUEST_PHYS_ADDR, &tmp); printf("Guest phys addr %08lx\n", tmp); } printf("pe=%d pg=%d ", current->u.vt.vr.pe, current->u.vt.vr.pg); printf("sw:en=0x%x ", current->u.vt.vr.sw.enable); printf("es=0x%x ", current->u.vt.vr.sw.es); printf("cs=0x%x ", current->u.vt.vr.sw.cs); printf("ss=0x%x ", current->u.vt.vr.sw.ss); printf("ds=0x%x ", current->u.vt.vr.sw.ds); printf("fs=0x%x ", current->u.vt.vr.sw.fs); printf("gs=0x%X\n", current->u.vt.vr.sw.gs); if (reason & EXIT_REASON_VMENTRY_FAILURE_BIT) { vt_dump_vmcs(); } } tinyvisor/vmm/core/svm_io.c0000644006644000001440000000575211733245403016266 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include "current.h" #include "panic.h" #include "svm_io.h" #include "vcpu.h" void svm_ioio (void) { union { struct exitinfo1_ioio s; u64 v; } e1; vmmerr_t err; void *data; struct vmcb *vmcb; vmcb = current->u.svm.vi.vmcb; e1.v = vmcb->exitinfo1; if (e1.s.str) { /* INS : IN(DX) -> ES:[DI/EDI/RDI] */ /* OUTS : DS/OVERRIDE:[SI/ESI/RSI] -> OUT(DX) */ /* EXITINFO1 includes no information about segment overrides */ /* we use an interpreter here to avoid the problem */ err = cpu_interpreter (); if (err != VMMERR_SUCCESS) panic ("I/O INSTRUCTION EMULATION FAILED" " (err: %d)", err); } else { data = &vmcb->rax; current->updateip = false; if (e1.s.type_in) { if (e1.s.sz8) call_io (IOTYPE_INB, e1.s.port, data); else if (e1.s.sz16) call_io (IOTYPE_INW, e1.s.port, data); else call_io (IOTYPE_INL, e1.s.port, data); } else { if (e1.s.sz8) call_io (IOTYPE_OUTB, e1.s.port, data); else if (e1.s.sz16) call_io (IOTYPE_OUTW, e1.s.port, data); else call_io (IOTYPE_OUTL, e1.s.port, data); } if (!current->updateip) vmcb->rip = vmcb->exitinfo2; } } static void set_iobmp (struct vcpu *v, ioport_t port, int bit) { u8 *p; port &= 0xFFFF; p = (u8 *)v->u.svm.io.iobmp; if (bit) p[port >> 3] |= 1 << (port & 7); else p[port >> 3] &= ~(1 << (port & 7)); } void svm_extern_iopass (struct vcpu *p, ioport_t port, bool pass) { set_iobmp (p, port, !pass); } tinyvisor/vmm/core/cpu_mmu_spt.h0000644006644000001440000000476112071526062017330 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_CPU_MMU_SPT_H #define _CORE_CPU_MMU_SPT_H #include #include #include #ifdef CONFIG_SPT3 struct cpu_mmu_spt_data_internal; struct cpu_mmu_spt_data { struct cpu_mmu_spt_data_internal *data; }; #else /* ! CONFIG_SPT3 */ #define NUM_OF_SPTTBL 1024 struct spt_page { LIST2_DEFINE (struct spt_page, list); phys_t phys; void *virt; u64 *pte_virt; }; struct cpu_mmu_spt_data { void *cr3tbl; u64 cr3tbl_phys; LIST2_DEFINE_HEAD(struct spt_page, shadow_free); LIST2_DEFINE_HEAD(struct spt_page, shadow_l1); LIST2_DEFINE_HEAD(struct spt_page, shadow_lu); int levels; struct spt_page spt_page[NUM_OF_SPTTBL]; bool tlbflash; }; #endif /* ! CONFIG_SPT3 */ struct vcpu; bool cpu_mmu_spt_tlbflush (void); void cpu_mmu_spt_updatecr3 (void); void cpu_mmu_spt_invalidate (ulong virtual_addr); void cpu_mmu_spt_pagefault (ulong err, ulong cr2); void cpu_mmu_spt_init(void); #endif tinyvisor/vmm/core/gmm_ident.h0000644006644000001440000000337611733245403016742 0ustar yuichi_xyusers/* * Copyright (c) 2010 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_GMM_PASS_H #define _CORE_GMM_PASS_H #include #include #include "gmm.h" struct gmm_ident { int mem_map_count; struct resource *mem_map; }; #endif /* _CORE_GMM_PASS_H */ tinyvisor/vmm/core/process.c0000644006644000001440000004637612000734676016462 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include "asm.h" #include "constants.h" #include "comphappy.h" #include "elf.h" #include "entry.h" #include "mm.h" #include "msg.h" #include "panic.h" #include "pcpu.h" #include "process.h" #include "process_builtin.h" #include "process_sysenter.h" #include "seg.h" #include #define NUM_OF_SYSCALLS 32 #define NAMELEN 16 #define MAX_MSGLEN 16384 typedef ulong (*syscall_func_t) (ulong ip, ulong sp, ulong num, ulong si, ulong di); struct syscall_regs { ulong rdi, rsi, rbp, rsp, rbx, rdx, rcx, rax; }; struct msgdsc_data { int pid; int gen; int dsc; void *func; }; struct process_data { bool valid; phys_t mm_phys; int gen; int running; struct msgdsc_data msgdsc[NUM_OF_MSGDSC]; bool exitflag; }; extern ulong volatile syscallstack asm ("%gs:gs_syscallstack"); static struct process_data process[NUM_OF_PID]; static spinlock_t process_lock = SPINLOCK_INITIALIZER; static bool process_initialized = false; static bool is_range_valid (ulong addr, u32 len) { if (addr >= 0x40000000) return false; if (addr + len >= 0x40000000) return false; if (addr < 0x00000000) return false; if (len >= 0x40000000) return false; return true; } static ulong sys_nop (ulong ip, ulong sp, ulong num, ulong si, ulong di) { return 0; } static void clearmsgdsc (struct msgdsc_data msgdsc[NUM_OF_MSGDSC]) { int i; for (i = 0; i < NUM_OF_MSGDSC; i++) { msgdsc[i].pid = 0; msgdsc[i].gen = 0; msgdsc[i].dsc = 0; msgdsc[i].func = NULL; } } #ifndef __x86_64__ static bool sysenter_available (void) { u32 a, b, c, d; unsigned int family, model, stepping; asm_cpuid (1, 0, &a, &b, &c, &d); if (d & CPUID_1_EDX_SEP_BIT) { family = (a & 0xF00) >> 8; model = (a & 0xF0) >> 4; stepping = (a & 0xF); if (family == 6 && model < 3 && stepping < 3) return false; return true; } return false; } #endif static void setup_syscallentry (void) { #ifdef __x86_64__ ulong efer; asm_wrmsr (MSR_IA32_SYSENTER_CS, 0); /* Disable SYSENTER/SYSEXIT */ asm_wrmsr32 (MSR_IA32_STAR, (u32) (ulong)syscall_entry_sysret64, (SEG_SEL_CODE64U << 16) | SEG_SEL_CODE64); asm_wrmsr (MSR_IA32_LSTAR, (ulong)syscall_entry_sysret64); asm_wrmsr (MSR_AMD_CSTAR, (ulong)syscall_entry_sysret64); asm_wrmsr (MSR_IA32_FMASK, RFLAGS_VM_BIT | RFLAGS_IF_BIT | RFLAGS_RF_BIT); asm_rdmsr (MSR_IA32_EFER, &efer); efer |= MSR_IA32_EFER_SCE_BIT; asm_wrmsr (MSR_IA32_EFER, efer); #else if (sysenter_available ()) { asm_wrmsr (MSR_IA32_SYSENTER_CS, SEG_SEL_CODE32); asm_wrmsr (MSR_IA32_SYSENTER_EIP, (ulong)syscall_entry_sysexit); asm_wrmsr (MSR_IA32_SYSENTER_ESP, currentcpu->tss32.esp0); } #endif } static void process_init_global (void) { int i; for (i = 0; i < NUM_OF_PID; i++) { process[i].valid = false; process[i].gen = 1; } process[0].valid = true; clearmsgdsc (process[0].msgdsc); setup_syscallentry (); process_initialized = true; } static void process_init_ap (void) { setup_syscallentry (); } static int load_bin (virt_t destvirt, uint destlen, void *src, uint srclen) { if (mm_process_map_alloc (destvirt, destlen)) { return -1; } memcpy ((void *)destvirt, src, srclen); return 0; } static ulong process_load (void *bin) { u8 *b; ELF_EHDR *ehdr; ELF_PHDR *phdr; unsigned int i; b = bin; if (b[0] != 0x7F && b[1] != 'E' && b[2] != 'L' && b[3] != 'F') return 0; ehdr = bin; phdr = (ELF_PHDR *)((u8 *)bin + ehdr->e_phoff); for (i = ehdr->e_phnum; i; i--, phdr = (ELF_PHDR *)((u8 *)phdr + ehdr->e_phentsize)) { if (phdr->p_type == PT_LOAD) { if (load_bin (phdr->p_vaddr, phdr->p_memsz, (u8 *)bin + phdr->p_offset, phdr->p_filesz)) { return 0; } } } return ehdr->e_entry; } /* for internal use */ static int _msgopen_2 (int pid, int mpid, int mgen, int mdesc) { int i, r; spinlock_lock (&process_lock); for (i = 0; i < NUM_OF_MSGDSC; i++) { if (process[pid].msgdsc[i].pid == 0 && process[pid].msgdsc[i].gen == 0) goto found; } r = -1; goto ret; found: process[pid].msgdsc[i].pid = mpid; process[pid].msgdsc[i].gen = mgen; process[pid].msgdsc[i].dsc = mdesc; r = i; ret: spinlock_unlock (&process_lock); return r; } static int process_new (int frompid, void *bin) { int pid, gen; phys_t phys; ulong rip; phys_t mm_phys; spinlock_lock (&process_lock); for (pid = 1; pid < NUM_OF_PID; pid++) { if (!process[pid].valid) goto found; } goto err; found: if (mm_process_alloc (&phys) < 0) /* alloc page directories and init */ goto err; process[pid].mm_phys = phys; process[pid].running = 0; process[pid].exitflag = false; gen = ++process[pid].gen; process[pid].valid = true; clearmsgdsc (process[pid].msgdsc); mm_phys = mm_process_switch (phys); if (!(rip = process_load (bin))) { /* load a program */ printf ("process_new: process_load failed.\n"); goto err2; } /* for system calls */ #ifdef __x86_64__ if (mm_process_map_shared_physpage (0x3FFFF000, sym_to_phys (processuser_syscall), false)) { printf("process_new: Failed to map syscall.\n"); goto err2; } #else if (sysenter_available ()) { if (mm_process_map_shared_physpage (0x3FFFF000, sym_to_phys (processuser_sysenter), false)) { printf("process_new: Failed to map sysenter.\n"); goto err2; } } else { if (mm_process_map_shared_physpage (0x3FFFF000, sym_to_phys (processuser_no_sysenter), false)) { printf("process_new: Failed to map no_sysenter.n"); goto err2; } } #endif process[pid].msgdsc[0].func = (void *)rip; mm_process_switch (mm_phys); spinlock_unlock (&process_lock); return _msgopen_2 (frompid, pid, gen, 0); err2: process[pid].valid = false; mm_process_unmapall (); mm_process_switch (mm_phys); mm_process_free (process[pid].mm_phys); err: spinlock_unlock (&process_lock); return -1; } static void callret (int retval) { asm_wrrsp_and_ret (syscallstack, retval); } void process_kill (bool (*func) (void *data), void *data) { if (!process_initialized) /* process not ready. */ return; if (!syscallstack) /* can't kill */ return; if (func && !func (data)) return; process[currentcpu->pid].exitflag = true; callret (0); } /* free any resources of a process */ /* CR3 must be the process's one */ /* process_lock must be locked */ static void cleanup (int pid, phys_t mm_phys) { ASSERT (process[pid].valid); ASSERT (process[pid].running == 0); process[pid].gen++; msg_unregisterall (pid); mm_process_unmapall (); mm_process_switch (mm_phys); mm_process_free (process[pid].mm_phys); process[pid].valid = false; } /* pid, func=pointer to the function of the process, sp=stack pointer of the process */ /* process_lock must be locked */ static int call_msgfunc0 (int pid, void *func, ulong sp) { ulong ax, bx, cx, dx, si, di; int oldpid; ASSERT (pid >= 0); ASSERT (pid < NUM_OF_PID); ASSERT (process[pid].valid); if (pid == 0) { panic ("call_msgfunc0 can't call kernel"); } oldpid = currentcpu->pid; currentcpu->pid = pid; process[pid].running++; spinlock_unlock (&process_lock); asm volatile ( #ifdef __x86_64__ " pushq %%rbp \n" " pushq %8 \n" " pushq $1f \n" " movq %%rsp,%8 \n" " jmp ret_to_user64 \n" "1: \n" " popq %8 \n" " popq %%rbp \n" #else " push %%ebp \n" " pushl %8 \n" " push $1f \n" " mov %%esp,%8 \n" " jmp ret_to_user32 \n" "1: \n" " popl %8 \n" " pop %%ebp \n" #endif : "=a" (ax) , "=b" (bx) , "=c" (cx) , "=d" (dx) , "=S" (si) , "=D" (di) : "c" (sp) , "d" ((ulong)func) , "m" (syscallstack) : "memory", "cc" #ifdef __x86_64__ , "%r8", "%r9", "%r10", "%r11", "%r12", "%r13", "%r14", "%r15" #endif ); spinlock_lock (&process_lock); process[pid].running--; currentcpu->pid = oldpid; return (int)ax; } /* pid, gen, desc, arg=arguments, len=length of the arguments (bytes) */ static int call_msgfunc1 (int pid, int gen, int desc, void *arg, int len, void *sendbuf, int sendlen, void *recvbuf, int recvlen) { phys_t mm_phys; ulong sp, sp2; int r = -1; void *sendbuf_user = NULL, *recvbuf_user = NULL; ulong curstk; int (*func) (); asm_rdrsp(&curstk); if (curstk - (ulong)currentcpu->stackaddr < VMM_MINSTACKSIZE) return r; spinlock_lock (&process_lock); ASSERT (pid >= 0); ASSERT (pid < NUM_OF_PID); if (!process[pid].valid) goto ret; ASSERT (desc >= 0); ASSERT (desc < NUM_OF_MSGDSC); if (process[pid].gen != gen) goto ret; if (process[pid].msgdsc[desc].func == NULL) goto ret; if (pid == 0) { ASSERT (len == sizeof (long) * 2); func = (int (*)())process[pid].msgdsc[desc].func; spinlock_unlock (&process_lock); r = func (((long *)arg)[0], ((long *)arg)[1], sendbuf, sendlen, recvbuf, recvlen); return r; } mm_phys = mm_process_switch (process[pid].mm_phys); sendbuf_user = mm_process_map_shared (mm_phys, sendbuf, sendlen, false); recvbuf_user = mm_process_map_shared (mm_phys, recvbuf, recvlen, true); sp2 = mm_process_map_stack (4096); sp = sp2; sp -= sizeof (ulong); *(ulong *)sp = (ulong)recvlen; sp -= sizeof (ulong); *(ulong *)sp = (ulong)recvbuf_user; sp -= sizeof (ulong); *(ulong *)sp = (ulong)sendlen; sp -= sizeof (ulong); *(ulong *)sp = (ulong)sendbuf_user; sp -= len; memcpy ((void *)sp, arg, len); sp -= sizeof (ulong); *(ulong *)sp = 0x3FFFF100; r = call_msgfunc0 (pid, process[pid].msgdsc[desc].func, sp); mm_process_unmapstack (sp2, 4096); mm_process_unmap ((virt_t)sendbuf_user, sendlen); mm_process_unmap ((virt_t)recvbuf_user, recvlen); if (process[pid].running == 0 && process[pid].exitflag) cleanup (pid, mm_phys); mm_process_switch (mm_phys); ret: spinlock_unlock (&process_lock); return r; } /* for internal use */ static void * _msgsetfunc (int pid, int desc, void *func) { void *oldfunc; spinlock_lock (&process_lock); oldfunc = process[pid].msgdsc[desc].func; process[pid].msgdsc[desc].func = func; spinlock_unlock (&process_lock); return oldfunc; } /* for kernel (VMM) */ void * msgsetfunc (int desc, void *func) { return _msgsetfunc (0, desc, func); } /* si=desc di=func */ ulong sys_msgsetfunc (ulong ip, ulong sp, ulong num, ulong si, ulong di) { if (si >= 0 && si < NUM_OF_MSGDSC) return (ulong)_msgsetfunc (currentcpu->pid, si, (void *)di); return 0; } /* for internal use*/ static int _msgregister (int pid, char *name, void *func) { int r, i; spinlock_lock (&process_lock); for (i = 0; i < NUM_OF_MSGDSC; i++) { if (!process[pid].msgdsc[i].func) goto found; } r = -1; goto ret; found: process[pid].msgdsc[i].func = func; if (msg_register (name, pid, process[pid].gen, i) < 0) { process[pid].msgdsc[i].func = NULL; r = -1; } else { r = i; } ret: spinlock_unlock (&process_lock); return r; } /* for kernel (VMM) */ int msgregister (char *name, void *func) { return _msgregister (0, name, func); } /* si=name di=func */ ulong sys_msgregister (ulong ip, ulong sp, ulong num, ulong si, ulong di) { char name[MSG_NAMELEN]; if (!is_range_valid (si, MSG_NAMELEN)) return (ulong)-1L; memcpy (name, (void *)si, MSG_NAMELEN); name[MSG_NAMELEN - 1] = '\0'; return _msgregister (currentcpu->pid, name, (void *)di); } /* for internal use */ static int _msgopen (int pid, char *name) { int mpid, mgen, mdesc; if (msg_findname (name, &mpid, &mgen, &mdesc)) return -1; return _msgopen_2 (pid, mpid, mgen, mdesc); } /* for kernel (VMM) */ int msgopen (char *name) { return _msgopen (0, name); } /* si=name */ ulong sys_msgopen (ulong ip, ulong sp, ulong num, ulong si, ulong di) { char name[MSG_NAMELEN]; if (!is_range_valid (si, MSG_NAMELEN)) return (ulong)-1L; memcpy (name, (void *)si, MSG_NAMELEN); name[MSG_NAMELEN - 1] = '\0'; return _msgopen (currentcpu->pid, name); } /* for internal use */ static int _msgclose (int pid, int desc) { if (desc >= 0 && desc < NUM_OF_MSGDSC) { spinlock_lock (&process_lock); process[pid].msgdsc[desc].pid = 0; process[pid].msgdsc[desc].gen = 0; spinlock_unlock (&process_lock); return 0; } return -1; } /* for kernel (VMM) */ int msgclose (int desc) { return _msgclose (0, desc); } /* si=desc */ ulong sys_msgclose (ulong ip, ulong sp, ulong num, ulong si, ulong di) { return _msgclose (currentcpu->pid, si); } /* for internal use */ static int _msgsendint (int pid, int desc, int data) { int mpid, mgen, mdesc; long d[2]; d[0] = MSG_INT; d[1] = data; spinlock_lock (&process_lock); mpid = process[pid].msgdsc[desc].pid; mgen = process[pid].msgdsc[desc].gen; mdesc = process[pid].msgdsc[desc].dsc; spinlock_unlock (&process_lock); return call_msgfunc1 (mpid, mgen, mdesc, d, sizeof (d), NULL, 0, NULL, 0); } /* for kernel (VMM) */ int msgsendint (int desc, int data) { return _msgsendint (0, desc, data); } /* si=desc di=data */ ulong sys_msgsendint (ulong ip, ulong sp, ulong num, ulong si, ulong di) { return _msgsendint (currentcpu->pid, si, di); } /* si=retval */ ulong sys_msgret (ulong ip, ulong sp, ulong num, ulong si, ulong di) { callret ((int)si); return 0; /* Not reached. */ } /* for internal use */ static int _msgsenddesc (int frompid, int todesc, int senddesc) { int topid, togen, i, r = -1; if (senddesc < 0 || senddesc >= NUM_OF_MSGDSC) return -1; if (todesc < 0 || todesc >= NUM_OF_MSGDSC) return -1; spinlock_lock (&process_lock); topid = process[frompid].msgdsc[todesc].pid; togen = process[frompid].msgdsc[todesc].gen; ASSERT (topid >= 0); ASSERT (topid < NUM_OF_PID); if (!process[topid].valid) goto ret; if (process[topid].gen != togen) goto ret; for (i = 0; i < NUM_OF_MSGDSCRECV; i++) { if (process[topid].msgdsc[i].pid == 0 && process[topid].msgdsc[i].gen == 0) goto found; } goto ret; found: process[topid].msgdsc[i].pid = process[frompid].msgdsc[senddesc].pid; process[topid].msgdsc[i].gen = process[frompid].msgdsc[senddesc].gen; process[topid].msgdsc[i].dsc = process[frompid].msgdsc[senddesc].dsc; r = i; ret: spinlock_unlock (&process_lock); return r; } /* for kernel (VMM) */ int msgsenddesc (int desc, int data) { return _msgsenddesc (0, desc, data); } /* si=desc di=data */ ulong sys_msgsenddesc (ulong ip, ulong sp, ulong num, ulong si, ulong di) { return _msgsenddesc (currentcpu->pid, si, di); } static void * _builtin_find (char *name) { int i; for (i = 0; process_builtin[i].name; i++) { if (strcmp (name, process_builtin[i].name) == 0) return process_builtin[i].bin; } return NULL; } static int _newprocess (int frompid, char *name) { void *bin = NULL; if (!bin) bin = _builtin_find (name); if (!bin) return -1; return process_new (frompid, bin); } int newprocess (char *name) { return _newprocess (0, name); } /* si=name */ ulong sys_newprocess (ulong ip, ulong sp, ulong num, ulong si, ulong di) { char name[PROCESS_NAMELEN]; memcpy (name, (void *)si, PROCESS_NAMELEN); name[PROCESS_NAMELEN - 1] = '\0'; return (ulong)_newprocess (currentcpu->pid, name); } /* for internal use */ static int _msgsendbuf (int pid, int desc, int data, void *sendbuf, int sendlen, void *recvbuf, int recvlen) { int mpid, mgen, mdesc; long d[2]; d[0] = MSG_BUF; d[1] = data; spinlock_lock (&process_lock); mpid = process[pid].msgdsc[desc].pid; mgen = process[pid].msgdsc[desc].gen; mdesc = process[pid].msgdsc[desc].dsc; spinlock_unlock (&process_lock); return call_msgfunc1 (mpid, mgen, mdesc, d, sizeof (d), sendbuf, sendlen, recvbuf, recvlen); } /* for kernel (VMM) */ int msgsendbuf (int desc, int data, void *sendbuf, int sendlen, void *recvbuf, int recvlen) { return _msgsendbuf (0, desc, data, sendbuf, sendlen, recvbuf, recvlen); } /* si=desc di=data sp=others */ ulong sys_msgsendbuf (ulong ip, ulong sp, ulong num, ulong si, ulong di) { struct msgsendbuf_args { int data; void *sendbuf; int sendlen; void *recvbuf; int recvlen; } *q = (struct msgsendbuf_args *)di; if (!is_range_valid (di, sizeof *q)) return (ulong)-1L; if (!is_range_valid ((ulong)q->sendbuf, q->sendlen)) return (ulong)-1L; if (!is_range_valid ((ulong)q->recvbuf, q->recvlen)) return (ulong)-1L; return _msgsendbuf (currentcpu->pid, si, q->data, q->sendbuf, q->sendlen, q->recvbuf, q->recvlen); } static int _msgunregister (int pid, int desc) { ASSERT (pid >= 0); ASSERT (pid < NUM_OF_PID); if (desc < 0 || desc >= NUM_OF_MSGDSC) return -1; process[pid].msgdsc[desc].func = NULL; return msg_unregister2 (pid, desc); } /* for kernel (VMM) */ int msgunregister (int desc) { return _msgunregister (0, desc); } /* si=desc */ ulong sys_msgunregister (ulong ip, ulong sp, ulong num, ulong si, ulong di) { return _msgunregister (currentcpu->pid, (int)si); } void exitprocess (int retval) { panic ("exitprocess inside VMM."); } /* si=retval */ ulong sys_exitprocess (ulong ip, ulong sp, ulong num, ulong si, ulong di) { if (!syscallstack) panic ("sys_exitprocess failed."); process[currentcpu->pid].exitflag = true; callret ((int)si); return 0; /* Not reached. */ } static syscall_func_t syscall_table[NUM_OF_SYSCALLS] = { NULL, /* 0 */ sys_nop, NULL, sys_msgsetfunc, sys_msgregister, sys_msgopen, /* 5 */ sys_msgclose, sys_msgsendint, sys_msgret, sys_msgsenddesc, sys_newprocess, /* 10 */ sys_msgsendbuf, sys_msgunregister, sys_exitprocess, }; __attribute__ ((regparm (1))) void process_syscall (struct syscall_regs *regs) { if (regs->rbx < NUM_OF_SYSCALLS && syscall_table[regs->rbx]) { regs->rax = syscall_table[regs->rbx] (regs->rdx, regs->rcx, regs->rbx, regs->rsi, regs->rdi); return; } printf ("Bad system call.\n"); printf ("rax:0x%lX rbx(num):0x%lX rcx(rsp):0x%lX rdx(eip):0x%lX\n", regs->rax, regs->rbx, regs->rcx, regs->rdx); printf ("rsp:0x%lX rbp:0x%lX rsi:0x%lX rdi:0x%lX\n", regs->rsp, regs->rbp, regs->rsi, regs->rdi); process_kill (NULL, NULL); panic ("process_kill failed."); } INITFUNC ("global3", process_init_global); INITFUNC ("ap0", process_init_ap); tinyvisor/vmm/core/string.s0000644006644000001440000001064211733227577016326 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ .include "longmode.h" .text .globl memset .globl memcpy .globl strcmp .globl memcmp .globl strlen .if longmode .set memset, memset64 .set memcpy, memcpy64 .set strcmp, strcmp64 .set memcmp, memcmp64 .set strlen, strlen64 .else .set memset, memset32 .set memcpy, memcpy32 .set strcmp, strcmp32 .set memcmp, memcmp32 .set strlen, strlen32 .endif .code32 .align 64 memset32: push %edi mov 8(%esp),%edi mov 12(%esp),%al mov 16(%esp),%ecx cld mov %al,%ah shr %ecx jc 1f mov %eax,%edx shl $16,%eax mov %dx,%ax shr %ecx jc 2f rep stosl mov 8(%esp),%eax pop %edi ret 1: rep stosw stosb mov 8(%esp),%eax pop %edi ret 2: rep stosl stosw mov 8(%esp),%eax pop %edi ret .align 64 memcpy32: push %esi push %edi mov 12(%esp),%edi mov 16(%esp),%esi mov 20(%esp),%ecx cld mov %edi,%eax shr %ecx jc 1f shr %ecx jc 2f rep movsl pop %edi pop %esi ret 1: rep movsw movsb pop %edi pop %esi ret 2: rep movsl movsw pop %edi pop %esi ret .align 64 strcmp32: push %esi push %edi mov 12(%esp),%edi mov 16(%esp),%esi xor %eax,%eax cld 1: lodsb scasb jne 1f test %al,%al jne 1b pop %edi pop %esi ret 1: setnc %al setc %ah ror %eax pop %edi pop %esi ret .align 64 memcmp32: push %esi push %edi mov 12(%esp),%edi mov 16(%esp),%esi mov 20(%esp),%ecx xor %eax,%eax cld shr %ecx jc 1f shr %ecx jc 2f repe cmpsl jne 3f pop %edi pop %esi ret 1: repe cmpsw jne 3f cmpsb jne 3f pop %edi pop %esi ret 2: repe cmpsl jne 3f cmpsw jne 3f pop %edi pop %esi ret 3: setnc %al setc %ah ror %eax pop %edi pop %esi ret .align 64 strlen32: mov %edi,%edx mov 4(%esp),%edi cld mov $-1,%ecx mov $0,%al repne scasb lea 1(%ecx),%eax not %eax mov %edx,%edi ret .code64 .align 64 memset64: mov %esi,%eax mov %rdx,%rcx cld mov %al,%ah shr %rcx jc 1f mov %eax,%edx shl $16,%eax mov %dx,%ax shr %rcx jc 2f mov %eax,%edx shl $32,%rax or %rdx,%rax shr %rcx jc 3f mov %rdi,%rdx rep stosq mov %rdx,%rax ret 1: mov %rdi,%rdx rep stosw stosb mov %rdx,%rax ret 2: mov %rdi,%rdx rep stosl stosw mov %rdx,%rax ret 3: mov %rdi,%rdx rep stosq stosl mov %rdx,%rax ret .align 64 memcpy64: mov %rdx,%rcx cld mov %rdi,%rax shr %rcx jc 1f shr %rcx jc 2f shr %rcx jc 3f rep movsq ret 1: rep movsw movsb ret 2: rep movsl movsw ret 3: rep movsq movsl ret .align 64 strcmp64: xor %eax,%eax cld 1: lodsb scasb jne 1f test %al,%al jne 1b ret 1: setnc %al setc %ah ror %eax ret .align 64 memcmp64: mov %rdx,%rcx xor %eax,%eax cld shr %rcx jc 1f shr %rcx jc 2f shr %rcx jc 3f repe cmpsq jne 4f ret 1: repe cmpsw jne 4f cmpsb jne 4f ret 2: repe cmpsl jne 4f cmpsw jne 4f ret 3: repe cmpsq jne 4f cmpsl jne 4f ret 4: setnc %al setc %ah ror %eax ret .align 64 strlen64: cld mov $-1,%rcx mov $0,%al repne scasb lea 1(%rcx),%rax not %rax ret tinyvisor/vmm/core/gmm.h0000644006644000001440000000357612140353512015553 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_GMM_H #define _CORE_GMM_H #include struct gmm_func { phys_t (*gp2hp)(phys_t gphys); int (*get_mem_map)(int index, phys_t *base, phys_t *len, u32 *type); int (*get_mem_map_count)(void); void (*clear_mem)(void); }; #endif tinyvisor/vmm/core/panic.h0000644006644000001440000000360412007655714016070 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_PANIC_H #define _CORE_PANIC_H #include struct int_stack; void panic_int(struct int_stack *stack, const char *format, ...) __attribute__ ((format (printf, 2, 3), noreturn)); void shell(void); void __attribute__((noreturn))freeze(void); #endif tinyvisor/vmm/core/svm_main.c0000644006644000001440000003001012071455154016566 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include "apic_pass.h" #include "asm.h" #include "constants.h" #include "cpu.h" #include "cpu_mmu.h" #include "cpu_mmu_spt.h" #include "current.h" #include "extint.h" #include "panic.h" #include "pcpu.h" #include "svm_exitcode.h" #include "svm_io.h" #include "svm_main.h" #include "svm_np.h" #include "svm_regs.h" #include "thread.h" #include "vmmcall.h" static void svm_event_injection_setup (void) { struct svm_intr_data *sid = ¤t->u.svm.intr; if (sid->intr_info.s.v) current->u.svm.vi.vmcb->eventinj = sid->intr_info.v; } static void svm_vm_run () { asm_vmrun_regs (¤t->u.svm.vr, current->u.svm.vi.vmcb_phys, currentcpu->svm.vmcbhost_phys); } static void svm_event_injection_check (void) { struct svm_intr_data *sid = ¤t->u.svm.intr; sid->intr_info.s.v = 0; } static void task_switch_load_segdesc (u16 sel, ulong gdtr_base, ulong gdtr_limit, struct vmcb_seg *seg) { ulong addr, ldt_attr, desc_base, desc_limit; union { struct segdesc s; u64 v; } desc; vmmerr_t r; struct vmcb *vmcb; vmcb = current->u.svm.vi.vmcb; /* FIXME: set busy bit */ if (sel == 0) return; if (sel & SEL_LDT_BIT) { ldt_attr = vmcb->ldtr.attr; desc_base = vmcb->ldtr.base; desc_limit = vmcb->ldtr.limit; if (!(ldt_attr & 0x80)) panic ("loadseg: LDT unusable. sel=0x%X, seg=%p\n", sel, seg); addr = sel & ~(SEL_LDT_BIT | SEL_PRIV_MASK); } else { desc_base = gdtr_base; desc_limit = gdtr_limit; addr = sel & ~(SEL_LDT_BIT | SEL_PRIV_MASK); } if ((addr | 7) > desc_limit) panic ("loadseg: limit check failed"); addr += desc_base; r = read_linearaddr_q (addr, &desc.v); if (r != VMMERR_SUCCESS) panic ("loadseg: cannot read descriptor"); if (desc.s.s == SEGDESC_S_CODE_OR_DATA_SEGMENT) desc.s.type |= 1; /* accessed bit */ seg->attr = ((desc.v >> 40) & 0xFF) | ((desc.v >> 44) & 0xF00); seg->base = SEGDESC_BASE (desc.s); seg->limit = ((desc.s.limit_15_0 | (desc.s.limit_19_16 << 16)) << (desc.s.g ? 12 : 0)) | (desc.s.g ? 0xFFF : 0); } static void svm_task_switch (void) { vmmerr_t r; union { struct exitinfo2_task_switch s; u64 v; } e2; ulong tr_sel, to_sel; ulong gdtr_base, gdtr_limit; union { struct segdesc s; u64 v; } tss1_desc, tss2_desc; struct tss32 tss32_1, tss32_2; ulong rflags, tmp; u16 tmp16; struct vmcb *vmcb; vmcb = current->u.svm.vi.vmcb; /* FIXME: 16bit TSS */ /* FIXME: generate an exception if errors */ /* FIXME: virtual 8086 mode */ e2.v = vmcb->exitinfo2; tr_sel = vmcb->tr.sel; to_sel = vmcb->exitinfo1 & 0xFFFF; printf ("task switch from 0x%lX to 0x%lX\n", tr_sel, to_sel); gdtr_base = vmcb->gdtr.base; gdtr_limit = vmcb->gdtr.limit; r = read_linearaddr_q (gdtr_base + tr_sel, &tss1_desc.v); if (r != VMMERR_SUCCESS) goto err; r = read_linearaddr_q (gdtr_base + to_sel, &tss2_desc.v); if (r != VMMERR_SUCCESS) goto err; if (e2.s.has_err) panic ("svm_task_switch: error code"); if (tss1_desc.s.type == SEGDESC_TYPE_16BIT_TSS_BUSY) panic ("task switch from 16bit TSS is not implemented."); if (tss1_desc.s.type != SEGDESC_TYPE_32BIT_TSS_BUSY) panic ("bad TSS descriptor 0x%llX", tss1_desc.v); if (e2.s.iret || e2.s.jump) tss1_desc.s.type = SEGDESC_TYPE_32BIT_TSS_AVAILABLE; if (e2.s.iret) { if (tss2_desc.s.type == SEGDESC_TYPE_16BIT_TSS_BUSY) panic ("task switch to 16bit TSS is not implemented."); if (tss2_desc.s.type != SEGDESC_TYPE_32BIT_TSS_BUSY) panic ("bad TSS descriptor 0x%llX", tss1_desc.v); } else { if (tss2_desc.s.type == SEGDESC_TYPE_16BIT_TSS_AVAILABLE) panic ("task switch to 16bit TSS is not implemented."); if (tss2_desc.s.type != SEGDESC_TYPE_32BIT_TSS_AVAILABLE) panic ("bad TSS descriptor 0x%llX", tss1_desc.v); tss2_desc.s.type = SEGDESC_TYPE_32BIT_TSS_BUSY; } r = read_linearaddr_tss (SEGDESC_BASE (tss1_desc.s), &tss32_1, sizeof tss32_1); if (r != VMMERR_SUCCESS) goto err; r = read_linearaddr_tss (SEGDESC_BASE (tss2_desc.s), &tss32_2, sizeof tss32_2); if (r != VMMERR_SUCCESS) goto err; /* save old state */ rflags = vmcb->rflags; if (e2.s.iret) rflags &= ~RFLAGS_NT_BIT; svm_read_general_reg (GENERAL_REG_RAX, &tmp); tss32_1.eax = tmp; svm_read_general_reg (GENERAL_REG_RCX, &tmp); tss32_1.ecx = tmp; svm_read_general_reg (GENERAL_REG_RDX, &tmp); tss32_1.edx = tmp; svm_read_general_reg (GENERAL_REG_RBX, &tmp); tss32_1.ebx = tmp; svm_read_general_reg (GENERAL_REG_RSP, &tmp); tss32_1.esp = tmp; svm_read_general_reg (GENERAL_REG_RBP, &tmp); tss32_1.ebp = tmp; svm_read_general_reg (GENERAL_REG_RSI, &tmp); tss32_1.esi = tmp; svm_read_general_reg (GENERAL_REG_RDI, &tmp); tss32_1.edi = tmp; svm_read_sreg_sel (SREG_ES, &tmp16); tss32_1.es = tmp16; svm_read_sreg_sel (SREG_CS, &tmp16); tss32_1.cs = tmp16; svm_read_sreg_sel (SREG_SS, &tmp16); tss32_1.ss = tmp16; svm_read_sreg_sel (SREG_DS, &tmp16); tss32_1.ds = tmp16; svm_read_sreg_sel (SREG_FS, &tmp16); tss32_1.fs = tmp16; svm_read_sreg_sel (SREG_GS, &tmp16); tss32_1.gs = tmp16; tss32_1.eflags = rflags; svm_read_ip (&tmp); tss32_1.eip = tmp; r = write_linearaddr_q (gdtr_base + tr_sel, tss1_desc.v); if (r != VMMERR_SUCCESS) goto err; r = write_linearaddr_tss (SEGDESC_BASE (tss1_desc.s), &tss32_1, sizeof tss32_1); if (r != VMMERR_SUCCESS) goto err; /* load new state */ rflags = tss32_2.eflags; if (!e2.s.iret && !e2.s.jump) { rflags |= RFLAGS_NT_BIT; tss32_2.link = tr_sel; } rflags |= RFLAGS_ALWAYS1_BIT; svm_write_general_reg (GENERAL_REG_RAX, tss32_2.eax); svm_write_general_reg (GENERAL_REG_RCX, tss32_2.ecx); svm_write_general_reg (GENERAL_REG_RDX, tss32_2.edx); svm_write_general_reg (GENERAL_REG_RBX, tss32_2.ebx); svm_write_general_reg (GENERAL_REG_RSP, tss32_2.esp); svm_write_general_reg (GENERAL_REG_RBP, tss32_2.ebp); svm_write_general_reg (GENERAL_REG_RSI, tss32_2.esi); svm_write_general_reg (GENERAL_REG_RDI, tss32_2.edi); vmcb->es.sel = tss32_2.es; vmcb->cs.sel = tss32_2.cs; vmcb->ss.sel = tss32_2.ss; vmcb->ds.sel = tss32_2.ds; vmcb->fs.sel = tss32_2.fs; vmcb->gs.sel = tss32_2.gs; vmcb->tr.sel = to_sel; vmcb->ldtr.sel = tss32_2.ldt; vmcb->es.attr = 0; vmcb->cs.attr = 0; vmcb->ss.attr = 0; vmcb->ds.attr = 0; vmcb->fs.attr = 0; vmcb->gs.attr = 0; vmcb->tr.attr = 0; vmcb->ldtr.attr = 0; svm_write_flags (rflags); svm_write_ip (tss32_2.eip); svm_write_control_reg (CONTROL_REG_CR3, tss32_2.cr3); r = write_linearaddr_q (gdtr_base + to_sel, tss2_desc.v); if (r != VMMERR_SUCCESS) goto err; r = write_linearaddr_tss (SEGDESC_BASE (tss2_desc.s), &tss32_2, sizeof tss32_2); if (r != VMMERR_SUCCESS) goto err; /* load segment descriptors */ if (rflags & RFLAGS_VM_BIT) panic ("switching to virtual 8086 mode"); task_switch_load_segdesc (to_sel, gdtr_base, gdtr_limit, &vmcb->tr); task_switch_load_segdesc (tss32_2.ldt, gdtr_base, gdtr_limit, &vmcb->ldtr); task_switch_load_segdesc (tss32_2.es, gdtr_base, gdtr_limit, &vmcb->es); task_switch_load_segdesc (tss32_2.cs, gdtr_base, gdtr_limit, &vmcb->cs); task_switch_load_segdesc (tss32_2.ss, gdtr_base, gdtr_limit, &vmcb->ss); task_switch_load_segdesc (tss32_2.ds, gdtr_base, gdtr_limit, &vmcb->ds); task_switch_load_segdesc (tss32_2.fs, gdtr_base, gdtr_limit, &vmcb->fs); task_switch_load_segdesc (tss32_2.gs, gdtr_base, gdtr_limit, &vmcb->gs); svm_read_control_reg (CONTROL_REG_CR0, &tmp); tmp |= CR0_TS_BIT; svm_write_control_reg (CONTROL_REG_CR0, tmp); return; err: panic ("svm_task_switch: error %d", r); } static void do_pagefault (void) { struct vmcb *vmcb; if (current->u.svm.np) panic ("page fault while np enabled"); vmcb = current->u.svm.vi.vmcb; cpu_mmu_spt_pagefault ((ulong)vmcb->exitinfo1, (ulong)vmcb->exitinfo2); } static void call_cpu_interpreter(void) { vmmerr_t err; err = cpu_interpreter (); if (err != VMMERR_SUCCESS) panic ("ERR %d", err); } static void do_readwrite_msr (void) { vmmerr_t err; struct svm_intr_data *sid = ¤t->u.svm.intr; err = cpu_interpreter (); if (err == VMMERR_MSR_FAULT) { sid->intr_info.v = 0; sid->intr_info.s.vector = EXCEPTION_GP; sid->intr_info.s.type = VMCB_EVENTINJ_TYPE_EXCEPTION; sid->intr_info.s.ev = 1; sid->intr_info.s.v = 1; sid->intr_info.s.errorcode = 0; } else if (err != VMMERR_SUCCESS) panic ("ERR %d", err); } static void do_npf (void) { struct vmcb *vmcb; vmcb = current->u.svm.vi.vmcb; svm_np_pagefault ((ulong)vmcb->exitinfo1, (ulong)vmcb->exitinfo2); } static void do_vmmcall (void) { current->u.svm.vi.vmcb->rip += 3; vmmcall (); } static void svm_exit_code () { switch (current->u.svm.vi.vmcb->exitcode) { case VMEXIT_EXCP14: /* Page fault */ do_pagefault (); break; case VMEXIT_CR0_READ: case VMEXIT_CR0_WRITE: case VMEXIT_CR3_READ: case VMEXIT_CR3_WRITE: case VMEXIT_CR4_READ: case VMEXIT_CR4_WRITE: case VMEXIT_CR8_READ: case VMEXIT_CR8_WRITE: call_cpu_interpreter(); break; case VMEXIT_IOIO: svm_ioio (); break; case VMEXIT_INVLPG: call_cpu_interpreter(); break; case VMEXIT_TASK_SWITCH: svm_task_switch (); break; case VMEXIT_INTR: /* * extint_check_interrupt will be inject the pending * interrupt or keep it. */ break; case VMEXIT_VINTR: /* * extint_check_interrupt will be inject the pending * interrupt. */ break; case VMEXIT_NMI: panic("NMI recieved while executing guest software."); break; case VMEXIT_MSR: do_readwrite_msr (); break; case VMEXIT_NPF: do_npf (); break; case VMEXIT_VMMCALL: do_vmmcall (); break; case VMEXIT_SWINT: call_cpu_interpreter(); break; default: panic ("unsupported exitcode 0x%llx", current->u.svm.vi.vmcb->exitcode); } } static void svm_tlbflush (void) { struct vmcb *vmcb; vmcb = current->u.svm.vi.vmcb; if (current->u.svm.np) { if (svm_np_tlbflush ()) vmcb->tlb_control = VMCB_TLB_CONTROL_FLUSH_TLB; else vmcb->tlb_control = VMCB_TLB_CONTROL_DO_NOTHING; } else { if (cpu_mmu_spt_tlbflush ()) vmcb->tlb_control = VMCB_TLB_CONTROL_FLUSH_TLB; else vmcb->tlb_control = VMCB_TLB_CONTROL_DO_NOTHING; } } static void svm_mainloop (void) { enable_interrupt(); for (;;) { schedule (); apic_handle_wait_for_sipi_state(); disable_interrupt(); extint_check_interrupt (); svm_event_injection_setup (); svm_vm_run (); svm_tlbflush (); svm_event_injection_check (); svm_exit_code (); enable_interrupt(); } } void svm_invlpg (ulong addr) { if (!current->u.svm.np) cpu_mmu_spt_invalidate (addr); else panic ("invlpg while np enabled"); } void svm_run_vm (void) { svm_mainloop (); } tinyvisor/vmm/core/vt_ept.c0000644006644000001440000003562612027612776016306 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include #include #include #include "apic_pass.h" #include "asm.h" #include "cpu_mmu.h" #include "mm.h" #include "mtrr.h" #include "vt_internal.h" #include "constants.h" #include "current.h" #define EPT_PAGE_NUM 1024 #define EPT_MAX_LEVEL 4 #define EPT_LEVEL_STRIDE (9) #define EPT_LEVEL_MASK ((1 << EPT_LEVEL_STRIDE) - 1) #define EPT_READ 0x1 #define EPT_WRITE 0x2 #define EPT_EXECUTE 0x4 #define EPT_VAILED_MASK 0x7 #define EPT_PS 0x80 #define EPT_MEMTYPE_TO_PTE(memtype) ((memtype) << 3) #define VMCS_EPT_POINTER_ADDR_WB 0x6 #define VMCS_EPT_POINTER_ADDR_EPT_LENGTH ((EPT_MAX_LEVEL - 1) << 3) #define VMCS_EXIT_QUALIFICATION_READ_BIT 0x1 #define VMCS_EXIT_QUALIFICATION_WRITE_BIT 0x2 #define VMCS_EXIT_QUALIFICATION_INST_BIT 0x4 #define VMCS_EXIT_QUALIFICATION_LINEAR_ADDR_VALID_BIT 0x80 #define ept_offset(addr, level) \ ((addr >> (PAGE_SHIFT + (level - 1) * EPT_LEVEL_STRIDE)) \ & EPT_LEVEL_MASK) struct ept_tbl { LIST2_DEFINE(struct ept_tbl, list); u64 *referenced_pte; void *virt; phys_t phys; }; static void vt_ept_invalidate_tlb(void) { struct { u64 ept_l4tbl; u64 reserved; } desc; desc.ept_l4tbl = current->vm->vt.ept_l4tbl; desc.reserved = 0; asm_invept(&desc); } void vt_ept_init(void) { struct vt_vm_data *vt_data = ¤t->vm->vt; u32 ctls; u32 ctls_or, ctls_and; u32 ctls2_or, ctls2_and; u32 exit_ctls_or, exit_ctls_and; u32 entry_ctls_or, entry_ctls_and; void *vaddr; vmmerr_t err; u64 pat; struct ept_tbl *tbls, *tbl; int i; asm_rdmsr32(MSR_IA32_VMX_PROCBASED_CTLS, &ctls_or, &ctls_and); if ((ctls_and & VMCS_PROC_BASED_VMEXEC_CTL_SEC_CTL_BIT) == 0 || ctls_or & VMCS_PROC_BASED_VMEXEC_CTL_INVLPGEXIT_BIT) { return; } asm_rdmsr32(MSR_IA32_VMX_PROCBASED_CTLS2, &ctls2_or, &ctls2_and); if ((ctls2_and & VMCS_PROC_BASED_VMEXEC_CTL2_EPT_BIT) == 0) { return; } asm_rdmsr32(MSR_IA32_VMX_EXIT_CTLS, &exit_ctls_or, &exit_ctls_and); if ((exit_ctls_or & VMCS_VMEXIT_CTL_LOAD_IA32_PAT_BIT) || (exit_ctls_and & VMCS_VMEXIT_CTL_LOAD_IA32_PAT_BIT) == 0) { return; } asm_rdmsr32 (MSR_IA32_VMX_ENTRY_CTLS, &entry_ctls_or, &entry_ctls_and); if ((entry_ctls_or & VMCS_VMENTRY_CTL_LOAD_IA32_PAT_BIT) || (entry_ctls_and & VMCS_VMENTRY_CTL_LOAD_IA32_PAT_BIT) == 0) { return; } if (cpu_is_bsp()) { printf("Enabling EPT\n"); } current->u.vt.ept_enabled = true; spinlock_lock(&vt_data->ept_lock); if (vt_data->ept_l4tbl == 0) { LIST2_HEAD_INIT(vt_data->ept_tbl_free_list); LIST2_HEAD_INIT(vt_data->ept_tbl_l1_list); err = alloc_page(&vaddr, &vt_data->ept_l4tbl); if (err) { panic("Failed to allocate a ept l4tbl."); } memset(vaddr, 0, PAGE_SIZE); tbls = alloc(sizeof(struct ept_tbl) * EPT_PAGE_NUM); if (tbls == NULL) { panic("Failed to allocate struct ept_tbl"); } for (i = 0; i < EPT_PAGE_NUM; i++) { tbl = tbls + i; err = alloc_page(&tbl->virt, &tbl->phys); if (err) { panic("Failed to allocate ept tbl."); } memset(tbl->virt, 0, PAGE_SIZE); LIST2_ADD(vt_data->ept_tbl_free_list, list, tbl); } } spinlock_unlock(&vt_data->ept_lock); ctls = ctls2_or | VMCS_PROC_BASED_VMEXEC_CTL2_EPT_BIT; asm_vmwrite32(VMCS_PROC_BASED_VMEXEC_CTL2, ctls); asm_vmread32(VMCS_PROC_BASED_VMEXEC_CTL, &ctls); ctls &= ~VMCS_PROC_BASED_VMEXEC_CTL_INVLPGEXIT_BIT; ctls |= VMCS_PROC_BASED_VMEXEC_CTL_SEC_CTL_BIT; asm_vmwrite32(VMCS_PROC_BASED_VMEXEC_CTL, ctls); asm_vmwrite32(VMCS_EXCEPTION_BMP, 0xffffbfff); asm_vmwrite32(VMCS_PAGEFAULT_ERRCODE_MASK, 0); asm_vmwrite32(VMCS_PAGEFAULT_ERRCODE_MATCH, 0xffffffff); asm_vmwrite64(VMCS_EPT_POINTER_ADDR, vt_data->ept_l4tbl | VMCS_EPT_POINTER_ADDR_WB | VMCS_EPT_POINTER_ADDR_EPT_LENGTH); asm_vmread32(VMCS_VMEXIT_CTL, &ctls); ctls |= VMCS_VMEXIT_CTL_LOAD_IA32_PAT_BIT; asm_vmwrite32(VMCS_VMEXIT_CTL, ctls); asm_vmread32(VMCS_VMENTRY_CTL, &ctls); ctls |= VMCS_VMENTRY_CTL_LOAD_IA32_PAT_BIT; asm_vmwrite32(VMCS_VMENTRY_CTL, ctls); asm_rdmsr64(MSR_IA32_PAT, &pat); asm_vmwrite64(VMCS_HOST_IA32_PAT, pat); /* * Guest IA32_PAT will be set by msr_init * so that we don't need to set guest IA32_PAT here. */ } static u64 * vt_ept_walk(phys_t gphys, void *ept_l4tbl, int req_level, int *result_level) { u64 *tbl; int offset; u64 *pte; int level; struct ept_tbl *stbl; void *virt; phys_t phys; struct vt_vm_data *vt_data = ¤t->vm->vt; tbl = ept_l4tbl; for (level = EPT_MAX_LEVEL; level >= req_level + 1; level--) { offset = ept_offset(gphys, level); pte = &tbl[offset]; if ((*pte & EPT_VAILED_MASK) == 0) { /* * Allocate new ept table. */ stbl = LIST2_POP(vt_data->ept_tbl_free_list, list); if (stbl == NULL) { stbl = LIST2_POP(vt_data->ept_tbl_l1_list, list); if (stbl == NULL) { panic("No usable ept tbl"); } *stbl->referenced_pte = 0; } if (level == 2) { LIST2_ADD(vt_data->ept_tbl_l1_list, list, stbl); } stbl->referenced_pte = pte; virt = stbl->virt; phys = stbl->phys; memset(virt, 0, PAGE_SIZE); /* * Set pte. */ *pte = (phys & PAGE_MASK) | EPT_READ | EPT_WRITE | EPT_EXECUTE; } else { if (*pte & EPT_PS) { break; } phys = *pte & PAGE_MASK; virt = (void *)phys_to_virt(phys); } tbl = (u64 *)virt; }; *result_level = level; return tbl + ept_offset(gphys, level); } static void vt_ept_generate_pagefault(vmmerr_t vmmerr) { bool wr, us; ulong linear_addr; ulong qual; asm_vmread(VMCS_EXIT_QUALIFICATION, &qual); if ((qual & VMCS_EXIT_QUALIFICATION_LINEAR_ADDR_VALID_BIT) == 0) { panic("EPT violation without linear address. qual 0x%lx", qual); } wr = qual & VMCS_EXIT_QUALIFICATION_WRITE_BIT ? true : false; us = seg_user_mode(); asm_vmread(VMCS_GUEST_LINEAR_ADDR, &linear_addr); printf("vt_ept_generate_pagefault 0x%lx wr %d us %d\n", linear_addr, wr, us); mmu_generate_pagefault(vmmerr, wr, us, linear_addr); } static vmmerr_t vt_ept_map_4kpage(phys_t gphys) { struct vt_vm_data *vt_data = ¤t->vm->vt; void *ept_l4tbl; u64 *pte; u8 memtype; phys_t hphys; int level; gphys = ROUND_DOWN(gphys, PAGESIZE); hphys = current->vm->gmm.gp2hp(gphys); if (hphys == GMM_NO_MAPPING) { return VMMERR_RANGE; } memtype = mtrr_get_mem_type(hphys); spinlock_lock(&vt_data->ept_lock); ept_l4tbl = (void *)phys_to_virt(vt_data->ept_l4tbl); pte = vt_ept_walk(gphys, ept_l4tbl, 1, &level); if (pte == NULL) { spinlock_unlock(&vt_data->ept_lock); return VMMERR_NOMEM; } if (level != 1) { panic("EPT 2M page is already mapped. " "gphys 0x%llx, hphys 0x%llx, pte 0x%llx", gphys, hphys, *pte); } if (*pte & EPT_VAILED_MASK) { if ((*pte & PAGE_MASK) != (hphys & PAGE_MASK)) { panic("EPT PTE is already set. " "gphys 0x%llx, hphys 0x%llx, pte 0x%llx", gphys, hphys, *pte); } } else { *pte = (hphys & PAGE_MASK) | EPT_READ | EPT_WRITE | EPT_EXECUTE | EPT_MEMTYPE_TO_PTE(memtype); } spinlock_unlock(&vt_data->ept_lock); return VMMERR_SUCCESS; } static vmmerr_t vt_ept_map_2mpage(phys_t gphys) { struct vt_vm_data *vt_data = ¤t->vm->vt; void *ept_l4tbl; u64 *pte; u8 memtype; phys_t hphys; phys_t cur_hphys; phys_t cur_gphys; int level; gphys = ROUND_DOWN(gphys, PAGESIZE2M); hphys = current->vm->gmm.gp2hp(gphys); if (hphys == GMM_NO_MAPPING) { return VMMERR_RANGE; } if ((hphys & PAGESIZE2M_MASK) != 0) { return VMMERR_NOSUP; } memtype = mtrr_get_mem_type(hphys); cur_hphys = hphys + PAGESIZE; for (cur_gphys = gphys + PAGESIZE; cur_gphys < gphys + PAGESIZE2M; cur_gphys += PAGESIZE) { if (cur_hphys != current->vm->gmm.gp2hp(cur_gphys)) { return VMMERR_NOT_CONTIGUOUS; } if (memtype != mtrr_get_mem_type(cur_hphys)) { return VMMERR_NOT_CONTIGUOUS; } cur_hphys += PAGESIZE; } spinlock_lock(&vt_data->ept_lock); ept_l4tbl = (void *)phys_to_virt(vt_data->ept_l4tbl); pte = vt_ept_walk(gphys, ept_l4tbl, 2, &level); if (pte == NULL) { spinlock_unlock(&vt_data->ept_lock); return VMMERR_NOMEM; } if (level != 2) { panic("EPT 2M page is already mapped. " "gphys 0x%llx, hphys 0x%llx, pte 0x%llx", gphys, hphys, *pte); } if (*pte & EPT_VAILED_MASK) { if ((*pte & EPT_PS) == 0) { panic("EPT L2 PTE is already set, but not 2M page. " "gphys 0x%llx, hphys 0x%llx, pte 0x%llx", gphys, hphys, *pte); } if ((*pte & PAGE_MASK) != (hphys & PAGE_MASK)) { panic("EPT L2 PTE (2M) is already set. " "gphys 0x%llx, hphys 0x%llx, pte 0x%llx", gphys, hphys, *pte); } } else { *pte = (hphys & PAGE_MASK) | EPT_PS | EPT_READ | EPT_WRITE | EPT_EXECUTE | EPT_MEMTYPE_TO_PTE(memtype); } spinlock_unlock(&vt_data->ept_lock); return VMMERR_SUCCESS; } void vt_ept_violation(void) { phys_t gphys; vmmerr_t ret; asm_vmread64(VMCS_GUEST_PHYS_ADDR, &gphys); mmio_lock(); ret = mmio_pagefault(gphys); mmio_unlock(); if (ret != VMMERR_NODEV) { if (ret == VMMERR_SUCCESS) { return; } if (ret < VMMERR_PAGE_NOT_PRESENT || ret > VMMERR_PAGE_BAD_RESERVED_BIT) { panic("Failed to emulate accessing to MMIO area. ret 0x%x", ret); } vt_ept_generate_pagefault(ret); return; } ret = vt_ept_map_4kpage(gphys); if (ret != VMMERR_SUCCESS) { if (ret != VMMERR_RANGE) { panic("vt_ept_violation: Unknown error 0x%x", ret); } ret = cpu_interpreter(); if (ret == VMMERR_SUCCESS) { return; } if (ret < VMMERR_PAGE_NOT_PRESENT || ret > VMMERR_PAGE_BAD_RESERVED_BIT) { panic("Failed to emulate accessing to no mapping area. ret 0x%x", ret); } vt_ept_generate_pagefault(ret); } } void vt_ept_pg_change(bool pg) { ulong cr4; u32 ctls; if (!current->u.vt.ept_enabled) { return; } if (pg) { /* * - Enable EPT. * - Don't cause VM-exit on invlpg. * - Don't cause VM-exit on page fault. * - Load IA32_PAT on VM-exit and VM-entry. * - Set Guest CR3 to the value set by guest software * instead of shadow table. */ asm_vmread32(VMCS_PROC_BASED_VMEXEC_CTL2, &ctls); ctls |= VMCS_PROC_BASED_VMEXEC_CTL2_EPT_BIT; asm_vmwrite32(VMCS_PROC_BASED_VMEXEC_CTL2, ctls); asm_vmread32(VMCS_PROC_BASED_VMEXEC_CTL, &ctls); ctls &= ~VMCS_PROC_BASED_VMEXEC_CTL_INVLPGEXIT_BIT; asm_vmwrite32(VMCS_PROC_BASED_VMEXEC_CTL, ctls); asm_vmwrite32(VMCS_EXCEPTION_BMP, 0xffffbfff); asm_vmwrite32(VMCS_PAGEFAULT_ERRCODE_MASK, 0); asm_vmwrite32(VMCS_PAGEFAULT_ERRCODE_MATCH, 0xffffffff); asm_vmread32(VMCS_VMEXIT_CTL, &ctls); ctls |= VMCS_VMEXIT_CTL_LOAD_IA32_PAT_BIT; asm_vmwrite32(VMCS_VMEXIT_CTL, ctls); asm_vmread32(VMCS_VMENTRY_CTL, &ctls); ctls |= VMCS_VMENTRY_CTL_LOAD_IA32_PAT_BIT; asm_vmwrite32(VMCS_VMENTRY_CTL, ctls); asm_vmwrite32(VMCS_GUEST_CR3, current->u.vt.vr.cr3); } else { /* * - Disable EPT. * - Cause VM-exit on invlpg. * - Cause VM-exit on page fault. * - Don't load IA32_PAT on VM-exit and VM-entry. * * Guest CR3 will be updated by cpu_mmu_spt_updatecr3, * so that we don't need to set guest CR3 here. */ asm_vmread32(VMCS_PROC_BASED_VMEXEC_CTL2, &ctls); ctls &= ~VMCS_PROC_BASED_VMEXEC_CTL2_EPT_BIT; asm_vmwrite32(VMCS_PROC_BASED_VMEXEC_CTL2, ctls); asm_vmread32(VMCS_PROC_BASED_VMEXEC_CTL, &ctls); ctls |= VMCS_PROC_BASED_VMEXEC_CTL_INVLPGEXIT_BIT; asm_vmwrite32(VMCS_PROC_BASED_VMEXEC_CTL, ctls); asm_vmwrite32(VMCS_EXCEPTION_BMP, 0xffffffff); asm_vmwrite32(VMCS_PAGEFAULT_ERRCODE_MASK, 0); asm_vmwrite32(VMCS_PAGEFAULT_ERRCODE_MATCH, 0); asm_vmread32(VMCS_VMEXIT_CTL, &ctls); ctls &= ~VMCS_VMEXIT_CTL_LOAD_IA32_PAT_BIT; asm_vmwrite32(VMCS_VMEXIT_CTL, ctls); asm_vmread32(VMCS_VMENTRY_CTL, &ctls); ctls &= ~VMCS_VMENTRY_CTL_LOAD_IA32_PAT_BIT; asm_vmwrite32(VMCS_VMENTRY_CTL, ctls); } vt_read_control_reg(CONTROL_REG_CR4, &cr4); vt_write_control_reg(CONTROL_REG_CR4, cr4); vt_ept_invalidate_tlb(); } static void vt_ept_map_memory_region(phys_t gphys, phys_t len) { phys_t cur, cur2; phys_t start, end, final_end; vmmerr_t err; final_end = ROUND_UP(gphys + len, PAGESIZE); start = ROUND_DOWN(gphys, PAGESIZE); end = MIN(ROUND_UP(gphys, PAGESIZE2M), final_end); for (cur = start; cur < end; cur += PAGESIZE) { err = vt_ept_map_4kpage(cur); if (err != VMMERR_SUCCESS) { panic("Failed to map 4K page via EPT. 0x%llx", cur); } } start = end; end = MAX(ROUND_DOWN(gphys + len, PAGESIZE2M), end); for (cur = start; cur < end; cur += PAGESIZE2M) { if (vt_ept_map_2mpage(cur)) { for (cur2 = cur; cur2 < cur + PAGESIZE2M; cur2 += PAGESIZE) { err = vt_ept_map_4kpage(cur2); if (err != VMMERR_SUCCESS) { panic("Failed to map 4k page via EPT. 0x%llx", cur2); } } } } start = end; end = final_end; for (cur = start; cur < end; cur += PAGESIZE) { err = vt_ept_map_4kpage(cur); if (err != VMMERR_SUCCESS) { panic("Failed to map 4K page via EPT. 0x%llx", cur); } } } static void vt_ept_map_all_memory(void) { int index = 0; phys_t gphys; phys_t len; u32 type; while (gmm_get_mem_map(index++, &gphys, &len, &type)) { if (type != MEM_TYPE_AVAILABLE) { continue; } vt_ept_map_memory_region(gphys, len); } } static void vt_ept_setup_vm(void) { if (currentcpu->fullvirtualize != FULLVIRTUALIZE_VT) { return; } if (!current->u.vt.ept_enabled) { return; } vt_ept_map_all_memory(); } INITFUNC("passvm3", vt_ept_setup_vm); tinyvisor/vmm/core/vcpu.h0000644006644000001440000000574312206320117015744 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #ifndef _CORE_VCPU_H #define _CORE_VCPU_H #include #include #include #include "constants.h" #include "cpu.h" #include "cpu_mmu_spt.h" #include "extint.h" #include "svm.h" #include "vm.h" #include "vmctl.h" #include "vt.h" struct apic_data { spinlock_t lock; volatile bool wait_for_sipi; volatile vector_t sipi_vector; volatile bool sipi_pending; volatile bool fake_sipi; u32 ldr; u32 icr_low; u32 icr_high; }; #define MSR_DATA_PAT_COUNT 8 struct msr_data { u64 pat_reg; u8 pat_to_cache_flag[MSR_DATA_PAT_COUNT]; }; struct vcpu { LIST2_DEFINE(struct vcpu, vcpu_list); struct vm *vm; union { struct vt vt; struct svm svm; } u; struct cpu_mmu_spt_data spt; struct msr_data msr_data; struct extint_data extint; struct apic_data apic_data; struct pcpu *pcpu; struct vmctl_func vmctl; struct int_hook int_hook[NUM_OF_INT]; bool initialized; bool vbsp; bool halt; u64 tsc_offset; bool updateip; apic_id_t apic_id; }; void vcpu_list_foreach (struct vm *vm, bool (*func) (struct vcpu *p, void *q), void *q); struct vcpu *find_vcpu_with_apic_id (struct vm *vm, apic_id_t apic_id); struct vcpu *new_vcpu (struct vm *vm, bool vbsp); struct vcpu *vcpu_next (struct vm *vm, struct vcpu *vcpu); void vcpu_reset(void); void vcpu_reset_apic(void); inline static bool vcpu_is_bsp (struct vcpu *vcpu) { return vcpu->vbsp; } #endif tinyvisor/vmm/core/printf.c0000644006644000001440000003127412143453571016275 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include "putchar.h" /* printf 20071010 %[flags][width][.[precision]][length modifier] flags: # alternate form 0 zero padded - left adjusted ' ' a blank before a positive number + a sign before a number width, precision: decimal number only. length modifier: h short hh char l long ll long long j intmax_t z size_t t ptrdiff_t conversion: d, i integer as decimal o unsigned integer as octal number u unsigned integer as decimal number X unsigned integer as capital hexadecimal number x unsigned integer as hexadecimal number c int as character s char* as string p void* as hexadecimal number % % */ struct snputchar_data { char *buf; size_t len; }; struct parse_data { int width; int precision; }; #define FLAG_ALTERNATE_FORM 0x1 #define FLAG_ZERO_PADDED 0x2 #define FLAG_LEFT_ADJUSTED 0x4 #define FLAG_POSITIVE_BLANK 0x8 #define FLAG_POSITIVE_SIGN 0x10 #define HAS_WIDTH 0x20 #define HAS_PRECISION 0x40 #define LENGTH_SHORT 0x80 #define LENGTH_CHAR 0x100 #define LENGTH_LONG 0x200 #define LENGTH_LONGLONG 0x400 #define LENGTH_INTMAX 0x800 #define LENGTH_SIZE 0x1000 #define LENGTH_PTRDIFF 0x2000 #define CONVERSION_INT 0x4000 #define CONVERSION_DECIMAL 0x8000 #define CONVERSION_UINT 0x10000 #define CONVERSION_OCTAL 0x20000 #define CONVERSION_CAPITAL 0x40000 #define CONVERSION_HEXADECIMAL 0x80000 #define CONVERSION_CHARACTER 0x100000 #define CONVERSION_CHARP 0x200000 #define CONVERSION_VOIDP 0x400000 #define CONVERSION_NONE 0x800000 #define END_STRING 0x1000000 #define FLAG_MINUS 0x2000000 #define FLAG_PLUS 0x4000000 #define PUTCHAR(c) do { if (func (c, data) < 0) goto error; n++; } while (0) static unsigned long long sub10[] = { 10000000000000000000ULL, 1000000000000000000ULL, 100000000000000000ULL, 10000000000000000ULL, 1000000000000000ULL, 100000000000000ULL, 10000000000000ULL, 1000000000000ULL, 100000000000ULL, 10000000000ULL, 1000000000ULL, 100000000ULL, 10000000ULL, 1000000ULL, 100000ULL, 10000ULL, 1000ULL, 100ULL, 10ULL, 1ULL, 0ULL, }; static unsigned long long sub8[] = { 01000000000000000000000ULL, 0100000000000000000000ULL, 010000000000000000000ULL, 01000000000000000000ULL, 0100000000000000000ULL, 010000000000000000ULL, 01000000000000000ULL, 0100000000000000ULL, 010000000000000ULL, 01000000000000ULL, 0100000000000ULL, 010000000000ULL, 01000000000ULL, 0100000000ULL, 010000000ULL, 01000000ULL, 0100000ULL, 010000ULL, 01000ULL, 0100ULL, 010ULL, 01ULL, 00ULL, }; static unsigned long long sub16[] = { 0x1000000000000000ULL, 0x100000000000000ULL, 0x10000000000000ULL, 0x1000000000000ULL, 0x100000000000ULL, 0x10000000000ULL, 0x1000000000ULL, 0x100000000ULL, 0x10000000ULL, 0x1000000ULL, 0x100000ULL, 0x10000ULL, 0x1000ULL, 0x100ULL, 0x10ULL, 0x1ULL, 0x0ULL, }; static spinlock_t printf_lock = SPINLOCK_INITIALIZER; static int parse_format (const char **format, int *width, int *precision) { char c; int r = 0; *width = 0; *precision = 0; while ((c = *(*format)++) != '\0') { switch (c) { case '#': r |= FLAG_ALTERNATE_FORM; break; case '0': r |= FLAG_ZERO_PADDED; break; case '-': r |= FLAG_LEFT_ADJUSTED; break; case ' ': r |= FLAG_POSITIVE_BLANK; break; case '+': r |= FLAG_POSITIVE_SIGN; break; default: goto parse_width; } } return END_STRING; while ((c = *(*format)++) != '\0') { parse_width: if (c >= '0' && c <= '9') { r |= HAS_WIDTH; *width *= 10; *width += (c - '0'); } else { goto parse_precision; } } return END_STRING; parse_precision: if (c != '.') goto parse_length_modifier; r |= HAS_PRECISION; while ((c = *(*format)++) != '\0') { if (c >= '0' && c <= '9') { *precision *= 10; *precision += (c - '0'); } else { goto parse_length_modifier; } } return END_STRING; while ((c = *(*format)++) != '\0') { parse_length_modifier: switch (c) { case 'h': if (r & LENGTH_SHORT) r |= LENGTH_CHAR; else r |= LENGTH_SHORT; break; case 'l': if (r & LENGTH_LONG) r |= LENGTH_LONGLONG; else r |= LENGTH_LONG; break; case 'j': r |= LENGTH_INTMAX; break; case 'z': r |= LENGTH_SIZE; break; case 't': r |= LENGTH_PTRDIFF; break; default: goto parse_conversion; } } return END_STRING; parse_conversion: switch (c) { case 'd': case 'i': r |= CONVERSION_INT | CONVERSION_DECIMAL; break; case 'o': r |= CONVERSION_UINT | CONVERSION_OCTAL; break; case 'u': r |= CONVERSION_UINT | CONVERSION_DECIMAL; break; case 'X': r |= CONVERSION_CAPITAL; /* Fall through */ case 'x': r |= CONVERSION_UINT | CONVERSION_HEXADECIMAL; break; case 'c': r |= CONVERSION_INT | CONVERSION_CHARACTER; break; case 's': r |= CONVERSION_CHARP; break; case 'p': r |= CONVERSION_VOIDP | CONVERSION_HEXADECIMAL | FLAG_ALTERNATE_FORM; break; case '%': r |= CONVERSION_NONE; break; } return r; } static int valconv (unsigned long long val, char *buf, unsigned long long *sub, char *str) { int n = 0; int digit; if (val == 0) { *buf++ = '0'; return 1; } while (val < *sub) sub++; while (*sub) { digit = 0; while (val >= *sub) { digit++; val -= *sub; } *buf++ = str[digit]; n++; sub++; } return n; } static int do_conversion_int (unsigned long long val, int f, int width, int precision, int (*func)(int c, void *data), void *data) { int len = 0; int n = 0; int leftsp = 0, leftlen = 0, leftzero = 0, rightsp = 0; char buf[32], *leftbuf = "", *bufp; if (f & CONVERSION_CHARACTER) { PUTCHAR ((int)val); return n; } if ((f & HAS_PRECISION) && precision == 0 && val == 0) return 0; if (f & CONVERSION_DECIMAL) len = valconv (val, buf, sub10, "0123456789"); else if (f & CONVERSION_OCTAL) len = valconv (val, buf, sub8, "01234567"); else if ((f & CONVERSION_HEXADECIMAL) && (f & CONVERSION_CAPITAL)) len = valconv (val, buf, sub16, "0123456789ABCDEF"); else if (f & CONVERSION_HEXADECIMAL) len = valconv (val, buf, sub16, "0123456789abcdef"); if ((f & HAS_PRECISION) && precision > len) leftzero = precision - len; if (!(f & CONVERSION_DECIMAL) && (f & FLAG_ALTERNATE_FORM) && val != 0) { if ((f & CONVERSION_OCTAL) && leftzero == 0) { leftbuf = "0"; leftlen = 1; } else if (f & CONVERSION_HEXADECIMAL) { if (f & CONVERSION_CAPITAL) leftbuf = "0X"; else leftbuf = "0x"; leftlen = 2; } } if (f & CONVERSION_DECIMAL) { if (f & FLAG_PLUS) { if (f & FLAG_POSITIVE_SIGN) { leftbuf = "+"; leftlen = 1; } else if (f & FLAG_POSITIVE_BLANK) { leftbuf = " "; leftlen = 1; } } else if (f & FLAG_MINUS) { leftbuf = "-"; leftlen = 1; } } if ((f & HAS_WIDTH) && width > leftlen + leftzero + len) { if (f & FLAG_LEFT_ADJUSTED) rightsp = width - (leftlen + leftzero + len); else leftsp = width - (leftlen + leftzero + len); } if ((f & FLAG_ZERO_PADDED) && !(f & HAS_PRECISION)) { leftzero += leftsp; leftsp = 0; } bufp = buf; while (leftsp--) PUTCHAR (' '); while (leftlen--) PUTCHAR (*leftbuf++); while (leftzero--) PUTCHAR ('0'); while (len--) PUTCHAR (*bufp++); while (rightsp--) PUTCHAR (' '); error: return n; } static int do_conversion_string (const char *str, int f, int width, int precision, int (*func)(int c, void *data), void *data) { int len; int n = 0; int leftsp = 0, rightsp = 0; len = 0; while (!((f & HAS_PRECISION) && len >= precision) && str[len] != '\0') len++; if ((f & HAS_WIDTH) && width > len) { if (f & FLAG_LEFT_ADJUSTED) rightsp = width - len; else leftsp = width - len; } while (leftsp--) PUTCHAR (' '); while (len--) PUTCHAR (*str++); while (rightsp--) PUTCHAR (' '); error: return n; } static int do_printf (const char *format, va_list ap, int (*func)(int c, void *data), void *data) { char c; int n, f; int width, precision; n = 0; while ((c = *format++) != '\0') { if (c == '%') { f = parse_format (&format, &width, &precision); if (f & LENGTH_INTMAX) f |= LENGTH_LONGLONG; else if (f & LENGTH_SIZE) f |= LENGTH_LONG; else if (f & LENGTH_PTRDIFF) f |= LENGTH_LONG; if (f == END_STRING) { break; } else if (f & CONVERSION_NONE) { PUTCHAR ('%'); } else if (f & CONVERSION_INT) { long long intval; unsigned long long uintval; if (f & LENGTH_CHAR) intval = (long long)va_arg (ap, int); else if (f & LENGTH_SHORT) intval = (long long)va_arg (ap, int); else if (f & LENGTH_LONGLONG) intval = va_arg (ap, long long); else if (f & LENGTH_LONG) intval = (long long)va_arg (ap, long); else intval = (long long)va_arg (ap, int); if (intval < 0) { uintval = (unsigned long long)-intval; f |= FLAG_MINUS; } else { uintval = (unsigned long long)intval; f |= FLAG_PLUS; } n += do_conversion_int (uintval, f, width, precision, func, data); continue; } else if (f & CONVERSION_UINT) { unsigned long long uintval; if (f & LENGTH_CHAR) uintval = (unsigned long long) va_arg (ap, unsigned int); else if (f & LENGTH_SHORT) uintval = (unsigned long long) va_arg (ap, unsigned int); else if (f & LENGTH_LONGLONG) uintval = va_arg (ap, unsigned long long); else if (f & LENGTH_LONG) uintval = (unsigned long long) va_arg (ap, unsigned long); else uintval = (unsigned long long) va_arg (ap, unsigned int); n += do_conversion_int (uintval, f, width, precision, func, data); } else if (f & CONVERSION_VOIDP) { void *voidpval; unsigned long long uintval; voidpval = va_arg (ap, void *); uintval = (unsigned long long) (unsigned long)voidpval; n += do_conversion_int (uintval, f, width, precision, func, data); } else if (f & CONVERSION_CHARP) { char *charpval; charpval = va_arg (ap, char *); if (charpval == NULL) charpval = "(null)"; n += do_conversion_string (charpval, f, width, precision, func, data); } else { n += do_conversion_string ("FORMAT ERROR", CONVERSION_CHARP, 0, 0, func, data); } } else { PUTCHAR (c); } } error: return n; } static int do_putchar (int c, void *data) { putchar (c); return 0; } static int do_snputchar (int c, void *data) { struct snputchar_data *p; p = data; if (!p->len) return -1; if (!--p->len) c = '\0'; *p->buf++ = (char)c; return 0; } int printf (const char *format, ...) { va_list ap; int r; va_start (ap, format); r = vprintf (format, ap); va_end (ap); return r; } int vprintf (const char *format, va_list ap) { int r; spinlock_lock (&printf_lock); r = do_printf (format, ap, do_putchar, NULL); spinlock_unlock (&printf_lock); return r; } int snprintf (char *str, size_t size, const char *format, ...) { va_list ap; int r; va_start (ap, format); r = vsnprintf (str, size, format, ap); va_end (ap); return r; } int vsnprintf (char *str, size_t size, const char *format, va_list ap) { struct snputchar_data data; int r; data.buf = str; data.len = size; r = do_printf (format, ap, do_snputchar, &data); do_snputchar ('\0', &data); return r; } tinyvisor/vmm/core/param.c0000644006644000001440000001774211733245403016074 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include "param.h" /* * /boot/vmm.elf vm=vm0,vm1 vm1.cpu=6,7 vm1.mem=80000000-200000000 vm1.pci=00:1c.0 shell=5 */ enum param_state { STATE_NAME, STATE_VALUE, STATE_OTHER_VALUE, STATE_IGNORE }; static char saved_cmdline[CMDLINE_SIZE]; void param_save(const char *cmdline) { snprintf(saved_cmdline, CMDLINE_SIZE, "%s", cmdline); printf("VMM params: %s\n", cmdline); } vmmerr_t param_get_str(const char *name, int number, char *buf, size_t len) { char *cur; char *na; size_t na_len; size_t name_len; enum param_state state; if (name == NULL || *name == '\0') { return VMMERR_INVAL; } name_len = strlen(name); cur = na = saved_cmdline; na_len = 0; state = STATE_NAME; for (;;) { switch (*cur) { case '\0': case ' ': case '\t': switch (state) { case STATE_NAME: if (na_len == name_len && memcmp(na, name, na_len) == 0) { if (buf && len == 0) { return VMMERR_BUFSIZE; } else if (buf) { *buf = '\0'; } return VMMERR_SUCCESS; } break; case STATE_VALUE: if (buf && len == 0) { return VMMERR_BUFSIZE; } else if (buf) { *buf = '\0'; } return VMMERR_SUCCESS; case STATE_OTHER_VALUE: return VMMERR_NOTEXIST; case STATE_IGNORE: break; } if (*cur == '\0') { goto out; } na = cur + 1; na_len = 0; state = STATE_NAME; break; case '=': switch (state) { case STATE_NAME: if (na_len == name_len && memcmp(na, name, na_len) == 0) { if (number == 0) { state = STATE_VALUE; } else { state = STATE_OTHER_VALUE; } } else { state = STATE_IGNORE; } break; case STATE_VALUE: if (buf && len == 0) { return VMMERR_BUFSIZE; } else if (buf) { *buf = *cur; buf++; len--; } break; case STATE_OTHER_VALUE: case STATE_IGNORE: break; } break; case ',': switch (state) { case STATE_NAME: break; case STATE_VALUE: if (buf && len == 0) { return VMMERR_BUFSIZE; } else if (buf) { *buf = '\0'; } return VMMERR_SUCCESS; case STATE_OTHER_VALUE: number--; if (number == 0) { state = STATE_VALUE; } break; case STATE_IGNORE: break; } break; default: switch (state) { case STATE_NAME: na_len++; break; case STATE_VALUE: if (buf && len == 0) { return VMMERR_BUFSIZE; } else if (buf) { *buf = *cur; buf++; len--; } break; case STATE_OTHER_VALUE: case STATE_IGNORE: break; } break; } cur++; } out: return VMMERR_NOTEXIST; } static vmmerr_t asci_to_ux(const char *buf, u64 *value, int bit) { int i; u64 ret_val = 0; if (buf[0] == '\0') { /* * If a param is the zero-length string, return * VMMERR_NOTEXIST. */ return VMMERR_NOTEXIST; } for (i = 0; i < bit / 4; i++) { if (buf[i] == '\0') { break; } if (buf[i] >= '0' && buf[i] <= '9') { ret_val <<= 4; ret_val += buf[i] - '0'; } else if (buf[i] >= 'a' && buf[i] <= 'f') { ret_val <<= 4; ret_val += buf[i] - 'a' + 0xa; } else if (buf[i] >= 'A' && buf[i] <= 'F') { ret_val <<= 4; ret_val += buf[i] - 'A' + 0xa; } else { return VMMERR_INVAL; } } if (buf[i] != '\0') { return VMMERR_INVAL; } *value = ret_val; return VMMERR_SUCCESS; } static vmmerr_t asci_to_u8(const char *buf, u8 *value) { u64 temp; vmmerr_t err; err = asci_to_ux(buf, &temp, 8); *value = temp; return err; } static vmmerr_t asci_to_u16(const char *buf, u16 *value) { u64 temp; vmmerr_t err; err = asci_to_ux(buf, &temp, 16); *value = temp; return err; } static vmmerr_t asci_to_u32(const char *buf, u32 *value) { u64 temp; vmmerr_t err; err = asci_to_ux(buf, &temp, 32); *value = temp; return err; } static vmmerr_t asci_to_u64(const char *buf, u64 *value) { u64 temp; vmmerr_t err; err = asci_to_ux(buf, &temp, 64); *value = temp; return err; } vmmerr_t param_get_u8(const char *name, int number, u8 *value) { char buf[9]; vmmerr_t vmmerr; vmmerr = param_get_str(name, number, buf, sizeof(buf)); if (vmmerr != VMMERR_SUCCESS) { return vmmerr; } return asci_to_u8(buf, value); } vmmerr_t param_get_u16(const char *name, int number, u16 *value) { char buf[9]; vmmerr_t vmmerr; vmmerr = param_get_str(name, number, buf, sizeof(buf)); if (vmmerr != VMMERR_SUCCESS) { return vmmerr; } return asci_to_u16(buf, value); } vmmerr_t param_get_u32(const char *name, int number, u32 *value) { char buf[9]; vmmerr_t vmmerr; vmmerr = param_get_str(name, number, buf, sizeof(buf)); if (vmmerr != VMMERR_SUCCESS) { return vmmerr; } return asci_to_u32(buf, value); } vmmerr_t param_get_u64(const char *name, int number, u64 *value) { char buf[17]; vmmerr_t vmmerr; vmmerr = param_get_str(name, number, buf, sizeof(buf)); if (vmmerr != VMMERR_SUCCESS) { return vmmerr; } return asci_to_u64(buf, value); } vmmerr_t param_get_u64_range(const char *name, int number, u64 *value1, u64 *value2) { char buf[16 * 2 + 1 + 1]; vmmerr_t vmmerr; char *val2 = buf; vmmerr = param_get_str(name, number, buf, sizeof(buf)); if (vmmerr != VMMERR_SUCCESS) { return vmmerr; } while (*val2) { if (*val2 == '-') { *val2 = '\0'; val2++; goto found; } val2++; } return VMMERR_INVAL; found: vmmerr = asci_to_u64(buf, value1); if (vmmerr != VMMERR_SUCCESS) { return vmmerr; } vmmerr = asci_to_u64(val2, value2); return vmmerr; } vmmerr_t param_get_bdf(const char *name, int number, u8 *bus, u8 *dev, u8 *func) { char buf[8]; /* bb:dd.f */ char *dev_str = buf; char *func_str; vmmerr_t vmmerr; vmmerr = param_get_str(name, number, buf, sizeof(buf)); if (vmmerr != VMMERR_SUCCESS) { return vmmerr; } if (*dev_str == '\0') { /* * If a param is the zero-length string, return * VMMERR_NOTEXIST. */ return VMMERR_NOTEXIST; } while (*dev_str) { if (*dev_str == ':') { *dev_str = '\0'; dev_str++; goto found1; } dev_str++; } return VMMERR_INVAL; found1: func_str = dev_str + 1; while (*func_str) { if (*func_str == '.') { *func_str = '\0'; func_str++; goto found2; } func_str++; } return VMMERR_INVAL; found2: vmmerr = asci_to_u8(buf, bus); if (vmmerr != VMMERR_SUCCESS) { return vmmerr; } vmmerr = asci_to_u8(dev_str, dev); if (vmmerr != VMMERR_SUCCESS) { return vmmerr; } vmmerr = asci_to_u8(func_str, func); if (vmmerr != VMMERR_SUCCESS) { return vmmerr; } return vmmerr; } tinyvisor/vmm/core/keyboard.c0000644006644000001440000001323511733245403016565 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include "asm.h" #include "keyboard.h" #define KBD_STATUS 0x64 #define KBD_DATA 0x60 #define IS_CTRL_PRESSED(x) (x[0x1D] || x[0x3A]) #define IS_SHIFT_PRESSED(x) (x[0x2A] || x[0x36] || x[0x73]) static spinlock_t keyboard_lock; static bool pressed[128]; static int scancode_to_asciichar[128] = { -1, '\e', '1', '2', '3', '4', '5', '6', '7', '8', '9', '0', '-', '=', '\b', '\t', 'q', 'w', 'e', 'r', 't', 'y', 'u', 'i', 'o', 'p', '[', ']', '\n', -1, 'a', 's', 'd', 'f', 'g', 'h', 'j', 'k', 'l', ';', '\'', '`', -1, '\\', 'z', 'x', 'c', 'v', 'b', 'n', 'm', ',', '.', '/', -1, '*', -1, ' ', -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, 1 /*^A*/, 16 /*^P*/, 128+'v', '-', 2 /*^B*/, -1, 6 /*^F*/, '+', 5 /*^E*/, 14 /*^N*/, 22 /*^V*/, -1, 4 /*^D*/, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, '\\', -1, -1, }; static int scancode_to_asciichar_shift[128] = { -1, '\e', '!', '@', '#', '$', '%', '^', '&', '*', '(', ')', '_', '+', '\b', '\t', 'Q', 'W', 'E', 'R', 'T', 'Y', 'U', 'I', 'O', 'P', '{', '}', '\n', -1, 'A', 'S', 'D', 'F', 'G', 'H', 'J', 'K', 'L', ':', '"', '~', -1, '|', 'Z', 'X', 'C', 'V', 'B', 'N', 'M', '<', '>', '?', -1, '*', -1, ' ', -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, 1 /*^A*/, 16 /*^P*/, 128+'v', '-', 2 /*^B*/, -1, 6 /*^F*/, '+', 5 /*^E*/, 14 /*^N*/, 22 /*^V*/, -1, 4 /*^D*/, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, '|', -1, -1, }; static int scancode_to_asciichar_ctrl[128] = { -1, '\e', -1, 0, 27, 28, 29, 30, 31, '\b', -1, -1, '_'&31, -1, -1, -1, 'q'&31, 'w'&31, 'e'&31, 'r'&31, 't'&31, 'y'&31, 'u'&31, 'i'&31, 'o'&31, 'p'&31, '['&31, ']'&31, '\n', -1, 'a'&31, 's'&31, 'd'&31, 'f'&31, 'g'&31, 'h'&31, 'j'&31, 'k'&31, 'l'&31, -1, -1, -1, -1, '\\'&31, 'z'&31, 'x'&31, 'c'&31, 'v'&31, 'b'&31, 'n'&31, 'm'&31, -1, -1, 31, -1, -1, -1, 0, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, '\\'&31, -1, -1, }; static void wait_for_kbdsend (bool sending) { u8 status; do asm_inb (KBD_STATUS, &status); while (!(status & 2) != !sending); } static void wait_for_kbdrecv (bool receiving) { u8 status; do asm_inb (KBD_STATUS, &status); while (!(status & 1) != !receiving); } void keyboard_reset (void) { wait_for_kbdsend (false); asm_outb (KBD_STATUS, 0x60); wait_for_kbdsend (false); asm_outb (KBD_DATA, 0x64); wait_for_kbdsend (false); asm_outb (KBD_DATA, 0xFF); } void setkbdled (int ledstatus) { u8 gomi; wait_for_kbdsend (false); asm_outb (KBD_DATA, 0xED); wait_for_kbdrecv (true); asm_inb (KBD_DATA, &gomi); wait_for_kbdsend (false); asm_outb (KBD_DATA, ledstatus); wait_for_kbdrecv (true); asm_inb (KBD_DATA, &gomi); } static u8 keyboard_getkey (void) { u8 data; wait_for_kbdrecv (true); asm_inb (KBD_DATA, &data); wait_for_kbdrecv (false); pressed[data & 127] = (data & 128) ? false : true; return data; } static int keycode_to_ascii (u8 key) { if (key & 0x80) return -1; if (IS_CTRL_PRESSED (pressed)) return scancode_to_asciichar_ctrl[key & 127]; if (IS_SHIFT_PRESSED (pressed)) return scancode_to_asciichar_shift[key & 127]; return scancode_to_asciichar[key & 127]; } static int keyboard_getchar (void) { u8 key; int c; spinlock_lock (&keyboard_lock); retry: key = keyboard_getkey (); c = keycode_to_ascii (key); if (c < 0) goto retry; spinlock_unlock (&keyboard_lock); return c; } static int keyboard_msghandler (int m, int c) { if (m == 0) return keyboard_getchar (); return 0; } static void keyboard_init_msg (void) { int i; spinlock_init (&keyboard_lock); for (i = 0; i < 128; i++) pressed[i] = false; msgregister ("keyboard", keyboard_msghandler); } INITFUNC ("msg0", keyboard_init_msg); tinyvisor/vmm/core/gmm_access.c0000644006644000001440000001344311733245403017067 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ /* accessing memory by guest-physical address */ #include "constants.h" #include "current.h" #include "mm.h" #include "mmio.h" #include "panic.h" #include "pcpu.h" void read_gphys_b (phys_t phys, void *data, u32 flags) { mmio_lock (); if (!mmio_access_memory (phys, false, data, 1, flags)) { phys = current->vm->gmm.gp2hp(phys); if (phys == GMM_NO_MAPPING) { *(u8 *)data = (u8)((i8)-1); } else { read_hphys_b (phys, data, flags); } } mmio_unlock (); } void write_gphys_b (phys_t phys, u32 data, u32 flags) { mmio_lock (); if (!mmio_access_memory (phys, true, &data, 1, flags)) { phys = current->vm->gmm.gp2hp(phys); if (phys != GMM_NO_MAPPING) { write_hphys_b (phys, data, flags); } } mmio_unlock (); } void read_gphys_w (phys_t phys, void *data, u32 flags) { if ((phys & 0xFFF) == 0xFFF) { read_gphys_b (phys + 0, ((u8 *)data) + 0, flags); read_gphys_b (phys + 1, ((u8 *)data) + 1, flags); return; } mmio_lock (); if (!mmio_access_memory (phys, false, data, 2, flags)) { phys = current->vm->gmm.gp2hp(phys); if (phys == GMM_NO_MAPPING) { *(u16 *)data = (u16)((i16)-1); } else { read_hphys_w (phys, data, flags); } } mmio_unlock (); } void write_gphys_w (phys_t phys, u32 data, u32 flags) { if ((phys & 0xFFF) == 0xFFF) { write_gphys_b (phys + 0, *(((u8 *)&data) + 0), flags); write_gphys_b (phys + 1, *(((u8 *)&data) + 1), flags); return; } mmio_lock (); if (!mmio_access_memory (phys, true, &data, 2, flags)) { phys = current->vm->gmm.gp2hp(phys); if (phys != GMM_NO_MAPPING) { write_hphys_w (phys, data, flags); } } mmio_unlock (); } void read_gphys_l (phys_t phys, void *data, u32 flags) { if ((phys & 0xFFF) >= 0xFFD) { read_gphys_w (phys + 0, ((u16 *)data) + 0, flags); read_gphys_w (phys + 2, ((u16 *)data) + 1, flags); return; } mmio_lock (); if (!mmio_access_memory (phys, false, data, 4, flags)) { phys = current->vm->gmm.gp2hp(phys); if (phys == GMM_NO_MAPPING) { *(u32 *)data = (u32)((i32)-1); } else { read_hphys_l (phys, data, flags); } } mmio_unlock (); } void write_gphys_l (phys_t phys, u32 data, u32 flags) { if ((phys & 0xFFF) >= 0xFFD) { write_gphys_w (phys + 0, (u16)data, flags); write_gphys_w (phys + 2, (u16)(data >> 16), flags); return; } mmio_lock (); if (!mmio_access_memory (phys, true, &data, 4, flags)) { phys = current->vm->gmm.gp2hp(phys); if (phys != GMM_NO_MAPPING) { write_hphys_l (phys, data, flags); } } mmio_unlock (); } void read_gphys_q (phys_t phys, void *data, u32 flags) { if ((phys & 0xFFF) >= 0xFF9) { read_gphys_l (phys + 0, ((u32 *)data) + 0, flags); read_gphys_l (phys + 4, ((u32 *)data) + 1, flags); return; } mmio_lock (); if (!mmio_access_memory (phys, false, data, 8, flags)) { phys = current->vm->gmm.gp2hp(phys); if (phys == GMM_NO_MAPPING) { *(u64 *)data = (u64)((i64)-1); } else { read_hphys_q (phys, data, flags); } } mmio_unlock (); } void write_gphys_q (phys_t phys, u64 data, u32 flags) { if ((phys & 0xFFF) >= 0xFF9) { write_gphys_w (phys + 0, (u32)data, flags); write_gphys_w (phys + 4, (u32)(data >> 32), flags); return; } mmio_lock (); if (!mmio_access_memory (phys, true, &data, 8, flags)) { phys = current->vm->gmm.gp2hp(phys); if (phys != GMM_NO_MAPPING) { write_hphys_q (phys, data, flags); } } mmio_unlock (); } bool cmpxchg_gphys_l (phys_t phys, u32 *olddata, u32 data, u32 flags) { if ((phys & 0xFFF) >= 0xFFD) panic ("cmpxchg_gphys_l: bad physical address"); mmio_lock (); if (mmio_access_memory (phys, false, olddata, 4, flags)) panic ("CMPXCHG MMIO!"); mmio_unlock (); phys = current->vm->gmm.gp2hp(phys); if (phys == GMM_NO_MAPPING) { panic ("cmpxchg_gphys_l modifying no-mapping memory."); } return cmpxchg_hphys_l (phys, olddata, data, flags); } bool cmpxchg_gphys_q (phys_t phys, u64 *olddata, u64 data, u32 flags) { if ((phys & 0xFFF) >= 0xFF9) panic ("cmpxchg_gphys_q: bad physical address"); mmio_lock (); if (mmio_access_memory (phys, false, olddata, 8, flags)) panic ("CMPXCHG MMIO!"); mmio_unlock (); phys = current->vm->gmm.gp2hp(phys); if (phys == GMM_NO_MAPPING) { panic ("cmpxchg_gphys_l modifying no-mapping memory."); } return cmpxchg_hphys_q (phys, olddata, data, flags); } tinyvisor/vmm/core/mtrr.h0000644006644000001440000000343511753454341015764 0ustar yuichi_xyusers/* * Copyright (c) 2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_MTRR_H #define _CORE_MTRR_H #define MTRR_ENCODING_UC 0x00 #define MTRR_ENCODING_WC 0x01 #define MTRR_ENCODING_WT 0x04 #define MTRR_ENCODING_WP 0x05 #define MTRR_ENCODING_WB 0x06 u8 mtrr_get_mem_type(phys_t addr); #endif tinyvisor/vmm/core/reboot.h0000644006644000001440000000321011733245403016254 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_REBOOT_H #define _CORE_REBOOT_H void reboot (void); #endif tinyvisor/vmm/core/cpu_stack.h0000644006644000001440000000375011733245403016747 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_CPU_STACK_H #define _CORE_CPU_STACK_H #include #include "cpu_seg.h" #include "cpu_interpreter.h" struct cpu_stack { ulong sp; }; vmmerr_t cpu_stack_get (struct cpu_stack *st); vmmerr_t cpu_stack_set (struct cpu_stack *st); vmmerr_t cpu_stack_push (struct cpu_stack *st, void *data, enum optype type); vmmerr_t cpu_stack_pop (struct cpu_stack *st, void *data, enum optype type); #endif tinyvisor/vmm/core/cpu_mmu.h0000644006644000001440000000476511733245403016447 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_CPU_MMU_H #define _CORE_CPU_MMU_H #include #include vmmerr_t mmu_get_pte (ulong virt, ulong cr0, ulong cr3, ulong cr4, u64 efer, bool write, bool user, bool exec, u64 entries[5], int *plevels); vmmerr_t write_linearaddr_b (ulong linear, u8 data); vmmerr_t write_linearaddr_w (ulong linear, u16 data); vmmerr_t write_linearaddr_l (ulong linear, u32 data); vmmerr_t write_linearaddr_q (ulong linear, u64 data); vmmerr_t read_linearaddr_b (ulong linear, void *data); vmmerr_t read_linearaddr_w (ulong linear, void *data); vmmerr_t read_linearaddr_l (ulong linear, void *data); vmmerr_t read_linearaddr_q (ulong linear, void *data); vmmerr_t read_linearaddr_tss (ulong linear, void *tss, uint len); vmmerr_t write_linearaddr_tss (ulong linear, void *tss, uint len); void mmu_generate_pagefault(vmmerr_t vmmerr, bool wr, bool us, ulong cr2); #endif tinyvisor/vmm/core/vramwrite.c0000644006644000001440000001357712011203114016775 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include "asm.h" #include "callrealmode.h" #include "vramwrite.h" #define CRTC_SCROLL 0xC #define CRTC_CURSOR_POS 0xE static u8 *vram_virtaddr; static u16 saved_cursor_pos; static bool vramwrite_enable = false; static spinlock_t vram_lock = SPINLOCK_INITIALIZER; static u16 read_crtc_word (u8 i) { u8 h, l; asm_outb (0x3D4, i); asm_inb (0x3D5, &h); asm_outb (0x3D4, i + 1); asm_inb (0x3D5, &l); return ((u16)h << 8) | l; } static void write_crtc_word (u8 i, u16 data) { u8 h, l; h = (data >> 8); l = (data); asm_outb (0x3D4, i); asm_outb (0x3D5, h); asm_outb (0x3D4, i + 1); asm_outb (0x3D5, l); } static u16 read_cursor_pos (void) { u8 orig_3d4; u16 data; asm_inb (0x3D4, &orig_3d4); data = read_crtc_word (CRTC_CURSOR_POS); asm_outb (0x3D4, orig_3d4); return data; } static u16 read_scroll (void) { u8 orig_3d4; u16 data; asm_inb (0x3D4, &orig_3d4); data = read_crtc_word (CRTC_SCROLL); asm_outb (0x3D4, orig_3d4); return data; } static void move_cursor_pos (u16 cursor_pos) { u8 orig_3d4; asm_inb (0x3D4, &orig_3d4); write_crtc_word (CRTC_CURSOR_POS, cursor_pos); asm_outb (0x3D4, orig_3d4); } static void move_cursor_pos_xy (unsigned int x, unsigned int y) { move_cursor_pos (read_scroll () + y * 80 + x); } static void scroll_up (u8 *startaddr, int width, int height, u16 space) { int dummy; asm volatile ("cld ; rep movsw ; mov %7,%%ecx ; rep stosw" : "=S" (dummy), "=D" (dummy), "=c" (dummy) : "S" (startaddr + width * 2), "D" (startaddr) , "c" (width * height - width), "a" (space) , "r" (width)); } void vramwrite_putchar (unsigned char c) { u16 cursor; u16 scroll; u8 *p; unsigned int lines; spinlock_lock(&vram_lock); if (!vramwrite_enable) { spinlock_unlock(&vram_lock); return; } scroll = read_scroll (); cursor = read_cursor_pos (); p = vram_virtaddr + (cursor << 1); if (c == '\b') { if (cursor != 0 && cursor != scroll) cursor--; } else if (c == '\r') { while (cursor != 0 && cursor != scroll && ((cursor - scroll) % 80)) cursor--; } else if (c != '\n') { p[0] = c; p[1] = 0x07; /* color background:foreground = black:gray */ cursor++; } else do { p[0] = ' '; p[1] = 0x07; p += 2; cursor++; } while ((cursor - scroll) % 80); if (cursor - scroll >= 80 * 25 && ((cursor - scroll) % 80) == 0) { lines = (cursor - scroll) / 80; while ((scroll << 1) + lines * 160 >= 0x8000) lines--; cursor -= 80; scroll_up (vram_virtaddr + (scroll << 1), 80, lines, 0x0720); } move_cursor_pos (cursor); spinlock_unlock(&vram_lock); } void vramwrite_save_and_move_cursor (unsigned int x, unsigned int y) { spinlock_lock(&vram_lock); saved_cursor_pos = read_cursor_pos (); move_cursor_pos_xy (x, y); spinlock_unlock(&vram_lock); } void vramwrite_restore_cursor (void) { spinlock_lock(&vram_lock); move_cursor_pos (saved_cursor_pos); spinlock_unlock(&vram_lock); } void vramwrite_get_cursor_pos (unsigned int *x, unsigned int *y) { u16 cursor, scroll; spinlock_lock(&vram_lock); scroll = read_scroll (); cursor = read_cursor_pos (); *y = (cursor - scroll) / 80; *x = (cursor - scroll) % 80; spinlock_unlock(&vram_lock); } void vramwrite_init_global(void) { spinlock_lock(&vram_lock); vramwrite_enable = true; vram_virtaddr = (void *)0x800B8000; spinlock_unlock(&vram_lock); } void vramwrite_mm_initialized(void) { spinlock_lock(&vram_lock); vramwrite_enable = true; vram_virtaddr = mapmem_hphys(0xb8000, 0x8000, MAPMEM_UC | MAPMEM_WRITE); spinlock_unlock(&vram_lock); } /* void */ /* vramwrite_reenable(void) */ /* { */ /* spinlock_lock(&vram_lock); */ /* if (vramwrite_enable || !vram_virtaddr) { */ /* spinlock_unlock(&vram_lock); */ /* return; */ /* } */ /* vramwrite_enable = true; */ /* callrealmode_setvideomode (VIDEOMODE_80x25TEXT_16COLORS); */ /* spinlock_unlock(&vram_lock); */ /* } */ void vramwrite_exit_global (void) { spinlock_lock(&vram_lock); vramwrite_enable = false; spinlock_unlock(&vram_lock); } static int vramwrite_msghandler (int m, int c) { if (m == 0) vramwrite_putchar (c); return 0; } static void vramwrite_init_msg (void) { msgregister ("vramwrite", vramwrite_msghandler); } INITFUNC ("msg0", vramwrite_init_msg); tinyvisor/vmm/core/cpu_stack.c0000644006644000001440000001061711733245403016742 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include "constants.h" #include "cpu_stack.h" #include "current.h" vmmerr_t cpu_stack_get (struct cpu_stack *st) { ulong acr; current->vmctl.read_sreg_acr (SREG_SS, &acr); if (acr & ACCESS_RIGHTS_UNUSABLE_BIT) return VMMERR_INVALID_GUESTSEG; if (!(acr & ACCESS_RIGHTS_P_BIT)) return VMMERR_GUESTSEG_NOT_PRESENT; /* FIXME: expand-down */ /* FIXME: limit check */ /* FIXME: CPL check */ /* FIXME: access rights check */ current->vmctl.read_general_reg (GENERAL_REG_RSP, &st->sp); if (!(acr & ACCESS_RIGHTS_D_B_BIT)) st->sp &= 0xFFFF; return VMMERR_SUCCESS; } vmmerr_t cpu_stack_set (struct cpu_stack *st) { ulong rsp; ulong acr; current->vmctl.read_sreg_acr (SREG_SS, &acr); if (acr & ACCESS_RIGHTS_UNUSABLE_BIT) return VMMERR_INVALID_GUESTSEG; if (!(acr & ACCESS_RIGHTS_P_BIT)) return VMMERR_GUESTSEG_NOT_PRESENT; /* FIXME: expand-down */ /* FIXME: limit check */ /* FIXME: CPL check */ /* FIXME: access rights check */ if (!(acr & ACCESS_RIGHTS_D_B_BIT)) { current->vmctl.read_general_reg (GENERAL_REG_RSP, &rsp); rsp &= ~0xFFFF; rsp |= st->sp & 0xFFFF; } else { rsp = st->sp; } current->vmctl.write_general_reg (GENERAL_REG_RSP, rsp); return VMMERR_SUCCESS; } vmmerr_t cpu_stack_push (struct cpu_stack *st, void *data, enum optype type) { ulong acr; current->vmctl.read_sreg_acr (SREG_SS, &acr); if (acr & ACCESS_RIGHTS_UNUSABLE_BIT) return VMMERR_INVALID_GUESTSEG; if (!(acr & ACCESS_RIGHTS_P_BIT)) return VMMERR_GUESTSEG_NOT_PRESENT; /* FIXME: expand-down */ /* FIXME: limit check */ /* FIXME: CPL check */ /* FIXME: access rights check */ if (type == OPTYPE_16BIT) { st->sp -= 2; if (!(acr & ACCESS_RIGHTS_D_B_BIT)) st->sp &= 0xFFFF; GUESTSEG_WRITE_W (SREG_SS, st->sp, *(u16 *)data); } else if (type == OPTYPE_32BIT) { st->sp -= 4; if (!(acr & ACCESS_RIGHTS_D_B_BIT)) st->sp &= 0xFFFF; GUESTSEG_WRITE_L (SREG_SS, st->sp, *(u32 *)data); } else { panic ("cpu_stack_push does not support 64bit optype"); } return VMMERR_SUCCESS; } vmmerr_t cpu_stack_pop (struct cpu_stack *st, void *data, enum optype type) { ulong acr; current->vmctl.read_sreg_acr (SREG_SS, &acr); if (acr & ACCESS_RIGHTS_UNUSABLE_BIT) return VMMERR_INVALID_GUESTSEG; if (!(acr & ACCESS_RIGHTS_P_BIT)) return VMMERR_GUESTSEG_NOT_PRESENT; /* FIXME: expand-down */ /* FIXME: limit check */ /* FIXME: CPL check */ /* FIXME: access rights check */ if (type == OPTYPE_16BIT) { GUESTSEG_READ_W (SREG_SS, st->sp, (u16 *)data); st->sp += 2; if (!(acr & ACCESS_RIGHTS_D_B_BIT)) st->sp &= 0xFFFF; } else if (type == OPTYPE_32BIT) { GUESTSEG_READ_L (SREG_SS, st->sp, (u32 *)data); st->sp += 4; if (!(acr & ACCESS_RIGHTS_D_B_BIT)) st->sp &= 0xFFFF; } else { panic ("cpu_stack_pop does not support 64bit optype"); } return VMMERR_SUCCESS; } tinyvisor/vmm/core/acpi_dsdt.c0000644006644000001440000016301011765367726016736 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include "acpi.h" #include "acpi_dsdt.h" #include "mm.h" #include "panic.h" #define PKGENDLEN 16 #define DATALEN 64 /* --- */ enum elementid { OK, AML_PkgLength_0, AML_PkgLength_1, AML_PkgLength_2, AML_PkgLength_3, AML_PkgLength_PUSH, AML_SegCount_OK, AML_ObjectList2, AML_0x00, AML_0x00_TO_0xFF, AML_0x01, AML_0x01_TO_0x7F, AML_0x02, AML_0x06, AML_0x08, AML_0x0A, AML_0x0B, AML_0x0C, AML_0x0D, AML_0x0E, AML_0x10, AML_0x11, AML_0x12, AML_0x13, AML_0x14, AML_0x1F, AML_0x20, AML_0x21, AML_0x22, AML_0x23, AML_0x24, AML_0x25, AML_0x26, AML_0x27, AML_0x28, AML_0x29, AML_0x2A, AML_0x2E, AML_0x2F, AML_0x30, AML_0x30_TO_0x39, AML_0x31, AML_0x32, AML_0x33, AML_0x41_TO_0x5A, AML_0x5B, AML_0x5C, AML_0x5E, AML_0x5F, AML_0x60, AML_0x61, AML_0x62, AML_0x63, AML_0x64, AML_0x65, AML_0x66, AML_0x67, AML_0x68, AML_0x69, AML_0x6A, AML_0x6B, AML_0x6C, AML_0x6D, AML_0x6E, AML_0x70, AML_0x71, AML_0x72, AML_0x73, AML_0x74, AML_0x75, AML_0x76, AML_0x77, AML_0x78, AML_0x79, AML_0x7A, AML_0x7B, AML_0x7C, AML_0x7D, AML_0x7E, AML_0x7F, AML_0x80, AML_0x81, AML_0x82, AML_0x83, AML_0x84, AML_0x85, AML_0x86, AML_0x87, AML_0x88, AML_0x89, AML_0x8A, AML_0x8B, AML_0x8C, AML_0x8D, AML_0x8E, AML_0x8F, AML_0x90, AML_0x91, AML_0x92, AML_0x93, AML_0x94, AML_0x95, AML_0x96, AML_0x97, AML_0x98, AML_0x99, AML_0x9C, AML_0x9D, AML_0x9E, AML_0x9F, AML_0xA0, AML_0xA1, AML_0xA2, AML_0xA3, AML_0xA4, AML_0xA5, AML_0xCC, AML_0xFF, AML_AMLCode, AML_AccessAttrib, AML_AccessField, AML_AccessType, AML_AcquireOp, AML_AddOp, AML_AliasOp, AML_AndOp, AML_Arg0Op, AML_Arg1Op, AML_Arg2Op, AML_Arg3Op, AML_Arg4Op, AML_Arg5Op, AML_Arg6Op, AML_ArgObj, AML_ArgObject, AML_AsciiChar, AML_AsciiCharList, AML_BCDValue, AML_BankFieldOp, AML_BankValue, AML_BitIndex, AML_BreakOp, AML_BreakPointOp, AML_BufData, AML_BuffPkgStrObj, AML_BufferOp, AML_BufferSize, AML_ByteConst, AML_ByteData, AML_ByteIndex, AML_ByteList, AML_BytePrefix, AML_CheckSum, AML_ComputationalData, AML_ConcatOp, AML_ConcatResOp, AML_CondRefOfOp, AML_ConstObj, AML_ContinueOp, AML_CopyObjectOp, AML_CreateBitFieldOp, AML_CreateByteFieldOp, AML_CreateDWordFieldOp, AML_CreateFieldOp, AML_CreateQWordFieldOp, AML_CreateWordFieldOp, AML_CreatorID, AML_CreatorRevision, AML_DDBHandle, AML_DDBHandleObject, AML_DWordConst, AML_DWordData, AML_DWordPrefix, AML_Data, AML_DataObject, AML_DataRefObject, AML_DataRegionOp, AML_DebugObj, AML_DebugOp, AML_DecrementOp, AML_DefAcquire, AML_DefAdd, AML_DefAlias, AML_DefAnd, AML_DefBankField, AML_DefBlockHdr, AML_DefBreak, AML_DefBreakPoint, AML_DefBuffer, AML_DefConcat, AML_DefConcatRes, AML_DefCondRefOf, AML_DefContinue, AML_DefCopyObject, AML_DefCreateBitField, AML_DefCreateByteField, AML_DefCreateDWordField, AML_DefCreateField, AML_DefCreateQWordField, AML_DefCreateWordField, AML_DefDataRegion, AML_DefDecrement, AML_DefDerefOf, AML_DefDevice, AML_DefDivide, AML_DefElse, AML_DefEvent, AML_DefFatal, AML_DefField, AML_DefFindSetLeftBit, AML_DefFindSetRightBit, AML_DefFromBCD, AML_DefIfElse, AML_DefIncrement, AML_DefIndex, AML_DefIndexField, AML_DefLAnd, AML_DefLEqual, AML_DefLGreater, AML_DefLGreaterEqual, AML_DefLLess, AML_DefLLessEqual, AML_DefLNot, AML_DefLNotEqual, AML_DefLOr, AML_DefLoad, AML_DefLoadTable, AML_DefMatch, AML_DefMethod, AML_DefMid, AML_DefMod, AML_DefMultiply, AML_DefMutex, AML_DefNAnd, AML_DefNOr, AML_DefName, AML_DefNoop, AML_DefNot, AML_DefNotify, AML_DefObjectType, AML_DefOpRegion, AML_DefOr, AML_DefPackage, AML_DefPowerRes, AML_DefProcessor, AML_DefRefOf, AML_DefRelease, AML_DefReset, AML_DefReturn, AML_DefScope, AML_DefShiftLeft, AML_DefShiftRight, AML_DefSignal, AML_DefSizeOf, AML_DefSleep, AML_DefStall, AML_DefStore, AML_DefSubtract, AML_DefThermalZone, AML_DefTimer, AML_DefToBCD, AML_DefToBuffer, AML_DefToDecimalString, AML_DefToHexString, AML_DefToInteger, AML_DefToString, AML_DefUnload, AML_DefVarPackage, AML_DefWait, AML_DefWhile, AML_DefXOr, AML_DerefOfOp, AML_Device, AML_DeviceOp, AML_DigitChar, AML_DivideOp, AML_Dividend, AML_Divisor, AML_DualNamePath, AML_DualNamePrefix, AML_ElseOp, AML_EventObject, AML_EventOp, AML_ExtOpPrefix, AML_FatalArg, AML_FatalCode, AML_FatalOp, AML_FatalType, AML_FieldElement, AML_FieldFlags, AML_FieldList, AML_FieldOp, AML_FindSetLeftBitOp, AML_FindSetRightBitOp, AML_FromBCDOp, AML_IfOp, AML_IncrementOp, AML_IndexFieldOp, AML_IndexOp, AML_IndexValue, AML_LandOp, AML_LeadNameChar, AML_LengthArg, AML_LequalOp, AML_LgreaterEqualOp, AML_LgreaterOp, AML_LlessEqualOp, AML_LlessOp, AML_LnotEqualOp, AML_LnotOp, AML_LoadOp, AML_LoadTableOp, AML_Local0Op, AML_Local1Op, AML_Local2Op, AML_Local3Op, AML_Local4Op, AML_Local5Op, AML_Local6Op, AML_Local7Op, AML_LocalObj, AML_LorOp, AML_MatchOp, AML_MatchOpcode, AML_MethodFlags, AML_MethodOp, AML_MidObj, AML_MidOp, AML_ModOp, AML_MsecTime, AML_MultiNamePath, AML_MultiNamePrefix, AML_MultiplyOp, AML_MutexObject, AML_MutexOp, AML_NameChar, AML_NameOp, AML_NamePath, AML_NameSeg, AML_NameSpaceModifierObj, AML_NameString, AML_NamedField, AML_NamedObj, AML_NandOp, AML_NoopOp, AML_NorOp, AML_NotOp, AML_Nothing, AML_NotifyObject, AML_NotifyOp, AML_NotifyValue, AML_NullChar, AML_NullName, AML_NumBits, AML_NumElements, AML_ObjReference, AML_Object, AML_ObjectList, AML_ObjectReference, AML_ObjectTypeOp, AML_OemID, AML_OemRevision, AML_OemTableID, AML_OneOp, AML_OnesOp, AML_OpRegionOp, AML_Operand, AML_OrOp, AML_PackageElement, AML_PackageElementList, AML_PackageOp, AML_ParentPrefixChar, AML_PblkAddr, AML_PblkLen, AML_PkgEND, AML_PkgIGNORE, AML_PkgLength, AML_PowerResOp, AML_Predicate, AML_PrefixPath, AML_ProcID, AML_Processor, AML_ProcessorOp, AML_QWordConst, AML_QWordData, AML_QWordPrefix, AML_Quotient, AML_RefOfOp, AML_RegionLen, AML_RegionOffset, AML_RegionSpace, AML_ReleaseOp, AML_Remainder, AML_ReservedField, AML_ResetOp, AML_ResourceOrder, AML_ReturnOp, AML_RevisionOp, AML_RootChar, AML_ScopeOp, AML_SearchPkg, AML_SegCount, AML_ShiftCount, AML_ShiftLeftOp, AML_ShiftRightOp, AML_SignalOp, AML_SimpleName, AML_SizeOfOp, AML_SleepOp, AML_SourceBuff, AML_SpecCompliance, AML_StallOp, AML_StartIndex, AML_StoreOp, AML_String, AML_StringPrefix, AML_SubtractOp, AML_SuperName, AML_SyncFlags, AML_SystemLevel, AML_TableLength, AML_TableSignature, AML_Target, AML_TermArg, AML_TermArgList, AML_TermList, AML_TermObj, AML_ThermalZoneOp, AML_Timeout, AML_TimerOp, AML_ToBCDOp, AML_ToBufferOp, AML_ToDecimalStringOp, AML_ToHexStringOp, AML_ToIntegerOp, AML_ToStringOp, AML_Type1Opcode, AML_Type2Opcode, AML_Type6Opcode, AML_UnloadOp, AML_UsecTime, AML_UserTermObj, AML_VarNumElements, AML_VarPackageOp, AML_WaitOp, AML_WhileOp, AML_WordConst, AML_WordData, AML_WordPrefix, AML_XorOp, AML_ZeroOp, }; /* --- */ struct pathlist { struct pathlist *next; enum elementid element; int namelen, nameflag; int ref; }; struct buflist { struct buflist *next; enum elementid element; int ref; }; struct limitlist { struct limitlist *next; unsigned char *pkgend; int ref; }; struct breaklist { struct breaklist *next; char name[DATALEN]; int namelen; }; struct parsedatalist { struct parsedatalist *next; unsigned char *pkglen_c; unsigned int pkglen; unsigned char system_state[6][5]; unsigned char *system_state_name[6]; int datalen; unsigned char data[DATALEN]; unsigned char *datac; struct limitlist *limithead; enum elementid pathelement; struct pathlist *pathhead; struct buflist *bufhead; }; struct parsedata { struct parsedatalist *head, *cur, *ok; unsigned char *start, *end, *c; int progress, progresschar; }; static void * parsealloc (int s) { void *p; p = alloc (s); if (p == NULL) { panic("parsealloc: Failed to alocate memory."); } return p; } static void parsefree (void *p) { free (p); } static void error (char *str) { panic ("ACPI DSDT: %s", str); } static void replace_byte (struct parsedata *d, unsigned char *p, unsigned char c) { d->start[9] += *p - c; *p = c; } static void addpathlist (struct pathlist **pathhead, enum elementid element) { struct pathlist *newpath; newpath = parsealloc (sizeof (*newpath)); newpath->next = *pathhead; newpath->element = element; newpath->namelen = *pathhead ? (*pathhead)->namelen : 0; newpath->nameflag = 0; newpath->ref = 1; *pathhead = newpath; } static void addbuflist (struct buflist **bufhead, enum elementid element) { struct buflist *newbuf; newbuf = parsealloc (sizeof (*newbuf)); newbuf->next = *bufhead; newbuf->element = element; newbuf->ref = 1; *bufhead = newbuf; } static void pushpkgend (struct limitlist **limithead, unsigned char *pkgend) { struct limitlist *newlimit; newlimit = parsealloc (sizeof (*newlimit)); newlimit->next = *limithead; newlimit->pkgend = pkgend; newlimit->ref = 1; *limithead = newlimit; } static unsigned char * poppkgend (struct limitlist **limithead, int pollflag) { struct limitlist *curlimit; unsigned char *r; curlimit = *limithead; if (!curlimit) return NULL; r = curlimit->pkgend; if (pollflag) return r; curlimit->ref--; *limithead = curlimit->next; if (!curlimit->ref) parsefree (curlimit); else if (*limithead) (*limithead)->ref++; return r; } static void parsefreepathlist (struct pathlist **pathhead) { struct pathlist *p; while (*pathhead && !--(*pathhead)->ref) { p = *pathhead; *pathhead = p->next; parsefree (p); } *pathhead = NULL; } static void parsefreebuflist (struct buflist **bufhead) { struct buflist *p; while (*bufhead && !--(*bufhead)->ref) { p = *bufhead; *bufhead = p->next; parsefree (p); } *bufhead = NULL; } static void parsefreelimitlist (struct limitlist **limithead) { struct limitlist *p; while (*limithead && !--(*limithead)->ref) { p = *limithead; *limithead = p->next; parsefree (p); } *limithead = NULL; } static void addbufsub (struct parsedata *d, enum elementid *tmp, int n) { struct parsedatalist *q; int i, j, f; q = parsealloc (sizeof *q); /* copy path */ f = 0; q->pathhead = d->cur->pathhead; if (q->pathhead) q->pathhead->ref++; if (!q->pathhead || q->pathhead->element != d->cur->pathelement) { addpathlist (&q->pathhead, d->cur->pathelement); f = 1; } /* copy buf */ q->bufhead = d->cur->bufhead; if (q->bufhead) q->bufhead->ref++; if (f) addbuflist (&q->bufhead, OK); for (i = n; i > 0; i--) addbuflist (&q->bufhead, tmp[i - 1]); /* copy limit */ q->limithead = d->cur->limithead; if (q->limithead) q->limithead->ref++; /* copy data */ for (i = 0; i < d->cur->datalen; i++) q->data[i] = d->cur->data[i]; q->datalen = d->cur->datalen; q->datac = d->cur->datac; /* copy other data */ for (i = 0; i < 6; i++) { for (j = 0; j < 5; j++) q->system_state[i][j] = d->cur->system_state[i][j]; q->system_state_name[i] = d->cur->system_state_name[i]; } /* initialize other data */ q->next = d->head; d->head = q; } static void addbuf (struct parsedata *d, ...) { va_list ap; enum elementid element, tmp[32]; int i; va_start (ap, d); i = 0; while ((element = va_arg (ap, enum elementid)) != OK) { if (i >= 32) error ("i >= 32"); tmp[i++] = element; } va_end (ap); addbufsub (d, tmp, i); } static void addbuf2 (struct parsedata *d, enum elementid element0, enum elementid element, int n) { enum elementid tmp[32]; int i; if (n >= 32) error ("n >= 32"); tmp[0] = element0; for (i = 0; i < n; i++) tmp[i + 1] = element; addbufsub (d, tmp, n + 1); } static struct parsedatalist * getbuf (struct parsedata *d) { if (d->head == NULL) { d->head = d->ok; d->ok = NULL; d->c++; if (((d->c - d->start) % d->progress) == 0) printf ("%c", d->progresschar); } if (d->head == NULL) return NULL; d->cur = d->head; d->head = d->head->next; return d->cur; } static int eqlist (struct parsedatalist *p, struct parsedatalist *q) { struct buflist *bufp1, *bufp2; struct limitlist *limitp1, *limitp2; bufp1 = p->bufhead; bufp2 = q->bufhead; while (bufp1 != bufp2) { if (!bufp1 || !bufp2) return 0; if (bufp1->element != bufp2->element) return 0; bufp1 = bufp1->next; bufp2 = bufp2->next; } limitp1 = p->limithead; limitp2 = q->limithead; while (limitp1 != limitp2) { if (!limitp1 || !limitp2) return 0; if (limitp1->pkgend != limitp2->pkgend) return 0; limitp1 = limitp1->next; limitp2 = limitp2->next; } /* path and data may be different. it's ok. */ return 1; } static struct pathlist * pathsearch (struct parsedata *d, enum elementid element, struct pathlist *end) { struct pathlist *path; for (path = d->cur->pathhead; path && path != end; path = path->next) if (path->element == element) return path; return NULL; } static int getname (struct parsedata *d, char *buf, int len) { char c; int i, j; for (i = j = 0; i < d->cur->datalen; i++) { c = (char)d->cur->data[i]; switch (c) { case '\\': j = 0; break; case '^': if (j >= 4) j -= 4; else j = 0; break; default: if (j < len) buf[j++] = c; } } return j; } static int namecmp_system_state (struct parsedata *d) { int s, len; char tmp[DATALEN]; len = getname (d, tmp, sizeof tmp); if (len != 4) s = -1; else if (!memcmp (tmp, "_S0_", 4)) s = 0; else if (!memcmp (tmp, "_S1_", 4)) s = 1; else if (!memcmp (tmp, "_S2_", 4)) s = 2; else if (!memcmp (tmp, "_S3_", 4)) s = 3; else if (!memcmp (tmp, "_S4_", 4)) s = 4; else if (!memcmp (tmp, "_S5_", 4)) s = 5; else s = -1; return s; } static void save_system_state (struct parsedata *d, struct pathlist *path) { int s; struct parsedatalist *c; if (path->element != AML_DefName) return; c = d->cur; s = namecmp_system_state (d); if (s < 0) return; if ((path = pathsearch (d, AML_DefPackage, path)) && (path = pathsearch (d, AML_PackageElementList, path)) && (path = pathsearch (d, AML_PackageElement, path))) { switch (c->pathhead->element) { case AML_ByteData: case AML_ZeroOp: case AML_OneOp: case AML_OnesOp: if (c->system_state[s][0] >= 5) return; c->system_state[s][0]++; if (c->system_state[s][0] >= 5) return; c->system_state[s][c->system_state[s][0]] = *d->c; c->system_state_name[s] = c->datac; default: break; } } } static void parseok_def (struct parsedata *d, struct pathlist *path) { struct pathlist *path2; if ((path2 = pathsearch (d, AML_NameString, path)) && path2->next == path) { d->cur->datalen = path->namelen; if (!pathsearch (d, AML_NameSeg, path2) && !pathsearch (d, AML_RootChar, path2) && !pathsearch (d, AML_PrefixPath, path2)) return; if (pathsearch (d, AML_NullName, path2)) return; if (d->cur->datalen < DATALEN - 2) { if (!path->nameflag) path->nameflag = 1; else if (path->nameflag == 2) error ("nameflag == 2"); d->cur->data[d->cur->datalen++] = *d->c; d->cur->datac = d->c; path->namelen = d->cur->datalen; } } else { if (path->nameflag == 1) path->nameflag = 2; save_system_state (d, path); } } static void parseok (struct parsedata *d) { struct pathlist *path, *tmp; path = NULL; path = (tmp = pathsearch (d, AML_DefScope, path)) ? tmp : path; path = (tmp = pathsearch (d, AML_DefDevice, path)) ? tmp : path; path = (tmp = pathsearch (d, AML_DefMethod, path)) ? tmp : path; path = (tmp = pathsearch (d, AML_DefName, path)) ? tmp : path; if (path) parseok_def (d, path); } static struct parsedatalist * parsemain (struct parsedata *d) { struct parsedatalist *q, *r; struct pathlist *curpath; struct buflist *curbuf; enum elementid element; unsigned char *tmpc; int i; r = NULL; loop: if (r == NULL) { if (getbuf (d) == NULL) error ("getbuf"); if (d->c == d->end) { r = d->cur; goto loop; } } else { if (getbuf (d) == NULL) return r; goto err; } loop2: curbuf = d->cur->bufhead; if (!curbuf) goto err; element = curbuf->element; curbuf->ref--; d->cur->bufhead = curbuf->next; if (!curbuf->ref) parsefree (curbuf); else if (d->cur->bufhead) d->cur->bufhead->ref++; d->cur->pathelement = element; switch (element) { /* --- */ case AML_AMLCode: addbuf (d, AML_DefBlockHdr, AML_TermList, OK); break; case AML_DefBlockHdr: addbuf (d, AML_TableSignature, AML_TableLength, AML_SpecCompliance, AML_CheckSum, AML_OemID, AML_OemTableID, AML_OemRevision, AML_CreatorID, AML_CreatorRevision, OK); break; case AML_TableSignature: addbuf (d, AML_DWordData, OK); break; case AML_TableLength: addbuf (d, AML_DWordData, OK); break; case AML_SpecCompliance: addbuf (d, AML_ByteData, OK); break; case AML_CheckSum: addbuf (d, AML_ByteData, OK); break; case AML_OemID: addbuf (d, AML_ByteData, AML_ByteData, AML_ByteData, AML_ByteData, AML_ByteData, AML_ByteData, OK); break; case AML_OemTableID: addbuf (d, AML_ByteData, AML_ByteData, AML_ByteData, AML_ByteData, AML_ByteData, AML_ByteData, AML_ByteData, AML_ByteData, OK); break; case AML_OemRevision: addbuf (d, AML_DWordData, OK); break; case AML_CreatorID: addbuf (d, AML_DWordData, OK); break; case AML_CreatorRevision: addbuf (d, AML_DWordData, OK); break; case AML_LeadNameChar: addbuf (d, AML_0x41_TO_0x5A, OK); addbuf (d, AML_0x5F, OK); break; case AML_DigitChar: addbuf (d, AML_0x30_TO_0x39, OK); break; case AML_NameChar: addbuf (d, AML_DigitChar, OK); addbuf (d, AML_LeadNameChar, OK); break; case AML_RootChar: addbuf (d, AML_0x5C, OK); break; case AML_ParentPrefixChar: addbuf (d, AML_0x5E, OK); break; case AML_NameSeg: addbuf (d, AML_LeadNameChar, AML_NameChar, AML_NameChar, AML_NameChar, OK); break; case AML_NameString: addbuf (d, AML_RootChar, AML_NamePath, OK); addbuf (d, AML_PrefixPath, AML_NamePath, OK); break; case AML_PrefixPath: addbuf (d, AML_Nothing, OK); addbuf (d, AML_0x5E, AML_PrefixPath, OK); break; case AML_NamePath: addbuf (d, AML_NameSeg, OK); addbuf (d, AML_DualNamePath, OK); addbuf (d, AML_MultiNamePath, OK); addbuf (d, AML_NullName, OK); break; case AML_DualNamePath: addbuf (d, AML_DualNamePrefix, AML_NameSeg, AML_NameSeg, OK); break; case AML_DualNamePrefix: addbuf (d, AML_0x2E, OK); break; case AML_MultiNamePrefix: addbuf (d, AML_0x2F, OK); break; case AML_SimpleName: addbuf (d, AML_NameString, OK); addbuf (d, AML_ArgObj, OK); addbuf (d, AML_LocalObj, OK); break; case AML_SuperName: addbuf (d, AML_SimpleName, OK); addbuf (d, AML_DebugObj, OK); addbuf (d, AML_Type6Opcode, OK); break; case AML_NullName: addbuf (d, AML_0x00, OK); break; case AML_Target: addbuf (d, AML_SuperName, OK); addbuf (d, AML_NullName, OK); break; case AML_ComputationalData: addbuf (d, AML_ByteConst, OK); addbuf (d, AML_WordConst, OK); addbuf (d, AML_DWordConst, OK); addbuf (d, AML_QWordConst, OK); addbuf (d, AML_String, OK); addbuf (d, AML_ConstObj, OK); addbuf (d, AML_RevisionOp, OK); addbuf (d, AML_DefBuffer, OK); break; case AML_DataObject: addbuf (d, AML_ComputationalData, OK); addbuf (d, AML_DefPackage, OK); addbuf (d, AML_DefVarPackage, OK); break; case AML_DataRefObject: addbuf (d, AML_DataObject, OK); addbuf (d, AML_ObjectReference, OK); addbuf (d, AML_DDBHandle, OK); break; case AML_ByteConst: addbuf (d, AML_BytePrefix, AML_ByteData, OK); break; case AML_BytePrefix: addbuf (d, AML_0x0A, OK); break; case AML_WordConst: addbuf (d, AML_WordPrefix, AML_WordData, OK); break; case AML_WordPrefix: addbuf (d, AML_0x0B, OK); break; case AML_DWordConst: addbuf (d, AML_DWordPrefix, AML_DWordData, OK); break; case AML_DWordPrefix: addbuf (d, AML_0x0C, OK); break; case AML_QWordConst: addbuf (d, AML_QWordPrefix, AML_QWordData, OK); break; case AML_QWordPrefix: addbuf (d, AML_0x0E, OK); break; case AML_String: addbuf (d, AML_StringPrefix, AML_AsciiCharList, AML_NullChar, OK); break; case AML_StringPrefix: addbuf (d, AML_0x0D, OK); break; case AML_ConstObj: addbuf (d, AML_ZeroOp, OK); addbuf (d, AML_OneOp, OK); addbuf (d, AML_OnesOp, OK); break; case AML_ByteList: addbuf (d, AML_Nothing, OK); addbuf (d, AML_ByteData, AML_ByteList, OK); break; case AML_ByteData: addbuf (d, AML_0x00_TO_0xFF, OK); break; case AML_AsciiCharList: addbuf (d, AML_Nothing, OK); addbuf (d, AML_AsciiChar, AML_AsciiCharList, OK); break; case AML_AsciiChar: addbuf (d, AML_0x01_TO_0x7F, OK); break; case AML_NullChar: addbuf (d, AML_0x00, OK); break; case AML_ZeroOp: addbuf (d, AML_0x00, OK); break; case AML_OneOp: addbuf (d, AML_0x01, OK); break; case AML_OnesOp: addbuf (d, AML_0xFF, OK); break; case AML_RevisionOp: addbuf (d, AML_ExtOpPrefix, AML_0x30, OK); break; case AML_ExtOpPrefix: addbuf (d, AML_0x5B, OK); break; case AML_TermObj: addbuf (d, AML_NameSpaceModifierObj, OK); addbuf (d, AML_NamedObj, OK); addbuf (d, AML_Type1Opcode, OK); addbuf (d, AML_Type2Opcode, OK); break; case AML_TermList: addbuf (d, AML_Nothing, OK); addbuf (d, AML_TermObj, AML_TermList, OK); break; case AML_TermArg: addbuf (d, AML_Type2Opcode, OK); addbuf (d, AML_DataObject, OK); addbuf (d, AML_ArgObj, OK); addbuf (d, AML_LocalObj, OK); break; case AML_UserTermObj: addbuf (d, AML_NameString, AML_TermArgList, OK); break; case AML_TermArgList: addbuf (d, AML_Nothing, OK); addbuf (d, AML_TermArg, AML_TermArgList, OK); break; case AML_ObjectList: addbuf (d, AML_Nothing, OK); addbuf (d, AML_Object, AML_ObjectList, OK); break; case AML_Object: addbuf (d, AML_NameSpaceModifierObj, OK); addbuf (d, AML_NamedObj, OK); break; case AML_NameSpaceModifierObj: addbuf (d, AML_DefAlias, OK); addbuf (d, AML_DefName, OK); addbuf (d, AML_DefScope, OK); break; case AML_DefAlias: addbuf (d, AML_AliasOp, AML_NameString, AML_NameString, OK); break; case AML_AliasOp: addbuf (d, AML_0x06, OK); break; case AML_DefName: addbuf (d, AML_NameOp, AML_NameString, AML_DataRefObject, OK); break; case AML_NameOp: addbuf (d, AML_0x08, OK); break; case AML_DefScope: addbuf (d, AML_ScopeOp, AML_PkgLength, AML_NameString, AML_TermList, AML_PkgEND, OK); break; case AML_ScopeOp: addbuf (d, AML_0x10, OK); break; case AML_NamedObj: addbuf (d, AML_DefBankField, OK); addbuf (d, AML_DefCreateBitField, OK); addbuf (d, AML_DefCreateByteField, OK); addbuf (d, AML_DefCreateDWordField, OK); addbuf (d, AML_DefCreateField, OK); addbuf (d, AML_DefCreateQWordField, OK); addbuf (d, AML_DefCreateWordField, OK); addbuf (d, AML_DefDataRegion, OK); addbuf (d, AML_DefDevice, OK); addbuf (d, AML_DefEvent, OK); addbuf (d, AML_DefField, OK); addbuf (d, AML_DefIndexField, OK); addbuf (d, AML_DefMethod, OK); addbuf (d, AML_DefMutex, OK); addbuf (d, AML_DefOpRegion, OK); addbuf (d, AML_DefPowerRes, OK); addbuf (d, AML_DefProcessor, OK); addbuf (d, AML_DefThermalZone, OK); break; case AML_DefBankField: addbuf (d, AML_BankFieldOp, AML_PkgLength, AML_NameString, AML_NameString, AML_BankValue, AML_FieldFlags, AML_FieldList, AML_PkgEND, OK); break; case AML_BankFieldOp: addbuf (d, AML_ExtOpPrefix, AML_0x87, OK); break; case AML_BankValue: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_FieldFlags: addbuf (d, AML_ByteData, OK); break; case AML_FieldList: addbuf (d, AML_Nothing, OK); addbuf (d, AML_FieldElement, AML_FieldList, OK); break; case AML_FieldElement: addbuf (d, AML_NamedField, OK); addbuf (d, AML_ReservedField, OK); addbuf (d, AML_AccessField, OK); break; case AML_NamedField: addbuf (d, AML_NameSeg, AML_PkgLength, AML_PkgIGNORE, OK); break; case AML_ReservedField: addbuf (d, AML_0x00, AML_PkgLength, AML_PkgIGNORE, OK); break; case AML_AccessField: addbuf (d, AML_0x01, AML_AccessType, AML_AccessAttrib, OK); break; case AML_AccessType: addbuf (d, AML_ByteData, OK); break; case AML_AccessAttrib: addbuf (d, AML_ByteData, OK); break; case AML_DefCreateBitField: addbuf (d, AML_CreateBitFieldOp, AML_SourceBuff, AML_BitIndex, AML_NameString, OK); break; case AML_CreateBitFieldOp: addbuf (d, AML_0x8D, OK); break; case AML_SourceBuff: addbuf (d, AML_TermArg, /* => Buffer */OK); break; case AML_BitIndex: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefCreateByteField: addbuf (d, AML_CreateByteFieldOp, AML_SourceBuff, AML_ByteIndex, AML_NameString, OK); break; case AML_CreateByteFieldOp: addbuf (d, AML_0x8C, OK); break; case AML_ByteIndex: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefCreateDWordField: addbuf (d, AML_CreateDWordFieldOp, AML_SourceBuff, AML_ByteIndex, AML_NameString, OK); break; case AML_CreateDWordFieldOp: addbuf (d, AML_0x8A, OK); break; case AML_DefCreateField: addbuf (d, AML_CreateFieldOp, AML_SourceBuff, AML_BitIndex, AML_NumBits, AML_NameString, OK); break; case AML_CreateFieldOp: addbuf (d, AML_ExtOpPrefix, AML_0x13, OK); break; case AML_NumBits: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefCreateQWordField: addbuf (d, AML_CreateQWordFieldOp, AML_SourceBuff, AML_ByteIndex, AML_NameString, OK); break; case AML_CreateQWordFieldOp: addbuf (d, AML_0x8F, OK); break; case AML_DefCreateWordField: addbuf (d, AML_CreateWordFieldOp, AML_SourceBuff, AML_ByteIndex, AML_NameString, OK); break; case AML_CreateWordFieldOp: addbuf (d, AML_0x8B, OK); break; case AML_DefDataRegion: addbuf (d, AML_DataRegionOp, AML_NameString, AML_TermArg, AML_TermArg, AML_TermArg, OK); break; case AML_DataRegionOp: addbuf (d, AML_ExtOpPrefix, AML_0x88, OK); break; case AML_DeviceOp: addbuf (d, AML_ExtOpPrefix, AML_0x82, OK); break; case AML_DefEvent: addbuf (d, AML_EventOp, AML_NameString, OK); break; case AML_EventOp: addbuf (d, AML_ExtOpPrefix, AML_0x02, OK); break; case AML_DefField: addbuf (d, AML_FieldOp, AML_PkgLength, AML_NameString, AML_FieldFlags, AML_FieldList, AML_PkgEND, OK); break; case AML_FieldOp: addbuf (d, AML_ExtOpPrefix, AML_0x81, OK); break; case AML_DefIndexField: addbuf (d, AML_IndexFieldOp, AML_PkgLength, AML_NameString, AML_NameString, AML_FieldFlags, AML_FieldList, AML_PkgEND, OK); break; case AML_IndexFieldOp: addbuf (d, AML_ExtOpPrefix, AML_0x86, OK); break; case AML_MethodOp: addbuf (d, AML_0x14, OK); break; case AML_MethodFlags: addbuf (d, AML_ByteData, OK); break; case AML_DefMutex: addbuf (d, AML_MutexOp, AML_NameString, AML_SyncFlags, OK); break; case AML_MutexOp: addbuf (d, AML_ExtOpPrefix, AML_0x01, OK); break; case AML_SyncFlags: addbuf (d, AML_ByteData, OK); break; case AML_DefOpRegion: addbuf (d, AML_OpRegionOp, AML_NameString, AML_RegionSpace, AML_RegionOffset, AML_RegionLen, OK); break; case AML_OpRegionOp: addbuf (d, AML_ExtOpPrefix, AML_0x80, OK); break; case AML_RegionSpace: addbuf (d, AML_ByteData, OK); break; case AML_RegionOffset: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_RegionLen: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefPowerRes: addbuf (d, AML_PowerResOp, AML_PkgLength, AML_NameString, AML_SystemLevel, AML_ResourceOrder, AML_ObjectList, AML_PkgEND, OK); break; case AML_PowerResOp: addbuf (d, AML_ExtOpPrefix, AML_0x84, OK); break; case AML_SystemLevel: addbuf (d, AML_ByteData, OK); break; case AML_ResourceOrder: addbuf (d, AML_WordData, OK); break; case AML_DefProcessor: addbuf (d, AML_ProcessorOp, AML_PkgLength, AML_NameString, AML_ProcID, AML_PblkAddr, AML_PblkLen, AML_ObjectList, AML_PkgEND, OK); break; case AML_ProcessorOp: addbuf (d, AML_ExtOpPrefix, AML_0x83, OK); break; case AML_ProcID: addbuf (d, AML_ByteData, OK); break; case AML_PblkAddr: addbuf (d, AML_DWordData, OK); break; case AML_PblkLen: addbuf (d, AML_ByteData, OK); break; case AML_DefThermalZone: addbuf (d, AML_ThermalZoneOp, AML_PkgLength, AML_NameString, AML_ObjectList, AML_PkgEND, OK); break; case AML_ThermalZoneOp: addbuf (d, AML_ExtOpPrefix, AML_0x85, OK); break; case AML_Type1Opcode: addbuf (d, AML_DefBreak, OK); addbuf (d, AML_DefBreakPoint, OK); addbuf (d, AML_DefContinue, OK); addbuf (d, AML_DefFatal, OK); addbuf (d, AML_DefIfElse, OK); addbuf (d, AML_DefLoad, OK); addbuf (d, AML_DefNoop, OK); addbuf (d, AML_DefNotify, OK); addbuf (d, AML_DefRelease, OK); addbuf (d, AML_DefReset, OK); addbuf (d, AML_DefReturn, OK); addbuf (d, AML_DefSignal, OK); addbuf (d, AML_DefSleep, OK); addbuf (d, AML_DefStall, OK); addbuf (d, AML_DefUnload, OK); addbuf (d, AML_DefWhile, OK); break; case AML_DefBreak: addbuf (d, AML_BreakOp, OK); break; case AML_BreakOp: addbuf (d, AML_0xA5, OK); break; case AML_DefBreakPoint: addbuf (d, AML_BreakPointOp, OK); break; case AML_BreakPointOp: addbuf (d, AML_0xCC, OK); break; case AML_DefContinue: addbuf (d, AML_ContinueOp, OK); break; case AML_ContinueOp: addbuf (d, AML_0x9F, OK); break; case AML_DefElse: addbuf (d, AML_Nothing, OK); addbuf (d, AML_ElseOp, AML_PkgLength, AML_TermList, AML_PkgEND, OK); break; case AML_ElseOp: addbuf (d, AML_0xA1, OK); break; case AML_DefFatal: addbuf (d, AML_FatalOp, AML_FatalType, AML_FatalCode, AML_FatalArg, OK); break; case AML_FatalOp: addbuf (d, AML_ExtOpPrefix, AML_0x32, OK); break; case AML_FatalType: addbuf (d, AML_ByteData, OK); break; case AML_FatalCode: addbuf (d, AML_DWordData, OK); break; case AML_FatalArg: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefIfElse: addbuf (d, AML_IfOp, AML_PkgLength, AML_Predicate, AML_TermList, AML_PkgEND, AML_DefElse, OK); break; case AML_IfOp: addbuf (d, AML_0xA0, OK); break; case AML_Predicate: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefLoad: addbuf (d, AML_LoadOp, AML_NameString, AML_DDBHandleObject, OK); break; case AML_LoadOp: addbuf (d, AML_ExtOpPrefix, AML_0x20, OK); break; case AML_DDBHandleObject: addbuf (d, AML_SuperName, OK); break; case AML_DefNoop: addbuf (d, AML_NoopOp, OK); break; case AML_NoopOp: addbuf (d, AML_0xA3, OK); break; case AML_DefNotify: addbuf (d, AML_NotifyOp, AML_NotifyObject, AML_NotifyValue, OK); break; case AML_NotifyOp: addbuf (d, AML_0x86, OK); break; case AML_NotifyValue: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefRelease: addbuf (d, AML_ReleaseOp, AML_MutexObject, OK); break; case AML_ReleaseOp: addbuf (d, AML_ExtOpPrefix, AML_0x27, OK); break; case AML_MutexObject: addbuf (d, AML_SuperName, OK); break; case AML_DefReset: addbuf (d, AML_ResetOp, AML_EventObject, OK); break; case AML_ResetOp: addbuf (d, AML_ExtOpPrefix, AML_0x26, OK); break; case AML_EventObject: addbuf (d, AML_SuperName, OK); break; case AML_DefReturn: addbuf (d, AML_ReturnOp, AML_ArgObject, OK); break; case AML_ReturnOp: addbuf (d, AML_0xA4, OK); break; case AML_ArgObject: addbuf (d, AML_TermArg, /* => DataRefObject */OK); break; case AML_DefSignal: addbuf (d, AML_SignalOp, AML_EventObject, OK); break; case AML_SignalOp: addbuf (d, AML_ExtOpPrefix, AML_0x24, OK); break; case AML_DefSleep: addbuf (d, AML_SleepOp, AML_MsecTime, OK); break; case AML_SleepOp: addbuf (d, AML_ExtOpPrefix, AML_0x22, OK); break; case AML_MsecTime: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefStall: addbuf (d, AML_StallOp, AML_UsecTime, OK); break; case AML_StallOp: addbuf (d, AML_ExtOpPrefix, AML_0x21, OK); break; case AML_UsecTime: addbuf (d, AML_TermArg, /* => ByteData */OK); break; case AML_DefUnload: addbuf (d, AML_UnloadOp, AML_DDBHandleObject, OK); break; case AML_UnloadOp: addbuf (d, AML_ExtOpPrefix, AML_0x2A, OK); break; case AML_DefWhile: addbuf (d, AML_WhileOp, AML_PkgLength, AML_Predicate, AML_TermList, AML_PkgEND, OK); break; case AML_WhileOp: addbuf (d, AML_0xA2, OK); break; case AML_Type2Opcode: addbuf (d, AML_DefAcquire, OK); addbuf (d, AML_DefAdd, OK); addbuf (d, AML_DefAnd, OK); addbuf (d, AML_DefBuffer, OK); addbuf (d, AML_DefConcat, OK); addbuf (d, AML_DefConcatRes, OK); addbuf (d, AML_DefCondRefOf, OK); addbuf (d, AML_DefCopyObject, OK); addbuf (d, AML_DefDecrement, OK); addbuf (d, AML_DefDerefOf, OK); addbuf (d, AML_DefDivide, OK); addbuf (d, AML_DefFindSetLeftBit, OK); addbuf (d, AML_DefFindSetRightBit, OK); addbuf (d, AML_DefFromBCD, OK); addbuf (d, AML_DefIncrement, OK); addbuf (d, AML_DefIndex, OK); addbuf (d, AML_DefLAnd, OK); addbuf (d, AML_DefLEqual, OK); addbuf (d, AML_DefLGreater, OK); addbuf (d, AML_DefLGreaterEqual, OK); addbuf (d, AML_DefLLess, OK); addbuf (d, AML_DefLLessEqual, OK); addbuf (d, AML_DefMid, OK); addbuf (d, AML_DefLNot, OK); addbuf (d, AML_DefLNotEqual, OK); addbuf (d, AML_DefLoadTable, OK); addbuf (d, AML_DefLOr, OK); addbuf (d, AML_DefMatch, OK); addbuf (d, AML_DefMod, OK); addbuf (d, AML_DefMultiply, OK); addbuf (d, AML_DefNAnd, OK); addbuf (d, AML_DefNOr, OK); addbuf (d, AML_DefNot, OK); addbuf (d, AML_DefObjectType, OK); addbuf (d, AML_DefOr, OK); addbuf (d, AML_DefPackage, OK); addbuf (d, AML_DefVarPackage, OK); addbuf (d, AML_DefRefOf, OK); addbuf (d, AML_DefShiftLeft, OK); addbuf (d, AML_DefShiftRight, OK); addbuf (d, AML_DefSizeOf, OK); addbuf (d, AML_DefStore, OK); addbuf (d, AML_DefSubtract, OK); addbuf (d, AML_DefTimer, OK); addbuf (d, AML_DefToBCD, OK); addbuf (d, AML_DefToBuffer, OK); addbuf (d, AML_DefToDecimalString, OK); addbuf (d, AML_DefToHexString, OK); addbuf (d, AML_DefToInteger, OK); addbuf (d, AML_DefToString, OK); addbuf (d, AML_DefWait, OK); addbuf (d, AML_DefXOr, OK); addbuf (d, AML_UserTermObj, OK); break; case AML_Type6Opcode: addbuf (d, AML_DefRefOf, OK); addbuf (d, AML_DefDerefOf, OK); addbuf (d, AML_DefIndex, OK); addbuf (d, AML_UserTermObj, OK); break; case AML_DefAcquire: addbuf (d, AML_AcquireOp, AML_MutexObject, AML_Timeout, OK); break; case AML_AcquireOp: addbuf (d, AML_ExtOpPrefix, AML_0x23, OK); break; case AML_Timeout: addbuf (d, AML_WordData, OK); break; case AML_DefAdd: addbuf (d, AML_AddOp, AML_Operand, AML_Operand, AML_Target, OK); break; case AML_AddOp: addbuf (d, AML_0x72, OK); break; case AML_Operand: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefAnd: addbuf (d, AML_AndOp, AML_Operand, AML_Operand, AML_Target, OK); break; case AML_AndOp: addbuf (d, AML_0x7B, OK); break; case AML_DefBuffer: addbuf (d, AML_BufferOp, AML_PkgLength, AML_BufferSize, AML_ByteList, AML_PkgEND, OK); break; case AML_BufferOp: addbuf (d, AML_0x11, OK); break; case AML_BufferSize: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefConcat: addbuf (d, AML_ConcatOp, AML_Data, AML_Data, AML_Target, OK); break; case AML_ConcatOp: addbuf (d, AML_0x73, OK); break; case AML_Data: addbuf (d, AML_TermArg, /* => ComputationalData */OK); break; case AML_DefConcatRes: addbuf (d, AML_ConcatResOp, AML_BufData, AML_BufData, AML_Target, OK); break; case AML_ConcatResOp: addbuf (d, AML_0x84, OK); break; case AML_BufData: addbuf (d, AML_TermArg, /* => Buffer */OK); break; case AML_DefCondRefOf: addbuf (d, AML_CondRefOfOp, AML_SuperName, AML_Target, OK); break; case AML_CondRefOfOp: addbuf (d, AML_ExtOpPrefix, AML_0x12, OK); break; case AML_DefCopyObject: addbuf (d, AML_CopyObjectOp, AML_TermArg, AML_SimpleName, OK); break; case AML_CopyObjectOp: addbuf (d, AML_0x9D, OK); break; case AML_DefDecrement: addbuf (d, AML_DecrementOp, AML_SuperName, OK); break; case AML_DecrementOp: addbuf (d, AML_0x76, OK); break; case AML_DefDerefOf: addbuf (d, AML_DerefOfOp, AML_ObjReference, OK); break; case AML_DerefOfOp: addbuf (d, AML_0x83, OK); break; case AML_ObjReference: addbuf (d, AML_TermArg, /* => ObjectReference */OK); addbuf (d, AML_String, OK); break; case AML_DefDivide: addbuf (d, AML_DivideOp, AML_Dividend, AML_Divisor, AML_Remainder, AML_Quotient, OK); break; case AML_DivideOp: addbuf (d, AML_0x78, OK); break; case AML_Dividend: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_Divisor: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_Remainder: addbuf (d, AML_Target, OK); break; case AML_Quotient: addbuf (d, AML_Target, OK); break; case AML_DefFindSetLeftBit: addbuf (d, AML_FindSetLeftBitOp, AML_Operand, AML_Target, OK); break; case AML_FindSetLeftBitOp: addbuf (d, AML_0x81, OK); break; case AML_DefFindSetRightBit: addbuf (d, AML_FindSetRightBitOp, AML_Operand, AML_Target, OK); break; case AML_FindSetRightBitOp: addbuf (d, AML_0x82, OK); break; case AML_DefFromBCD: addbuf (d, AML_FromBCDOp, AML_BCDValue, AML_Target, OK); break; case AML_FromBCDOp: addbuf (d, AML_ExtOpPrefix, AML_0x28, OK); break; case AML_BCDValue: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefIncrement: addbuf (d, AML_IncrementOp, AML_SuperName, OK); break; case AML_IncrementOp: addbuf (d, AML_0x75, OK); break; case AML_DefIndex: addbuf (d, AML_IndexOp, AML_BuffPkgStrObj, AML_IndexValue, AML_Target, OK); break; case AML_IndexOp: addbuf (d, AML_0x88, OK); break; case AML_IndexValue: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefLAnd: addbuf (d, AML_LandOp, AML_Operand, AML_Operand, OK); break; case AML_LandOp: addbuf (d, AML_0x90, OK); break; case AML_DefLEqual: addbuf (d, AML_LequalOp, AML_Operand, AML_Operand, OK); break; case AML_LequalOp: addbuf (d, AML_0x93, OK); break; case AML_DefLGreater: addbuf (d, AML_LgreaterOp, AML_Operand, AML_Operand, OK); break; case AML_LgreaterOp: addbuf (d, AML_0x94, OK); break; case AML_DefLGreaterEqual: addbuf (d, AML_LgreaterEqualOp, AML_Operand, AML_Operand, OK); break; case AML_LgreaterEqualOp: addbuf (d, AML_LnotOp, AML_LlessOp, OK); break; case AML_DefLLess: addbuf (d, AML_LlessOp, AML_Operand, AML_Operand, OK); break; case AML_LlessOp: addbuf (d, AML_0x95, OK); break; case AML_DefLLessEqual: addbuf (d, AML_LlessEqualOp, AML_Operand, AML_Operand, OK); break; case AML_LlessEqualOp: addbuf (d, AML_LnotOp, AML_LgreaterOp, OK); break; case AML_DefLNot: addbuf (d, AML_LnotOp, AML_Operand, OK); break; case AML_LnotOp: addbuf (d, AML_0x92, OK); break; case AML_DefLNotEqual: addbuf (d, AML_LnotEqualOp, AML_Operand, AML_Operand, OK); break; case AML_LnotEqualOp: addbuf (d, AML_LnotOp, AML_LequalOp, OK); break; case AML_DefLoadTable: addbuf (d, AML_LoadTableOp, AML_TermArg, AML_TermArg, AML_TermArg, AML_TermArg, AML_TermArg, AML_TermArg, OK); break; case AML_LoadTableOp: addbuf (d, AML_ExtOpPrefix, AML_0x1F, OK); break; case AML_DefLOr: addbuf (d, AML_LorOp, AML_Operand, AML_Operand, OK); break; case AML_LorOp: addbuf (d, AML_0x91, OK); break; case AML_DefMatch: addbuf (d, AML_MatchOp, AML_SearchPkg, AML_MatchOpcode, AML_Operand, AML_MatchOpcode, AML_Operand, AML_StartIndex, OK); break; case AML_MatchOp: addbuf (d, AML_0x89, OK); break; case AML_SearchPkg: addbuf (d, AML_TermArg, /* => Package */OK); break; case AML_MatchOpcode: addbuf (d, AML_ByteData, OK); break; case AML_StartIndex: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefMid: addbuf (d, AML_MidOp, AML_MidObj, AML_TermArg, AML_TermArg, AML_Target, OK); break; case AML_MidOp: addbuf (d, AML_0x9E, OK); break; case AML_MidObj: addbuf (d, AML_TermArg, /* => Buffer */OK); addbuf (d, AML_String, OK); break; case AML_DefMod: addbuf (d, AML_ModOp, AML_Dividend, AML_Divisor, AML_Target, OK); break; case AML_ModOp: addbuf (d, AML_0x85, OK); break; case AML_DefMultiply: addbuf (d, AML_MultiplyOp, AML_Operand, AML_Operand, AML_Target, OK); break; case AML_MultiplyOp: addbuf (d, AML_0x77, OK); break; case AML_DefNAnd: addbuf (d, AML_NandOp, AML_Operand, AML_Operand, AML_Target, OK); break; case AML_NandOp: addbuf (d, AML_0x7C, OK); break; case AML_DefNOr: addbuf (d, AML_NorOp, AML_Operand, AML_Operand, AML_Target, OK); break; case AML_NorOp: addbuf (d, AML_0x7E, OK); break; case AML_DefNot: addbuf (d, AML_NotOp, AML_Operand, AML_Target, OK); break; case AML_NotOp: addbuf (d, AML_0x80, OK); break; case AML_DefObjectType: addbuf (d, AML_ObjectTypeOp, AML_SuperName, OK); break; case AML_ObjectTypeOp: addbuf (d, AML_0x8E, OK); break; case AML_DefOr: addbuf (d, AML_OrOp, AML_Operand, AML_Operand, AML_Target, OK); break; case AML_OrOp: addbuf (d, AML_0x7D, OK); break; case AML_DefPackage: addbuf (d, AML_PackageOp, AML_PkgLength, AML_NumElements, AML_PackageElementList, AML_PkgEND, OK); break; case AML_PackageOp: addbuf (d, AML_0x12, OK); break; case AML_DefVarPackage: addbuf (d, AML_VarPackageOp, AML_PkgLength, AML_VarNumElements, AML_PackageElementList, AML_PkgEND, OK); break; case AML_VarPackageOp: addbuf (d, AML_0x13, OK); break; case AML_NumElements: addbuf (d, AML_ByteData, OK); break; case AML_VarNumElements: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_PackageElement: addbuf (d, AML_DataRefObject, OK); addbuf (d, AML_NameString, OK); break; case AML_DefRefOf: addbuf (d, AML_RefOfOp, AML_SuperName, OK); break; case AML_RefOfOp: addbuf (d, AML_0x71, OK); break; case AML_DefShiftLeft: addbuf (d, AML_ShiftLeftOp, AML_Operand, AML_ShiftCount, AML_Target, OK); break; case AML_ShiftLeftOp: addbuf (d, AML_0x79, OK); break; case AML_ShiftCount: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_DefShiftRight: addbuf (d, AML_ShiftRightOp, AML_Operand, AML_ShiftCount, AML_Target, OK); break; case AML_ShiftRightOp: addbuf (d, AML_0x7A, OK); break; case AML_DefSizeOf: addbuf (d, AML_SizeOfOp, AML_SuperName, OK); break; case AML_SizeOfOp: addbuf (d, AML_0x87, OK); break; case AML_DefStore: addbuf (d, AML_StoreOp, AML_TermArg, AML_SuperName, OK); break; case AML_StoreOp: addbuf (d, AML_0x70, OK); break; case AML_DefSubtract: addbuf (d, AML_SubtractOp, AML_Operand, AML_Operand, AML_Target, OK); break; case AML_SubtractOp: addbuf (d, AML_0x74, OK); break; case AML_DefTimer: addbuf (d, AML_TimerOp, OK); break; case AML_TimerOp: addbuf (d, AML_0x5B, AML_0x33, OK); break; case AML_DefToBCD: addbuf (d, AML_ToBCDOp, AML_Operand, AML_Target, OK); break; case AML_ToBCDOp: addbuf (d, AML_ExtOpPrefix, AML_0x29, OK); break; case AML_DefToBuffer: addbuf (d, AML_ToBufferOp, AML_Operand, AML_Target, OK); break; case AML_ToBufferOp: addbuf (d, AML_0x96, OK); break; case AML_DefToDecimalString: addbuf (d, AML_ToDecimalStringOp, AML_Operand, AML_Target, OK); break; case AML_ToDecimalStringOp: addbuf (d, AML_0x97, OK); break; case AML_DefToHexString: addbuf (d, AML_ToHexStringOp, AML_Operand, AML_Target, OK); break; case AML_ToHexStringOp: addbuf (d, AML_0x98, OK); break; case AML_DefToInteger: addbuf (d, AML_ToIntegerOp, AML_Operand, AML_Target, OK); break; case AML_ToIntegerOp: addbuf (d, AML_0x99, OK); break; case AML_DefToString: addbuf (d, AML_ToStringOp, AML_TermArg, AML_LengthArg, AML_Target, OK); break; case AML_LengthArg: addbuf (d, AML_TermArg, /* => Integer */OK); break; case AML_ToStringOp: addbuf (d, AML_0x9C, OK); break; case AML_DefWait: addbuf (d, AML_WaitOp, AML_EventObject, AML_Operand, OK); break; case AML_WaitOp: addbuf (d, AML_ExtOpPrefix, AML_0x25, OK); break; case AML_DefXOr: addbuf (d, AML_XorOp, AML_Operand, AML_Operand, AML_Target, OK); break; case AML_XorOp: addbuf (d, AML_0x7F, OK); break; case AML_ArgObj: addbuf (d, AML_Arg0Op, OK); addbuf (d, AML_Arg1Op, OK); addbuf (d, AML_Arg2Op, OK); addbuf (d, AML_Arg3Op, OK); addbuf (d, AML_Arg4Op, OK); addbuf (d, AML_Arg5Op, OK); addbuf (d, AML_Arg6Op, OK); break; case AML_Arg0Op: addbuf (d, AML_0x68, OK); break; case AML_Arg1Op: addbuf (d, AML_0x69, OK); break; case AML_Arg2Op: addbuf (d, AML_0x6A, OK); break; case AML_Arg3Op: addbuf (d, AML_0x6B, OK); break; case AML_Arg4Op: addbuf (d, AML_0x6C, OK); break; case AML_Arg5Op: addbuf (d, AML_0x6D, OK); break; case AML_Arg6Op: addbuf (d, AML_0x6E, OK); break; case AML_LocalObj: addbuf (d, AML_Local0Op, OK); addbuf (d, AML_Local1Op, OK); addbuf (d, AML_Local2Op, OK); addbuf (d, AML_Local3Op, OK); addbuf (d, AML_Local4Op, OK); addbuf (d, AML_Local5Op, OK); addbuf (d, AML_Local6Op, OK); addbuf (d, AML_Local7Op, OK); break; case AML_Local0Op: addbuf (d, AML_0x60, OK); break; case AML_Local1Op: addbuf (d, AML_0x61, OK); break; case AML_Local2Op: addbuf (d, AML_0x62, OK); break; case AML_Local3Op: addbuf (d, AML_0x63, OK); break; case AML_Local4Op: addbuf (d, AML_0x64, OK); break; case AML_Local5Op: addbuf (d, AML_0x65, OK); break; case AML_Local6Op: addbuf (d, AML_0x66, OK); break; case AML_Local7Op: addbuf (d, AML_0x67, OK); break; case AML_DebugObj: addbuf (d, AML_DebugOp, OK); break; case AML_DebugOp: addbuf (d, AML_ExtOpPrefix, AML_0x31, OK); break; /* --- */ #define OKIF(COND) if (COND) goto ok case AML_0x00: OKIF (*d->c == 0x00); goto err; case AML_0x00_TO_0xFF: goto ok; case AML_0x01: OKIF (*d->c == 0x01); goto err; case AML_0x01_TO_0x7F: OKIF (*d->c >= 0x01 && *d->c <= 0x7F); goto err; case AML_0x02: OKIF (*d->c == 0x02); goto err; case AML_0x06: OKIF (*d->c == 0x06); goto err; case AML_0x08: OKIF (*d->c == 0x08); goto err; case AML_0x0A: OKIF (*d->c == 0x0A); goto err; case AML_0x0B: OKIF (*d->c == 0x0B); goto err; case AML_0x0C: OKIF (*d->c == 0x0C); goto err; case AML_0x0D: OKIF (*d->c == 0x0D); goto err; case AML_0x0E: OKIF (*d->c == 0x0E); goto err; case AML_0x10: OKIF (*d->c == 0x10); goto err; case AML_0x11: OKIF (*d->c == 0x11); goto err; case AML_0x12: OKIF (*d->c == 0x12); goto err; case AML_0x13: OKIF (*d->c == 0x13); goto err; case AML_0x14: OKIF (*d->c == 0x14); goto err; case AML_0x1F: OKIF (*d->c == 0x1F); goto err; case AML_0x20: OKIF (*d->c == 0x20); goto err; case AML_0x21: OKIF (*d->c == 0x21); goto err; case AML_0x22: OKIF (*d->c == 0x22); goto err; case AML_0x23: OKIF (*d->c == 0x23); goto err; case AML_0x24: OKIF (*d->c == 0x24); goto err; case AML_0x25: OKIF (*d->c == 0x25); goto err; case AML_0x26: OKIF (*d->c == 0x26); goto err; case AML_0x27: OKIF (*d->c == 0x27); goto err; case AML_0x28: OKIF (*d->c == 0x28); goto err; case AML_0x29: OKIF (*d->c == 0x29); goto err; case AML_0x2A: OKIF (*d->c == 0x2A); goto err; case AML_0x2E: OKIF (*d->c == 0x2E); goto err; case AML_0x2F: OKIF (*d->c == 0x2F); goto err; case AML_0x30: OKIF (*d->c == 0x30); goto err; case AML_0x30_TO_0x39: OKIF (*d->c >= 0x30 && *d->c <= 0x39); goto err; case AML_0x31: OKIF (*d->c == 0x31); goto err; case AML_0x32: OKIF (*d->c == 0x32); goto err; case AML_0x33: OKIF (*d->c == 0x33); goto err; case AML_0x41_TO_0x5A: OKIF (*d->c >= 0x41 && *d->c <= 0x5A); goto err; case AML_0x5B: OKIF (*d->c == 0x5B); goto err; case AML_0x5C: OKIF (*d->c == 0x5C); goto err; case AML_0x5E: OKIF (*d->c == 0x5E); goto err; case AML_0x5F: OKIF (*d->c == 0x5F); goto err; case AML_0x60: OKIF (*d->c == 0x60); goto err; case AML_0x61: OKIF (*d->c == 0x61); goto err; case AML_0x62: OKIF (*d->c == 0x62); goto err; case AML_0x63: OKIF (*d->c == 0x63); goto err; case AML_0x64: OKIF (*d->c == 0x64); goto err; case AML_0x65: OKIF (*d->c == 0x65); goto err; case AML_0x66: OKIF (*d->c == 0x66); goto err; case AML_0x67: OKIF (*d->c == 0x67); goto err; case AML_0x68: OKIF (*d->c == 0x68); goto err; case AML_0x69: OKIF (*d->c == 0x69); goto err; case AML_0x6A: OKIF (*d->c == 0x6A); goto err; case AML_0x6B: OKIF (*d->c == 0x6B); goto err; case AML_0x6C: OKIF (*d->c == 0x6C); goto err; case AML_0x6D: OKIF (*d->c == 0x6D); goto err; case AML_0x6E: OKIF (*d->c == 0x6E); goto err; case AML_0x70: OKIF (*d->c == 0x70); goto err; case AML_0x71: OKIF (*d->c == 0x71); goto err; case AML_0x72: OKIF (*d->c == 0x72); goto err; case AML_0x73: OKIF (*d->c == 0x73); goto err; case AML_0x74: OKIF (*d->c == 0x74); goto err; case AML_0x75: OKIF (*d->c == 0x75); goto err; case AML_0x76: OKIF (*d->c == 0x76); goto err; case AML_0x77: OKIF (*d->c == 0x77); goto err; case AML_0x78: OKIF (*d->c == 0x78); goto err; case AML_0x79: OKIF (*d->c == 0x79); goto err; case AML_0x7A: OKIF (*d->c == 0x7A); goto err; case AML_0x7B: OKIF (*d->c == 0x7B); goto err; case AML_0x7C: OKIF (*d->c == 0x7C); goto err; case AML_0x7D: OKIF (*d->c == 0x7D); goto err; case AML_0x7E: OKIF (*d->c == 0x7E); goto err; case AML_0x7F: OKIF (*d->c == 0x7F); goto err; case AML_0x80: OKIF (*d->c == 0x80); goto err; case AML_0x81: OKIF (*d->c == 0x81); goto err; case AML_0x82: OKIF (*d->c == 0x82); goto err; case AML_0x83: OKIF (*d->c == 0x83); goto err; case AML_0x84: OKIF (*d->c == 0x84); goto err; case AML_0x85: OKIF (*d->c == 0x85); goto err; case AML_0x86: OKIF (*d->c == 0x86); goto err; case AML_0x87: OKIF (*d->c == 0x87); goto err; case AML_0x88: OKIF (*d->c == 0x88); goto err; case AML_0x89: OKIF (*d->c == 0x89); goto err; case AML_0x8A: OKIF (*d->c == 0x8A); goto err; case AML_0x8B: OKIF (*d->c == 0x8B); goto err; case AML_0x8C: OKIF (*d->c == 0x8C); goto err; case AML_0x8D: OKIF (*d->c == 0x8D); goto err; case AML_0x8E: OKIF (*d->c == 0x8E); goto err; case AML_0x8F: OKIF (*d->c == 0x8F); goto err; case AML_0x90: OKIF (*d->c == 0x90); goto err; case AML_0x91: OKIF (*d->c == 0x91); goto err; case AML_0x92: OKIF (*d->c == 0x92); goto err; case AML_0x93: OKIF (*d->c == 0x93); goto err; case AML_0x94: OKIF (*d->c == 0x94); goto err; case AML_0x95: OKIF (*d->c == 0x95); goto err; case AML_0x96: OKIF (*d->c == 0x96); goto err; case AML_0x97: OKIF (*d->c == 0x97); goto err; case AML_0x98: OKIF (*d->c == 0x98); goto err; case AML_0x99: OKIF (*d->c == 0x99); goto err; case AML_0x9C: OKIF (*d->c == 0x9C); goto err; case AML_0x9D: OKIF (*d->c == 0x9D); goto err; case AML_0x9E: OKIF (*d->c == 0x9E); goto err; case AML_0x9F: OKIF (*d->c == 0x9F); goto err; case AML_0xA0: OKIF (*d->c == 0xA0); goto err; case AML_0xA1: OKIF (*d->c == 0xA1); goto err; case AML_0xA2: OKIF (*d->c == 0xA2); goto err; case AML_0xA3: OKIF (*d->c == 0xA3); goto err; case AML_0xA4: OKIF (*d->c == 0xA4); goto err; case AML_0xA5: OKIF (*d->c == 0xA5); goto err; case AML_0xCC: OKIF (*d->c == 0xCC); goto err; case AML_0xFF: OKIF (*d->c == 0xFF); goto err; #undef OKIF case AML_BuffPkgStrObj: addbuf (d, AML_TermArg, /* => Buffer, Package or String */OK); break; case AML_DDBHandle: goto err; addbuf (d, AML_TermArg, OK); /* FIXME: correct? */ break; case AML_DefDevice: /* If() operator must not be in ObjectList but */ /* some BIOSes have a DSDT which has If() operator */ /* in ObjectList of Device() block. (see ACPI spec 4.0a) */ /* ObjectList2 includes If() operator for workaround. */ addbuf (d, AML_DeviceOp, AML_PkgLength, AML_NameString, AML_ObjectList2, AML_PkgEND, OK); break; case AML_DefMethod: addbuf (d, AML_MethodOp, AML_PkgLength, AML_NameString, AML_MethodFlags, AML_ByteList, AML_PkgEND, OK); break; case AML_DWordData: /* WordData[0:15] WordData[16:31] */ addbuf (d, AML_WordData, AML_WordData, OK); break; case AML_MultiNamePath: addbuf (d, AML_MultiNamePrefix, AML_SegCount, OK); break; case AML_Nothing: goto loop2; case AML_NotifyObject: addbuf (d, AML_SuperName, OK); /* => ThermalZone | Processor | Device */ break; case AML_ObjectList2: addbuf (d, AML_Nothing, OK); addbuf (d, AML_Object, AML_ObjectList2, OK); addbuf (d, AML_DefIfElse, AML_ObjectList2, OK); break; case AML_ObjectReference: addbuf (d, AML_TermArg, OK); /* FIXME: correct? */ break; case AML_PackageElementList: if (namecmp_system_state (d) < 0) { /* ignore uninteresting data */ addbuf (d, AML_ByteList, OK); } else { addbuf (d, AML_Nothing, OK); addbuf (d, AML_PackageElement, AML_PackageElementList, OK); } break; case AML_PkgLength: switch (*d->c & 0xC0) { case 0xC0: addbuf (d, AML_PkgLength_0, AML_PkgLength_1, AML_PkgLength_2, AML_PkgLength_3, AML_PkgLength_PUSH, OK); break; case 0x80: addbuf (d, AML_PkgLength_0, AML_PkgLength_1, AML_PkgLength_2, AML_PkgLength_PUSH, OK); break; case 0x40: addbuf (d, AML_PkgLength_0, AML_PkgLength_1, AML_PkgLength_PUSH, OK); break; case 0: addbuf (d, AML_PkgLength_0, AML_PkgLength_PUSH, OK); } break; case AML_PkgLength_0: d->cur->pkglen_c = d->c; d->cur->pkglen = *d->c; goto ok; case AML_PkgLength_1: d->cur->pkglen &= 0xF; d->cur->pkglen |= ((unsigned int)*d->c) << 4; goto ok; case AML_PkgLength_2: d->cur->pkglen |= ((unsigned int)*d->c) << 12; goto ok; case AML_PkgLength_3: d->cur->pkglen |= ((unsigned int)*d->c) << 20; goto ok; case AML_PkgLength_PUSH: pushpkgend (&d->cur->limithead, d->cur->pkglen_c + d->cur->pkglen); goto loop2; case AML_PkgIGNORE: if (poppkgend (&d->cur->limithead, 0) == NULL) error ("pkgignore underflow"); goto loop2; case AML_PkgEND: tmpc = poppkgend (&d->cur->limithead, 0); if (tmpc == NULL) error ("pkgend underflow"); if (tmpc == d->c) goto loop2; goto err; case AML_QWordData: /* DwordData[0:31] DwordData[32:63] */ addbuf (d, AML_DWordData, AML_DWordData, OK); break; case AML_SegCount: /* addbuf (d, AML_ByteData, OK); */ addbuf2 (d, AML_SegCount_OK, AML_NameSeg, *d->c); break; case AML_SegCount_OK: goto ok; case AML_WordData: /* ByteData[0:7] ByteData[8:15] */ addbuf (d, AML_ByteData, AML_ByteData, OK); break; case OK: if (!d->cur->pathhead) error ("path underflow"); curpath = d->cur->pathhead; curpath->ref--; d->cur->pathhead = curpath->next; if (!curpath->ref) parsefree (curpath); else if (d->cur->pathhead) d->cur->pathhead->ref++; goto loop2; default: error ("?"); ok: if (poppkgend (&d->cur->limithead, 1) == d->c) goto err; for (q = d->ok; q; q = q->next) { if (eqlist (d->cur, q)) { /* workaround for some DSDT */ for (i = 0; i < 6; i++) if (d->cur->system_state[i][0] > q->system_state[i][0]) break; if (i == 6) goto err; } } parseok (d); d->cur->next = d->ok; d->ok = d->cur; goto loop; } err: parsefreepathlist (&d->cur->pathhead); parsefreebuflist (&d->cur->bufhead); parsefreelimitlist (&d->cur->limithead); parsefree (d->cur); goto loop; } static void parser (unsigned char *start, unsigned char *end) { struct parsedata d; struct parsedatalist *q; int i, j; d.progress = ((end - start) + 25) / 50; d.progresschar = 'o'; d.start = start; d.end = end; for (i = 0, j = end - start; i < j; i += d.progress) printf ("."); for (i = 0, j = end - start; i < j; i += d.progress) printf ("\b"); d.c = start; d.ok = NULL; d.head = parsealloc (sizeof *d.head); for (i = 0; i <= 5; i++) { d.head->system_state[i][0] = 0; d.head->system_state_name[i] = NULL; } d.head->datalen = 0; d.head->bufhead = NULL; d.head->pathelement = OK; d.head->pathhead = NULL; d.head->next = NULL; addbuflist (&d.head->bufhead, AML_AMLCode); d.head->limithead = NULL; q = parsemain (&d); printf ("%c\n", d.progresschar); #ifdef DISABLE_SLEEP if (q->system_state_name[2] && *q->system_state_name[2] == '_') { replace_byte (&d, q->system_state_name[2], 'D'); printf ("Disable ACPI S2\n"); } if (q->system_state_name[3] && *q->system_state_name[3] == '_') { replace_byte (&d, q->system_state_name[3], 'D'); printf ("Disable ACPI S3\n"); } #endif for (i = 0; i < 6; i++) for (j = 0; j < 5; j++) acpi_dsdt_system_state[i][j] = q->system_state[i][j]; parsefreepathlist (&q->pathhead); parsefreebuflist (&q->bufhead); parsefreelimitlist (&q->limithead); parsefree (q); } void acpi_dsdt_parse (ulong dsdt) { u32 *p; u8 *q; u32 len; p = mapmem_hphys (dsdt, 8, 0); if (p == NULL) { panic("Failed to map dsdt."); } if (memcmp ((void *)p, "DSDT", 4)) panic ("DSDT broken"); len = p[1]; unmapmem (p, 8); q = mapmem_hphys (dsdt, len, MAPMEM_WRITE); if (p == NULL) { panic("Failed to map dsdt."); } parser (q, q + len); unmapmem (q, len); } tinyvisor/vmm/core/svm_exitcode.h0000644006644000001440000000330411733227577017473 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_SVM_EXITREASON_H #define _CORE_SVM_EXITREASON_H void printexitcode (int num); char *message_exitcode (int num); #endif tinyvisor/vmm/core/beep.c0000644006644000001440000000477011733245403015704 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include "asm.h" #include "beep.h" #include "constants.h" #include "convert.h" void beep_set_freq (unsigned int hz) { unsigned int counter2; u8 l, h; counter2 = (2386364 / hz + 1) / 2; conv16to8 ((u16)counter2, &l, &h); asm_outb (PIT_CONTROL, PIT_CONTROL_BINARY | PIT_CONTROL_MODE3 | PIT_CONTROL_16BIT | PIT_CONTROL_COUNTER2); asm_outb (PIT_COUNTER2, l); asm_outb (PIT_COUNTER2, h); } void beep_on (void) { u8 d; asm_inb (0x61, &d); asm_outb (0x61, d | 3); } void beep_off (void) { u8 d; asm_inb (0x61, &d); asm_outb (0x61, d & ~3); } static int beep_msghandler (int m, int c) { if (m == 0) { switch (c) { case 0: beep_off (); break; case 1: beep_on (); break; default: beep_set_freq (c); } } return 0; } static void beep_init_msg (void) { msgregister ("beep", beep_msghandler); } INITFUNC ("msg0", beep_init_msg); tinyvisor/vmm/core/cpu_mmu.c0000644006644000001440000003227111753454341016440 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include "constants.h" #include "cpu_mmu.h" #include "current.h" #include "mm.h" #include "msr_pass.h" #include "panic.h" #define USER_MODE()\ seg_user_mode(); struct get_pte_data { unsigned int pg : 1; /* PG (Paging): CR0 bit 31 */ unsigned int wp : 1; /* WP (Write Protect): CR0 bit 16 */ unsigned int pse : 1; /* PSE (Page Size Extensions): CR4 bit 4 */ unsigned int pae : 1; /* PAE (Physical Address Extensions):CR4bit5 */ unsigned int lme : 1; /* LME (Long Mode Enable): MSR(EFER) bit 8 */ unsigned int nxe : 1; /* NXE (No-Execute Enable):MSR(EFER) bit 10 */ unsigned int write : 1; /* Write access. Set D bit if 1 */ unsigned int user : 1; /* User access */ unsigned int exec : 1; /* Execution */ }; static u64 reserved_bit_table[2][3][5] = { /* NXE = 0 */ { /* levels = 2 (32-bit, PAE = 0, PSE = 1) */ { 0x0000000000200000ULL, /* PDE, 4-MByte page */ 0x0000000000000000ULL, /* PTE */ 0x0000000000000000ULL, /* PDE, 4-KByte page */ 0xFFFFFFFFFFFFFFFFULL, /* PDPTE */ 0xFFFFFFFFFFFFFFFFULL, /* PML4E */ }, /* levels = 3 (32-bit, PAE = 1) */ { 0xFFFFFF00001FE000ULL, /* PDE, 2-MByte page */ 0xFFFFFF0000000000ULL, /* PTE */ 0xFFFFFF0000000000ULL, /* PDE, 4-KByte page */ 0xFFFFFF00000001E6ULL, /* PDPTE */ 0xFFFFFFFFFFFFFFFFULL, /* PML4E */ }, /* levels = 4 (64-bit) */ { 0x800FFF00001FE000ULL, /* PDE, 2-MByte page */ 0x800FFF0000000000ULL, /* PTE */ 0x800FFF0000000000ULL, /* PDE, 4-KByte page */ 0x800FFF0000000000ULL, /* PDPTE */ 0x800FFF0000000000ULL, /* PML4E */ }, }, /* NXE = 1 */ { /* levels = 2 (32-bit, PAE = 0, PSE = 1) */ { 0x0000000000200000ULL, /* PDE, 4-MByte page */ 0x0000000000000000ULL, /* PTE */ 0x0000000000000000ULL, /* PDE, 4-KByte page */ 0xFFFFFFFFFFFFFFFFULL, /* PDPTE */ 0xFFFFFFFFFFFFFFFFULL, /* PML4E */ }, /* levels = 3 (32-bit, PAE = 1) */ { 0x7FFFFF00001FE000ULL, /* PDE, 2-MByte page */ 0x7FFFFF0000000000ULL, /* PTE */ 0x7FFFFF0000000000ULL, /* PDE, 4-KByte page */ 0xFFFFFF00000001E6ULL, /* PDPTE */ 0xFFFFFFFFFFFFFFFFULL, /* PML4E */ }, /* levels = 4 (64-bit) */ { 0x000FFF00001FE000ULL, /* PDE, 2-MByte page */ 0x000FFF0000000000ULL, /* PTE */ 0x000FFF0000000000ULL, /* PDE, 4-KByte page */ 0x000FFF0000000000ULL, /* PDPTE */ 0x000FFF0000000000ULL, /* PML4E */ }, }, }; static bool test_pmap_entry_reserved_bit (u64 entry, int level, int levels, struct get_pte_data d) { u64 mask; if (!d.pae && !d.pse) /* PAE = 0, PSE = 0 */ return false; /* No reserved bits checked */ if (level == 2 && (entry & PDE_PS_BIT)) level = 0; mask = reserved_bit_table[d.nxe][levels - 2][level]; ASSERT (mask != 0xFFFFFFFFFFFFFFFFULL); if (entry & mask) return true; return false; } static bool set_ad_bit (pmap_t *m, u64 entry, bool seta, bool setd) { if (entry & PDE_A_BIT) seta = false; if (entry & PDE_D_BIT) setd = false; if (seta || setd) { if (seta) entry |= PDE_A_BIT; if (setd) entry |= PDE_D_BIT; return pmap_write (m, entry, 0xFFF); } else { return false; } } /* simplify1: entries[0] & entries[1] are generated when paging is disabled */ /* simplify2: entries[2] (PDPTE) |= RW|US|A when 32-bit PAE */ /* simplify3: entries[1] (PDE) &= ~PS when PSE is disabled */ /* simplify : entries[] are 64-bit when PAE is disabled */ /* simplify : entries[0] (PTE) will be generated when it is in a large page */ static vmmerr_t get_pte_sub (ulong virt, ulong cr3, struct get_pte_data d, u64 entries[5], int *plevels) { pmap_t m; int levels; int i; u64 entry; vmmerr_t r; if (!d.pg) { /* Paging disabled */ /* simplify1 */ entries[0] = (virt & PTE_ADDR_MASK64) | PTE_P_BIT | PTE_RW_BIT | PTE_US_BIT | PTE_A_BIT | PTE_D_BIT; entries[1] = PDE_P_BIT | PDE_RW_BIT | PDE_US_BIT | PDE_A_BIT | PDE_D_BIT | PDE_PS_BIT; *plevels = 1; return VMMERR_SUCCESS; } /* Paging enabled */ if (d.lme) { d.pae = 1; d.pse = 1; levels = 4; } else if (d.pae) { d.pse = 1; levels = 3; } else { levels = 2; } *plevels = levels; pmap_open_guest (&m, cr3, levels, true); pmap_setvirt (&m, virt, levels + 1); entry = pmap_read (&m); entry |= PDE_RW_BIT | PDE_US_BIT | PDE_A_BIT; entries[levels] = entry; for (i = levels; i >= 1; i--) { pmap_setlevel (&m, i); retry: entry = pmap_read (&m); if (!(entry & PDE_P_BIT)) goto ret_nopage; if (test_pmap_entry_reserved_bit (entry, i, levels, d)) goto ret_reserved; if (levels == 3 && i == 3) /* simplify2 */ entry |= PDE_RW_BIT | PDE_US_BIT | PDE_A_BIT; if (!(entry & PDE_US_BIT) && d.user) goto ret_noaccess; if (!(entry & PDE_RW_BIT) && d.write && (d.wp || d.user)) goto ret_noaccess; if ((entry & PDE_NX_BIT) && d.exec && d.nxe) goto ret_noexec; if (i == 2 && !d.pse) /* simplify3 */ entry &= ~(u64)PDE_PS_BIT; if ((i == 2 && (entry & PDE_PS_BIT)) || i == 1) { if (set_ad_bit (&m, entry, true, d.write)) goto retry; } else { if (set_ad_bit (&m, entry, true, false)) goto retry; } entries[i - 1] = entry; } r = VMMERR_SUCCESS; ret: pmap_close (&m); return r; ret_nopage: r = VMMERR_PAGE_NOT_PRESENT; goto ret; ret_reserved: r = VMMERR_PAGE_BAD_RESERVED_BIT; goto ret; ret_noaccess: r = VMMERR_PAGE_NOT_ACCESSIBLE; goto ret; ret_noexec: r = VMMERR_PAGE_NOT_EXECUTABLE; goto ret; } vmmerr_t mmu_get_pte (ulong virt, ulong cr0, ulong cr3, ulong cr4, u64 efer, bool write, bool user, bool exec, u64 entries[5], int *plevels) { struct get_pte_data d; d.pg = !!(cr0 & CR0_PG_BIT); d.wp = !!(cr0 & CR0_WP_BIT); d.pse = !!(cr4 & CR4_PSE_BIT); d.pae = !!(cr4 & CR4_PAE_BIT); d.lme = !!(efer & MSR_IA32_EFER_LME_BIT); d.nxe = !!(efer & MSR_IA32_EFER_NXE_BIT); d.write = write; d.user = user; d.exec = exec; return get_pte_sub (virt, cr3, d, entries, plevels); } static vmmerr_t get_pte (ulong virt, bool wr, bool us, bool ex, u64 *pte) { int levels; vmmerr_t r; u64 entries[5]; u64 efer; ulong cr0, cr3, cr4; current->vmctl.read_control_reg (CONTROL_REG_CR0, &cr0); current->vmctl.read_control_reg (CONTROL_REG_CR3, &cr3); current->vmctl.read_control_reg (CONTROL_REG_CR4, &cr4); current->vmctl.read_msr (MSR_IA32_EFER, &efer); r = mmu_get_pte (virt, cr0, cr3, cr4, efer, wr, us, ex, entries, &levels); if (r == VMMERR_SUCCESS) *pte = entries[0]; return r; } vmmerr_t write_linearaddr_b (ulong linear, u8 data) { u64 pte; bool us; vmmerr_t err; us = USER_MODE(); err = get_pte(linear, true, us, false, &pte); if (err) { mmu_generate_pagefault(err, true, us, linear); return err; } write_gphys_b((pte & PTE_ADDR_MASK64) | (linear & 0xFFF), data, msr_pte_to_cache_flag(pte)); return VMMERR_SUCCESS; } vmmerr_t write_linearaddr_w (ulong linear, u16 data) { u64 pte; bool us; vmmerr_t err; if ((linear & 0xFFF) == 0xFFF) { RIE (write_linearaddr_b (linear, data)); RIE (write_linearaddr_b (linear + 1, data >> 8)); return VMMERR_SUCCESS; } us = USER_MODE(); err = get_pte(linear, true, us, false, &pte); if (err) { mmu_generate_pagefault(err, true, us, linear); return err; } write_gphys_w ((pte & PTE_ADDR_MASK64) | (linear & 0xFFF), data, msr_pte_to_cache_flag(pte)); return VMMERR_SUCCESS; } vmmerr_t write_linearaddr_l (ulong linear, u32 data) { u64 pte; bool us; vmmerr_t err; if ((linear & 0xFFF) >= 0xFFD) { RIE (write_linearaddr_w (linear, data)); RIE (write_linearaddr_w (linear + 2, data >> 16)); return VMMERR_SUCCESS; } us = USER_MODE(); err = get_pte(linear, true, us, false, &pte); if (err) { mmu_generate_pagefault(err, true, us, linear); return err; } write_gphys_l ((pte & PTE_ADDR_MASK64) | (linear & 0xFFF), data, msr_pte_to_cache_flag(pte)); return VMMERR_SUCCESS; } vmmerr_t write_linearaddr_q (ulong linear, u64 data) { u64 pte; bool us; vmmerr_t err; if ((linear & 0xFFF) >= 0xFF9) { RIE (write_linearaddr_l (linear, data)); RIE (write_linearaddr_l (linear + 4, data >> 32)); return VMMERR_SUCCESS; } us = USER_MODE(); err = get_pte(linear, true, us, false, &pte); if (err) { mmu_generate_pagefault(err, true, us, linear); return err; } write_gphys_q ((pte & PTE_ADDR_MASK64) | (linear & 0xFFF), data, msr_pte_to_cache_flag(pte)); return VMMERR_SUCCESS; } vmmerr_t read_linearaddr_b (ulong linear, void *data) { u64 pte; bool us; vmmerr_t err; us = USER_MODE(); err = get_pte(linear, false, us, false /* FIXME */, &pte); if (err) { mmu_generate_pagefault(err, false, us, linear); return err; } read_gphys_b ((pte & PTE_ADDR_MASK64) | (linear & 0xFFF), data, msr_pte_to_cache_flag(pte)); return VMMERR_SUCCESS; } vmmerr_t read_linearaddr_w (ulong linear, void *data) { u64 pte; bool us; vmmerr_t err; if ((linear & 0xFFF) == 0xFFF) { RIE (read_linearaddr_b (linear, ((u8 *)data))); RIE (read_linearaddr_b (linear + 1, ((u8 *)data + 1))); return VMMERR_SUCCESS; } us = USER_MODE(); err = get_pte(linear, false, us, false /* FIXME */, &pte); if (err) { mmu_generate_pagefault(err, false, us, linear); return err; } read_gphys_w ((pte & PTE_ADDR_MASK64) | (linear & 0xFFF), data, msr_pte_to_cache_flag(pte)); return VMMERR_SUCCESS; } vmmerr_t read_linearaddr_l (ulong linear, void *data) { u64 pte; bool us; vmmerr_t err; if ((linear & 0xFFF) >= 0xFFD) { RIE (read_linearaddr_w (linear, ((u8 *)data))); RIE (read_linearaddr_w (linear + 2, ((u8 *)data + 2))); return VMMERR_SUCCESS; } us = USER_MODE(); err = get_pte(linear, false, us, false /* FIXME */, &pte); if (err) { mmu_generate_pagefault(err, false, us, linear); return err; } read_gphys_l ((pte & PTE_ADDR_MASK64) | (linear & 0xFFF), data, msr_pte_to_cache_flag(pte)); return VMMERR_SUCCESS; } vmmerr_t read_linearaddr_q (ulong linear, void *data) { u64 pte; bool us; vmmerr_t err; if ((linear & 0xFFF) >= 0xFF9) { RIE (read_linearaddr_l (linear, ((u8 *)data))); RIE (read_linearaddr_l (linear + 4, ((u8 *)data + 4))); return VMMERR_SUCCESS; } us = USER_MODE(); err = get_pte(linear, false, us, false /* FIXME */, &pte); if (err) { mmu_generate_pagefault(err, false, us, linear); return err; } read_gphys_q ((pte & PTE_ADDR_MASK64) | (linear & 0xFFF), data, msr_pte_to_cache_flag(pte)); return VMMERR_SUCCESS; } /* access a TSS during a task switch */ /* According to the manual, a processor uses contiguous physical addresses */ /* to access a TSS during a task switch */ vmmerr_t read_linearaddr_tss (ulong linear, void *tss, uint len) { u64 pte; void *p; RIE (get_pte (linear, false, false, false, &pte)); p = mapmem_gphys ((pte & PTE_ADDR_MASK64) | (linear & 0xFFF), len, 0); if (!p) return VMMERR_NOMEM; memcpy (tss, p, len); unmapmem (p, len); return VMMERR_SUCCESS; } vmmerr_t write_linearaddr_tss (ulong linear, void *tss, uint len) { u64 pte; void *p; RIE (get_pte (linear, true, false, false, &pte)); p = mapmem_gphys ((pte & PTE_ADDR_MASK64) | (linear & 0xFFF), len, MAPMEM_WRITE); if (!p) return VMMERR_NOMEM; memcpy (p, tss, len); unmapmem (p, len); return VMMERR_SUCCESS; } void mmu_generate_pagefault(vmmerr_t vmmerr, bool wr, bool us, ulong cr2) { u32 err = 0; switch (vmmerr) { case VMMERR_PAGE_NOT_PRESENT: break; case VMMERR_PAGE_NOT_ACCESSIBLE: err = PAGEFAULT_ERR_P_BIT; break; case VMMERR_PAGE_BAD_RESERVED_BIT: err = PAGEFAULT_ERR_P_BIT | PAGEFAULT_ERR_RSVD_BIT; break; case VMMERR_PAGE_NOT_EXECUTABLE: err = PAGEFAULT_ERR_P_BIT | PAGEFAULT_ERR_ID_BIT; break; default: panic("mmu_generate_pagefault: Unknown vmmerr. 0x%x", vmmerr); } if (wr) { err |= PAGEFAULT_ERR_WR_BIT; } if (us) { err |= PAGEFAULT_ERR_US_BIT; } current->vmctl.generate_pagefault (err, cr2); } tinyvisor/vmm/core/time.c0000644006644000001440000000766512167264643015746 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include #include #include #include "asm.h" #include "constants.h" #include "convert.h" #include "panic.h" #include "pcpu.h" #include #include "smp.h" #include "vmmcall_status.h" /* #define TIME_DEBUG */ #ifdef TIME_DEBUG #define TIME_DBG(...) \ do { \ printf(__VA_ARGS__); \ } while (0) #else #define TIME_DBG(...) #endif static bool initialized = false; static u64 tsc_to_time (u64 tsc, u64 hz, u64 *surplus) { u64 tmp[2]; u64 time; while (hz > 0xFFFFFFFFULL) { tsc >>= 1; hz >>= 1; } mpumul_64_64 (tsc, 1000000ULL, tmp); /* tmp = tsc * 1000000 */ mpudiv_128_32 (tmp, (u32)hz, tmp); /* tmp = tmp / hz */ time = tmp[0]; mpumul_64_64 (time, hz, tmp); /* tmp = time * hz */ mpudiv_128_32 (tmp, 1000000ULL, tmp); /* tmp = tmp / 1000000 */ *surplus = tsc - tmp[0]; return time; } /* get per-cpu time by usec */ u64 get_cpu_time (void) { u32 tsc_l, tsc_h; u64 tsc, surplus; ASSERT (initialized); asm_rdtsc (&tsc_l, &tsc_h); conv32to64 (tsc_l, tsc_h, &tsc); currentcpu->last_time += tsc_to_time (tsc - currentcpu->last_tsc, currentcpu->hz, &surplus); currentcpu->last_tsc = tsc - surplus; return currentcpu->last_time; } bool time_initialized (void) { return initialized; } static void time_init_pcpu (void) { u32 a, b, c, d; u32 tsc1_l, tsc1_h; u32 tsc2_l, tsc2_h; u64 tsc1, tsc2, count; asm_cpuid (1, 0, &a, &b, &c, &d); if (!(d & CPUID_1_EDX_TSC_BIT)) panic ("CPU%d does not support TSC", get_cpu_id()); sync_all_processors (); asm_rdtsc (&tsc1_l, &tsc1_h); if (cpu_is_bsp()) usleep (1000000); sync_all_processors (); asm_rdtsc (&tsc2_l, &tsc2_h); conv32to64 (tsc1_l, tsc1_h, &tsc1); conv32to64 (tsc2_l, tsc2_h, &tsc2); count = tsc2 - tsc1; TIME_DBG("CPU%d %llu Hz\n", get_cpu_id(), count); currentcpu->hz = count; initialized = true; } static char * time_status (void) { static char buf[1024]; snprintf (buf, 1024, "time:\n" " cpu: %d\n" " hz: %llu\n" , get_cpu_id() , currentcpu->hz); return buf; } static void time_init_global_status (void) { register_status_callback (time_status); } INITFUNC ("global4", time_init_global_status); INITFUNC ("pcpu0", time_init_pcpu); tinyvisor/vmm/core/process_sysenter.s0000644006644000001440000001014611733227577020431 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ PAGESIZE = 4096 SYS_MSGRET = 8 SEG_SEL_CODE32U = (3 * 8 + 3) SEG_SEL_DATA32U = (4 * 8 + 3) SEG_SEL_PCPU32 = (8 * 8) SEG_SEL_CALLGATE = (9 * 8 + 3) SEG_SEL_DATA64 = (11 * 8) SEG_SEL_PCPU64 = (16 * 8) gs_syscallstack = 16 .text .globl syscall_entry_sysexit .globl syscall_entry_lret .globl ret_to_user32 .globl ret_to_user64 .globl syscall_entry_sysret64 .globl processuser_sysenter .globl processuser_no_sysenter .globl processuser_syscall .code32 .align 4 syscall_entry_sysexit: mov %ss,%eax mov %eax,%ds mov %eax,%es mov %eax,%fs mov $SEG_SEL_PCPU32,%eax mov %eax,%gs mov %gs:gs_syscallstack,%esp pusha mov %esp,%eax call process_syscall mov $SEG_SEL_DATA32U,%eax mov %eax,%ds mov %eax,%es popa sysexit .align 4 syscall_entry_lret: mov %ss,%eax mov %eax,%ds mov %eax,%es mov %eax,%fs mov $SEG_SEL_PCPU32,%eax mov %eax,%gs mov %gs:gs_syscallstack,%esp pusha mov %esp,%eax call process_syscall mov $SEG_SEL_DATA32U,%eax mov %eax,%ds mov %eax,%es popa ret_to_user: pushl $SEG_SEL_DATA32U push %ecx pushl $SEG_SEL_CODE32U push %edx lret .align 4 ret_to_user32: mov $SEG_SEL_DATA32U,%eax mov %eax,%ds mov %eax,%es jmp ret_to_user .code64 .align 8 syscall_entry_sysret64: mov %rsp,%rdx mov $SEG_SEL_DATA64,%eax mov %eax,%ds mov %eax,%es mov %eax,%fs mov %eax,%ss mov $SEG_SEL_PCPU64,%eax mov %eax,%gs mov %gs:gs_syscallstack,%rsp push %rax push %rdx # RSP push %rcx # RIP push %rbx push %rsp push %rbp push %rsi push %rdi mov %rsp,%rdi call process_syscall pop %rdi pop %rsi pop %rbp pop %rsp pop %rbx pop %rcx # RIP pop %rdx # RSP pop %rax pushf pop %r11 mov %rdx,%rsp sysretq .align 8 ret_to_user64: pushf pop %r11 mov %rcx,%rsp mov $0x3FFFF200,%rcx sysretq .code32 .align PAGESIZE processuser_sysenter: # at 0x3FFFF000 pop %edx mov %esp,%ecx sysenter .org processuser_sysenter + 0x100 # at 0x3FFFF100 mov $SYS_MSGRET,%ebx mov %eax,%esi sysenter .align PAGESIZE processuser_no_sysenter: # at 0x3FFFF000 pop %edx mov %esp,%ecx lcall $SEG_SEL_CALLGATE,$0 .org processuser_no_sysenter + 0x100 # at 0x3FFFF100 mov $SYS_MSGRET,%ebx mov %eax,%esi lcall $SEG_SEL_CALLGATE,$0 .align PAGESIZE .code64 .align PAGESIZE processuser_syscall: # at 0x3FFFF000 syscall # unused ret # .org processuser_syscall + 0x100 # at 0x3FFFF100 mov $SYS_MSGRET,%ebx mov %rax,%rsi syscall .org processuser_syscall+0x200 # at 0x3FFFF200 (used by ret_to_user64) mov %rdx,%rax pop %rbx pop %rdi pop %rsi pop %rdx pop %rcx pop %r8 pop %r9 push %rbx jmp *%rax .align PAGESIZE tinyvisor/vmm/core/panic.c0000644006644000001440000003137612167264643016076 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include #include #include "callrealmode.h" #include "current.h" #include "int.h" #include "keyboard.h" #include "mm.h" #include "panic.h" #include "pcpu.h" #include "process.h" #include #include "smp.h" #include "tty.h" /* #include "vramwrite.h" */ #include #define PANICMSG_BUF_SIZE 256 static spinlock_t panic_lock = SPINLOCK_INITIALIZER; static char panicmsg[PANICMSG_BUF_SIZE] = ""; static int paniccpu = -1; static bool do_wakeup = false; void __attribute__ ((noreturn)) freeze(void) { for (;;) { asm_cli_and_hlt (); } } /* stack */ /* +4/+8 caller */ /* 0 ebp */ /* ... */ void backtrace (void) { ulong rbp, nextrbp, *p; #ifdef __x86_64__ register ulong start_rbp asm ("%rbp"); #else register ulong start_rbp asm ("%ebp"); #endif printf ("backtrace: \n"); for (rbp = start_rbp; ; rbp = nextrbp) { p = (ulong *)rbp; printf (" %p: 0x%lx\n", &p[1] , p[1]); nextrbp = p[0]; if (nextrbp == 0) break; if (rbp > nextrbp || nextrbp - rbp > 1 * 1024 * 1024) { printf (" A next rbp is bad. 0x%lx\n", nextrbp); break; } } } static void dump_general_regs (ulong r[16]) { struct { char *format; enum general_reg reg; } *p, data[] = { { "RAX %08lX ", GENERAL_REG_RAX }, { "RCX %08lX ", GENERAL_REG_RCX }, { "RDX %08lX ", GENERAL_REG_RDX }, { "RBX %08lX\n", GENERAL_REG_RBX }, { "RSP %08lX ", GENERAL_REG_RSP }, { "RBP %08lX ", GENERAL_REG_RBP }, { "RSI %08lX ", GENERAL_REG_RSI }, { "RDI %08lX\n", GENERAL_REG_RDI }, { "R8 %08lX ", GENERAL_REG_R8 }, { "R9 %08lX ", GENERAL_REG_R9 }, { "R10 %08lX ", GENERAL_REG_R10 }, { "R11 %08lX\n", GENERAL_REG_R11 }, { "R12 %08lX ", GENERAL_REG_R12 }, { "R13 %08lX ", GENERAL_REG_R13 }, { "R14 %08lX ", GENERAL_REG_R14 }, { "R15 %08lX\n", GENERAL_REG_R15 }, { NULL, 0 }, }; for (p = data; p->format; p++) printf (p->format, r[p->reg]); } static void dump_control_regs (ulong r[16]) { struct { char *format; enum control_reg reg; } *p, data[] = { { "CR0 %08lX ", CONTROL_REG_CR0 }, { "CR2 %08lX ", CONTROL_REG_CR2 }, { "CR3 %08lX ", CONTROL_REG_CR3 }, { "CR4 %08lX\n", CONTROL_REG_CR4 }, { NULL, 0 }, }; for (p = data; p->format; p++) printf (p->format, r[p->reg]); } static void dump_vmm_general_regs (void) { ulong r[16]; #ifdef __x86_64__ asm volatile ("mov %%rax,%0" : "=m" (r[GENERAL_REG_RAX])); asm volatile ("mov %%rcx,%0" : "=m" (r[GENERAL_REG_RCX])); asm volatile ("mov %%rdx,%0" : "=m" (r[GENERAL_REG_RDX])); asm volatile ("mov %%rbx,%0" : "=m" (r[GENERAL_REG_RBX])); asm volatile ("mov %%rsp,%0" : "=m" (r[GENERAL_REG_RSP])); asm volatile ("mov %%rbp,%0" : "=m" (r[GENERAL_REG_RBP])); asm volatile ("mov %%rsi,%0" : "=m" (r[GENERAL_REG_RSI])); asm volatile ("mov %%rdi,%0" : "=m" (r[GENERAL_REG_RDI])); asm volatile ("mov %%r8,%0" : "=m" (r[GENERAL_REG_R8])); asm volatile ("mov %%r9,%0" : "=m" (r[GENERAL_REG_R9])); asm volatile ("mov %%r10,%0" : "=m" (r[GENERAL_REG_R10])); asm volatile ("mov %%r11,%0" : "=m" (r[GENERAL_REG_R11])); asm volatile ("mov %%r12,%0" : "=m" (r[GENERAL_REG_R12])); asm volatile ("mov %%r13,%0" : "=m" (r[GENERAL_REG_R13])); asm volatile ("mov %%r14,%0" : "=m" (r[GENERAL_REG_R14])); asm volatile ("mov %%r15,%0" : "=m" (r[GENERAL_REG_R15])); #else asm volatile ("mov %%eax,%0" : "=m" (r[GENERAL_REG_RAX])); asm volatile ("mov %%ecx,%0" : "=m" (r[GENERAL_REG_RCX])); asm volatile ("mov %%edx,%0" : "=m" (r[GENERAL_REG_RDX])); asm volatile ("mov %%ebx,%0" : "=m" (r[GENERAL_REG_RBX])); asm volatile ("mov %%esp,%0" : "=m" (r[GENERAL_REG_RSP])); asm volatile ("mov %%ebp,%0" : "=m" (r[GENERAL_REG_RBP])); asm volatile ("mov %%esi,%0" : "=m" (r[GENERAL_REG_RSI])); asm volatile ("mov %%edi,%0" : "=m" (r[GENERAL_REG_RDI])); r[GENERAL_REG_R8] = 0; r[GENERAL_REG_R9] = 0; r[GENERAL_REG_R10] = 0; r[GENERAL_REG_R11] = 0; r[GENERAL_REG_R12] = 0; r[GENERAL_REG_R13] = 0; r[GENERAL_REG_R14] = 0; r[GENERAL_REG_R15] = 0; #endif dump_general_regs (r); } static void dump_vmm_control_regs (void) { ulong r[16]; asm_rdcr0 (&r[CONTROL_REG_CR0]); asm_rdcr2 (&r[CONTROL_REG_CR2]); asm_rdcr3 (&r[CONTROL_REG_CR3]); asm_rdcr4 (&r[CONTROL_REG_CR4]); dump_control_regs (r); } static void dump_vmm_other_regs (void) { ulong tmp, tmp2; asm_rdrflags (&tmp); printf ("RFLAGS %08lX ", tmp); asm_rdgdtr (&tmp, &tmp2); printf ("GDTR %08lX+%08lX ", tmp, tmp2); asm_rdidtr (&tmp, &tmp2); printf ("IDTR %08lX+%08lX\n", tmp, tmp2); } static void dump_vm_general_regs (void) { ulong r[16]; if (!current->vmctl.read_general_reg) return; current->vmctl.read_general_reg (GENERAL_REG_RAX, &r[GENERAL_REG_RAX]); current->vmctl.read_general_reg (GENERAL_REG_RCX, &r[GENERAL_REG_RCX]); current->vmctl.read_general_reg (GENERAL_REG_RDX, &r[GENERAL_REG_RDX]); current->vmctl.read_general_reg (GENERAL_REG_RBX, &r[GENERAL_REG_RBX]); current->vmctl.read_general_reg (GENERAL_REG_RSP, &r[GENERAL_REG_RSP]); current->vmctl.read_general_reg (GENERAL_REG_RBP, &r[GENERAL_REG_RBP]); current->vmctl.read_general_reg (GENERAL_REG_RSI, &r[GENERAL_REG_RSI]); current->vmctl.read_general_reg (GENERAL_REG_RDI, &r[GENERAL_REG_RDI]); current->vmctl.read_general_reg (GENERAL_REG_R8, &r[GENERAL_REG_R8]); current->vmctl.read_general_reg (GENERAL_REG_R9, &r[GENERAL_REG_R9]); current->vmctl.read_general_reg (GENERAL_REG_R10, &r[GENERAL_REG_R10]); current->vmctl.read_general_reg (GENERAL_REG_R11, &r[GENERAL_REG_R11]); current->vmctl.read_general_reg (GENERAL_REG_R12, &r[GENERAL_REG_R12]); current->vmctl.read_general_reg (GENERAL_REG_R13, &r[GENERAL_REG_R13]); current->vmctl.read_general_reg (GENERAL_REG_R14, &r[GENERAL_REG_R14]); current->vmctl.read_general_reg (GENERAL_REG_R15, &r[GENERAL_REG_R15]); dump_general_regs (r); } static void dump_vm_control_regs (void) { ulong r[16]; if (!current->vmctl.read_control_reg) return; current->vmctl.read_control_reg (CONTROL_REG_CR0, &r[CONTROL_REG_CR0]); current->vmctl.read_control_reg (CONTROL_REG_CR2, &r[CONTROL_REG_CR2]); current->vmctl.read_control_reg (CONTROL_REG_CR3, &r[CONTROL_REG_CR3]); current->vmctl.read_control_reg (CONTROL_REG_CR4, &r[CONTROL_REG_CR4]); dump_control_regs (r); } static void dump_vm_sregs (void) { struct { char *format; enum sreg reg; } *p, data[] = { { "ES %08lX ", SREG_ES }, { "CS %08lX ", SREG_CS }, { "SS %08lX ", SREG_SS }, { "DS %08lX ", SREG_DS }, { "FS %08lX ", SREG_FS }, { "GS %08lX\n", SREG_GS }, { NULL, 0 }, }; ulong tmp; u16 tmp16; if (!current->vmctl.read_sreg_sel) return; if (!current->vmctl.read_sreg_acr) return; if (!current->vmctl.read_sreg_base) return; if (!current->vmctl.read_sreg_limit) return; printf ("ACR "); for (p = data; p->format; p++) { current->vmctl.read_sreg_acr (p->reg, &tmp); printf (p->format, tmp); } printf ("LIMIT "); for (p = data; p->format; p++) { current->vmctl.read_sreg_limit (p->reg, &tmp); printf (p->format, tmp); } printf ("BASE "); for (p = data; p->format; p++) { current->vmctl.read_sreg_base (p->reg, &tmp); printf (p->format, tmp); } printf ("SEL "); for (p = data; p->format; p++) { current->vmctl.read_sreg_sel (p->reg, &tmp16); tmp = tmp16; printf (p->format, tmp); } } static void dump_vm_other_regs (void) { ulong tmp, tmp2; u64 tmp3; if (current->vmctl.read_ip) { current->vmctl.read_ip (&tmp); printf ("RIP %08lX ", tmp); } if (current->vmctl.read_flags) { current->vmctl.read_flags (&tmp); printf ("RFLAGS %08lX ", tmp); } if (current->vmctl.read_gdtr) { current->vmctl.read_gdtr (&tmp, &tmp2); printf ("GDTR %08lX+%08lX ", tmp, tmp2); } if (current->vmctl.read_idtr) { current->vmctl.read_idtr (&tmp, &tmp2); printf ("IDTR %08lX+%08lX", tmp, tmp2); } printf ("\n"); if (current->vmctl.read_msr) { current->vmctl.read_msr (MSR_IA32_EFER, &tmp3); printf ("EFER %08llX\n", tmp3); } if (current->vmctl.panic_dump) current->vmctl.panic_dump (); } void shell(void) { int kbd, dsp, shell; shell = newprocess ("shell"); if (shell == -1) { return; } kbd = msgopen ("ttyin"); dsp = msgopen ("ttyout"); msgsenddesc (shell, kbd); msgsenddesc (shell, dsp); printf("Starting shell.\n"); msgsendint (shell, 0); } static void __attribute__ ((noreturn)) vpanic(struct int_stack *stack, const char *format, va_list ap) { volatile static bool wakeuped = false; volatile static bool shell_started = false; volatile static int paniccpu_count = 0; if (currentcpu_available()) { if (currentcpu->panic) { printf("The second panic on CPU%d: \n", get_cpu_id()); vprintf(format, ap); freeze(); }; currentcpu->panic = true; } spinlock_lock (&panic_lock); paniccpu_count++; if (paniccpu == -1) { /* Save the first panic message. */ vsnprintf(panicmsg, PANICMSG_BUF_SIZE, format, ap); paniccpu = get_cpu_id(); printf("CPU%d panic : %s\n", get_cpu_id(), panicmsg); } else { printf("CPU%d panic: ", get_cpu_id()); vprintf(format, ap); printf("\n"); } if (stack) { int_dump_stack(stack); } if (currentcpu_available ()) { printf ("VMM state of CPU%d ------------------------------\n", get_cpu_id ()); dump_vmm_general_regs (); dump_vmm_control_regs (); dump_vmm_other_regs (); backtrace(); printf ("------------------------------------------------\n"); } if (currentcpu_available () && current) { printf ("Guest state of CPU%d ----------------------------\n", get_cpu_id ()); dump_vm_general_regs (); dump_vm_control_regs (); dump_vm_sregs (); dump_vm_other_regs (); printf ("------------------------------------------------\n"); } if (do_wakeup && !wakeuped) { printf("Sending NMI to other CPUs\n"); wakeuped = true; panic_wakeup_all (); } spinlock_unlock (&panic_lock); if (!currentcpu_available() || get_cpu_id() != 0) { freeze (); } spinlock_lock (&panic_lock); if (wakeuped) { spinlock_unlock (&panic_lock); for (;;) { spinlock_lock (&panic_lock); if (paniccpu_count >= get_number_of_processors()) { spinlock_unlock (&panic_lock); break; } spinlock_unlock (&panic_lock); cpu_relax(); } } else { spinlock_unlock (&panic_lock); } /* /\* Change vidwo mode to output message. *\/ */ /* vramwrite_reenable(); */ printf ("The first panic occured on CPU%d : %s\n", paniccpu, panicmsg); if (!currentcpu_available()) { freeze (); } if (!shell_started) { shell_started = true; keyboard_reset (); usleep (250000); setkbdled (LED_SCROLLLOCK_BIT | LED_CAPSLOCK_BIT); ttylog_stop (); shell(); } freeze (); } void __attribute__ ((noreturn)) panic_int(struct int_stack *stack, const char *format, ...) { va_list ap; va_start(ap, format); vpanic(stack, format, ap); } void __attribute__ ((noreturn)) panic(char *format, ...) { va_list ap; va_start (ap, format); vpanic(NULL, format, ap); } static int panic_msghandler (int m, int c) { if (m == 0) panic("Panic requested by user"); return 0; } static void panic_init_msg (void) { msgregister ("panic", panic_msghandler); } static void panic_init_pcpu (void) { sync_all_processors(); do_wakeup = true; } INITFUNC ("msg0", panic_init_msg); INITFUNC ("pcpu0", panic_init_pcpu); tinyvisor/vmm/core/multiboot.h0000644006644000001440000000662111733245403017011 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_MULTIBOOT_H #define _CORE_MULTIBOOT_H #include /* * Multiboot manual is available on following page. * http://www.gnu.org/software/grub/manual/multiboot/ */ struct multiboot_info_flags { unsigned int mem : 1; /* Bit 0 */ unsigned int boot_device : 1; /* Bit 1 */ unsigned int cmdline : 1; /* Bit 2 */ unsigned int mods : 1; /* Bit 3 */ unsigned int aout : 1; /* Bit 4 */ unsigned int elf : 1; /* Bit 5 */ unsigned int mmap : 1; /* Bit 6 */ unsigned int drives : 1; /* Bit 7 */ unsigned int config_table : 1; /* Bit 8 */ unsigned int boot_loader_name : 1; /* Bit 9 */ unsigned int apm_table : 1; /* Bit 10 */ unsigned int graphics_table : 1; /* Bit 11 */ unsigned int bit15_12 : 4; unsigned int bit31_16 : 16; } __attribute__ ((packed)); struct multiboot_info_boot_device { u8 part3; u8 part2; u8 part1; u8 drive; } __attribute__ ((packed)); struct multiboot_modules { u32 mod_start; u32 mod_end; u32 string; u32 reserved; } __attribute__ ((packed)); struct multiboot_info { struct multiboot_info_flags flags; /* Offset 0 */ u32 mem_lower; /* Offset 4 */ u32 mem_upper; /* Offset 8 */ struct multiboot_info_boot_device boot_device; /* Offset 12 */ u32 cmdline; /* Offset 16 */ u32 mods_count; /* Offset 20 */ u32 mods_addr; /* Offset 24 */ u32 syms[4]; /* Offset 28, 32, 36, 40 */ u32 mmap_length; /* Offset 44 */ u32 mmap_addr; /* Offset 48 */ u32 drives_length; /* Offset 52 */ u32 drives_addr; /* Offset 56 */ u32 config_table; /* Offset 60 */ u32 boot_loader_name; /* Offset 64 */ u32 apm_table; /* Offset 68 */ u32 vbe_control_info; /* Offset 72 */ u32 vbe_mode_info; /* Offset 76 */ u16 vbe_mode; /* Offset 80 */ u16 vbe_interface_seg; /* Offset 82 */ u16 vbe_interface_off; /* Offset 84 */ u16 vbe_interface_len; /* Offset 86 */ } __attribute__ ((packed)); #endif tinyvisor/vmm/core/vmctl.h0000644006644000001440000000637011733245403016121 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_VMCTL_H #define _CORE_VMCTL_H #include #include #include "cpu_seg.h" #include "regs.h" #include "vcpu.h" struct vmctl_func { void (*vminit) (void); void (*vmexit) (void); void (*run_vm) (void); void (*generate_pagefault) (ulong err, ulong cr2); void (*generate_external_int) (vector_t vector); void (*read_general_reg) (enum general_reg reg, ulong *val); void (*write_general_reg) (enum general_reg reg, ulong val); void (*read_control_reg) (enum control_reg reg, ulong *val); void (*write_control_reg) (enum control_reg reg, ulong val); void (*read_sreg_sel) (enum sreg s, u16 *val); void (*read_sreg_acr) (enum sreg s, ulong *val); void (*read_sreg_base) (enum sreg s, ulong *val); void (*read_sreg_limit) (enum sreg s, ulong *val); void (*spt_setcr3) (ulong cr3); void (*read_ip) (ulong *val); void (*write_ip) (ulong val); void (*read_flags) (ulong *val); void (*write_flags) (ulong val); void (*read_gdtr) (ulong *base, ulong *limit); void (*write_gdtr) (ulong base, ulong limit); void (*read_idtr) (ulong *base, ulong *limit); void (*write_idtr) (ulong base, ulong limit); void (*write_realmode_seg) (enum sreg s, u16 val); vmmerr_t (*writing_sreg) (enum sreg s); bool (*read_msr) (u32 msrindex, u64 *msrdata); bool (*write_msr) (u32 msrindex, u64 msrdata); void (*cpuid) (u32 ia, u32 ic, u32 *oa, u32 *ob, u32 *oc, u32 *od); void (*extint_pending) (bool pending); bool (*extint_is_blocked) (void); void (*extern_iopass) (struct vcpu *p, ioport_t port, bool pass); void (*tsc_offset_changed) (void); void (*panic_dump) (void); void (*invlpg) (ulong addr); void (*reset) (void); }; #endif tinyvisor/vmm/core/constants.h0000644006644000001440000006024712165305216017012 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_CONSTANTS_H #define _CORE_CONSTANTS_H #define CPUID_1 0x1 #define CPUID_1_EBX_NUMOFLP_MASK 0x00FF0000 #define CPUID_1_EBX_NUMOFLP_1 0x00010000 #define CPUID_1_ECX_MONITOR_BIT 0x8 #define CPUID_1_ECX_VMX_BIT 0x20 #define CPUID_1_EDX_PSE_BIT 0x8 #define CPUID_1_EDX_TSC_BIT 0x10 #define CPUID_1_EDX_MSR_BIT 0x20 #define CPUID_1_EDX_PAE_BIT 0x40 #define CPUID_1_EDX_APIC_BIT 0x200 #define CPUID_1_EDX_SEP_BIT 0x800 #define CPUID_4_EAX_NUMOFTHREADS_MASK 0x03FFC000 #define CPUID_4_EAX_NUMOFCORES_MASK 0xFC000000 #define CPUID_EXT_0 0x80000000 #define CPUID_EXT_1 0x80000001 #define CPUID_EXT_1_ECX_SVM_BIT 0x4 #define CPUID_EXT_A 0x8000000A #define CPUID_EXT_A_EDX_NP_BIT 0x1 #define CPUID_EXT_A_EDX_SVM_LOCK_BIT 0x4 #define MSR_IA32_TIME_STAMP_COUNTER 0x10 #define MSR_IA32_APIC_BASE 0x1B #define MSR_IA32_APIC_BASE_APIC_GLOBAL_ENABLE_BIT 0x800 #define MSR_IA32_APIC_BASE_APIC_BASE_MASK 0xFFFFFF000ULL #define MSR_IA32_FEATURE_CONTROL 0x3A #define MSR_IA32_FEATURE_CONTROL_LOCK_BIT 0x1 #define MSR_IA32_FEATURE_CONTROL_VMXON_BIT 0x4 #define MSR_IA32_BIOS_UPDT_TRIG 0x79 #define MSR_IA32_MTRRCAP 0xfe #define MSR_IA32_MTRRCAP_VCNT_MASK 0xff #define MSR_IA32_MTRRCAP_FIX_BIT 0x100 #define MSR_IA32_SYSENTER_CS 0x174 #define MSR_IA32_SYSENTER_ESP 0x175 #define MSR_IA32_SYSENTER_EIP 0x176 #define MSR_IA32_MTRR_PHYSBASE0 0x200 #define MSR_IA32_MTRR_PHYSMASK0 0x201 #define MSR_IA32_MTRR_PHYSBASE1 0x202 #define MSR_IA32_MTRR_PHYSMASK1 0x203 #define MSR_IA32_MTRR_PHYSBASE2 0x204 #define MSR_IA32_MTRR_PHYSMASK2 0x205 #define MSR_IA32_MTRR_PHYSBASE3 0x206 #define MSR_IA32_MTRR_PHYSMASK3 0x207 #define MSR_IA32_MTRR_PHYSBASE4 0x208 #define MSR_IA32_MTRR_PHYSMASK4 0x209 #define MSR_IA32_MTRR_PHYSBASE5 0x20a #define MSR_IA32_MTRR_PHYSMASK5 0x20b #define MSR_IA32_MTRR_PHYSBASE6 0x20c #define MSR_IA32_MTRR_PHYSMASK6 0x20d #define MSR_IA32_MTRR_PHYSMASK_V_BIT 0x800 #define MSR_IA32_MTRR_PHYSMASK_MASK_MASK 0xfffffffffffff000 #define MSR_IA32_MTRR_PHYSBASE7 0x20e #define MSR_IA32_MTRR_PHYSBASE_TYPE_MASK 0xff #define MSR_IA32_MTRR_PHYSBASE_BASE_MASK 0xfffffffffffff000 #define MSR_IA32_MTRR_PHYSMASK7 0x20f #define MSR_IA32_MTRR_FIX64K_000 0x250 #define MSR_IA32_MTRR_FIX16K_800 0x258 #define MSR_IA32_MTRR_FIX16K_A00 0x259 #define MSR_IA32_MTRR_FIX4K_C000 0x268 #define MSR_IA32_MTRR_FIX4K_C800 0x269 #define MSR_IA32_MTRR_FIX4K_D000 0x26a #define MSR_IA32_MTRR_FIX4K_D800 0x26b #define MSR_IA32_MTRR_FIX4K_E000 0x26c #define MSR_IA32_MTRR_FIX4K_E800 0x26d #define MSR_IA32_MTRR_FIX4K_F000 0x26e #define MSR_IA32_MTRR_FIX4K_F800 0x26f #define MSR_IA32_MTRR_FIX_TYPE_MASK 0xff #define MSR_IA32_MTRR_FIX_TYPE_SHIFT 8 #define MSR_IA32_MTRR_FIX_TYPE_NUM 8 #define MSR_IA32_PAT 0x277 #define MSR_IA32_MTRR_DEF_TYPE 0x2ff #define MSR_IA32_MTRR_DEF_TYPE_TYPE_MASK 0x0ff #define MSR_IA32_MTRR_DEF_TYPE_FE_BIT 0x400 #define MSR_IA32_MTRR_DEF_TYPE_E_BIT 0x800 #define MSR_IA32_VMX_BASIC 0x480 #define MSR_IA32_VMX_PINBASED_CTLS 0x481 #define MSR_IA32_VMX_PROCBASED_CTLS 0x482 #define MSR_IA32_VMX_EXIT_CTLS 0x483 #define MSR_IA32_VMX_ENTRY_CTLS 0x484 #define MSR_IA32_VMX_CR0_FIXED0 0x486 #define MSR_IA32_VMX_CR0_FIXED1 0x487 #define MSR_IA32_VMX_CR4_FIXED0 0x488 #define MSR_IA32_VMX_CR4_FIXED1 0x489 #define MSR_IA32_VMX_PROCBASED_CTLS2 0x48b #define MSR_IA32_EFER 0xC0000080 #define MSR_IA32_EFER_SCE_BIT 0x1 #define MSR_IA32_EFER_LME_BIT 0x100 #define MSR_IA32_EFER_LMA_BIT 0x400 #define MSR_IA32_EFER_NXE_BIT 0x800 #define MSR_IA32_EFER_SVME_BIT 0x1000 #define MSR_IA32_EFER_FFXSR_BIT 0x4000 #define MSR_IA32_STAR 0xC0000081 #define MSR_IA32_LSTAR 0xC0000082 #define MSR_AMD_CSTAR 0xC0000083 #define MSR_IA32_FMASK 0xC0000084 #define MSR_IA32_FS_BASE 0xC0000100 #define MSR_IA32_GS_BASE 0xC0000101 #define MSR_IA32_KERNEL_GS_BASE 0xC0000102 #define MSR_AMD_VM_CR 0xC0010114 #define MSR_AMD_VM_CR_DIS_A20M_BIT 0x4 #define MSR_AMD_VM_CR_SVMDIS_BIT 0x10 #define MSR_AMD_VM_HSAVE_PA 0xC0010117 /* 16-Bit Guest-State Fields */ #define VMCS_GUEST_ES_SEL 0x800 #define VMCS_GUEST_CS_SEL 0x802 #define VMCS_GUEST_SS_SEL 0x804 #define VMCS_GUEST_DS_SEL 0x806 #define VMCS_GUEST_FS_SEL 0x808 #define VMCS_GUEST_GS_SEL 0x80A #define VMCS_GUEST_LDTR_SEL 0x80C #define VMCS_GUEST_TR_SEL 0x80E /* 16-Bit Host-State Fields */ #define VMCS_HOST_ES_SEL 0xC00 #define VMCS_HOST_CS_SEL 0xC02 #define VMCS_HOST_SS_SEL 0xC04 #define VMCS_HOST_DS_SEL 0xC06 #define VMCS_HOST_FS_SEL 0xC08 #define VMCS_HOST_GS_SEL 0xC0A #define VMCS_HOST_TR_SEL 0xC0C /* 64-Bit Control Fields */ #define VMCS_ADDR_IOBMP_A 0x2000 #define VMCS_ADDR_IOBMP_A_HIGH 0x2001 #define VMCS_ADDR_IOBMP_B 0x2002 #define VMCS_ADDR_IOBMP_B_HIGH 0x2003 #define VMCS_ADDR_MSRBMP 0x2004 #define VMCS_ADDR_MSRBMP_HIGH 0x2005 #define VMCS_VMEXIT_MSRSTORE_ADDR 0x2006 #define VMCS_VMEXIT_MSRSTORE_ADDR_HIGH 0x2007 #define VMCS_VMEXIT_MSRLOAD_ADDR 0x2008 #define VMCS_VMEXIT_MSRLOAD_ADDR_HIGH 0x2009 #define VMCS_VMENTRY_MSRLOAD_ADDR 0x200A #define VMCS_VMENTRY_MSRLOAD_ADDR_HIGH 0x200B #define VMCS_EXEC_VMCS_POINTER 0x200C #define VMCS_EXEC_VMCS_POINTER_HIGH 0x200D #define VMCS_TSC_OFFSET 0x2010 #define VMCS_TSC_OFFSET_HIGH 0x2011 #define VMCS_VIRT_APIC_PAGE_ADDR 0x2012 #define VMCS_VIRT_APIC_PAGE_ADDR_HIGH 0x2013 #define VMCS_EPT_POINTER_ADDR 0x201A #define VMCS_EPT_POINTER_ADDR_HIGH 0x201B /* 64-Bit Data Field */ #define VMCS_GUEST_PHYS_ADDR 0x2400 #define VMCS_GUEST_PHYS_ADDR_HIGH 0x2401 /* 64-Bit Guest-State Fields */ #define VMCS_VMCS_LINK_POINTER 0x2800 #define VMCS_VMCS_LINK_POINTER_HIGH 0x2801 #define VMCS_GUEST_IA32_DEBUGCTL 0x2802 #define VMCS_GUEST_IA32_DEBUGCTL_HIGH 0x2803 #define VMCS_GUEST_IA32_PAT 0x2804 #define VMCS_GUEST_IA32_PAT_HIGH 0x2805 /* 64-Bit Host-State Fields */ #define VMCS_HOST_IA32_PAT 0x2c00 #define VMCS_HOST_IA32_PAT_HIGH 0x2c01 /* 32-Bit Control Fields */ #define VMCS_PIN_BASED_VMEXEC_CTL 0x4000 #define VMCS_PROC_BASED_VMEXEC_CTL 0x4002 #define VMCS_EXCEPTION_BMP 0x4004 #define VMCS_PAGEFAULT_ERRCODE_MASK 0x4006 #define VMCS_PAGEFAULT_ERRCODE_MATCH 0x4008 #define VMCS_CR3_TARGET_COUNT 0x400A #define VMCS_VMEXIT_CTL 0x400C #define VMCS_VMEXIT_MSR_STORE_COUNT 0x400E #define VMCS_VMEXIT_MSR_LOAD_COUNT 0x4010 #define VMCS_VMENTRY_CTL 0x4012 #define VMCS_VMENTRY_CTL_64_GUEST_BIT 0x200 #define VMCS_VMENTRY_MSR_LOAD_COUNT 0x4014 #define VMCS_VMENTRY_INTR_INFO_FIELD 0x4016 #define VMCS_VMENTRY_EXCEPTION_ERRCODE 0x4018 #define VMCS_VMENTRY_INSTRUCTION_LEN 0x401A #define VMCS_TPR_THRESHOLD 0x401C #define VMCS_PROC_BASED_VMEXEC_CTL2 0x401E #define VMCS_VM_INSTRUCTION_ERR 0x4400 #define VMCS_EXIT_REASON 0x4402 #define VMCS_VMEXIT_INTR_INFO 0x4404 #define VMCS_VMEXIT_INTR_ERRCODE 0x4406 #define VMCS_IDT_VECTORING_INFO_FIELD 0x4408 #define VMCS_IDT_VECTORING_ERRCODE 0x440A #define VMCS_VMEXIT_INSTRUCTION_LEN 0x440C #define VMCS_VMX_INSTRUCTION_INFO 0x440E /* 32-Bit Guest-State Fields */ #define VMCS_GUEST_ES_LIMIT 0x4800 #define VMCS_GUEST_CS_LIMIT 0x4802 #define VMCS_GUEST_SS_LIMIT 0x4804 #define VMCS_GUEST_DS_LIMIT 0x4806 #define VMCS_GUEST_FS_LIMIT 0x4808 #define VMCS_GUEST_GS_LIMIT 0x480A #define VMCS_GUEST_LDTR_LIMIT 0x480C #define VMCS_GUEST_TR_LIMIT 0x480E #define VMCS_GUEST_GDTR_LIMIT 0x4810 #define VMCS_GUEST_IDTR_LIMIT 0x4812 #define VMCS_GUEST_ES_ACCESS_RIGHTS 0x4814 #define VMCS_GUEST_CS_ACCESS_RIGHTS 0x4816 #define VMCS_GUEST_SS_ACCESS_RIGHTS 0x4818 #define VMCS_GUEST_DS_ACCESS_RIGHTS 0x481A #define VMCS_GUEST_FS_ACCESS_RIGHTS 0x481C #define VMCS_GUEST_GS_ACCESS_RIGHTS 0x481E #define VMCS_GUEST_LDTR_ACCESS_RIGHTS 0x4820 #define VMCS_GUEST_TR_ACCESS_RIGHTS 0x4822 #define VMCS_GUEST_INTERRUPTIBILITY_STATE 0x4824 #define VMCS_GUEST_ACTIVITY_STATE 0x4826 #define VMCS_GUEST_SMBASE 0x4828 #define VMCS_GUEST_IA32_SYSENTER_CS 0x482A /* 32-Bit Host-State Field */ #define VMCS_HOST_IA32_SYSENTER_CS 0x4C00 /* Natural-Width Control Fields */ #define VMCS_CR0_GUESTHOST_MASK 0x6000 #define VMCS_CR4_GUESTHOST_MASK 0x6002 #define VMCS_CR0_READ_SHADOW 0x6004 #define VMCS_CR4_READ_SHADOW 0x6006 #define VMCS_CR3_TARGET_VALUE_0 0x6008 #define VMCS_CR3_TARGET_VALUE_1 0x600A #define VMCS_CR3_TARGET_VALUE_2 0x600C #define VMCS_CR3_TARGET_VALUE_3 0x600E /* Natural-Width Read-Only Data Fields */ #define VMCS_EXIT_QUALIFICATION 0x6400 #define VMCS_IO_RCX 0x6402 #define VMCS_IO_RSI 0x6404 #define VMCS_IO_RDI 0x6406 #define VMCS_IO_RIP 0x6408 #define VMCS_GUEST_LINEAR_ADDR 0x640A /* Natural-Width Guest-State Fields */ #define VMCS_GUEST_CR0 0x6800 #define VMCS_GUEST_CR3 0x6802 #define VMCS_GUEST_CR4 0x6804 #define VMCS_GUEST_ES_BASE 0x6806 #define VMCS_GUEST_CS_BASE 0x6808 #define VMCS_GUEST_SS_BASE 0x680A #define VMCS_GUEST_DS_BASE 0x680C #define VMCS_GUEST_FS_BASE 0x680E #define VMCS_GUEST_GS_BASE 0x6810 #define VMCS_GUEST_LDTR_BASE 0x6812 #define VMCS_GUEST_TR_BASE 0x6814 #define VMCS_GUEST_GDTR_BASE 0x6816 #define VMCS_GUEST_IDTR_BASE 0x6818 #define VMCS_GUEST_DR7 0x681A #define VMCS_GUEST_RSP 0x681C #define VMCS_GUEST_RIP 0x681E #define VMCS_GUEST_RFLAGS 0x6820 #define VMCS_GUEST_PENDING_DEBUG_EXCEPTIONS 0x6822 #define VMCS_GUEST_IA32_SYSENTER_ESP 0x6824 #define VMCS_GUEST_IA32_SYSENTER_EIP 0x6826 /* Natural-Width Host-State Fields */ #define VMCS_HOST_CR0 0x6C00 #define VMCS_HOST_CR3 0x6C02 #define VMCS_HOST_CR4 0x6C04 #define VMCS_HOST_FS_BASE 0x6C06 #define VMCS_HOST_GS_BASE 0x6C08 #define VMCS_HOST_TR_BASE 0x6C0A #define VMCS_HOST_GDTR_BASE 0x6C0C #define VMCS_HOST_IDTR_BASE 0x6C0E #define VMCS_HOST_IA32_SYSENTER_ESP 0x6C10 #define VMCS_HOST_IA32_SYSENTER_EIP 0x6C12 #define VMCS_HOST_RSP 0x6C14 #define VMCS_HOST_RIP 0x6C16 /* Bit-fields */ #define VMCS_VMEXIT_CTL_HOST_ADDRESS_SPACE_SIZE_BIT 0x200 #define VMCS_VMEXIT_CTL_LOAD_IA32_PAT_BIT 0x80000 #define VMCS_VMENTRY_CTL_LOAD_IA32_PAT_BIT 0x4000 #define VMCS_GUEST_INTERRUPTIBILITY_STATE_BLOCKING_BY_STI_BIT 0x1 #define VMCS_GUEST_INTERRUPTIBILITY_STATE_BLOCKING_BY_MOV_SS_BIT 0x2 #define VMCS_GUEST_INTERRUPTIBILITY_STATE_BLOCKING_BY_SMI_BIT 0x4 #define VMCS_GUEST_INTERRUPTIBILITY_STATE_BLOCKING_BY_NMI_BIT 0x8 #define VMCS_PIN_BASED_VMEXEC_CTL_EXINTEXIT_BIT 0x1 #define VMCS_PIN_BASED_VMEXEC_CTL_NMIEXIT_BIT 0x8 #define VMCS_PIN_BASED_VMEXEC_CTL_VIRTNMIS_BIT 0x20 #define VMCS_PROC_BASED_VMEXEC_CTL_INTRWINEXIT_BIT 0x4 #define VMCS_PROC_BASED_VMEXEC_CTL_USETSCOFF_BIT 0x8 #define VMCS_PROC_BASED_VMEXEC_CTL_HLTEXIT_BIT 0x80 #define VMCS_PROC_BASED_VMEXEC_CTL_INVLPGEXIT_BIT 0x200 #define VMCS_PROC_BASED_VMEXEC_CTL_MWAITEXIT_BIT 0x400 #define VMCS_PROC_BASED_VMEXEC_CTL_RDPMCEXIT_BIT 0x800 #define VMCS_PROC_BASED_VMEXEC_CTL_RDTSCEXIT_BIT 0x1000 #define VMCS_PROC_BASED_VMEXEC_CTL_CR8LOADEXIT_BIT 0x80000 #define VMCS_PROC_BASED_VMEXEC_CTL_CR8STOREEXIT_BIT 0x100000 #define VMCS_PROC_BASED_VMEXEC_CTL_USETPRSHADOW_BIT 0x200000 #define VMCS_PROC_BASED_VMEXEC_CTL_NMIWINEXIT_BIT 0x400000 #define VMCS_PROC_BASED_VMEXEC_CTL_MOVDREXIT_BIT 0x800000 #define VMCS_PROC_BASED_VMEXEC_CTL_UNCONDIOEXIT_BIT 0x1000000 #define VMCS_PROC_BASED_VMEXEC_CTL_USEIOBMP_BIT 0x2000000 #define VMCS_PROC_BASED_VMEXEC_CTL_USEMSRBMP_BIT 0x10000000 #define VMCS_PROC_BASED_VMEXEC_CTL_MONITOREXIT_BIT 0x20000000 #define VMCS_PROC_BASED_VMEXEC_CTL_PAUSEEXIT_BIT 0x40000000 #define VMCS_PROC_BASED_VMEXEC_CTL_SEC_CTL_BIT 0x80000000 #define VMCS_PROC_BASED_VMEXEC_CTL2_EPT_BIT 0x2 #define VMCS_PROC_BASED_VMEXEC_UNRESTRICTED_GUEST_BIT 0x80 #define VMCS_GUEST_ACTIVITY_STATE_ACTIVE 0x0 #define VMCS_GUEST_ACTIVITY_STATE_HLT 0x1 #define VMCS_GUEST_ACTIVITY_STATE_SHUTDOWN 0x2 #define VMCS_GUEST_ACTIVITY_STATE_WAIT_FOR_SIPI 0x3 #define VMXON_REGION_SIZE 0x1000 #define VMCS_REGION_SIZE 0x1000 #define ACCESS_RIGHTS_MASK 0xF0FF #define ACCESS_RIGHTS_UNUSABLE_BIT 0x10000 #define ACCESS_RIGHTS_DPL_MASK 0x60 #define ACCESS_RIGHTS_DPL_SHIFT 5 #define ACCESS_RIGHTS_P_BIT 0x80 #define ACCESS_RIGHTS_L_BIT 0x2000 #define ACCESS_RIGHTS_D_B_BIT 0x4000 #define SEL_PRIV_MASK 0x3 #define SEL_LDT_BIT 0x4 #define SEL_MASK 0xFFF8 #define EXIT_REASON_MASK 0xFFFF #define EXIT_REASON_EXCEPTION_OR_NMI 0x0 #define EXIT_REASON_EXTERNAL_INT 0x1 #define EXIT_REASON_TRIPLE_FAULT 0x2 #define EXIT_REASON_INIT_SIGNAL 0x3 #define EXIT_REASON_STARTUP_IPI 0x4 #define EXIT_REASON_IO_SMI 0x5 #define EXIT_REASON_OTHER_SMI 0x6 #define EXIT_REASON_INTERRUPT_WINDOW 0x7 #define EXIT_REASON_TASK_SWITCH 0x9 #define EXIT_REASON_CPUID 0xA #define EXIT_REASON_HLT 0xC #define EXIT_REASON_INVD 0xD #define EXIT_REASON_INVLPG 0xE #define EXIT_REASON_RDPMC 0xF #define EXIT_REASON_RDTSC 0x10 #define EXIT_REASON_RSM 0x11 #define EXIT_REASON_VMCALL 0x12 #define EXIT_REASON_VMCLEAR 0x13 #define EXIT_REASON_VMLAUNCH 0x14 #define EXIT_REASON_VMPTRLD 0x15 #define EXIT_REASON_VMPTRST 0x16 #define EXIT_REASON_VMREAD 0x17 #define EXIT_REASON_VMRESUME 0x18 #define EXIT_REASON_VMWRITE 0x19 #define EXIT_REASON_VMXOFF 0x1A #define EXIT_REASON_VMXON 0x1B #define EXIT_REASON_MOV_CR 0x1C #define EXIT_REASON_MOV_DR 0x1D #define EXIT_REASON_IO_INSTRUCTION 0x1E #define EXIT_REASON_RDMSR 0x1F #define EXIT_REASON_WRMSR 0x20 #define EXIT_REASON_ENTFAIL_GUEST_STATE 0x21 #define EXIT_REASON_ENTFAIL_MSR_LOADING 0x22 #define EXIT_REASON_MWAIT 0x24 #define EXIT_REASON_MONITOR 0x27 #define EXIT_REASON_PAUSE 0x28 #define EXIT_REASON_ENTFAIL_MACHINE_CHK 0x29 #define EXIT_REASON_TPR_BELOW_THRESHOLD 0x2B #define EXIT_REASON_EPT_VIOLATION 0x30 #define EXIT_REASON_EPT_MISCONFIG 0x31 #define EXIT_REASON_XSETBV 0x37 #define EXIT_REASON_VMEXIT_FROM_VMX_ROOT_OPERATION_BIT 0x20000000 #define EXIT_REASON_VMENTRY_FAILURE_BIT 0x80000000 #define VMEXIT_CR0_READ 0x0 #define VMEXIT_CR1_READ 0x1 #define VMEXIT_CR2_READ 0x2 #define VMEXIT_CR3_READ 0x3 #define VMEXIT_CR4_READ 0x4 #define VMEXIT_CR5_READ 0x5 #define VMEXIT_CR6_READ 0x6 #define VMEXIT_CR7_READ 0x7 #define VMEXIT_CR8_READ 0x8 #define VMEXIT_CR9_READ 0x9 #define VMEXIT_CR10_READ 0xA #define VMEXIT_CR11_READ 0xB #define VMEXIT_CR12_READ 0xC #define VMEXIT_CR13_READ 0xD #define VMEXIT_CR14_READ 0xE #define VMEXIT_CR15_READ 0xF #define VMEXIT_CR0_WRITE 0x10 #define VMEXIT_CR1_WRITE 0x11 #define VMEXIT_CR2_WRITE 0x12 #define VMEXIT_CR3_WRITE 0x13 #define VMEXIT_CR4_WRITE 0x14 #define VMEXIT_CR5_WRITE 0x15 #define VMEXIT_CR6_WRITE 0x16 #define VMEXIT_CR7_WRITE 0x17 #define VMEXIT_CR8_WRITE 0x18 #define VMEXIT_CR9_WRITE 0x19 #define VMEXIT_CR10_WRITE 0x1A #define VMEXIT_CR11_WRITE 0x1B #define VMEXIT_CR12_WRITE 0x1C #define VMEXIT_CR13_WRITE 0x1D #define VMEXIT_CR14_WRITE 0x1E #define VMEXIT_CR15_WRITE 0x1F #define VMEXIT_DR0_READ 0x20 #define VMEXIT_DR1_READ 0x21 #define VMEXIT_DR2_READ 0x22 #define VMEXIT_DR3_READ 0x23 #define VMEXIT_DR4_READ 0x24 #define VMEXIT_DR5_READ 0x25 #define VMEXIT_DR6_READ 0x26 #define VMEXIT_DR7_READ 0x27 #define VMEXIT_DR8_READ 0x28 #define VMEXIT_DR9_READ 0x29 #define VMEXIT_DR10_READ 0x2A #define VMEXIT_DR11_READ 0x2B #define VMEXIT_DR12_READ 0x2C #define VMEXIT_DR13_READ 0x2D #define VMEXIT_DR14_READ 0x2E #define VMEXIT_DR15_READ 0x2F #define VMEXIT_DR0_WRITE 0x30 #define VMEXIT_DR1_WRITE 0x31 #define VMEXIT_DR2_WRITE 0x32 #define VMEXIT_DR3_WRITE 0x33 #define VMEXIT_DR4_WRITE 0x34 #define VMEXIT_DR5_WRITE 0x35 #define VMEXIT_DR6_WRITE 0x36 #define VMEXIT_DR7_WRITE 0x37 #define VMEXIT_DR8_WRITE 0x38 #define VMEXIT_DR9_WRITE 0x39 #define VMEXIT_DR10_WRITE 0x3A #define VMEXIT_DR11_WRITE 0x3B #define VMEXIT_DR12_WRITE 0x3C #define VMEXIT_DR13_WRITE 0x3D #define VMEXIT_DR14_WRITE 0x3E #define VMEXIT_DR15_WRITE 0x3F #define VMEXIT_EXCP0 0x40 #define VMEXIT_EXCP1 0x41 #define VMEXIT_EXCP2 0x42 #define VMEXIT_EXCP3 0x43 #define VMEXIT_EXCP4 0x44 #define VMEXIT_EXCP5 0x45 #define VMEXIT_EXCP6 0x46 #define VMEXIT_EXCP7 0x47 #define VMEXIT_EXCP8 0x48 #define VMEXIT_EXCP9 0x49 #define VMEXIT_EXCP10 0x4A #define VMEXIT_EXCP11 0x4B #define VMEXIT_EXCP12 0x4C #define VMEXIT_EXCP13 0x4D #define VMEXIT_EXCP14 0x4E #define VMEXIT_EXCP15 0x4F #define VMEXIT_EXCP16 0x50 #define VMEXIT_EXCP17 0x51 #define VMEXIT_EXCP18 0x52 #define VMEXIT_EXCP19 0x53 #define VMEXIT_EXCP20 0x54 #define VMEXIT_EXCP21 0x55 #define VMEXIT_EXCP22 0x56 #define VMEXIT_EXCP23 0x57 #define VMEXIT_EXCP24 0x58 #define VMEXIT_EXCP25 0x59 #define VMEXIT_EXCP26 0x5A #define VMEXIT_EXCP27 0x5B #define VMEXIT_EXCP28 0x5C #define VMEXIT_EXCP29 0x5D #define VMEXIT_EXCP30 0x5E #define VMEXIT_EXCP31 0x5F #define VMEXIT_INTR 0x60 #define VMEXIT_NMI 0x61 #define VMEXIT_SMI 0x62 #define VMEXIT_INIT 0x63 #define VMEXIT_VINTR 0x64 #define VMEXIT_CR0_SEL_WRITE 0x65 #define VMEXIT_IDTR_READ 0x66 #define VMEXIT_GDTR_READ 0x67 #define VMEXIT_LDTR_READ 0x68 #define VMEXIT_TR_READ 0x69 #define VMEXIT_IDTR_WRITE 0x6A #define VMEXIT_GDTR_WRITE 0x6B #define VMEXIT_LDTR_WRITE 0x6C #define VMEXIT_TR_WRITE 0x6D #define VMEXIT_RDTSC 0x6E #define VMEXIT_RDPMC 0x6F #define VMEXIT_PUSHF 0x70 #define VMEXIT_POPF 0x71 #define VMEXIT_CPUID 0x72 #define VMEXIT_RSM 0x73 #define VMEXIT_IRET 0x74 #define VMEXIT_SWINT 0x75 #define VMEXIT_INVD 0x76 #define VMEXIT_PAUSE 0x77 #define VMEXIT_HLT 0x78 #define VMEXIT_INVLPG 0x79 #define VMEXIT_INVLPGA 0x7A #define VMEXIT_IOIO 0x7B #define VMEXIT_MSR 0x7C #define VMEXIT_TASK_SWITCH 0x7D #define VMEXIT_FERR_FREEZE 0x7E #define VMEXIT_SHUTDOWN 0x7F #define VMEXIT_VMRUN 0x80 #define VMEXIT_VMMCALL 0x81 #define VMEXIT_VMLOAD 0x82 #define VMEXIT_VMSAVE 0x83 #define VMEXIT_STGI 0x84 #define VMEXIT_CLGI 0x85 #define VMEXIT_SKINIT 0x86 #define VMEXIT_RDTSCP 0x87 #define VMEXIT_ICEBP 0x88 #define VMEXIT_WBINVD 0x89 #define VMEXIT_MONITOR 0x8A #define VMEXIT_MWAIT 0x8B #define VMEXIT_MWAIT_CONDITIONAL 0x8C #define VMEXIT_NPF 0x400 #define VMEXIT_INVALID -1 #define RFLAGS_CF_BIT 0x1 #define RFLAGS_PF_BIT 0x4 #define RFLAGS_AF_BIT 0x10 #define RFLAGS_ZF_BIT 0x40 #define RFLAGS_SF_BIT 0x80 #define RFLAGS_TF_BIT 0x100 #define RFLAGS_IF_BIT 0x200 #define RFLAGS_DF_BIT 0x400 #define RFLAGS_OF_BIT 0x800 #define RFLAGS_IOPL_MASK 0x3000 #define RFLAGS_IOPL_0 0x0000 #define RFLAGS_IOPL_1 0x1000 #define RFLAGS_IOPL_2 0x2000 #define RFLAGS_IOPL_3 0x3000 #define RFLAGS_NT_BIT 0x4000 #define RFLAGS_RF_BIT 0x10000 #define RFLAGS_VM_BIT 0x20000 #define RFLAGS_AC_BIT 0x40000 #define RFLAGS_VIF_BIT 0x80000 #define RFLAGS_VIP_BIT 0x100000 #define RFLAGS_ID_BIT 0x200000 #define RFLAGS_ALWAYS1_BIT 0x2 #define RFLAGS_SYS_MASK RFLAGS_TF_BIT | \ RFLAGS_IF_BIT | \ RFLAGS_IOPL_MASK | \ RFLAGS_NT_BIT | \ RFLAGS_RF_BIT | \ RFLAGS_VM_BIT | \ RFLAGS_AC_BIT | \ RFLAGS_VIF_BIT | \ RFLAGS_VIP_BIT | \ RFLAGS_ID_BIT #define RFLAGS_NONSYS_MASK RFLAGS_CF_BIT | \ RFLAGS_PF_BIT | \ RFLAGS_AF_BIT | \ RFLAGS_ZF_BIT | \ RFLAGS_SF_BIT | \ RFLAGS_DF_BIT | \ RFLAGS_OF_BIT #define CR0_PE_BIT 0x1 #define CR0_MP_BIT 0x2 #define CR0_EM_BIT 0x4 #define CR0_TS_BIT 0x8 #define CR0_ET_BIT 0x10 #define CR0_NE_BIT 0x20 #define CR0_WP_BIT 0x10000 #define CR0_AM_BIT 0x40000 #define CR0_NW_BIT 0x20000000 #define CR0_CD_BIT 0x40000000 #define CR0_PG_BIT 0x80000000 #define CR3_PWT_BIT 0x8 #define CR3_PCD_BIT 0x10 #define CR4_VME_BIT 0x1 #define CR4_PVI_BIT 0x2 #define CR4_TSD_BIT 0x4 #define CR4_DE_BIT 0x8 #define CR4_PSE_BIT 0x10 #define CR4_PAE_BIT 0x20 #define CR4_MCE_BIT 0x40 #define CR4_PGE_BIT 0x80 #define CR4_PCE_BIT 0x100 #define CR4_OSFXSR_BIT 0x200 #define CR4_OSXMMEXCPT_BIT 0x400 #define CR4_VMXE_BIT 0x2000 #define CR4_OSXSAVE_BIT 0x40000 #define PDE_P_BIT 0x1 #define PDE_RW_BIT 0x2 #define PDE_US_BIT 0x4 #define PDE_PWT_BIT 0x8 #define PDE_PCD_BIT 0x10 #define PDE_A_BIT 0x20 #define PDE_D_BIT 0x40 #define PDE_PS_BIT 0x80 #define PDE_G_BIT 0x100 #define PDE_AVAILABLE1_BIT 0x200 #define PDE_AVAILABLE2_BIT 0x400 #define PDE_AVAILABLE3_BIT 0x800 #define PDE_AVAILABLE_MASK 0xE00 #define PDE_NX_BIT 0x8000000000000000ULL #define PDE_4K_ADDR_MASK 0xFFFFF000 #define PDE_ATTR_MASK 0xFFF #define PDE_PS_PAT_BIT 0x1000 #define PDE_4M_PAT_BIT PDE_PS_PAT_BIT #define PDE_4M_OFFSET_MASK 0x003FFFFF #define PDE_4M_ADDR_MASK (~PDE_4M_OFFSET_MASK) #define PDE_2M_PAT_BIT PDE_PS_PAT_BIT #define PDE_2M_OFFSET_MASK 0x001FFFFF #define PDE_2M_ADDR_MASK (~PDE_2M_OFFSET_MASK) #define PDE_ADDR_MASK64 0x000000FFFFFFF000ULL #define PTE_P_BIT 0x1 #define PTE_RW_BIT 0x2 #define PTE_US_BIT 0x4 #define PTE_PWT_BIT 0x8 #define PTE_PCD_BIT 0x10 #define PTE_A_BIT 0x20 #define PTE_D_BIT 0x40 #define PTE_PAT_BIT 0x80 #define PTE_G_BIT 0x100 #define PTE_AVAILABLE1_BIT 0x200 #define PTE_AVAILABLE2_BIT 0x400 #define PTE_AVAILABLE3_BIT 0x800 #define PTE_AVAILABLE_MASK 0xE00 #define PTE_NX_BIT 0x8000000000000000ULL #define PTE_ADDR_MASK 0xFFFFF000 #define PTE_ATTR_MASK 0xFFF #define PTE_ADDR_MASK64 0x000000FFFFFFF000ULL #define PTE_NUM_IN_TABLE_32 1024 #define PTE_NUM_IN_TABLE_64 512 #define EXCEPTION_DE 0x0 #define EXCEPTION_DB 0x1 #define EXCEPTION_NMI 0x2 #define EXCEPTION_BP 0x3 #define EXCEPTION_OF 0x4 #define EXCEPTION_BR 0x5 #define EXCEPTION_UD 0x6 #define EXCEPTION_NM 0x7 #define EXCEPTION_DF 0x8 #define EXCEPTION_COPROCESSOR_SEGMENT_OVERRUN 0x9 #define EXCEPTION_TS 0xA #define EXCEPTION_NP 0xB #define EXCEPTION_SS 0xC #define EXCEPTION_GP 0xD #define EXCEPTION_PF 0xE #define EXCEPTION_MF 0x10 #define EXCEPTION_AC 0x11 #define EXCEPTION_MC 0x12 #define EXCEPTION_XM 0x13 #define EXT_INT_START 0x20 #define NUM_OF_IOPORT 0x10000 #define NUM_OF_INT 0x100 #define PAGEFAULT_ERR_P_BIT 0x1 #define PAGEFAULT_ERR_WR_BIT 0x2 #define PAGEFAULT_ERR_US_BIT 0x4 #define PAGEFAULT_ERR_RSVD_BIT 0x8 #define PAGEFAULT_ERR_ID_BIT 0x10 #define EXCEPTION_ERR_EXT_BIT 0x1 #define EXCEPTION_ERR_IDT_BIT 0x2 #define EXCEPTION_ERR_TI_BIT 0x4 #define EXCEPTION_ERR_SEL_MASK 0xFFF8 #define EXCEPTION_ERR_SEL_SHIFT 3 #define PAGESIZE 0x1000 #define PAGESIZE2M 0x200000 #define PAGESIZE4M 0x400000 #define PAGESIZE_SHIFT 12 #define PAGESIZE2M_SHIFT 21 #define PAGESIZE4M_SHIFT 22 #define PAGESIZE_MASK (PAGESIZE - 1) #define PAGESIZE2M_MASK (PAGESIZE2M - 1) #define PAGESIZE4M_MASK (PAGESIZE4M - 1) #define PIT_COUNTER0 0x40 #define PIT_COUNTER1 0x41 #define PIT_COUNTER2 0x42 #define PIT_CONTROL 0x43 #define PIT_CONTROL_BINARY 0x0 #define PIT_CONTROL_BCD 0x1 #define PIT_CONTROL_MODE0 0x0 #define PIT_CONTROL_MODE1 0x2 #define PIT_CONTROL_MODE2 0x4 #define PIT_CONTROL_MODE3 0x6 #define PIT_CONTROL_MODE4 0x8 #define PIT_CONTROL_MODE5 0xA #define PIT_CONTROL_LATCH 0x00 #define PIT_CONTROL_LOW8BIT 0x10 #define PIT_CONTROL_HIGH8BIT 0x20 #define PIT_CONTROL_16BIT 0x30 #define PIT_CONTROL_COUNTER0 0x00 #define PIT_CONTROL_COUNTER1 0x40 #define PIT_CONTROL_COUNTER2 0x80 #define PIT_CONTROL_READBACK 0xC0 #define VMM_MINSTACKSIZE 1024 #endif tinyvisor/vmm/core/acpi.h0000644006644000001440000000334311771625217015714 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_ACPI_H #define _CORE_ACPI_H extern unsigned char acpi_dsdt_system_state[6][5]; #endif /* _ACPI_H */ tinyvisor/vmm/core/cpu_interpreter.h0000644006644000001440000000346611733245403020211 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_CPU_INTERPRETER_H #define _CORE_CPU_INTERPRETER_H #include enum cpumode { CPUMODE_REAL, CPUMODE_PROTECTED, }; enum optype { OPTYPE_16BIT, OPTYPE_32BIT, OPTYPE_64BIT, }; vmmerr_t cpu_interpreter (void); #endif tinyvisor/vmm/core/extint.c0000644006644000001440000001656512206320117016301 0ustar yuichi_xyusers/* * Copyright (c) 2010-2013 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include "apic.h" #include "bitmap.h" #include "cpu_emul.h" #include "constants.h" #include "current.h" #include "panic.h" #define EXTINT_DEBUG 1 #ifdef EXTINT_DEBUG #define EXTINT_DBG(level, ...) \ do { \ if (level <= EXTINT_DEBUG) { \ printf(__VA_ARGS__); \ } \ } while (0) #else #define EXTINT_DBG(...) #endif void extint_pend_apic_int(vector_t vector) { long bsr; EXTINT_DBG(2, "R%d apic %d\n", get_cpu_id(), vector); bsr = BITMAP_BSR(¤t->extint.pending_apic_int); if (vector <= bsr) { panic ("A apic interrupt %d received, though a interrupt %ld is pending\n", vector, bsr); } bsr = BITMAP_BSR(¤t->extint.inservice_apic_int); if (vector <= bsr) { panic ("A apic interrupt %d received, though a interrupt %ld is in-service\n", vector, bsr); } if (BITMAP_SET(¤t->extint.pending_apic_int, vector)) { EXTINT_DBG(1, "A external interrupt %d (apic) received while the same interrupt is pending.\n", vector); } current->halt = false; } void extint_pend_8259a_int(vector_t vector) { EXTINT_DBG(2, "R%d 8259a %d\n", get_cpu_id(), vector); if (BITMAP_SET(¤t->extint.pending_8259a_int, vector)) { EXTINT_DBG(2, "A external interrupt %d (8259a) received while the same interrupt is pending.\n", vector); } current->halt = false; } void extint_pend_interrupt(vector_t vector) { if (current == NULL) { panic ("current is NULL in extint_pend"); } if (!current->vbsp) { extint_pend_apic_int(vector); } else if (apic_check_apic_interrupt(vector)) { extint_pend_apic_int(vector); } else { extint_pend_8259a_int(vector); } } /* * The caller should disable interrupts (CLI) before calling this * function until vmlaunch/vmresume to avoid losing interrupts. */ void extint_check_interrupt(void) { long vector = -1; bool apic_int = false; long inservice; ulong cr0; vmmerr_t err; /* * Get the highest priority interrupt. We assume 8259a * interrupts are higher than apic interrupts. */ if (current->vbsp) { vector = BITMAP_BSR(¤t->extint.pending_8259a_int); } if (vector < 0) { apic_int = true; vector = BITMAP_BSR(¤t->extint.pending_apic_int); if (vector >= 0) { inservice = BITMAP_BSR( ¤t->extint.inservice_apic_int); if (vector <= inservice) { /* * A higher priority interrupt is in service. * Pend the lower interrupt until a guest * software writes EOI. */ vector = -1; } } } if (vector < 0) { /* * There is no pending external interrupt to inject as * soon as possible. */ current->vmctl.extint_pending(false); return; } if (current->vmctl.extint_is_blocked ()) { /* * A external interrupt is blocked. Make VM-exit occur * at the beginning of next interrupt window. */ current->vmctl.extint_pending(true); return; } /* * A external interrupt is not blocked. Inject it. */ if (apic_int) { BITMAP_CLEAR(¤t->extint.pending_apic_int, vector); } else { BITMAP_CLEAR(¤t->extint.pending_8259a_int, vector); } current->vmctl.read_control_reg(CONTROL_REG_CR0, &cr0); if (cr0 & CR0_PE_BIT) { current->vmctl.generate_external_int(vector); } else { err = cpu_emul_realmode_int(vector); if (err != VMMERR_SUCCESS) { panic("vt_check_extint: cpu_emul_realmode_int retured error %d", err); } } if (apic_int) { EXTINT_DBG(2, "I%d apic %ld\n", get_cpu_id(), vector); /* * The injected interrupt is apic interrupt. A guest * software will write EOI to local APIC so that the * VMM can inject a next interrupt on EOI. */ current->vmctl.extint_pending(false); /* * Recode the interrupt as in-service to manage EOI. */ BITMAP_SET(¤t->extint.inservice_apic_int, vector); } else { EXTINT_DBG(2, "I%d 8259a %ld\n", get_cpu_id(), vector); vector = BITMAP_BSR (¤t->extint.pending_8259a_int); if (vector < 0) { vector = BITMAP_BSR ( ¤t->extint.pending_apic_int); } if (vector >= 0) { /* * There are some pending interrupts and the * injected interrupt is 8259a interrupt. A * guest software will not write EOI to local * APIC. Make VM-exit occur at the beginning * of next interrupt window to inject a next * interrupt. */ current->vmctl.extint_pending(true); } else { current->vmctl.extint_pending(false); } } } void extint_apic_eoi(void) { long eoi_vector, pending_vector; eoi_vector = BITMAP_BSR(¤t->extint.inservice_apic_int); if (eoi_vector >= 0) { BITMAP_CLEAR(¤t->extint.inservice_apic_int, eoi_vector); BITMAP_SET(¤t->extint.pending_eoi, eoi_vector); } else { EXTINT_DBG(1, "Null EOI on cpu%d\n", get_cpu_id()); } pending_vector = BITMAP_BSR(¤t->extint.pending_apic_int); while ((eoi_vector = BITMAP_BSR(¤t->extint.pending_eoi)) >= 0) { if (eoi_vector <= pending_vector) { break; } EXTINT_DBG(2, "E%d apic %ld\n", get_cpu_id(), eoi_vector); BITMAP_CLEAR(¤t->extint.pending_eoi, eoi_vector); apic_write_eoi(); } } void extint_send_apic_int(vector_t vector, apic_id_t dest) { apic_send_ipi(vector, dest); } void extint_reset_8259a(void) { ASSERT(current->vbsp); EXTINT_DBG(2, "Reset 8259a\n"); BITMAP_INIT(¤t->extint.pending_8259a_int); } void extint_reset_apic(void) { EXTINT_DBG(2, "Reset APIC\n"); long vector; while ((vector = BITMAP_BSR(¤t->extint.inservice_apic_int)) >= 0) { BITMAP_CLEAR(¤t->extint.inservice_apic_int, vector); apic_write_eoi(); } while ((vector = BITMAP_BSR(¤t->extint.pending_eoi)) >= 0) { BITMAP_CLEAR(¤t->extint.pending_eoi, vector); apic_write_eoi(); } while ((vector = BITMAP_BSR(¤t->extint.pending_apic_int)) >= 0) { BITMAP_CLEAR(¤t->extint.pending_apic_int, vector); apic_write_eoi(); } } tinyvisor/vmm/core/desc.h0000644006644000001440000001604411733245403015711 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_DESC_H #define _CORE_DESC_H #include enum segdesc_type { SEGDESC_TYPE_RDONLY_DATA = 0x0, SEGDESC_TYPE_RDONLY_DATA_A = 0x1, SEGDESC_TYPE_RDWR_DATA = 0x2, SEGDESC_TYPE_RDWR_DATA_A = 0x3, SEGDESC_TYPE_RDONLY_EXPANDDOWN_DATA = 0x4, SEGDESC_TYPE_RDONLY_EXPANDDOWN_DATA_A = 0x5, SEGDESC_TYPE_RDWR_EXPANDDOWN_DATA = 0x6, SEGDESC_TYPE_RDWR_EXPANDDOWN_DATA_A = 0x7, SEGDESC_TYPE_EXECONLY_CODE = 0x8, SEGDESC_TYPE_EXECONLY_CODE_A = 0x9, SEGDESC_TYPE_EXECREAD_CODE = 0xA, SEGDESC_TYPE_EXECREAD_CODE_A = 0xB, SEGDESC_TYPE_EXECONLY_CONFORMING_CODE = 0xC, SEGDESC_TYPE_EXECONLY_CONFORMING_CODE_A = 0xD, SEGDESC_TYPE_EXECREAD_CONFORMING_CODE = 0xE, SEGDESC_TYPE_EXECREAD_CONFORMING_CODE_A = 0xF, SEGDESC_TYPE_16BIT_TSS_AVAILABLE = 0x1, SEGDESC_TYPE_LDT = 0x2, SEGDESC_TYPE_16BIT_TSS_BUSY = 0x3, SEGDESC_TYPE_16BIT_CALLGATE = 0x4, SEGDESC_TYPE_TASKGATE = 0x5, SEGDESC_TYPE_16BIT_INTRGATE = 0x6, SEGDESC_TYPE_16BIT_TRAPGATE = 0x7, SEGDESC_TYPE_32BIT_TSS_AVAILABLE = 0x9, SEGDESC_TYPE_32BIT_TSS_BUSY = 0xB, SEGDESC_TYPE_32BIT_CALLGATE = 0xC, SEGDESC_TYPE_32BIT_INTRGATE = 0xE, SEGDESC_TYPE_32BIT_TRAPGATE = 0xF, SEGDESC_TYPE_64BIT_TSS_AVAILABLE = 0x9, SEGDESC_TYPE_64BIT_TSS_BUSY = 0xB, SEGDESC_TYPE_64BIT_CALLGATE = 0xC, SEGDESC_TYPE_64BIT_INTRGATE = 0xE, SEGDESC_TYPE_64BIT_TRAPGATE = 0xF, }; enum segdesc_s { SEGDESC_S_SYSTEM_SEGMENT = 0, SEGDESC_S_CODE_OR_DATA_SEGMENT = 1, }; enum segdesc_l { SEGDESC_L_16_OR_32 = 0, SEGDESC_L_64 = 1, }; enum segdesc_d_b { SEGDESC_D_B_16 = 0, SEGDESC_D_B_32 = 1, SEGDESC_D_B_64 = 0, }; struct segdesc { unsigned int limit_15_0 : 16; unsigned int base_15_0 : 16; unsigned int base_23_16 : 8; enum segdesc_type type : 4; enum segdesc_s s : 1; unsigned int dpl : 2; unsigned int p : 1; unsigned int limit_19_16 : 4; unsigned int avl : 1; unsigned int l : 1; enum segdesc_d_b d_b : 1; unsigned int g : 1; unsigned int base_31_24 : 8; } __attribute__ ((packed)); struct syssegdesc64 { /* System-Segment Descriptor for 64-Bit Mode */ unsigned int limit_15_0 : 16; unsigned int base_15_0 : 16; unsigned int base_23_16 : 8; enum segdesc_type type : 4; unsigned int zero1 : 1; unsigned int dpl : 2; unsigned int p : 1; unsigned int limit_19_16 : 4; unsigned int avl : 1; unsigned int reserved1 : 2; unsigned int g : 1; unsigned int base_31_24 : 8; unsigned int base_63_32 : 32; unsigned int reserved2 : 8; unsigned int zero2 : 5; unsigned int reserved3 : 19; } __attribute__ ((packed)); enum gatedesc_type { GATEDESC_TYPE_16BIT_CALL = 0x4, GATEDESC_TYPE_TASK = 0x5, GATEDESC_TYPE_16BIT_INTR = 0x6, GATEDESC_TYPE_16BIT_TRAP = 0x7, GATEDESC_TYPE_32BIT_CALL = 0xC, GATEDESC_TYPE_32BIT_INTR = 0xE, GATEDESC_TYPE_32BIT_TRAP = 0xF, GATEDESC_TYPE_64BIT_CALL = 0xC, GATEDESC_TYPE_64BIT_INTR = 0xE, GATEDESC_TYPE_64BIT_TRAP = 0xF, }; struct gatedesc32 { unsigned int offset_15_0 : 16; unsigned int sel : 16; unsigned int param_count : 5; unsigned int zero1 : 3; enum gatedesc_type type : 4; unsigned int zero2 : 1; unsigned int dpl : 2; unsigned int p : 1; unsigned int offset_31_16 : 16; } __attribute__ ((packed)); struct gatedesc64 { unsigned int offset_15_0 : 16; unsigned int sel : 16; unsigned int ist : 3; unsigned int reserved1 : 5; enum gatedesc_type type : 4; unsigned int zero : 1; unsigned int dpl : 2; unsigned int p : 1; unsigned int offset_31_16 : 16; unsigned int offset_63_32 : 32; unsigned int reserved2 : 32; } __attribute__ ((packed)); struct descreg { u16 limit; ulong base; } __attribute__ ((packed)); struct tss32 { unsigned int link : 16; unsigned int reserved1 : 16; unsigned int esp0 : 32; unsigned int ss0 : 16; unsigned int reserved2 : 16; unsigned int esp1 : 32; unsigned int ss1 : 16; unsigned int reserved3 : 16; unsigned int esp2 : 32; unsigned int ss2 : 16; unsigned int reserved4 : 16; unsigned int cr3 : 32; unsigned int eip : 32; unsigned int eflags : 32; unsigned int eax : 32; unsigned int ecx : 32; unsigned int edx : 32; unsigned int ebx : 32; unsigned int esp : 32; unsigned int ebp : 32; unsigned int esi : 32; unsigned int edi : 32; unsigned int es : 16; unsigned int reserved5 : 16; unsigned int cs : 16; unsigned int reserved6 : 16; unsigned int ss : 16; unsigned int reserved7 : 16; unsigned int ds : 16; unsigned int reserved8 : 16; unsigned int fs : 16; unsigned int reserved9 : 16; unsigned int gs : 16; unsigned int reserved10 : 16; unsigned int ldt : 16; unsigned int reserved11 : 16; unsigned int t : 1; unsigned int reserved12 : 15; unsigned int iomap : 16; } __attribute__ ((packed)); struct tss64 { unsigned int reserved1 : 32; unsigned long long rsp0 : 64; unsigned long long rsp1 : 64; unsigned long long rsp2 : 64; unsigned long long reserved2 : 64; unsigned long long ist1 : 64; unsigned long long ist2 : 64; unsigned long long ist3 : 64; unsigned long long ist4 : 64; unsigned long long ist5 : 64; unsigned long long ist6 : 64; unsigned long long ist7 : 64; unsigned long long reserved3 : 64; unsigned int reserved4 : 16; unsigned int iomap : 16; } __attribute__ ((packed)); #define SEGDESC_BASE(desc) ((u32)(((desc).base_31_24 << 24) | \ ((desc).base_23_16 << 16) | \ (desc).base_15_0)) #endif tinyvisor/vmm/core/current.c0000644006644000001440000000312211733227577016455 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include "current.h" tinyvisor/vmm/core/gmm_trans.h0000644006644000001440000000355012031761317016757 0ustar yuichi_xyusers/* * Copyright (c) 2010 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_GMM_TRANS_H #define _CORE_GMM_TRANS_H #include #include #include "gmm.h" struct gmm_trans_mem_map { struct resource hphys; phys_t gphys_start; phys_t gphys_end; }; struct gmm_trans { int mem_map_count; struct gmm_trans_mem_map *mem_map; }; #endif /* _CORE_GMM_TRANS_H */ tinyvisor/vmm/core/vmmcall.c0000644006644000001440000000652111733245403016420 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* process VMM calls (hypervisor calls) */ #include #include #include #include "cpu_mmu.h" #include "current.h" #include "panic.h" #include "vmmcall.h" #define VMMCALL_MAX 128 #define VMMCALL_NAME_MAXLEN 256 static int n_vmmcall; static struct { char *name; vmmcall_func_t func; } vmmcall_data[VMMCALL_MAX]; /* get a number for VMM call */ /* INPUT: EBX=virtual address of a name of a VMM call (in 256 bytes) */ /* OUTPUT: EAX=a number for the VMM call (0 on error) */ static void get_vmmcall_number (void) { u32 i; char buf[VMMCALL_NAME_MAXLEN]; ulong nameaddr; current->vmctl.read_general_reg (GENERAL_REG_RBX, &nameaddr); for (i = 0; i < VMMCALL_NAME_MAXLEN; i++) { if (read_linearaddr_b (nameaddr + i, &buf[i]) != VMMERR_SUCCESS) break; if (buf[i] == '\0') goto copy_ok; } current->vmctl.write_general_reg (GENERAL_REG_RAX, 0); return; copy_ok: for (i = 0; i < n_vmmcall; i++) { if (strcmp (vmmcall_data[i].name, buf) == 0) goto found; } current->vmctl.write_general_reg (GENERAL_REG_RAX, 0); return; found: current->vmctl.write_general_reg (GENERAL_REG_RAX, i); return; } /* handling a VMM call instruction */ void vmmcall (void) { ulong cmd; current->vmctl.read_general_reg (GENERAL_REG_RAX, &cmd); if (cmd < VMMCALL_MAX) vmmcall_data[cmd].func (); else current->vmctl.write_general_reg (GENERAL_REG_RAX, 0); } /* register a VMM call */ void vmmcall_register (char *name, vmmcall_func_t func) { if (n_vmmcall >= VMMCALL_MAX) panic ("Too many vmmcall_register."); vmmcall_data[n_vmmcall].name = name; vmmcall_data[n_vmmcall].func = func; n_vmmcall++; } void vmmcall_init (void) { n_vmmcall = 0; vmmcall_register ("get_vmmcall_number", get_vmmcall_number); } INITFUNC ("global3", vmmcall_init); tinyvisor/vmm/core/vmmcall_status.h0000644006644000001440000000350611733227577020044 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_VMMCALL_STATUS_H #define _CORE_VMMCALL_STATUS_H #define VMMCALL_STATUS_ENABLE #ifdef VMMCALL_STATUS_ENABLE #define STATUS_UPDATE(a) a #else #define STATUS_UPDATE(a) do; while (0) #endif void register_status_callback (char *(*func) (void)); #endif tinyvisor/vmm/core/beep.h0000644006644000001440000000330111733227577015712 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_BEEP_H #define _CORE_BEEP_H void beep_set_freq (unsigned int hz); void beep_on (void); void beep_off (void); #endif tinyvisor/vmm/core/vmmcall.h0000644006644000001440000000340611733227577016440 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_VMMCALL_H #define _CORE_VMMCALL_H typedef void (*vmmcall_func_t) (void); void vmmcall (void); void vmmcall_register (char *name, vmmcall_func_t func); void vmmcall_init (void); #endif tinyvisor/vmm/core/cpuid.h0000644006644000001440000000332111753454341016076 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_CPUID_H #define _CORE_CPUID_H #include void call_cpuid (u32 ia, u32 ic, u32 *oa, u32 *ob, u32 *oc, u32 *od); #endif tinyvisor/vmm/core/svm_regs.c0000644006644000001440000002473211762672062016625 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include "apic_pass.h" #include "asm.h" #include "constants.h" #include "cpu_mmu_spt.h" #include "current.h" #include "entry.h" #include "mm.h" #include "panic.h" #include "seg.h" #include "svm_msr.h" #include "svm_np.h" #include "svm_regs.h" void svm_read_general_reg (enum general_reg reg, ulong *val) { switch (reg) { case GENERAL_REG_RAX: *val = current->u.svm.vi.vmcb->rax; break; case GENERAL_REG_RCX: *val = current->u.svm.vr.rcx; break; case GENERAL_REG_RDX: *val = current->u.svm.vr.rdx; break; case GENERAL_REG_RBX: *val = current->u.svm.vr.rbx; break; case GENERAL_REG_RSP: *val = current->u.svm.vi.vmcb->rsp; break; case GENERAL_REG_RBP: *val = current->u.svm.vr.rbp; break; case GENERAL_REG_RSI: *val = current->u.svm.vr.rsi; break; case GENERAL_REG_RDI: *val = current->u.svm.vr.rdi; break; case GENERAL_REG_R8: *val = current->u.svm.vr.r8; break; case GENERAL_REG_R9: *val = current->u.svm.vr.r9; break; case GENERAL_REG_R10: *val = current->u.svm.vr.r10; break; case GENERAL_REG_R11: *val = current->u.svm.vr.r11; break; case GENERAL_REG_R12: *val = current->u.svm.vr.r12; break; case GENERAL_REG_R13: *val = current->u.svm.vr.r13; break; case GENERAL_REG_R14: *val = current->u.svm.vr.r14; break; case GENERAL_REG_R15: *val = current->u.svm.vr.r15; break; default: panic ("Unknown register."); } } void svm_write_general_reg (enum general_reg reg, ulong val) { switch (reg) { case GENERAL_REG_RAX: current->u.svm.vi.vmcb->rax = val; break; case GENERAL_REG_RCX: current->u.svm.vr.rcx = val; break; case GENERAL_REG_RDX: current->u.svm.vr.rdx = val; break; case GENERAL_REG_RBX: current->u.svm.vr.rbx = val; break; case GENERAL_REG_RSP: current->u.svm.vi.vmcb->rsp = val; break; case GENERAL_REG_RBP: current->u.svm.vr.rbp = val; break; case GENERAL_REG_RSI: current->u.svm.vr.rsi = val; break; case GENERAL_REG_RDI: current->u.svm.vr.rdi = val; break; case GENERAL_REG_R8: current->u.svm.vr.r8 = val; break; case GENERAL_REG_R9: current->u.svm.vr.r9 = val; break; case GENERAL_REG_R10: current->u.svm.vr.r10 = val; break; case GENERAL_REG_R11: current->u.svm.vr.r11 = val; break; case GENERAL_REG_R12: current->u.svm.vr.r12 = val; break; case GENERAL_REG_R13: current->u.svm.vr.r13 = val; break; case GENERAL_REG_R14: current->u.svm.vr.r14 = val; break; case GENERAL_REG_R15: current->u.svm.vr.r15 = val; break; default: panic ("Unknown register."); } } void svm_read_control_reg (enum control_reg reg, ulong *val) { u64 tmp; switch (reg) { case CONTROL_REG_CR0: *val = current->u.svm.vr.cr0; break; case CONTROL_REG_CR2: *val = current->u.svm.vi.vmcb->cr2; break; case CONTROL_REG_CR3: if (!current->u.svm.np) *val = current->u.svm.vr.cr3; else *val = current->u.svm.vi.vmcb->cr3; break; case CONTROL_REG_CR4: *val = current->u.svm.vr.cr4; break; case CONTROL_REG_CR8: apic_read_cr8(&tmp); *val = tmp; break; default: panic ("Unknown control register."); } } void svm_write_control_reg (enum control_reg reg, ulong val) { struct vmcb *vmcb; vmcb = current->u.svm.vi.vmcb; switch (reg) { case CONTROL_REG_CR0: current->u.svm.vr.cr0 = val; if (!current->u.svm.np) val |= CR0_PG_BIT | CR0_WP_BIT; vmcb->cr0 = val; svm_msr_update_lma (); if (!current->u.svm.np) cpu_mmu_spt_updatecr3 (); else svm_np_updatecr3 (); vmcb->tlb_control = VMCB_TLB_CONTROL_FLUSH_TLB; if (val & CR0_PE_BIT) { vmcb->intercept_int_n = 0; } else { /* * Qemu's emulation seems to be bug. * IP is not incremented, when guest software * executes INTx instruction in real mode in * SVM. So we intercept INTx instruction and * emulate it in VMM. */ vmcb->intercept_int_n = 1; } break; case CONTROL_REG_CR2: vmcb->cr2 = val; break; case CONTROL_REG_CR3: current->u.svm.vr.cr3 = val; if (current->u.svm.np) { current->u.svm.vi.vmcb->cr3 = val; svm_np_updatecr3 (); } else { cpu_mmu_spt_updatecr3 (); } vmcb->tlb_control = VMCB_TLB_CONTROL_FLUSH_TLB; break; case CONTROL_REG_CR4: current->u.svm.vr.cr4 = val; if (!current->u.svm.np) val |= CR4_PAE_BIT; vmcb->cr4 = val; if (!current->u.svm.np) cpu_mmu_spt_updatecr3 (); else svm_np_updatecr3 (); vmcb->tlb_control = VMCB_TLB_CONTROL_FLUSH_TLB; break; case CONTROL_REG_CR8: apic_write_cr8 (val); break; default: panic ("Unknown control register."); } } void svm_read_sreg_sel (enum sreg s, u16 *val) { switch (s) { case SREG_ES: *val = current->u.svm.vi.vmcb->es.sel; break; case SREG_CS: *val = current->u.svm.vi.vmcb->cs.sel; break; case SREG_SS: *val = current->u.svm.vi.vmcb->ss.sel; break; case SREG_DS: *val = current->u.svm.vi.vmcb->ds.sel; break; case SREG_FS: *val = current->u.svm.vi.vmcb->fs.sel; break; case SREG_GS: *val = current->u.svm.vi.vmcb->gs.sel; break; default: panic ("Unknown sreg."); } } void svm_read_sreg_acr (enum sreg s, ulong *val) { ulong tmp; switch (s) { case SREG_ES: tmp = current->u.svm.vi.vmcb->es.attr; break; case SREG_CS: tmp = current->u.svm.vi.vmcb->cs.attr; break; case SREG_SS: tmp = current->u.svm.vi.vmcb->ss.attr; break; case SREG_DS: tmp = current->u.svm.vi.vmcb->ds.attr; break; case SREG_FS: tmp = current->u.svm.vi.vmcb->fs.attr; break; case SREG_GS: tmp = current->u.svm.vi.vmcb->gs.attr; break; default: panic ("Unknown sreg."); } if (tmp & 0x80) /* P bit is 1 */ *val = ((tmp & 0xF00) << 4) | (tmp & 0xFF); else *val = ACCESS_RIGHTS_UNUSABLE_BIT; } void svm_read_sreg_base (enum sreg s, ulong *val) { ulong tmp; switch (s) { case SREG_ES: case SREG_CS: case SREG_SS: case SREG_DS: if (current->u.svm.lma) { svm_read_sreg_acr (SREG_CS, &tmp); if (tmp & ACCESS_RIGHTS_L_BIT) { *val = 0; return; } } break; default: break; } switch (s) { case SREG_ES: *val = current->u.svm.vi.vmcb->es.base; break; case SREG_CS: *val = current->u.svm.vi.vmcb->cs.base; break; case SREG_SS: *val = current->u.svm.vi.vmcb->ss.base; break; case SREG_DS: *val = current->u.svm.vi.vmcb->ds.base; break; case SREG_FS: *val = current->u.svm.vi.vmcb->fs.base; break; case SREG_GS: *val = current->u.svm.vi.vmcb->gs.base; break; default: panic ("Unknown sreg."); } } void svm_read_sreg_limit (enum sreg s, ulong *val) { ulong tmp; if (current->u.svm.lma) { svm_read_sreg_acr (SREG_CS, &tmp); if (tmp & ACCESS_RIGHTS_L_BIT) { *val = ~0UL; return; } } switch (s) { case SREG_ES: *val = current->u.svm.vi.vmcb->es.limit; break; case SREG_CS: *val = current->u.svm.vi.vmcb->cs.limit; break; case SREG_SS: *val = current->u.svm.vi.vmcb->ss.limit; break; case SREG_DS: *val = current->u.svm.vi.vmcb->ds.limit; break; case SREG_FS: *val = current->u.svm.vi.vmcb->fs.limit; break; case SREG_GS: *val = current->u.svm.vi.vmcb->gs.limit; break; default: panic ("Unknown sreg."); } } void svm_spt_setcr3 (ulong cr3) { current->u.svm.vi.vmcb->cr3 = cr3; } void svm_read_ip (ulong *val) { *val = current->u.svm.vi.vmcb->rip; } void svm_write_ip (ulong val) { current->u.svm.vi.vmcb->rip = val; current->updateip = true; } void svm_read_flags (ulong *val) { *val = current->u.svm.vi.vmcb->rflags; } void svm_write_flags (ulong val) { current->u.svm.vi.vmcb->rflags = val; } void svm_read_gdtr (ulong *base, ulong *limit) { *base = current->u.svm.vi.vmcb->gdtr.base; *limit = current->u.svm.vi.vmcb->gdtr.limit; } void svm_write_gdtr (ulong base, ulong limit) { current->u.svm.vi.vmcb->gdtr.base = base; current->u.svm.vi.vmcb->gdtr.limit = limit; } void svm_read_idtr (ulong *base, ulong *limit) { *base = current->u.svm.vi.vmcb->idtr.base; *limit = current->u.svm.vi.vmcb->idtr.limit; } void svm_write_idtr (ulong base, ulong limit) { current->u.svm.vi.vmcb->idtr.base = base; current->u.svm.vi.vmcb->idtr.limit = limit; } void svm_write_realmode_seg (enum sreg s, u16 val) { switch (s) { case SREG_ES: current->u.svm.vi.vmcb->es.sel = val; current->u.svm.vi.vmcb->es.base = val << 4; break; case SREG_CS: current->u.svm.vi.vmcb->cs.sel = val; current->u.svm.vi.vmcb->cs.base = val << 4; break; case SREG_SS: current->u.svm.vi.vmcb->ss.sel = val; current->u.svm.vi.vmcb->ss.base = val << 4; break; case SREG_DS: current->u.svm.vi.vmcb->ds.sel = val; current->u.svm.vi.vmcb->ds.base = val << 4; break; case SREG_FS: current->u.svm.vi.vmcb->fs.sel = val; current->u.svm.vi.vmcb->fs.base = val << 4; break; case SREG_GS: current->u.svm.vi.vmcb->gs.sel = val; current->u.svm.vi.vmcb->gs.base = val << 4; break; default: panic ("Unknown sreg."); } } vmmerr_t svm_writing_sreg (enum sreg s) { switch (s) { case SREG_ES: break; case SREG_CS: break; case SREG_SS: break; case SREG_DS: break; case SREG_FS: break; case SREG_GS: break; case SREG_DEFAULT: return VMMERR_AVOID_COMPILER_WARNING; } return VMMERR_SW; } tinyvisor/vmm/core/regs.h0000644006644000001440000000421011733245403015723 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_REGS_H #define _CORE_REGS_H #include enum control_reg { CONTROL_REG_CR0 = 0, CONTROL_REG_CR2 = 2, CONTROL_REG_CR3 = 3, CONTROL_REG_CR4 = 4, CONTROL_REG_CR8 = 8, }; enum general_reg { GENERAL_REG_RAX = 0, GENERAL_REG_RCX = 1, GENERAL_REG_RDX = 2, GENERAL_REG_RBX = 3, GENERAL_REG_RSP = 4, GENERAL_REG_RBP = 5, GENERAL_REG_RSI = 6, GENERAL_REG_RDI = 7, GENERAL_REG_R8 = 8, GENERAL_REG_R9 = 9, GENERAL_REG_R10 = 10, GENERAL_REG_R11 = 11, GENERAL_REG_R12 = 12, GENERAL_REG_R13 = 13, GENERAL_REG_R14 = 14, GENERAL_REG_R15 = 15, }; #endif tinyvisor/vmm/core/svm_io.h0000644006644000001440000000345211733245403016266 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_SVM_IO_H #define _CORE_SVM_IO_H #include struct vcpu; struct svm_io { void *iobmp; phys_t iobmp_phys; }; void svm_ioio (void); void svm_extern_iopass (struct vcpu *p, ioport_t port, bool pass); #endif tinyvisor/vmm/core/acpi_madt.c0000644006644000001440000000721512165656112016712 0ustar yuichi_xyusers/* * Copyright (c) 2012-2013 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include "current.h" #include "vcpu.h" #define ACPI_MADT_SIGNATURE "APIC" #define APIC_STRUCT_TYPE_LOCAL_APIC 0 #define LOCAL_APIC_FLGAS_ENABLED 0x1 #define APIC_STRUCT_TYPE_LOCAL_X2APIC 9 struct acpi_madt { struct acpi_desc_header header; u32 local_apic_addr; u32 flags; } __attribute__ ((packed)); struct apic_header { u8 type; u8 length; } __attribute__ ((packed)); struct local_apic { struct apic_header header; u8 acpi_processor_id; u8 apic_id; u32 flags; } __attribute__ ((packed)); struct local_x2apic { struct apic_header header; u16 reserved; u32 x2apic_id; u32 flags; u32 acpi_processor_uid; } __attribute__ ((packed)); static bool check_vm0(apic_id_t apic_id) { struct vcpu *vcpu = NULL; struct vm *vm; vm = current->vm; while ((vcpu = vcpu_next(vm, vcpu)) != NULL) { if (vcpu->apic_id == apic_id) { return true; } } return false; } static void parse_apic_structure(struct apic_header *apic_header) { struct local_apic *local_apic; struct local_x2apic *local_x2apic; switch (apic_header->type) { case APIC_STRUCT_TYPE_LOCAL_APIC: local_apic = (struct local_apic *)apic_header; if (!check_vm0(local_apic->apic_id)) { local_apic->flags &= ~LOCAL_APIC_FLGAS_ENABLED; } break; case APIC_STRUCT_TYPE_LOCAL_X2APIC: local_x2apic = (struct local_x2apic *)apic_header; local_x2apic->flags &= ~LOCAL_APIC_FLGAS_ENABLED; break; } } static acpi_parser_t parse_madt; static void parse_madt(void *table, u32 length) { struct acpi_madt *acpi_madt = (struct acpi_madt *)table; struct apic_header *apic_header; for (apic_header = (struct apic_header *)(acpi_madt + 1); (ulong)apic_header < (ulong)acpi_madt + length; apic_header = (struct apic_header *)((ulong)apic_header + apic_header->length)) { parse_apic_structure(apic_header); } } static void acpi_madt_overwrite(void) { if (!cpu_is_bsp()) { return; } acpi_register_parser(ACPI_MADT_SIGNATURE, parse_madt); } INITFUNC("passvm4", acpi_madt_overwrite); tinyvisor/vmm/core/thread.h0000644006644000001440000000330011733227577016245 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_THREAD_H #define _CORE_THREAD_H #include void thread_set_process_switch (phys_t switchto); #endif tinyvisor/vmm/core/mm_access.c0000644006644000001440000000735211733245403016722 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include "asm.h" #include "mm.h" #include static void * hphys_mapmem (phys_t phys, u32 flags, uint len, bool wr) { void *p; p = mapmem(MAPMEM_HPHYS | (wr ? MAPMEM_WRITE : 0) | (flags & MAPMEM_CACHE_MASK), phys, len); if (p == NULL) { panic("Faild to map memory space for access."); } return p; } void read_hphys_b (phys_t phys, void *data, u32 flags) { u8 *p; p = (u8 *)hphys_mapmem (phys, flags, sizeof *p, false); *(u8 *)data = *p; unmapmem (p, sizeof *p); } void write_hphys_b (phys_t phys, u32 data, u32 flags) { u8 *p; p = (u8 *)hphys_mapmem (phys, flags, sizeof *p, true); *p = data; unmapmem (p, sizeof *p); } void read_hphys_w (phys_t phys, void *data, u32 flags) { u16 *p; p = (u16 *)hphys_mapmem (phys, flags, sizeof *p, false); *(u16 *)data = *p; unmapmem (p, sizeof *p); } void write_hphys_w (phys_t phys, u32 data, u32 flags) { u16 *p; p = (u16 *)hphys_mapmem (phys, flags, sizeof *p, true); *p = data; unmapmem (p, sizeof *p); } void read_hphys_l (phys_t phys, void *data, u32 flags) { u32 *p; p = (u32 *)hphys_mapmem (phys, flags, sizeof *p, false); *(u32 *)data = *p; unmapmem (p, sizeof *p); } void write_hphys_l (phys_t phys, u32 data, u32 flags) { u32 *p; p = (u32 *)hphys_mapmem (phys, flags, sizeof *p, true); *p = data; unmapmem (p, sizeof *p); } void read_hphys_q (phys_t phys, void *data, u32 flags) { u64 *p; p = (u64 *)hphys_mapmem (phys, flags, sizeof *p, false); *(u64 *)data = *p; unmapmem (p, sizeof *p); } void write_hphys_q (phys_t phys, u64 data, u32 flags) { u64 *p; p = (u64 *)hphys_mapmem (phys, flags, sizeof *p, true); *p = data; unmapmem (p, sizeof *p); } bool cmpxchg_hphys_l (phys_t phys, u32 *olddata, u32 data, u32 flags) { u32 *p; bool r; p = (u32 *)hphys_mapmem (phys, flags, sizeof *p, true); r = asm_lock_cmpxchgl (p, olddata, data); unmapmem (p, sizeof *p); return r; } bool cmpxchg_hphys_q (phys_t phys, u64 *olddata, u64 data, u32 flags) { u64 *p; bool r; p = (u64 *)hphys_mapmem (phys, flags, sizeof *p, true); r = asm_lock_cmpxchgq (p, olddata, data); unmapmem (p, sizeof *p); return r; } tinyvisor/vmm/core/vt_exitreason.c0000644006644000001440000001052311753454341017661 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include "constants.h" #include "vt_internal.h" char * message_exitreason (int num) { char *m; switch (num & EXIT_REASON_MASK) { case EXIT_REASON_EXCEPTION_OR_NMI: m = "Exception or NMI"; break; case EXIT_REASON_EXTERNAL_INT: m = "External int"; break; case EXIT_REASON_TRIPLE_FAULT: m = "Triple fault"; break; case EXIT_REASON_INIT_SIGNAL: m = "INIT signal"; break; case EXIT_REASON_STARTUP_IPI: m = "Start-up IPI"; break; case EXIT_REASON_IO_SMI: m = "I/O SMI"; break; case EXIT_REASON_OTHER_SMI: m = "Other SMI"; break; case EXIT_REASON_INTERRUPT_WINDOW: m = "Interrupt window"; break; case EXIT_REASON_TASK_SWITCH: m = "Task switch"; break; case EXIT_REASON_CPUID: m = "CPUID"; break; case EXIT_REASON_HLT: m = "HLT"; break; case EXIT_REASON_INVD: m = "INVD"; break; case EXIT_REASON_INVLPG: m = "INVLPG"; break; case EXIT_REASON_RDPMC: m = "RDPMC"; break; case EXIT_REASON_RDTSC: m = "RDTSC"; break; case EXIT_REASON_RSM: m = "RSM"; break; case EXIT_REASON_VMCALL: m = "VMCALL"; break; case EXIT_REASON_VMCLEAR: m = "VMCLEAR"; break; case EXIT_REASON_VMLAUNCH: m = "VMLAUNCH"; break; case EXIT_REASON_VMPTRLD: m = "VMPTRLD"; break; case EXIT_REASON_VMPTRST: m = "VMPTRST"; break; case EXIT_REASON_VMREAD: m = "VMREAD"; break; case EXIT_REASON_VMRESUME: m = "VMRESUME"; break; case EXIT_REASON_VMWRITE: m = "VMWRITE"; break; case EXIT_REASON_VMXOFF: m = "VMXOFF"; break; case EXIT_REASON_VMXON: m = "VMXON"; break; case EXIT_REASON_MOV_CR: m = "MOV CR"; break; case EXIT_REASON_MOV_DR: m = "MOV DR"; break; case EXIT_REASON_IO_INSTRUCTION: m = "I/O instruction"; break; case EXIT_REASON_RDMSR: m = "RDMSR"; break; case EXIT_REASON_WRMSR: m = "WRMSR"; break; case EXIT_REASON_ENTFAIL_GUEST_STATE: m = "VM-entry failure due to invalid guest state"; break; case EXIT_REASON_ENTFAIL_MSR_LOADING: m = "VM-entry failure due to MSR loading"; break; case EXIT_REASON_MWAIT: m = "MWAIT"; break; case EXIT_REASON_MONITOR: m = "MONITOR"; break; case EXIT_REASON_PAUSE: m = "PAUSE"; break; case EXIT_REASON_ENTFAIL_MACHINE_CHK: m = "VM-entry failure due to machine check"; break; case EXIT_REASON_TPR_BELOW_THRESHOLD: m = "TPR below threshold"; break; case EXIT_REASON_EPT_VIOLATION: m = "EPT Violation"; break; case EXIT_REASON_EPT_MISCONFIG: m = "EPT misconfiguration"; break; default: m = "unknown error"; } return m; } void printexitreason (int num) { char *m; m = message_exitreason (num); printf ("0x%x (%s) %s %s\n", num, m, (num & EXIT_REASON_VMEXIT_FROM_VMX_ROOT_OPERATION_BIT) ? "VM exit from VMX root operation" : "", (num & EXIT_REASON_VMENTRY_FAILURE_BIT) ? "VM entry failure" : ""); } tinyvisor/vmm/core/entry.s0000644006644000001440000002460712165305216016152 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ MULTIBOOT_PAGE_ALIGN = (1 << 0) MULTIBOOT_MEMORY_INFO = (1 << 1) MULTIBOOT_HEADER_MAGIC = 0x1BADB002 MULTIBOOT_HEADER_FLAGS = (MULTIBOOT_PAGE_ALIGN | MULTIBOOT_MEMORY_INFO) CHECKSUM = -(MULTIBOOT_HEADER_MAGIC + MULTIBOOT_HEADER_FLAGS) PAGESIZE = 4096 DIFFPHYS = 0x40000000 ENTRY_SEL_CODE32 = 0x08 ENTRY_SEL_DATA32 = 0x10 ENTRY_SEL_CODE64 = 0x18 ENTRY_SEL_DATA64 = 0x20 ENTRY_SEL_CODE16 = 0x28 ENTRY_SEL_DATA16 = 0x30 ENTRY_SEL_DATA16_TEXTVRAM = 0x38 EXCEPTION_UD = 0x6 EXCEPTION_DF = 0x8 TEXTVRAM_ADDR = 0xB8000 TEXTVRAM_ATTR = 0x2 CPUID_1_EDX_PSE_BIT = 0x8 CPUID_1_EDX_MSR_BIT = 0x20 CPUID_1_EDX_PAE_BIT = 0x40 CPUID_1_EDX_CX8_BIT = 0x100 CPUID_0x80000001_EDX_64_BIT = 0x20000000 CR0_PE_BIT = 0x1 CR0_TS_BIT = 0x8 CR0_PG_BIT = 0x80000000 CR0_NW_BIT = 0x20000000 CR0_CD_BIT = 0x40000000 CR4_PSE_BIT = 0x10 CR4_PAE_BIT = 0x20 EFLAGS_ID_BIT = 0x200000 MSR_IA32_EFER = 0xC0000080 MSR_IA32_EFER_LME_BIT = 0x100 GUEST_APINIT_SEGMENT = 0x0000 GUEST_APINIT_OFFSET = 0xF000 MSR_IA32_PAT = 0x277 HOST_PAT_HIGH = 0x00010506 /* UC WC WP WB */ HOST_PAT_LOW = 0x00070406 /* UC UC- WT WB */ .include "longmode.h" ######## ENTRY SECTION START # This section is placed at the start of the .text section. # See the linker script. .section .entry # GRUB Multiboot Header .align 4 .long MULTIBOOT_HEADER_MAGIC .long MULTIBOOT_HEADER_FLAGS .long CHECKSUM # 32bit code start .code32 .globl entry entry: # We must use physical addresses while paging is off # The VMM is loaded at 0x00100000- (Symbols are placed at 0x40100000-) mov $-DIFFPHYS,%ebp # Difference of physical & virtual addr mov %ebx,entry_ebx(%ebp) # Save information from grub lea bss(%ebp),%edi # Clear BSS lea end+3(%ebp),%ecx # sub %edi,%ecx # shr $2,%ecx # xor %eax,%eax # cld # rep stosl # mov %cr4,%ecx or $CR4_PAE_BIT,%ecx # Enable PAE .if longmode lea entry_pml4(%ebp),%eax # CR3 for long mode .else lea entry_pdp(%ebp),%eax # CR3 for PAE ON andw $0xFE19,8*0(%eax) # Clear reserved bits andw $0xFE19,8*1(%eax) # andw $0xFE19,8*2(%eax) # andw $0xFE19,8*3(%eax) # .endif mov %ecx,entry_cr4(%ebp) # Save CR4 mov %eax,vmm_base_cr3(%ebp) # Save CR3 lea cpuinit_start(%ebp),%eax mov %ax,entry_gdt+0x28+2(%ebp) mov %ax,entry_gdt+0x30+2(%ebp) shr $16,%eax mov %al,entry_gdt+0x28+4(%ebp) mov %al,entry_gdt+0x30+4(%ebp) mov %ah,entry_gdt+0x28+7(%ebp) mov %ah,entry_gdt+0x30+7(%ebp) lgdtl entry_gdtr_phys(%ebp) # Load GDTR mov $ENTRY_SEL_DATA16,%eax mov %eax,%ds mov %eax,%ss mov $cpuinit_tmpstack-cpuinit_start,%esp mov $ENTRY_SEL_DATA16_TEXTVRAM,%eax mov %eax,%es ljmp $ENTRY_SEL_CODE16,$entry16-cpuinit_start .globl cpuinit_start cpuinit_start: .code16 jmp 1f .space 30 cpuinit_tmpstack: 1: cli ljmp $GUEST_APINIT_SEGMENT,$1f-cpuinit_start+GUEST_APINIT_OFFSET 1: mov %cs,%ax # %ds <- %cs mov %ax,%ds # # Increment the number of processors. lock incw apinit_procs-cpuinit_start+GUEST_APINIT_OFFSET # Setup realmode segments mov %ax,%ss # %ss <- %cs mov $cpuinit_tmpstack-cpuinit_start+GUEST_APINIT_OFFSET,%sp mov $(TEXTVRAM_ADDR >> 4),%ax # %es <- text vram mov %ax,%es # # Spinlock! mov $1,%al 1: pause xchg %al,apinit_lock-cpuinit_start+GUEST_APINIT_OFFSET test %al,%al jne 1b # Fall through entry16: call entry16_2 entry16_2: pop %bp call check386 lea msg_badcpu16-entry16_2(%bp),%si jc error16 call check_cpuid lea msg_badcpuid-entry16_2(%bp),%si jc error16 call check_flags lea msg_badcpu-entry16_2(%bp),%si jc error16 lgdtl entry_gdtr-entry16_2(%bp) mov entry_cr4-entry16_2(%bp),%eax mov %eax,%cr4 mov vmm_base_cr3-entry16_2(%bp),%eax mov %eax,%cr3 mov $HOST_PAT_HIGH,%edx mov $HOST_PAT_LOW,%eax mov $MSR_IA32_PAT,%ecx wrmsr cli je init32 mov $MSR_IA32_EFER,%ecx rdmsr or $MSR_IA32_EFER_LME_BIT,%eax wrmsr mov %cr0,%eax or $(CR0_PG_BIT|CR0_TS_BIT|CR0_PE_BIT),%eax and $(~(CR0_CD_BIT|CR0_NW_BIT)),%eax /* Enable cache */ mov %eax,%cr0 ljmpl $ENTRY_SEL_CODE64,$callmain64 init32: mov %cr0,%eax or $(CR0_PG_BIT|CR0_TS_BIT|CR0_PE_BIT),%eax and $(~(CR0_CD_BIT|CR0_NW_BIT)),%eax /* Enable cache */ mov %eax,%cr0 ljmpl $ENTRY_SEL_CODE32,$callmain32 error16: cld xor %di,%di # %di <- zero mov $TEXTVRAM_ATTR,%ah 1: lodsb test %al,%al je 1f stosw jmp 1b 1: cli hlt jmp 1b ## Processor check (241618J-019) # 32bit test # OUTPUT # CF =0: 32bit available # %ax, flags check386: # 8086? pushfw popw %ax and $0xFFF,%ax pushw %ax popfw pushfw popw %ax and $0xF000,%ax cmp $0xF000,%ax je is8086 # 80286? pushfw popw %ax or $0xF000,%ax pushw %ax popfw test $0xF000,%ax je is80286 clc ret is8086: is80286: stc ret # cpuid test # OUTPUT # CF =0: cpuid available # %eax, %ecx, flags check_cpuid: pushfl popl %eax mov %eax,%ecx xor $EFLAGS_ID_BIT,%eax pushl %eax popfl pushfl popl %eax xor %ecx,%eax je no_cpuid clc ret no_cpuid: stc ret # cpuid flags test # OUTPUT # CF =0: ok # ZF =0: 64bit 1: 32bit # %eax, %ebx, %ecx, %edx, flags check_flags: mov $1,%eax cpuid test $CPUID_1_EDX_PSE_BIT,%edx je 1f test $CPUID_1_EDX_PAE_BIT,%edx je 1f test $CPUID_1_EDX_MSR_BIT,%edx je 1f test $CPUID_1_EDX_CX8_BIT,%edx je 1f .if longmode mov $0x80000000,%eax cpuid cmp $0x80000000,%eax jbe 1f mov $0x80000001,%eax cpuid test $CPUID_0x80000001_EDX_64_BIT,%edx je 1f .else xor %eax,%eax .endif clc ret 1: stc ret msg_badcpu16: .string "16bit processor is not supported." msg_badcpuid: .string "This processor does not support CPUID. (386 or 486?)" msg_badcpu: .string "This processor is not supported." # Provisional GDT .align 4 .short 0 entry_gdtr: .short 0x27 .long entry_gdt .short 0 entry_gdtr_phys: .short 0x3F .long entry_gdt-DIFFPHYS .align 8 entry_gdt: .quad 0 .quad 0x00CF9B000000FFFF # 0x08 CODE32, DPL=0 .quad 0x00CF93000000FFFF # 0x10 DATA32, DPL=0 .quad 0x00AF9B000000FFFF # 0x18 CODE64, DPL=0 .quad 0x00AF93000000FFFF # 0x20 DATA64, DPL=0 .quad 0x00009B000000FFFF # 0x28 CODE16, DPL=0 .quad 0x000093000000FFFF # 0x30 DATA16, DPL=0 .quad 0x0000930B8000FFFF # 0x38 DATA16, DPL=0 .globl vmm_base_cr3 vmm_base_cr3: .quad 0 .global vmm_main_cr3 vmm_main_cr3: .quad 0 entry_cr4: .quad 0 entry_ebx: .quad 0 .globl apinit_procs apinit_procs: .quad 0 .globl apinit_lock apinit_lock: .quad 0 .globl cpuinit_end cpuinit_end: .code32 callmain32: mov $ENTRY_SEL_DATA32,%eax xor %ebx,%ebx mov %eax,%ds mov %eax,%es mov %ebx,%fs mov %ebx,%gs mov %eax,%ss mov $start_stack,%esp mov entry_ebx,%edi movl $0,entry_ebx test %edi,%edi # AP? je 1f # Yes- # BSP push %edi xor %ebp,%ebp call vmm_start cli hlt 1: # AP call apinitproc0 cli hlt # 64bit code start .code64 callmain64: mov $ENTRY_SEL_DATA64,%eax xor %ebx,%ebx mov %eax,%ds mov %eax,%es mov %ebx,%fs mov %ebx,%gs mov %eax,%ss mov $start_stack,%esp mov $entry_ebx,%eax mov (%rax),%edi movl $0,(%rax) test %edi,%edi # AP? je 1f # Yes- # BSP call vmm_start cli hlt 1: # AP call apinitproc0 cli hlt # Provisional page tables .align PAGESIZE entry_pml4: # 7654321|76543210 .long entry_pdp-DIFFPHYS+0x7 # 0x0000000000000000 .long 0 # .space 4096-8*1 # 0x0000008000000000- .globl entry_pdp entry_pdp: .long entry_pd0-DIFFPHYS+0x7 # 0x0000000000000000 .long 0 # .long entry_pd0-DIFFPHYS+0x7 # 0x0000000040000000 .long 0 # .long entry_pd0-DIFFPHYS+0x7 # 0x0000000080000000 .long 0 # .quad 0 # 0x00000000C0000000 .space 4096-8*4 # 0x0000000100000000- .globl entry_pd0 entry_pd0: .quad 0x000083 # +0x00000000 .quad 0x200083 # +0x00200000 .quad 0x400083 # +0x00400000 .quad 0x600083 # +0x00600000 .quad 0x800083 # +0x00800000 .quad 0xA00083 # +0x00A00000 .quad 0xC00083 # +0x00C00000 .quad 0xE00083 # +0x00E00000 .space 4096-8*8 # +0x01000000- # Stack for initialization .align PAGESIZE .space PAGESIZE start_stack: ######## ENTRY SECTION END .data .align PAGESIZE .globl vmm_pml4 vmm_pml4: .space PAGESIZE .globl vmm_pdp vmm_pdp: .space PAGESIZE .globl vmm_pd1 vmm_pd1: .space PAGESIZE .globl vmm_pd2 vmm_pd2: .space PAGESIZE .globl vmm_main_pml4 vmm_main_pml4: .space PAGESIZE .globl vmm_main_pdp vmm_main_pdp: .space PAGESIZE .text .code32 .globl move_vmm_area32 move_vmm_area32: push %esi push %edi cld mov $end,%ecx # size of the VMM sub $head,%ecx # (end-head) mov $0x40100000,%esi # source: 0x40100000- mov $0xC0100000,%edi # destination: 0xC0100000- rep movsb # copy the VMM code and data pop %edi pop %esi ret .code64 .globl move_vmm_area64 move_vmm_area64: push %rsi push %rdi cld mov $end,%ecx # size of the VMM sub $head,%ecx # (end-head) mov $0x40100000,%esi # source: 0x40100000- mov $0xC0100000,%edi # destination: 0xC0100000- rep movsb # copy the VMM code and data ;; mov %rax,%cr3 # pop %rdi pop %rsi ret tinyvisor/vmm/core/longmode.h0000644006644000001440000000325111733227577016607 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifdef AS .section .gomi 1: inc %eax 2: .if 2b-1b == 1 longmode = 0 .else longmode = 1 .endif #endif tinyvisor/vmm/core/vt_init.c0000644006644000001440000003256012143664174016451 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include "asm.h" #include "constants.h" #include "cpu_mmu_spt.h" #include "current.h" #include "panic.h" #include "mm.h" #include "pcpu.h" #include "vt_internal.h" /* #define VT_DEBUG */ #ifdef VT_DEBUG #define VT_DBG(...) \ do { \ printf(__VA_ARGS__); \ } while (0) #else #define VT_DBG(...) #endif /* Check whether VMX is usable Return value: 0:usable -1:unusable (disabled by BIOS Setup, or not supported) */ static int check_vmx (void) { u32 a, b, c, d; u64 tmp; /* 19.6 DISCOVERING SUPPORT FOR VMX */ asm_cpuid (CPUID_1, 0, &a, &b, &c, &d); if (c & CPUID_1_ECX_VMX_BIT) { /* VMX operation is supported. */ } else { VT_DBG("CPU%d does not support VMX operation.\n", get_cpu_id()); return -1; } /* 19.7 ENABLING AND ENTERING VMX OPERATION */ asm_rdmsr64 (MSR_IA32_FEATURE_CONTROL, &tmp); if (tmp & MSR_IA32_FEATURE_CONTROL_LOCK_BIT) { if (tmp & MSR_IA32_FEATURE_CONTROL_VMXON_BIT) { /* VMX operation is allowed by bios. */ } else { printf("VMX operation is not allowed by BIOS."); return -1; } } else { tmp |= MSR_IA32_FEATURE_CONTROL_VMXON_BIT; tmp |= MSR_IA32_FEATURE_CONTROL_LOCK_BIT; asm_wrmsr64 (MSR_IA32_FEATURE_CONTROL, tmp); } return 0; } int vt_available (void) { return !check_vmx (); } void vt_vmx_init (void) { void *v; u64 p; if (alloc_page (&v, &p) < 0) panic ("vt_vmx_init: alloc_page failed."); currentcpu->vt.vmxon_region_virt = v; currentcpu->vt.vmxon_region_phys = p; } /* Enable VMX and do VMXON INPUT: vmxon_region_phys: physical address of VMXON region vmxon_region_virt: virtual address of VMXON region OUTPUT: vmcs_revision_identifier: VMCS revision identifier */ void vt_vmxon (void) { ulong cr0_0, cr0_1, cr4_0, cr4_1; ulong cr0, cr4; u32 *p; u32 dummy; /* apply FIXED bits */ asm_rdmsr (MSR_IA32_VMX_CR0_FIXED0, &cr0_0); asm_rdmsr (MSR_IA32_VMX_CR0_FIXED1, &cr0_1); asm_rdmsr (MSR_IA32_VMX_CR4_FIXED0, &cr4_0); asm_rdmsr (MSR_IA32_VMX_CR4_FIXED1, &cr4_1); asm_rdcr0 (&cr0); cr0 &= cr0_1; cr0 |= cr0_0; asm_wrcr0 (cr0); asm_rdcr4 (&cr4); cr4 &= cr4_1; cr4 |= cr4_0; asm_wrcr4 (cr4); /* set VMXE bit to enable VMX */ asm_rdcr4 (&cr4); cr4 |= CR4_VMXE_BIT; asm_wrcr4 (cr4); /* write a VMCS revision identifier */ asm_rdmsr32 (MSR_IA32_VMX_BASIC, ¤tcpu->vt.vmcs_revision_identifier, &dummy); p = currentcpu->vt.vmxon_region_virt; *p = currentcpu->vt.vmcs_revision_identifier; /* VMXON */ asm_vmxon (¤tcpu->vt.vmxon_region_phys); } void vt_reset (void) { struct vt_intr_data *vid = ¤t->u.vt.intr; vid->intr_info.v = 0; asm_vmwrite (VMCS_GUEST_INTERRUPTIBILITY_STATE, 0); asm_vmwrite (VMCS_GUEST_ACTIVITY_STATE, 0); asm_vmwrite (VMCS_GUEST_PENDING_DEBUG_EXCEPTIONS, 0); } static void vt_vmptrld (u64 ptr) { if (currentcpu->vt.vmcs_region_phys == ptr) return; if (currentcpu->vt.vmcs_region_phys != 0) asm_vmptrst (¤tcpu->vt.vmcs_region_phys); currentcpu->vt.vmcs_region_phys = ptr; if (currentcpu->vt.vmcs_region_phys != 0) asm_vmptrld (¤tcpu->vt.vmcs_region_phys); } /* Initialize VMCS region INPUT: vmcs_revision_identifier: VMCS revision identifier */ static void vt_vmcs_init (void) { u32 *p; struct regs_in_vmcs host_riv, guest_riv; u32 pinbased_ctls_or, pinbased_ctls_and; u32 procbased_ctls_or, procbased_ctls_and; u32 exit_ctls_or, exit_ctls_and; u32 entry_ctls_or, entry_ctls_and; ulong sysenter_cs, sysenter_esp, sysenter_eip; ulong exitctl64; vmmerr_t err; current->u.vt.io.iobmpflag = false; err = alloc_page (¤t->u.vt.vi.vmcs_region_virt, ¤t->u.vt.vi.vmcs_region_phys); if (err) { panic("Failed to allocate VMCS."); } current->u.vt.intr.intr_info.s.valid = INTR_INFO_VALID_INVALID; p = current->u.vt.vi.vmcs_region_virt; *p = currentcpu->vt.vmcs_revision_identifier; /* write VMCS revision identifier */ asm_vmclear (¤t->u.vt.vi.vmcs_region_phys); /* clear */ vt_vmptrld (current->u.vt.vi.vmcs_region_phys); /* load */ /* get information from MSR */ asm_rdmsr32 (MSR_IA32_VMX_PINBASED_CTLS, &pinbased_ctls_or, &pinbased_ctls_and); asm_rdmsr32 (MSR_IA32_VMX_PROCBASED_CTLS, &procbased_ctls_or, &procbased_ctls_and); asm_rdmsr32 (MSR_IA32_VMX_EXIT_CTLS, &exit_ctls_or, &exit_ctls_and); asm_rdmsr32 (MSR_IA32_VMX_ENTRY_CTLS, &entry_ctls_or, &entry_ctls_and); asm_rdmsr (MSR_IA32_SYSENTER_CS, &sysenter_cs); asm_rdmsr (MSR_IA32_SYSENTER_ESP, &sysenter_esp); asm_rdmsr (MSR_IA32_SYSENTER_EIP, &sysenter_eip); /* get current information */ vt_get_current_regs_in_vmcs (&host_riv); guest_riv = host_riv; exitctl64 = sizeof (ulong) == 4 ? 0 : VMCS_VMEXIT_CTL_HOST_ADDRESS_SPACE_SIZE_BIT; /* initialize VMCS fields */ /* 16-Bit Guest-State Fields */ asm_vmwrite (VMCS_GUEST_ES_SEL, guest_riv.es.sel); asm_vmwrite (VMCS_GUEST_CS_SEL, guest_riv.cs.sel); asm_vmwrite (VMCS_GUEST_SS_SEL, guest_riv.ss.sel); asm_vmwrite (VMCS_GUEST_DS_SEL, guest_riv.ds.sel); asm_vmwrite (VMCS_GUEST_FS_SEL, guest_riv.fs.sel); asm_vmwrite (VMCS_GUEST_GS_SEL, guest_riv.gs.sel); asm_vmwrite (VMCS_GUEST_LDTR_SEL, guest_riv.ldtr.sel); asm_vmwrite (VMCS_GUEST_TR_SEL, guest_riv.tr.sel); /* 16-Bit Host-State Fields */ asm_vmwrite (VMCS_HOST_ES_SEL, host_riv.es.sel); asm_vmwrite (VMCS_HOST_CS_SEL, host_riv.cs.sel); asm_vmwrite (VMCS_HOST_SS_SEL, host_riv.ss.sel); asm_vmwrite (VMCS_HOST_DS_SEL, host_riv.ds.sel); asm_vmwrite (VMCS_HOST_FS_SEL, host_riv.fs.sel); asm_vmwrite (VMCS_HOST_GS_SEL, host_riv.gs.sel); asm_vmwrite (VMCS_HOST_TR_SEL, host_riv.tr.sel); /* 64-Bit Control Fields */ asm_vmwrite (VMCS_ADDR_IOBMP_A, 0xFFFFFFFF); asm_vmwrite (VMCS_ADDR_IOBMP_A_HIGH, 0xFFFFFFFF); asm_vmwrite (VMCS_ADDR_IOBMP_B, 0xFFFFFFFF); asm_vmwrite (VMCS_ADDR_IOBMP_B_HIGH, 0xFFFFFFFF); asm_vmwrite (VMCS_ADDR_MSRBMP, 0xFFFFFFFF); asm_vmwrite (VMCS_ADDR_MSRBMP_HIGH, 0xFFFFFFFF); asm_vmwrite (VMCS_VMEXIT_MSRSTORE_ADDR, 0); asm_vmwrite (VMCS_VMEXIT_MSRSTORE_ADDR_HIGH, 0); asm_vmwrite (VMCS_VMEXIT_MSRLOAD_ADDR, 0); asm_vmwrite (VMCS_VMEXIT_MSRLOAD_ADDR_HIGH, 0); asm_vmwrite (VMCS_VMENTRY_MSRLOAD_ADDR, 0); asm_vmwrite (VMCS_VMENTRY_MSRLOAD_ADDR_HIGH, 0); asm_vmwrite (VMCS_EXEC_VMCS_POINTER, 0); asm_vmwrite (VMCS_EXEC_VMCS_POINTER_HIGH, 0); asm_vmwrite (VMCS_TSC_OFFSET, 0); asm_vmwrite (VMCS_TSC_OFFSET_HIGH, 0); /* 64-Bit Guest-State Fields */ asm_vmwrite (VMCS_VMCS_LINK_POINTER, 0xFFFFFFFF); asm_vmwrite (VMCS_VMCS_LINK_POINTER_HIGH, 0xFFFFFFFF); asm_vmwrite (VMCS_GUEST_IA32_DEBUGCTL, 0); asm_vmwrite (VMCS_GUEST_IA32_DEBUGCTL_HIGH, 0); /* 32-Bit Control Fields */ asm_vmwrite (VMCS_PIN_BASED_VMEXEC_CTL, (VMCS_PIN_BASED_VMEXEC_CTL_EXINTEXIT_BIT | VMCS_PIN_BASED_VMEXEC_CTL_NMIEXIT_BIT | VMCS_PIN_BASED_VMEXEC_CTL_VIRTNMIS_BIT | pinbased_ctls_or) & pinbased_ctls_and); asm_vmwrite (VMCS_PROC_BASED_VMEXEC_CTL, (/* XXX: VMCS_PROC_BASED_VMEXEC_CTL_HLTEXIT_BIT */0 | VMCS_PROC_BASED_VMEXEC_CTL_INVLPGEXIT_BIT | VMCS_PROC_BASED_VMEXEC_CTL_UNCONDIOEXIT_BIT | VMCS_PROC_BASED_VMEXEC_CTL_USETSCOFF_BIT | procbased_ctls_or) & procbased_ctls_and); asm_vmwrite (VMCS_EXCEPTION_BMP, 0xFFFFFFFF); asm_vmwrite (VMCS_PAGEFAULT_ERRCODE_MASK, 0); asm_vmwrite (VMCS_PAGEFAULT_ERRCODE_MATCH, 0); asm_vmwrite (VMCS_CR3_TARGET_COUNT, 0); asm_vmwrite (VMCS_VMEXIT_CTL, (exit_ctls_or & exit_ctls_and) | exitctl64); asm_vmwrite (VMCS_VMEXIT_MSR_STORE_COUNT, 0); asm_vmwrite (VMCS_VMEXIT_MSR_LOAD_COUNT, 0); asm_vmwrite (VMCS_VMENTRY_CTL, entry_ctls_or & entry_ctls_and); asm_vmwrite (VMCS_VMENTRY_MSR_LOAD_COUNT, 0); asm_vmwrite (VMCS_VMENTRY_INTR_INFO_FIELD, 0); asm_vmwrite (VMCS_VMENTRY_EXCEPTION_ERRCODE, 0); asm_vmwrite (VMCS_VMENTRY_INSTRUCTION_LEN, 0); asm_vmwrite (VMCS_TPR_THRESHOLD, 0); /* 32-Bit Guest-State Fields */ asm_vmwrite (VMCS_GUEST_ES_LIMIT, guest_riv.es.limit); asm_vmwrite (VMCS_GUEST_CS_LIMIT, guest_riv.cs.limit); asm_vmwrite (VMCS_GUEST_SS_LIMIT, guest_riv.ss.limit); asm_vmwrite (VMCS_GUEST_DS_LIMIT, guest_riv.ds.limit); asm_vmwrite (VMCS_GUEST_FS_LIMIT, guest_riv.fs.limit); asm_vmwrite (VMCS_GUEST_GS_LIMIT, guest_riv.gs.limit); asm_vmwrite (VMCS_GUEST_LDTR_LIMIT, guest_riv.ldtr.limit); asm_vmwrite (VMCS_GUEST_TR_LIMIT, guest_riv.tr.limit); asm_vmwrite (VMCS_GUEST_GDTR_LIMIT, guest_riv.gdtr.limit); asm_vmwrite (VMCS_GUEST_IDTR_LIMIT, guest_riv.idtr.limit); asm_vmwrite (VMCS_GUEST_ES_ACCESS_RIGHTS, guest_riv.es.acr); asm_vmwrite (VMCS_GUEST_CS_ACCESS_RIGHTS, guest_riv.cs.acr); asm_vmwrite (VMCS_GUEST_SS_ACCESS_RIGHTS, guest_riv.ss.acr); asm_vmwrite (VMCS_GUEST_DS_ACCESS_RIGHTS, guest_riv.ds.acr); asm_vmwrite (VMCS_GUEST_FS_ACCESS_RIGHTS, guest_riv.fs.acr); asm_vmwrite (VMCS_GUEST_GS_ACCESS_RIGHTS, guest_riv.gs.acr); asm_vmwrite (VMCS_GUEST_LDTR_ACCESS_RIGHTS, guest_riv.ldtr.acr); asm_vmwrite (VMCS_GUEST_TR_ACCESS_RIGHTS, guest_riv.tr.acr); asm_vmwrite (VMCS_GUEST_INTERRUPTIBILITY_STATE, 0); asm_vmwrite (VMCS_GUEST_ACTIVITY_STATE, 0); asm_vmwrite (VMCS_GUEST_IA32_SYSENTER_CS, sysenter_cs); /* 32-Bit Host-State Field */ asm_vmwrite (VMCS_HOST_IA32_SYSENTER_CS, sysenter_cs); /* Natural-Width Control Fields */ asm_vmwrite (VMCS_CR0_GUESTHOST_MASK, 0xFFFFFFFF); asm_vmwrite (VMCS_CR4_GUESTHOST_MASK, 0xFFFFFFFF); asm_vmwrite (VMCS_CR0_READ_SHADOW, guest_riv.cr0); asm_vmwrite (VMCS_CR4_READ_SHADOW, guest_riv.cr4); asm_vmwrite (VMCS_CR3_TARGET_VALUE_0, 0); asm_vmwrite (VMCS_CR3_TARGET_VALUE_1, 0); asm_vmwrite (VMCS_CR3_TARGET_VALUE_2, 0); asm_vmwrite (VMCS_CR3_TARGET_VALUE_3, 0); /* Natural-Width Guest-State Fields */ asm_vmwrite (VMCS_GUEST_CR0, guest_riv.cr0); asm_vmwrite (VMCS_GUEST_CR3, guest_riv.cr3); asm_vmwrite (VMCS_GUEST_CR4, guest_riv.cr4); asm_vmwrite (VMCS_GUEST_ES_BASE, guest_riv.es.base); asm_vmwrite (VMCS_GUEST_CS_BASE, guest_riv.cs.base); asm_vmwrite (VMCS_GUEST_SS_BASE, guest_riv.ss.base); asm_vmwrite (VMCS_GUEST_DS_BASE, guest_riv.ds.base); asm_vmwrite (VMCS_GUEST_FS_BASE, guest_riv.fs.base); asm_vmwrite (VMCS_GUEST_GS_BASE, guest_riv.gs.base); asm_vmwrite (VMCS_GUEST_LDTR_BASE, guest_riv.ldtr.base); asm_vmwrite (VMCS_GUEST_TR_BASE, guest_riv.tr.base); asm_vmwrite (VMCS_GUEST_GDTR_BASE, guest_riv.gdtr.base); asm_vmwrite (VMCS_GUEST_IDTR_BASE, guest_riv.idtr.base); asm_vmwrite (VMCS_GUEST_DR7, guest_riv.dr7); asm_vmwrite (VMCS_GUEST_RSP, 0xDEADBEEF); asm_vmwrite (VMCS_GUEST_RIP, 0xDEADBEEF); asm_vmwrite (VMCS_GUEST_RFLAGS, guest_riv.rflags); asm_vmwrite (VMCS_GUEST_PENDING_DEBUG_EXCEPTIONS, 0); asm_vmwrite (VMCS_GUEST_IA32_SYSENTER_ESP, sysenter_esp); asm_vmwrite (VMCS_GUEST_IA32_SYSENTER_EIP, sysenter_eip); /* Natural-Width Host-State Fields */ asm_vmwrite (VMCS_HOST_CR0, host_riv.cr0); asm_vmwrite (VMCS_HOST_CR3, host_riv.cr3); asm_vmwrite (VMCS_HOST_CR4, host_riv.cr4); asm_vmwrite (VMCS_HOST_FS_BASE, host_riv.fs.base); asm_vmwrite (VMCS_HOST_GS_BASE, host_riv.gs.base); asm_vmwrite (VMCS_HOST_TR_BASE, host_riv.tr.base); asm_vmwrite (VMCS_HOST_GDTR_BASE, host_riv.gdtr.base); asm_vmwrite (VMCS_HOST_IDTR_BASE, host_riv.idtr.base); asm_vmwrite (VMCS_HOST_IA32_SYSENTER_ESP, sysenter_esp); asm_vmwrite (VMCS_HOST_IA32_SYSENTER_EIP, sysenter_eip); asm_vmwrite (VMCS_HOST_RSP, 0xDEADBEEF); asm_vmwrite (VMCS_HOST_RIP, 0xDEADBEEF); /* allocate iobmp */ vt_iopass_init (); } static void vt_realmode_data_init (void) { current->u.vt.realmode.idtr.base = 0; current->u.vt.realmode.idtr.limit = 0x3FF; current->u.vt.realmode.tr_limit = 0; current->u.vt.realmode.tr_acr = 0x8B; /* 32bit busy TSS */ current->u.vt.realmode.tr_base = 0; } void vt_vminit (void) { vt_vmcs_init(); current->u.vt.vr.pe = 1; current->u.vt.vr.pg = 1; vt_realmode_data_init(); vt_msr_init(); vt_ept_init(); cpu_mmu_spt_init(); } void vt_vmexit (void) { asm_vmxoff(); } void vt_init (void) { vt_vmx_init (); vt_vmxon (); VT_DBG("VMX operation is enabled on CPU%d.\n", get_cpu_id()); } tinyvisor/vmm/core/current.h0000644006644000001440000000327511733227577016473 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_CURRENT_H #define _CORE_CURRENT_H #include "vcpu.h" extern struct vcpu *current asm ("%gs:gs_current"); #endif tinyvisor/vmm/core/timer.c0000644006644000001440000001104211733245403016077 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include #include #include "comphappy.h" #include "constants.h" #include "mm.h" #include "pcpu.h" #include "thread.h" #include /* #include */ #define MAX_TIMER_PCPU 8 void * timer_new (void (*callback) (void *handle, void *data), void *data) { struct timer_data *p; spinlock_lock (¤tcpu->timer_lock); p = LIST1_POP (currentcpu->timer_free_list); if (p == NULL) { spinlock_unlock (¤tcpu->timer_lock); return NULL; } p->enable = false; p->callback = callback; p->data = data; LIST1_ADD (currentcpu->timer_off_list, p); spinlock_unlock (¤tcpu->timer_lock); return p; } void timer_set (void *handle, u64 interval_usec) { struct timer_data *p, *d; u64 time; u64 expire; spinlock_lock (¤tcpu->timer_lock); time = get_cpu_time (); p = handle; if (p->enable) { LIST1_DEL (currentcpu->timer_on_list, p); } else { LIST1_DEL (currentcpu->timer_off_list, p); p->enable = true; } p->settime = time; p->interval = interval_usec; expire = p->settime + p->interval; LIST1_FOREACH (currentcpu->timer_on_list, d) { if ((d->settime + d->interval) > expire) { break; } } if (d) LIST1_INSERT (currentcpu->timer_on_list, d, p); else LIST1_ADD(currentcpu->timer_on_list, p); spinlock_unlock (¤tcpu->timer_lock); } void timer_free (void *handle) { struct timer_data *p; spinlock_lock (¤tcpu->timer_lock); p = handle; if (p->enable) LIST1_DEL (currentcpu->timer_on_list, p); else LIST1_DEL (currentcpu->timer_off_list, p); p->enable = false; LIST1_ADD (currentcpu->timer_free_list, p); spinlock_unlock (¤tcpu->timer_lock); } static void timer_thread (void *thread_data) { struct timer_data *p; u64 time; bool call; void (*callback) (void *handle, void *data); void *data; VAR_IS_INITIALIZED (callback); VAR_IS_INITIALIZED (data); for (;;) { call = false; spinlock_lock (¤tcpu->timer_lock); time = get_cpu_time (); p = LIST1_POP (currentcpu->timer_on_list); if (p) { ASSERT(p->enable); if ((time - p->settime) >= p->interval) { p->enable = false; call = true; callback = p->callback; data = p->data; LIST1_ADD (currentcpu->timer_off_list, p); } else { LIST1_PUSH (currentcpu->timer_on_list, p); } } spinlock_unlock (¤tcpu->timer_lock); if (call) callback (p, data); else schedule (); } } static void timer_init_pcpu (void) { struct timer_data *p; int i; p = alloc (MAX_TIMER_PCPU * sizeof (struct timer_data)); if (p == NULL) { panic("Failed to allocate memory for struct timer_data."); } for (i = 0; i < MAX_TIMER_PCPU; i++) LIST1_PUSH (currentcpu->timer_free_list, &p[i]); spinlock_init (¤tcpu->timer_lock); thread_new_bind(timer_thread, NULL, VMM_STACKSIZE, get_cpu_id()); } INITFUNC ("pcpu4", timer_init_pcpu); tinyvisor/vmm/core/smp.h0000644006644000001440000000361211733245403015567 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_SMP_H #define _CORE_SMP_H #include "pcpu.h" #include void panic_wakeup_all (void); void sync_all_processors (void); void start_all_processors (void (*bsp_initproc) (void), void (*ap_initproc) (void)); int get_number_of_processors (void); #endif tinyvisor/vmm/core/gmm_ident.c0000644006644000001440000001075311733245403016732 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ /* * Guest Memory Manager whose guest-address is identical with host-address. */ #include #include #include #include #include #include #include #include #include "current.h" #include "mm.h" #include "gmm.h" #include "gmm_ident.h" #define MAXNUM_OF_IDENT_MEM_MAP 64 static phys_t gmm_ident_gp2hp (phys_t gp) { phys_t r; if (phys_in_vmm (gp)) { r = GMM_NO_MAPPING; } else { r = gp; } return r; } static int gmm_ident_get_mem_map(int index, phys_t *base, phys_t *len, u32 *type) { struct gmm_ident *gmm_ident; struct resource *resource; gmm_ident = ¤t->vm->gmm_ident; if (index < 0 || index >= gmm_ident->mem_map_count) { return 0; } ASSERT(gmm_ident->mem_map); resource = gmm_ident->mem_map + index; *base = resource->start; *len = resource->end - resource->start + 1; *type = resource->data; return 1; } static int gmm_ident_get_mem_map_count(void) { return current->vm->gmm_ident.mem_map_count; } static struct gmm_func gmm_ident_func = { .gp2hp = gmm_ident_gp2hp, .get_mem_map = gmm_ident_get_mem_map, .get_mem_map_count = gmm_ident_get_mem_map_count }; static void gmm_ident_init_mem_map(void) { int index = 0; struct gmm_ident* gmm_ident; phys_t avail_start, avail_end; struct resource *parent = NULL, *new, *next, *prev; char *name = current->vm->name; gmm_ident = ¤t->vm->gmm_ident; gmm_ident->mem_map = alloc(sizeof(struct resource) * MAXNUM_OF_IDENT_MEM_MAP); if (gmm_ident->mem_map == NULL) { panic("gmm_ident_init_mem_map: Failed to alloc mem_map"); } while ((parent = mm_next_mem_map(parent)) != NULL) { if (parent->data != MEM_TYPE_AVAILABLE) { new = gmm_ident->mem_map + index++; rm_init_resource(new, parent->start, parent->end, parent->type, parent->data, name); rm_insert_resource(parent, new); if (index >= MAXNUM_OF_IDENT_MEM_MAP) { goto out; } continue; } next = NULL; prev = NULL; for (;;) { next = RM_RESOURCE_NEXT(parent, next); avail_start = prev ? prev->end + 1 : parent->start; avail_end = next ? next->start - 1 : parent->end; if (avail_start <= avail_end) { new = gmm_ident->mem_map + index++; rm_init_resource(new, avail_start, avail_end, parent->type, parent->data, name); rm_insert_resource(parent, new); } if (next == NULL) { break; } new = gmm_ident->mem_map + index++; rm_init_resource(new, next->start, next->end, parent->type, MEM_TYPE_RESERVED, name); if (index >= MAXNUM_OF_IDENT_MEM_MAP) { goto out; } prev = next; } } out: gmm_ident->mem_map_count = index; } static void gmm_ident_init (void) { if (!cpu_is_bsp()) { return; } memcpy((void *)¤t->vm->gmm, (void *)&gmm_ident_func, sizeof(gmm_ident_func)); gmm_ident_init_mem_map(); } INITFUNC ("passvm0", gmm_ident_init); tinyvisor/vmm/core/svm_exitcode.c0000644006644000001440000002320111733245403017450 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include "constants.h" #include "svm_exitcode.h" char * message_exitcode (int num) { char *m; switch (num) { case VMEXIT_CR0_READ: m = "VMEXIT_CR0_READ"; break; case VMEXIT_CR1_READ: m = "VMEXIT_CR1_READ"; break; case VMEXIT_CR2_READ: m = "VMEXIT_CR2_READ"; break; case VMEXIT_CR3_READ: m = "VMEXIT_CR3_READ"; break; case VMEXIT_CR4_READ: m = "VMEXIT_CR4_READ"; break; case VMEXIT_CR5_READ: m = "VMEXIT_CR5_READ"; break; case VMEXIT_CR6_READ: m = "VMEXIT_CR6_READ"; break; case VMEXIT_CR7_READ: m = "VMEXIT_CR7_READ"; break; case VMEXIT_CR8_READ: m = "VMEXIT_CR8_READ"; break; case VMEXIT_CR9_READ: m = "VMEXIT_CR9_READ"; break; case VMEXIT_CR10_READ: m = "VMEXIT_CR10_READ"; break; case VMEXIT_CR11_READ: m = "VMEXIT_CR11_READ"; break; case VMEXIT_CR12_READ: m = "VMEXIT_CR12_READ"; break; case VMEXIT_CR13_READ: m = "VMEXIT_CR13_READ"; break; case VMEXIT_CR14_READ: m = "VMEXIT_CR14_READ"; break; case VMEXIT_CR15_READ: m = "VMEXIT_CR15_READ"; break; case VMEXIT_CR0_WRITE: m = "VMEXIT_CR0_WRITE"; break; case VMEXIT_CR1_WRITE: m = "VMEXIT_CR1_WRITE"; break; case VMEXIT_CR2_WRITE: m = "VMEXIT_CR2_WRITE"; break; case VMEXIT_CR3_WRITE: m = "VMEXIT_CR3_WRITE"; break; case VMEXIT_CR4_WRITE: m = "VMEXIT_CR4_WRITE"; break; case VMEXIT_CR5_WRITE: m = "VMEXIT_CR5_WRITE"; break; case VMEXIT_CR6_WRITE: m = "VMEXIT_CR6_WRITE"; break; case VMEXIT_CR7_WRITE: m = "VMEXIT_CR7_WRITE"; break; case VMEXIT_CR8_WRITE: m = "VMEXIT_CR8_WRITE"; break; case VMEXIT_CR9_WRITE: m = "VMEXIT_CR9_WRITE"; break; case VMEXIT_CR10_WRITE: m = "VMEXIT_CR10_WRITE"; break; case VMEXIT_CR11_WRITE: m = "VMEXIT_CR11_WRITE"; break; case VMEXIT_CR12_WRITE: m = "VMEXIT_CR12_WRITE"; break; case VMEXIT_CR13_WRITE: m = "VMEXIT_CR13_WRITE"; break; case VMEXIT_CR14_WRITE: m = "VMEXIT_CR14_WRITE"; break; case VMEXIT_CR15_WRITE: m = "VMEXIT_CR15_WRITE"; break; case VMEXIT_DR0_READ: m = "VMEXIT_DR0_READ"; break; case VMEXIT_DR1_READ: m = "VMEXIT_DR1_READ"; break; case VMEXIT_DR2_READ: m = "VMEXIT_DR2_READ"; break; case VMEXIT_DR3_READ: m = "VMEXIT_DR3_READ"; break; case VMEXIT_DR4_READ: m = "VMEXIT_DR4_READ"; break; case VMEXIT_DR5_READ: m = "VMEXIT_DR5_READ"; break; case VMEXIT_DR6_READ: m = "VMEXIT_DR6_READ"; break; case VMEXIT_DR7_READ: m = "VMEXIT_DR7_READ"; break; case VMEXIT_DR8_READ: m = "VMEXIT_DR8_READ"; break; case VMEXIT_DR9_READ: m = "VMEXIT_DR9_READ"; break; case VMEXIT_DR10_READ: m = "VMEXIT_DR10_READ"; break; case VMEXIT_DR11_READ: m = "VMEXIT_DR11_READ"; break; case VMEXIT_DR12_READ: m = "VMEXIT_DR12_READ"; break; case VMEXIT_DR13_READ: m = "VMEXIT_DR13_READ"; break; case VMEXIT_DR14_READ: m = "VMEXIT_DR14_READ"; break; case VMEXIT_DR15_READ: m = "VMEXIT_DR15_READ"; break; case VMEXIT_DR0_WRITE: m = "VMEXIT_DR0_WRITE"; break; case VMEXIT_DR1_WRITE: m = "VMEXIT_DR1_WRITE"; break; case VMEXIT_DR2_WRITE: m = "VMEXIT_DR2_WRITE"; break; case VMEXIT_DR3_WRITE: m = "VMEXIT_DR3_WRITE"; break; case VMEXIT_DR4_WRITE: m = "VMEXIT_DR4_WRITE"; break; case VMEXIT_DR5_WRITE: m = "VMEXIT_DR5_WRITE"; break; case VMEXIT_DR6_WRITE: m = "VMEXIT_DR6_WRITE"; break; case VMEXIT_DR7_WRITE: m = "VMEXIT_DR7_WRITE"; break; case VMEXIT_DR8_WRITE: m = "VMEXIT_DR8_WRITE"; break; case VMEXIT_DR9_WRITE: m = "VMEXIT_DR9_WRITE"; break; case VMEXIT_DR10_WRITE: m = "VMEXIT_DR10_WRITE"; break; case VMEXIT_DR11_WRITE: m = "VMEXIT_DR11_WRITE"; break; case VMEXIT_DR12_WRITE: m = "VMEXIT_DR12_WRITE"; break; case VMEXIT_DR13_WRITE: m = "VMEXIT_DR13_WRITE"; break; case VMEXIT_DR14_WRITE: m = "VMEXIT_DR14_WRITE"; break; case VMEXIT_DR15_WRITE: m = "VMEXIT_DR15_WRITE"; break; case VMEXIT_EXCP0: m = "VMEXIT_EXCP0"; break; case VMEXIT_EXCP1: m = "VMEXIT_EXCP1"; break; case VMEXIT_EXCP2: m = "VMEXIT_EXCP2"; break; case VMEXIT_EXCP3: m = "VMEXIT_EXCP3"; break; case VMEXIT_EXCP4: m = "VMEXIT_EXCP4"; break; case VMEXIT_EXCP5: m = "VMEXIT_EXCP5"; break; case VMEXIT_EXCP6: m = "VMEXIT_EXCP6"; break; case VMEXIT_EXCP7: m = "VMEXIT_EXCP7"; break; case VMEXIT_EXCP8: m = "VMEXIT_EXCP8"; break; case VMEXIT_EXCP9: m = "VMEXIT_EXCP9"; break; case VMEXIT_EXCP10: m = "VMEXIT_EXCP10"; break; case VMEXIT_EXCP11: m = "VMEXIT_EXCP11"; break; case VMEXIT_EXCP12: m = "VMEXIT_EXCP12"; break; case VMEXIT_EXCP13: m = "VMEXIT_EXCP13"; break; case VMEXIT_EXCP14: m = "VMEXIT_EXCP14"; break; case VMEXIT_EXCP15: m = "VMEXIT_EXCP15"; break; case VMEXIT_EXCP16: m = "VMEXIT_EXCP16"; break; case VMEXIT_EXCP17: m = "VMEXIT_EXCP17"; break; case VMEXIT_EXCP18: m = "VMEXIT_EXCP18"; break; case VMEXIT_EXCP19: m = "VMEXIT_EXCP19"; break; case VMEXIT_EXCP20: m = "VMEXIT_EXCP20"; break; case VMEXIT_EXCP21: m = "VMEXIT_EXCP21"; break; case VMEXIT_EXCP22: m = "VMEXIT_EXCP22"; break; case VMEXIT_EXCP23: m = "VMEXIT_EXCP23"; break; case VMEXIT_EXCP24: m = "VMEXIT_EXCP24"; break; case VMEXIT_EXCP25: m = "VMEXIT_EXCP25"; break; case VMEXIT_EXCP26: m = "VMEXIT_EXCP26"; break; case VMEXIT_EXCP27: m = "VMEXIT_EXCP27"; break; case VMEXIT_EXCP28: m = "VMEXIT_EXCP28"; break; case VMEXIT_EXCP29: m = "VMEXIT_EXCP29"; break; case VMEXIT_EXCP30: m = "VMEXIT_EXCP30"; break; case VMEXIT_EXCP31: m = "VMEXIT_EXCP31"; break; case VMEXIT_INTR: m = "VMEXIT_INTR"; break; case VMEXIT_NMI: m = "VMEXIT_NMI"; break; case VMEXIT_SMI: m = "VMEXIT_SMI"; break; case VMEXIT_INIT: m = "VMEXIT_INIT"; break; case VMEXIT_VINTR: m = "VMEXIT_VINTR"; break; case VMEXIT_CR0_SEL_WRITE: m = "VMEXIT_CR0_SEL_WRITE"; break; case VMEXIT_IDTR_READ: m = "VMEXIT_IDTR_READ"; break; case VMEXIT_GDTR_READ: m = "VMEXIT_GDTR_READ"; break; case VMEXIT_LDTR_READ: m = "VMEXIT_LDTR_READ"; break; case VMEXIT_TR_READ: m = "VMEXIT_TR_READ"; break; case VMEXIT_IDTR_WRITE: m = "VMEXIT_IDTR_WRITE"; break; case VMEXIT_GDTR_WRITE: m = "VMEXIT_GDTR_WRITE"; break; case VMEXIT_LDTR_WRITE: m = "VMEXIT_LDTR_WRITE"; break; case VMEXIT_TR_WRITE: m = "VMEXIT_TR_WRITE"; break; case VMEXIT_RDTSC: m = "VMEXIT_RDTSC"; break; case VMEXIT_RDPMC: m = "VMEXIT_RDPMC"; break; case VMEXIT_PUSHF: m = "VMEXIT_PUSHF"; break; case VMEXIT_POPF: m = "VMEXIT_POPF"; break; case VMEXIT_CPUID: m = "VMEXIT_CPUID"; break; case VMEXIT_RSM: m = "VMEXIT_RSM"; break; case VMEXIT_IRET: m = "VMEXIT_IRET"; break; case VMEXIT_SWINT: m = "VMEXIT_SWINT"; break; case VMEXIT_INVD: m = "VMEXIT_INVD"; break; case VMEXIT_PAUSE: m = "VMEXIT_PAUSE"; break; case VMEXIT_HLT: m = "VMEXIT_HLT"; break; case VMEXIT_INVLPG: m = "VMEXIT_INVLPG"; break; case VMEXIT_INVLPGA: m = "VMEXIT_INVLPGA"; break; case VMEXIT_IOIO: m = "VMEXIT_IOIO"; break; case VMEXIT_MSR: m = "VMEXIT_MSR"; break; case VMEXIT_TASK_SWITCH: m = "VMEXIT_TASK_SWITCH"; break; case VMEXIT_FERR_FREEZE: m = "VMEXIT_FERR_FREEZE"; break; case VMEXIT_SHUTDOWN: m = "VMEXIT_SHUTDOWN"; break; case VMEXIT_VMRUN: m = "VMEXIT_VMRUN"; break; case VMEXIT_VMMCALL: m = "VMEXIT_VMMCALL"; break; case VMEXIT_VMLOAD: m = "VMEXIT_VMLOAD"; break; case VMEXIT_VMSAVE: m = "VMEXIT_VMSAVE"; break; case VMEXIT_STGI: m = "VMEXIT_STGI"; break; case VMEXIT_CLGI: m = "VMEXIT_CLGI"; break; case VMEXIT_SKINIT: m = "VMEXIT_SKINIT"; break; case VMEXIT_RDTSCP: m = "VMEXIT_RDTSCP"; break; case VMEXIT_ICEBP: m = "VMEXIT_ICEBP"; break; case VMEXIT_WBINVD: m = "VMEXIT_WBINVD"; break; case VMEXIT_MONITOR: m = "VMEXIT_MONITOR"; break; case VMEXIT_MWAIT: m = "VMEXIT_MWAIT"; break; case VMEXIT_MWAIT_CONDITIONAL: m = "VMEXIT_MWAIT_CONDITIONAL"; break; case VMEXIT_NPF: m = "VMEXIT_NPF"; break; case VMEXIT_INVALID: m = "VMEXIT_INVALID"; break; default: m = "unknown exitcode"; } return m; } void printexitcode (int num) { char *m; m = message_exitcode (num); printf ("%d=0x%X (%s)\n", num, num, m); } tinyvisor/vmm/core/vramwrite.h0000644006644000001440000000423712011203114016773 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_VRAMWRITE_H #define _CORE_VRAMWRITE_H void vramwrite_putchar (unsigned char c); void vramwrite_mark1 (unsigned int x, unsigned int y); void vramwrite_mark2 (unsigned int x, unsigned int y, u8 xor_color); void vramwrite_mark3 (unsigned int x, unsigned int y, u8 color); void vramwrite_save_and_move_cursor (unsigned int x, unsigned int y); void vramwrite_restore_cursor (void); void vramwrite_get_cursor_pos (unsigned int *x, unsigned int *y); void vramwrite_init_global (void); void vramwrite_exit_global (void); void vramwrite_mm_initialized(void); /* void vramwrite_reenable(void); */ #endif tinyvisor/vmm/core/comphappy.h0000644006644000001440000000331611733245403016771 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_COMPHAPPY_H #define _CORE_COMPHAPPY_H /* make gcc happy */ #define VAR_IS_INITIALIZED(var) asm volatile ("" : "=m" (var)) #endif tinyvisor/vmm/core/tty.h0000644006644000001440000000331012143714154015603 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_TTY_H #define _CORE_TTY_H void ttylog_stop (void); void tty_putchar (unsigned char c); void tty_init_global (void); #endif tinyvisor/vmm/core/guest_boot.s0000644006644000001440000001366012011643607017157 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ GUEST_BOOT_OFFSET = 0x800 .globl guest_boot_start .globl guest_boot_end .text .code16 .align 16 # INPUT: # Boot from MBR or boot sector (EDI = 0) # CL = BIOS DRIVE NUMBER # DH = CURSOR POSITION (ROW) # DL = CURSOR POSITION (COL) # BH = CURSOR POSITION (PAGE NUMBER) # SI = BOOT AN ACTIVE PARTITION FLAG # EDI = 0 # Boot using INT 18 (EDI = 1) # EDI = 1 # Boot 32bit kernel (EDI > 2) # ESI = BOOT PARAMS # EDI = 32BIT KERNEL START ADDRESS guest_boot_start: cli xor %ax,%ax ljmp $0,$GUEST_BOOT_OFFSET + (1f - guest_boot_start) 1: mov %ax,%ds mov %ax,%es mov %ax,%fs mov %ax,%gs mov %ax,%ss mov $GUEST_BOOT_OFFSET,%sp sti cmp $0x00000001, %edi je boot_using_int18 test %edi,%edi jne boot_32bit_kernel boot_from_mbr_or_bootsect: push %si push %cx mov $0x02,%ah # SET CURSOR POSITION int $0x10 # CALL VIDEO BIOS pop %dx mov $0x4B01,%ax # GET STATUS mov $0x7C00,%si int $0x13 # CALL DISK BIOS jc notcd cmpw $0x13,(%si) # PACKET SIZE = 0x13 AND NO EMULATION jne notcd call print_by_bios .string "Reading CD-ROM.\n" mov $GUEST_BOOT_OFFSET + (exread1 - guest_boot_start),%si mov $0x42,%ah # EXTENDED READ int $0x13 # CALL DISK BIOS jc notcd mov $GUEST_BOOT_OFFSET + (exread2 - guest_boot_start),%si mov 0x7C47,%ax # READ BOOT CATALOG mov %ax,8(%si) mov 0x7C49,%ax mov %ax,10(%si) mov $0x42,%ah # EXTENDED READ int $0x13 # CALL DISK BIOS jc notcd cmpb $0x88,0x7C20 # BOOTABLE? jne notcd mov $GUEST_BOOT_OFFSET + (exread3 - guest_boot_start),%si mov 0x7C22,%ax # SEGMENT test %ax,%ax jne 1f mov $0x7C0,%ax 1: cmp $0x100,%ax # CHECK SEGMENT jb cderr push %ax mov %ax,6(%si) mov 0x7C26,%ax # SECTOR COUNT mov %ax,2(%si) mov 0x7C28,%ax # LOAD RBA mov %ax,8(%si) mov 0x7C2A,%ax mov %ax,10(%si) mov $0x42,%ah # EXTENDED READ int $0x13 # CALL DISK BIOS jc cderr call print_by_bios .string "Booting from CD.\n" xor %ax,%ax push %ax lret cderr: call print_by_bios .string "CD boot failed.\n" jmp error exread1: .short 0x10 # PACKET SIZE .short 1 # NUMBER OF BLOCKS .long 0x7C00 # BUFFER ADDRESS .quad 0x11 # LBA exread2: .short 0x10 # PACKET SIZE .short 1 # NUMBER OF BLOCKS .long 0x7C00 # BUFFER ADDRESS .quad 0 # LBA exread3: .short 0x10 # PACKET SIZE .short 0 # NUMBER OF BLOCKS .long 0 # BUFFER ADDRESS .quad 0 # LBA notcd: call print_by_bios .string "Loading boot loader.\n" mov $0x00,%ah # DRIVE RESET int $0x13 # CALL DISK BIOS jnc 1f # JUMP IF NO ERRORS call print_by_bios .string "Drive reset failed.\n" jmp error 1: mov $0x0201,%ax # READ, 1 SECTOR mov $0x0001,%cx # CYLINDER 0, SECTOR 1 mov $0x00,%dh # HEAD 0 mov $0x7C00,%bx # BUFFER AT 0x7C00 int $0x13 # CALL DISK BIOS jnc 1f # JUMP IF NO ERRORS 4: call print_by_bios .string "Read failed.\n" jmp error 1: pop %si test %si,%si je 1f mov $-0x40,%di 3: testb $0x80,0x7DFE(%di) je 2f mov $GUEST_BOOT_OFFSET + (exread1 - guest_boot_start),%si mov 0x7DFE+8(%di),%eax mov %eax,8(%si) mov $0x42,%ah # EXTENDED READ int $0x13 # CALL DISK BIOS jc 4b 1: call print_by_bios .string "Jamp to boot loader.\n" mov $0x7C00,%bx jmp *%bx # JUMP TO MASTER BOOT RECORD 2: add $0x10,%di jne 3b call print_by_bios .string "No active partition." jmp error error: xor %ax,%ax # GET KEYSTROKE int $0x16 # CALL KEYBOARD BIOS int $0x19 # BOOTSTRAP LOADER int $0x18 # ROM BASIC cli hlt 2: push %ax call print_by_bios .string "\r" pop %ax 1: push %dx mov $7,%bx # COLOR (GRAPHICS MODE ONLY) AND PAGE NUMBER mov $0x0E,%ah # TELETYPE OUTPUT int $0x10 # CALL VIDEO BIOS pop %dx print_by_bios: pop %si cld lodsb push %si cmp $'\n',%al je 2b test %al,%al jne 1b ret boot_using_int18: int $0x18 boot_32bit_kernel: push %esi push %edi call print_by_bios .string "Starting a kernel.\n" pop %edi pop %esi lgdtl GUEST_BOOT_OFFSET + (startkernel_gdtr - guest_boot_start) mov %cr0,%eax or $1,%eax mov %eax,%cr0 ljmp $8,$GUEST_BOOT_OFFSET + (1f - guest_boot_start) .code32 1: mov $0x10,%eax mov %ax,%ds mov %ax,%es mov %ax,%fs mov %ax,%gs mov %ax,%ss mov $GUEST_BOOT_OFFSET,%esp jmp *%edi .align 16 startkernel_gdtr: .short 0x17 .long GUEST_BOOT_OFFSET + (startkernel_gdt - guest_boot_start) .align 16 startkernel_gdt: .quad 0 .quad 0x00CF9B000000FFFF # 0x08 CODE32, DPL=0 .quad 0x00CF93000000FFFF # 0x10 DATA32, DPL=0 guest_boot_end: tinyvisor/vmm/core/keyboard.h0000644006644000001440000000340711733227577016606 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_KEYBOARD_H #define _CORE_KEYBOARD_H #define LED_SCROLLLOCK_BIT 1 #define LED_NUMLOCK_BIT 2 #define LED_CAPSLOCK_BIT 4 void setkbdled (int ledstatus); void keyboard_reset (void); #endif tinyvisor/vmm/core/process.h0000644006644000001440000000530311733245403016445 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_PROCESS_H #define _CORE_PROCESS_H #include #define NUM_OF_PID 32 #define NUM_OF_MSGDSC 32 #define NUM_OF_MSGDSCRECV 8 #define PROCESS_NAMELEN 32 enum msgcode { MSG_INT, MSG_BUF, }; void process_kill (bool (*func) (void *data), void *data); int newprocess (char *name); void exitprocess (int retval); ulong sys_msgsetfunc (ulong ip, ulong sp, ulong num, ulong si, ulong di); ulong sys_msgregister (ulong ip, ulong sp, ulong num, ulong si, ulong di); ulong sys_msgopen (ulong ip, ulong sp, ulong num, ulong si, ulong di); ulong sys_msgclose (ulong ip, ulong sp, ulong num, ulong si, ulong di); ulong sys_msgsendint (ulong ip, ulong sp, ulong num, ulong si, ulong di); ulong sys_msgret (ulong ip, ulong sp, ulong num, ulong si, ulong di); ulong sys_msgsenddesc (ulong ip, ulong sp, ulong num, ulong si, ulong di); ulong sys_newprocess (ulong ip, ulong sp, ulong num, ulong si, ulong di); ulong sys_msgsendbuf (ulong ip, ulong sp, ulong num, ulong si, ulong di); ulong sys_msgunregister (ulong ip, ulong sp, ulong num, ulong si, ulong di); ulong sys_exitprocess (ulong ip, ulong sp, ulong num, ulong si, ulong di); #endif tinyvisor/vmm/core/vt.h0000644006644000001440000000674411753454341015437 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_VT_H #define _CORE_VT_H #include #include "asm.h" enum intr_info_type { INTR_INFO_TYPE_EXTERNAL = 0, INTR_INFO_TYPE_NMI = 2, INTR_INFO_TYPE_HARD_EXCEPTION = 3, INTR_INFO_TYPE_SOFT_INTR = 4, INTR_INFO_TYPE_PRIV_SOFT_EXCEPTION = 5, INTR_INFO_TYPE_SOFT_EXCEPTION = 6, }; enum intr_info_err { INTR_INFO_ERR_INVALID = 0, INTR_INFO_ERR_VALID = 1, }; enum intr_info_valid { INTR_INFO_VALID_INVALID = 0, INTR_INFO_VALID_VALID = 1, }; struct vt_io_data { bool iobmpflag; phys_t iobmpphys[2]; void *iobmp[2]; }; struct vt_msr_entry { u32 index; u32 reserved; u64 data; } __attribute__ ((packed)); struct vt_msr { struct vt_msr_entry *vmm; struct vt_msr_entry *guest; int count; int efer, star, lstar, cstar, fmask, kerngs; }; struct vt_realmode_data { struct descreg idtr; ulong tr_limit, tr_acr, tr_base; }; struct intr_info { unsigned int vector : 8; enum intr_info_type type : 3; enum intr_info_err err : 1; unsigned int nmi_unblocking : 1; unsigned int reserved : 18; enum intr_info_valid valid : 1; } __attribute__ ((packed)); struct vt_intr_data { union { struct intr_info s; u32 v; } intr_info; u32 exception_errcode; u32 instruction_len; }; struct vt_vmcs_info { void *vmcs_region_virt; phys_t vmcs_region_phys; }; struct vt { struct vt_vmentry_regs vr; struct vt_vmcs_info vi; struct vt_realmode_data realmode; struct vt_intr_data intr; struct vt_io_data io; struct vt_msr msr; bool lme, lma; bool launched; bool ept_enabled; }; struct vt_pcpu_data { u32 vmcs_revision_identifier; void *vmxon_region_virt; phys_t vmxon_region_phys; phys_t vmcs_region_phys; }; struct vt_vm_data { spinlock_t ept_lock; phys_t ept_l4tbl; LIST2_DEFINE_HEAD(struct ept_tbl, ept_tbl_free_list); LIST2_DEFINE_HEAD(struct ept_tbl, ept_tbl_l1_list); }; int vt_available (void); void vt_vmctl_init (void); void vt_init (void); #endif tinyvisor/vmm/core/svm_np.h0000644006644000001440000000342111733245403016270 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_SVM_NP_H #define _CORE_SVM_NP_H #include void svm_np_init (void); void svm_np_pagefault (ulong err, ulong gphys); bool svm_np_tlbflush (void); void svm_np_updatecr3 (void); #endif tinyvisor/vmm/core/callrealmode_asm.s0000644006644000001440000001517411733227577020311 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ CALLREALMODE_OFFSET = 0xF000 CALLREALMODE_FUNC_PRINTMSG = 0x0 CALLREALMODE_FUNC_GETSYSMEMMAP = 0x1 CALLREALMODE_FUNC_GETSHIFTFLAGS = 0x2 CALLREALMODE_FUNC_SETVIDEOMODE = 0x3 CALLREALMODE_FUNC_REBOOT = 0x4 SEG_SEL_CODE_REAL = 0x0000 SEG_SEL_DATA_REAL = 0x0000 SEG_SEL_CODE16 = (6 * 8) SEG_SEL_DATA16 = (7 * 8) .globl callrealmode_start .globl callrealmode_end .text .code16 callrealmode_start: push %ebp mov %sp,%bp OFF_EBP = 0x00 OFF_EIP = 0x04 OFF_CS = 0x08 OFF_EDI = 0x0C OFF_ESI = 0x10 OFF_EBP = 0x14 OFF_ESP = 0x18 OFF_EBX = 0x1C OFF_EDX = 0x20 OFF_ECX = 0x24 OFF_EAX = 0x28 OFF_FUNC = 0x2C OFF_PRINTMSG_MESSAGE = 0x30 OFF_GETSYSMEMMAP_EBX = 0x30 OFF_GETSYSMEMMAP_EBX_RET = 0x34 OFF_GETSYSMEMMAP_FAIL = 0x38 OFF_GETSYSMEMMAP_DESC = 0x3C OFF_GETSHIFTFLAGS_AL_RET = 0x30 OFF_SETVIDEOMODE_AL = 0x30 # Which function? mov OFF_FUNC(%bp),%ax cmp $CALLREALMODE_FUNC_PRINTMSG,%ax je printmsg cmp $CALLREALMODE_FUNC_GETSYSMEMMAP,%ax je getsysmemmap cmp $CALLREALMODE_FUNC_GETSHIFTFLAGS,%ax je getshiftflags cmp $CALLREALMODE_FUNC_SETVIDEOMODE,%ax je setvideomode cmp $CALLREALMODE_FUNC_REBOOT,%ax je reboot # Error! cld mov $(errormsg_data-1-callrealmode_start+CALLREALMODE_OFFSET),%di mov %esp,%eax call hex32 mov $',',%al stosb mov %cs,%ax call hex16 mov $',',%al stosb mov %bp,%ax call hex16 mov $',',%al stosb lea OFF_FUNC(%bp),%si call lodswhex call lodswhex lea OFF_EBP(%bp),%si call lodslhex call lodslhex call lodslhex call lodslhex call lodslhex call lodslhex call lodslhex call lodslhex call lodslhex mov $0,%al stosb mov $(errormsg-callrealmode_start+CALLREALMODE_OFFSET),%si jmp printmsg_cont errormsg: .string "FUNCTION ERROR!\n" errormsg_data: .space 128 callrealmode_ret: pop %ebp lretl # Return to 32bit segment # printmsg # printmsg: mov OFF_PRINTMSG_MESSAGE(%bp),%si printmsg_cont: call paging_off call protection_off call init_pic sti # Set mode 80x25 text push %si mov $3,%ax int $0x10 # Try to set mode 1280x1024 graphics mov $0x4F02,%ax mov $0x0107,%bx int $0x10 1: pop %si # Print the message call print_si_by_bios # Halt 1: cli hlt jmp 1b # getsysmemmap # getsysmemmap: call paging_off call protection_off # Enable interrupts sti # Call int $0x15 stc mov $0xE820,%eax mov $0x534D4150,%edx mov OFF_GETSYSMEMMAP_EBX(%bp),%ebx mov $20,%ecx lea OFF_GETSYSMEMMAP_DESC(%bp),%di int $0x15 mov $1,%ax jc 1f xor %ax,%ax 1: mov %ax,OFF_GETSYSMEMMAP_FAIL(%bp) mov %ebx,OFF_GETSYSMEMMAP_EBX_RET(%bp) call protection_and_paging_on jmp callrealmode_ret # getshiftflags # getshiftflags: call paging_off call protection_off # Enable interrupts sti # Call int $0x16 mov $0x02,%ah int $0x16 mov %al,OFF_GETSHIFTFLAGS_AL_RET(%bp) call protection_and_paging_on jmp callrealmode_ret # setvideomode # setvideomode: mov OFF_SETVIDEOMODE_AL(%bp),%si call paging_off call protection_off call init_pic # Enable interrupts sti # Set mode 80x25 text push %si mov $3,%ax int $0x10 # Try to set mode 1280x1024 graphics mov $0x4F02,%ax mov $0x0107,%bx int $0x10 # Set video mode pop %ax mov $0x00,%ah int $0x10 call protection_and_paging_on jmp callrealmode_ret # reboot # reboot: call paging_off call protection_off ljmp $0xFFFF,$0x0 # Subroutines # paging_off: # PG BIT (PAGING) OFF mov %cr0,%eax and $0x7FFFFFFF,%eax mov %eax,%cr0 mov %cr3,%eax mov %eax,%cr3 ret protection_off: cli # PE BIT OFF mov %cr0,%eax and $0xFFFFFFFE,%eax mov %eax,%cr0 jmp 1f 1: ljmp $SEG_SEL_CODE_REAL,$1f-callrealmode_start+CALLREALMODE_OFFSET 1: # Load segment registers mov $SEG_SEL_DATA_REAL,%ax mov %ax,%ds mov %ax,%es mov %ax,%fs mov %ax,%gs mov %ax,%ss # Clear TS bit clts ret protection_and_paging_on: cli # PE BIT, TS BIT AND PG BIT ON mov %cr0,%eax or $0x80000009,%eax mov %eax,%cr0 jmp 1f 1: ljmp $SEG_SEL_CODE16,$1f-callrealmode_start+CALLREALMODE_OFFSET 1: # Load segment registers mov $SEG_SEL_DATA16,%ax mov %ax,%ds mov %ax,%es mov %ax,%ss xor %ax,%ax mov %ax,%fs mov %ax,%gs ret init_pic: # Initialize PIC master mov $0x11,%al # ICW1 out %al,$0x20 mov $8,%al # ICW2 out %al,$0x21 mov $4,%al # ICW3 out %al,$0x21 mov $1,%al # ICW4 out %al,$0x21 # Initialize PIC slave mov $0x11,%al # ICW1 out %al,$0xA0 mov $0x70,%al # ICW2 out %al,$0xA1 mov $2,%al # ICW3 out %al,$0xA1 mov $1,%al # ICW4 out %al,$0xA1 # Wait xor %cx,%cx 2: loop 2b # Disable interrupts mov $0xFF,%al out %al,$0x21 mov $0xFF,%al out %al,$0xA1 ret print_by_bios: pop %si call print_si_by_bios jmp *%si 1: call putchar_by_bios print_si_by_bios: cld lodsb test %al,%al jne 1b ret putchar_by_bios: cmp $'\n',%al jne 1f mov $'\r',%al call 1f mov $'\n',%al 1: push %si mov $7,%bx mov $0x0E,%ah int $0x10 pop %si ret hex32: rol $16,%eax call hex16 ror $16,%eax hex16: xchg %ah,%al call hex8 xchg %ah,%al hex8: rol $4,%al call hex4 ror $4,%al hex4: push %ax and $0xF,%al add $0x90,%al daa adc $0x40,%al daa stosb pop %ax ret lodswhex: lodsw call hex16 mov $'/',%al stosb ret lodslhex: lodsl call hex32 mov $'/',%al stosb ret callrealmode_end: tinyvisor/vmm/core/cpu.h0000644006644000001440000000343612070775077015575 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_CPU_H #define _CORE_CPU_H #include #include #define VECTOR_COUNT 256 vmmerr_t monitor_size(size_t *max, size_t *min); void setup_monitor (void *addr); void wait_for_updating (void); #endif tinyvisor/vmm/core/tty.c0000644006644000001440000000710012143714154015577 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include "putchar.h" #include "serial.h" #include "tty.h" #include "vramwrite.h" static int ttyin, ttyout; static unsigned char log[65536]; static int logoffset, loglen; static spinlock_t putchar_lock; static bool logflag; static int ttyin_msghandler (int m, int c) { if (m == 0) return msgsendint (ttyin, c); return 0; } static int ttyout_msghandler (int m, int c) { if (m == 0) { #ifdef TTY_SERIAL serial_putchar (c); #endif vramwrite_putchar (c); } return 0; } static int ttylog_msghandler (int m, int c, void *recvbuf, int recvlen, void *sendbuf, int sendlen) { int i; unsigned char *q; if (m == 1) { q = sendbuf; for (i = 0; i < sendlen && i < loglen; i++) q[i] = log[(logoffset + i) % sizeof log]; } return loglen; } void ttylog_stop (void) { logflag = false; } void tty_putchar (unsigned char c) { if (logflag) { spinlock_lock (&putchar_lock); log[(logoffset + loglen) % sizeof log] = c; if (loglen == sizeof log) logoffset = (logoffset + 1) % sizeof log; else loglen++; spinlock_unlock (&putchar_lock); } #ifdef TTY_SERIAL serial_putchar (c); #endif vramwrite_putchar (c); } static void tty_init_global2 (void) { char buf[100]; snprintf (buf, 100, "tty:log=%p,logoffset=%p,loglen=%p,logmax=%lu\n", log, &logoffset, &loglen, (unsigned long)sizeof log); } void tty_init_global (void) { logoffset = 0; loglen = 0; logflag = true; spinlock_init (&putchar_lock); #ifdef TTY_SERIAL serial_init_global(); #endif vramwrite_init_global(); putchar_set_func (tty_putchar, NULL); } static void tty_init_msg (void) { #ifdef TTY_SERIAL ttyin = msgopen ("serialin"); ttyout = msgopen ("serialout"); #else ttyin = msgopen ("keyboard"); ttyout = msgopen ("vramwrite"); #endif msgregister ("ttyin", ttyin_msghandler); msgregister ("ttyout", ttyout_msghandler); msgregister ("ttylog", ttylog_msghandler); } INITFUNC ("global3", tty_init_global2); INITFUNC ("msg1", tty_init_msg); tinyvisor/vmm/core/svm.c0000644006644000001440000001211411771577030015573 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include "asm.h" #include "cpu_emul.h" #include "cpuid.h" #include "current.h" #include "panic.h" #include "svm.h" #include "svm_init.h" #include "svm_io.h" #include "svm_main.h" #include "svm_msr.h" #include "svm_panic.h" #include "svm_regs.h" #include "vmctl.h" #define UNIMPLEMENTED() do { \ panic ("DEBUG : file %s line %d function %s NOT IMPLEMENTED", \ __FILE__, __LINE__, __FUNCTION__); \ } while (0) static void svm_generate_pagefault (ulong err, ulong cr2); static void svm_extint_pending (bool pending); static bool svm_extint_is_blocked (); static void svm_generate_external_int (vector_t num); static void svm_tsc_offset_changed (void); static struct vmctl_func func = { .vminit = svm_vminit, .vmexit = svm_vmexit, .run_vm = svm_run_vm, .generate_pagefault = svm_generate_pagefault, .generate_external_int = svm_generate_external_int, .read_general_reg = svm_read_general_reg, .write_general_reg = svm_write_general_reg, .read_control_reg = svm_read_control_reg, .write_control_reg = svm_write_control_reg, .read_sreg_sel = svm_read_sreg_sel, .read_sreg_acr = svm_read_sreg_acr, .read_sreg_base = svm_read_sreg_base, .read_sreg_limit = svm_read_sreg_limit, .spt_setcr3 = svm_spt_setcr3, .read_ip = svm_read_ip, .write_ip = svm_write_ip, .read_flags = svm_read_flags, .write_flags = svm_write_flags, .read_gdtr = svm_read_gdtr, .write_gdtr = svm_write_gdtr, .read_idtr = svm_read_idtr, .write_idtr = svm_write_idtr, .write_realmode_seg = svm_write_realmode_seg, .writing_sreg = svm_writing_sreg, .read_msr = svm_read_msr, .write_msr = svm_write_msr, .cpuid = call_cpuid, .extint_pending = svm_extint_pending, .extint_is_blocked = svm_extint_is_blocked, .extern_iopass = svm_extern_iopass, .tsc_offset_changed = svm_tsc_offset_changed, .panic_dump = svm_panic_dump, .invlpg = svm_invlpg, .reset = svm_reset, }; static void svm_generate_pagefault (ulong err, ulong cr2) { struct svm_intr_data *sid = ¤t->u.svm.intr; sid->intr_info.v = 0; sid->intr_info.s.vector = EXCEPTION_PF; sid->intr_info.s.type = VMCB_EVENTINJ_TYPE_EXCEPTION; sid->intr_info.s.ev = 1; sid->intr_info.s.v = 1; sid->intr_info.s.errorcode = (u32)err; current->u.svm.vi.vmcb->cr2 = cr2; } static void svm_extint_pending (bool pending) { if (pending) { current->u.svm.vi.vmcb->v_irq = 1; current->u.svm.vi.vmcb->v_ign_tpr = 1; current->u.svm.vi.vmcb->intercept_vintr = 1; } else { current->u.svm.vi.vmcb->v_irq = 0; current->u.svm.vi.vmcb->intercept_vintr = 0; } } static bool svm_extint_is_blocked (void) { ulong rflags; svm_read_flags (&rflags); return (!(rflags & RFLAGS_IF_BIT) || current->u.svm.vi.vmcb->interrupt_shadow || current->u.svm.intr.intr_info.s.v == 1); } static void svm_generate_external_int (vector_t vector) { struct svm_intr_data *sid = ¤t->u.svm.intr; if (sid->intr_info.s.v == 1) { panic ("Can't inject external interrupt because the other event is already pending. " "vector 0x%x type 0x%x, ev 0x%x", sid->intr_info.s.vector, sid->intr_info.s.type, sid->intr_info.s.ev); } sid->intr_info.v = 0; sid->intr_info.s.vector = vector; sid->intr_info.s.type = VMCB_EVENTINJ_TYPE_INTR; sid->intr_info.s.ev = 0; sid->intr_info.s.v = 1; } static void svm_tsc_offset_changed (void) { current->u.svm.vi.vmcb->tsc_offset = current->tsc_offset; } void svm_vmctl_init (void) { memcpy ((void *)¤t->vmctl, (void *)&func, sizeof func); } tinyvisor/vmm/core/mmio.h0000644006644000001440000000424311733245403015732 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_MMIO_H #define _CORE_MMIO_H #include #include #define MMIO_INDEX(gphysaddr) \ (gphysaddr <= 0xFFFFFFFFULL ? gphysaddr >> 28 : 16) struct mmio_handle { LIST1_DEFINE (struct mmio_handle); phys_t gphys; uint len; void *data; mmio_handler_t *handler; }; struct mmio_data { LIST1_DEFINE_HEAD (struct mmio_handle, mmio[17]); }; int mmio_access_memory (phys_t gphysaddr, bool wr, void *buf, uint len, u32 flags); vmmerr_t mmio_pagefault(phys_t gphysaddr); void mmio_lock (void); void mmio_unlock (void); #endif tinyvisor/vmm/core/cpu_emul.c0000644006644000001440000001104712165305216016574 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include "constants.h" #include "convert.h" #include "cpu_emul.h" #include "cpu_mmu.h" #include "cpu_stack.h" #include "current.h" #include "regs.h" #include "panic.h" void cpu_emul_cpuid (void) { u32 ia, ic, oa, ob, oc, od; ulong la, lc; current->vmctl.read_general_reg (GENERAL_REG_RAX, &la); current->vmctl.read_general_reg (GENERAL_REG_RCX, &lc); ia = la; ic = lc; current->vmctl.cpuid (ia, ic, &oa, &ob, &oc, &od); current->vmctl.write_general_reg (GENERAL_REG_RAX, oa); current->vmctl.write_general_reg (GENERAL_REG_RBX, ob); current->vmctl.write_general_reg (GENERAL_REG_RCX, oc); current->vmctl.write_general_reg (GENERAL_REG_RDX, od); } bool cpu_emul_rdmsr (void) { u32 ic, oa, od; ulong lc; u64 msrdata; bool err; /* FIXME: Privilege check */ current->vmctl.read_general_reg (GENERAL_REG_RCX, &lc); ic = lc; err = current->vmctl.read_msr (ic, &msrdata); conv64to32 (msrdata, &oa, &od); current->vmctl.write_general_reg (GENERAL_REG_RAX, oa); current->vmctl.write_general_reg (GENERAL_REG_RDX, od); return err; } bool cpu_emul_wrmsr (void) { ulong ic, ia, id; u64 msrdata; bool err; /* FIXME: Privilege check */ current->vmctl.read_general_reg (GENERAL_REG_RCX, &ic); current->vmctl.read_general_reg (GENERAL_REG_RAX, &ia); current->vmctl.read_general_reg (GENERAL_REG_RDX, &id); conv32to64 (ia, id, &msrdata); err = current->vmctl.write_msr (ic, msrdata); return err; } void cpu_emul_hlt (void) { current->halt = true; } void cpu_emul_cli (void) { ulong rflags; current->vmctl.read_flags (&rflags); rflags &= ~RFLAGS_IF_BIT; current->vmctl.write_flags (rflags); } void cpu_emul_sti (void) { ulong rflags; current->vmctl.read_flags (&rflags); rflags |= RFLAGS_IF_BIT; current->vmctl.write_flags (rflags); } vmmerr_t cpu_emul_realmode_int (u8 num) { u16 seg, off; ulong rflags, rip; u16 cs; ulong idtr_base, idtr_limit; struct cpu_stack st; /* FIXME: IDTR LIMIT CHECK */ /* FIXME: stack limit check */ current->vmctl.read_idtr (&idtr_base, &idtr_limit); RIE (read_linearaddr_w (idtr_base + ((u32)num << 2) + 0, &off)); RIE (read_linearaddr_w (idtr_base + ((u32)num << 2) + 2, &seg)); current->vmctl.read_flags (&rflags); current->vmctl.read_sreg_sel (SREG_CS, &cs); current->vmctl.read_ip (&rip); RIE (cpu_stack_get (&st)); RIE (cpu_stack_push (&st, &rflags, OPTYPE_16BIT)); RIE (cpu_stack_push (&st, &cs, OPTYPE_16BIT)); RIE (cpu_stack_push (&st, &rip, OPTYPE_16BIT)); current->vmctl.write_realmode_seg (SREG_CS, seg); current->vmctl.write_ip (off); rflags &= ~(RFLAGS_TF_BIT | RFLAGS_AC_BIT); current->vmctl.write_flags (rflags); RIE (cpu_stack_set (&st)); cpu_emul_cli (); return VMMERR_SUCCESS; } /* Copy from bitvisor 1.3 and modify */ void cpu_emul_xsetbv (void) { u32 ia, ic, id; ulong la, lc, ld; current->vmctl.read_general_reg (GENERAL_REG_RAX, &la); current->vmctl.read_general_reg (GENERAL_REG_RCX, &lc); current->vmctl.read_general_reg (GENERAL_REG_RDX, &ld); ia = la; ic = lc; id = ld; asm_xsetbv (ic, ia, id); } tinyvisor/vmm/core/callrealmode.c0000644006644000001440000001120112011203114017357 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include "asm.h" #include "callrealmode.h" #include "callrealmode_asm.h" #include "entry.h" #include "mm.h" #include "seg.h" static void callrealmode_copy (void) { memcpy ((u8 *)CALLREALMODE_OFFSET, callrealmode_start, callrealmode_end - callrealmode_start); } /* interrupts must be disabled */ static void callrealmode_call (struct callrealmode_data *d) { ulong sp16; u32 sp32; ulong idtr_base, idtr_limit; ulong cr3; asm_rdcr3 (&cr3); asm_wrcr3 (vmm_base_cr3); callrealmode_copy (); sp16 = CALLREALMODE_OFFSET - sizeof *d; memcpy ((u8 *)sp16, d, sizeof *d); asm_rdidtr (&idtr_base, &idtr_limit); asm_wridtr (0, 0x3FF); asm volatile ( #ifdef __x86_64__ "push %%rax\n" "push %%rbx\n" "push %%rcx\n" "push %%rdx\n" "push %%rbp\n" "push %%rsi\n" "push %%rdi\n" "push %%r8\n" "push %%r9\n" "push %%r10\n" "push %%r11\n" "push %%r12\n" "push %%r13\n" "push %%r14\n" "push %%r15\n" "push $2f\n" "movl %8,4(%%rsp)\n" "push %7\n" "push $1f\n" "lretq\n" ".code32\n" "1:\n" #endif "mov %%esp,%0\n" "mov %1,%%ds\n" "mov %1,%%es\n" "mov %1,%%fs\n" "mov %1,%%gs\n" "mov %1,%%ss\n" "mov %2,%%esp\n" "pusha\n" "lcall %3,%4\n" "popa\n" "mov %5,%%ds\n" "mov %5,%%es\n" "mov %5,%%fs\n" "mov %6,%%gs\n" "mov %5,%%ss\n" "mov %0,%%esp\n" #ifdef __x86_64__ "lretl\n" ".code64\n" "2:\n" "pop %%r15\n" "pop %%r14\n" "pop %%r13\n" "pop %%r12\n" "pop %%r11\n" "pop %%r10\n" "pop %%r9\n" "pop %%r8\n" "pop %%rdi\n" "pop %%rsi\n" "pop %%rbp\n" "pop %%rdx\n" "pop %%rcx\n" "pop %%rbx\n" "pop %%rax\n" #endif : "=&a" (sp32) /* 0 */ : "b" ((u32)SEG_SEL_DATA16) , "c" ((u32)sp16) , "i" (SEG_SEL_CODE16) , "i" (CALLREALMODE_OFFSET) , "d" ((u32)SEG_SEL_DATA32) /* 5 */ , "S" ((u32)SEG_SEL_PCPU32) , "i" (SEG_SEL_CODE32) , "i" (SEG_SEL_CODE64) : "cc", "memory"); #ifdef __x86_64__ asm_wrds (SEG_SEL_DATA64); asm_wres (SEG_SEL_DATA64); asm_wrfs (SEG_SEL_DATA64); asm_wrgs (SEG_SEL_PCPU64); asm_wrss (SEG_SEL_DATA64); #endif asm_wridtr (idtr_base, idtr_limit); memcpy (d, (u8 *)sp16, sizeof *d); asm_wrcr3 (cr3); } void callrealmode_printmsg (u32 message) { struct callrealmode_data d; d.func = CALLREALMODE_FUNC_PRINTMSG; d.u.printmsg.message = message; callrealmode_call (&d); } int callrealmode_getsysmemmap (u32 ebx, struct e820map *m, u32 *ebx_ret) { struct callrealmode_data d; d.func = CALLREALMODE_FUNC_GETSYSMEMMAP; d.u.getsysmemmap.ebx = ebx; callrealmode_call (&d); *ebx_ret = d.u.getsysmemmap.ebx_ret; memcpy (m, &d.u.getsysmemmap.desc, sizeof *m); return d.u.getsysmemmap.fail & 0xFFFF; } int callrealmode_getshiftflags (void) { struct callrealmode_data d; d.func = CALLREALMODE_FUNC_GETSHIFTFLAGS; callrealmode_call (&d); return d.u.getshiftflags.al_ret; } void callrealmode_setvideomode (int mode) { struct callrealmode_data d; d.func = CALLREALMODE_FUNC_SETVIDEOMODE; d.u.setvideomode.al = mode; callrealmode_call (&d); } void callrealmode_reboot (void) { struct callrealmode_data d; d.func = CALLREALMODE_FUNC_REBOOT; callrealmode_call (&d); } tinyvisor/vmm/core/svm_msr.h0000644006644000001440000000345711733245403016465 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_SVM_MSR_H #define _CORE_SVM_MSR_H struct svm_msr { void *msrbmp; phys_t msrbmp_phys; }; void svm_msr_update_lma (void); bool svm_read_msr (u32 msrindex, u64 *msrdata); bool svm_write_msr (u32 msrindex, u64 msrdata); #endif tinyvisor/vmm/core/mm.h0000644006644000001440000001257012011203114015363 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_MM_H #define _CORE_MM_H #include #include #include "constants.h" #include /* * Virtual address space map on x86_64 * * 0x81_0000_0000 +-------------------+ * | hphys | NUM_OF_HPHYS_ * | | PAGES * 4096 * 0x80_0000_0000 (HPHYS_ADDR) +-------------------+ * | | * 0x00_A000_0000 (MAPMEM_ADDR_END) +-------------------+ * | mapmem | * 0x00_8000_0000 (MAPMEM_ADDR_START) +-------------------+ * | | * 0x00_4800_0000 +-------------------+ * | | VMMSIZE_ALL * (end) | +---------------+ | * | | text/data/bss | | * 0x00_4100_0000 (head) | +---------------+ | * | vmm | * 0x00_4000_0000 (VMM_START_VIRT) +-------------------+ * * * Virtual address space map on x86_32 * * 0xA000_0000 (MAPMEM_ADDR_END) -------------------- * | mapmem | * 0x8000_0000 (MAPMEM_ADDR_START) +-------------------+ * | | * 0x4800_0000 +-------------------+ * | | VMMSIZE_ALL * (end) | +---------------+ | * | | text/data/bss | | * 0x4100_0000 (head) | +---------------+ | * | vmm | * 0x4000_0000 (VMM_START_VIRT) +-------------------+ */ #ifdef __x86_64__ # define PDPE_ATTR (PDE_P_BIT | PDE_RW_BIT | PDE_US_BIT) # define NUM_OF_HPHYS_PAGES (1 * 1024 * 1024) # define HPHYS_ADDR (1ULL << (12 + 9 + 9 + 9)) #else # define PDPE_ATTR PDE_P_BIT # define NUM_OF_HPHYS_PAGES 0 # define HPHYS_ADDR 0 #endif # define PMAP_LEVELS (sizeof (ulong) == 4 ? 3 : 4) # define PDE_PS_OFFSET_MASK PDE_2M_OFFSET_MASK # define PDE_PS_ADDR_MASK PDE_2M_ADDR_MASK #define VMM_START_VIRT 0x40000000 #define VMMSIZE_ALL (128 * 1024 * 1024) /* #define VMMSIZE_ALL (256 * 1024 * 1024) */ #define NUM_OF_PAGES (VMMSIZE_ALL >> PAGESIZE_SHIFT) #define MAPMEM_ADDR_START 0x80000000 #define MAPMEM_ADDR_END 0xA0000000 enum page_type { PAGE_TYPE_FREE, PAGE_TYPE_NOT_HEAD, PAGE_TYPE_ALLOCATED, PAGE_TYPE_RESERVED, }; struct page { LIST1_DEFINE (struct page); enum page_type type; int allocsize; phys_t phys; virt_t virt; }; enum pmap_type { PMAP_TYPE_VMM, PMAP_TYPE_GUEST, PMAP_TYPE_GUEST_ATOMIC, }; typedef struct { u64 entry[5]; phys_t entryaddr[4]; virt_t curaddr; int curlevel; int readlevel; int levels; enum pmap_type type; } pmap_t; phys_t sym_to_phys (void *sym); bool phys_in_vmm (phys_t phys); int num_of_available_pages (void); phys32_t mm_top_of_low_avail_mem(); /* process */ int mm_process_alloc (phys_t *phys); void mm_process_free (phys_t phys); int mm_process_map_alloc (virt_t virt, uint len); int mm_process_unmap (virt_t virt, uint len); void mm_process_unmapall (void); virt_t mm_process_map_stack (uint len); int mm_process_unmapstack (virt_t virt, uint len); int mm_process_map_shared_physpage (virt_t virt, phys_t phys, bool rw); void *mm_process_map_shared (phys_t procphys, void *buf, uint len, bool rw); phys_t mm_process_switch (phys_t switchto); /* accessing page tables */ void pmap_open_vmm (pmap_t *m, ulong cr3, int levels); void pmap_open_guest (pmap_t *m, ulong cr3, int levels, bool atomic); void pmap_close (pmap_t *m); int pmap_getreadlevel (pmap_t *m); void pmap_setlevel (pmap_t *m, int level); void pmap_setvirt (pmap_t *m, virt_t virtaddr, int level); u64 pmap_read (pmap_t *m); bool pmap_write (pmap_t *m, u64 e, uint attrmask); void pmap_clear (pmap_t *m); vmmerr_t pmap_autoalloc (pmap_t *m); void *pmap_pointer (pmap_t *m); void pmap_dump (pmap_t *m); struct page *mm_page_alloc (int n); void mm_page_free (struct page *p); struct page *virt_to_page (virt_t virt); struct page *phys_to_page (phys_t phys); virt_t page_to_virt (struct page *p); phys_t page_to_phys (struct page *p); void mm_alloc_init (void); u64 mm_cache_flag_to_pte_attr (int flags); void mm_dump_mem_address_space(void); #endif tinyvisor/vmm/core/svm_main.h0000644006644000001440000000325611733245403016605 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_SVM_MAIN_H #define _CORE_SVM_MAIN_H void svm_invlpg (ulong addr); void svm_run_vm (void); #endif tinyvisor/vmm/core/gbiosloader.c0000644006644000001440000000556512140421510017252 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #include #include #include #include #include #include #include "mm.h" #include "gbiosloader.h" #define GBIOS_GPHYS_END 0xfffff #define GBIOS_MAX_SIZE 0x20000 static void *saved_gbios = 0; static size_t gbios_size; void gbios_save (u32 start, u32 size) { void *tmp; if (size > GBIOS_MAX_SIZE) { panic("Guest BIOS is too large."); } saved_gbios = alloc (size); if (saved_gbios == NULL) { panic("Failed to allocate guest BIOS save area."); } tmp = mapmem (MAPMEM_HPHYS, start, size); if (tmp == NULL) { panic("Failed to map guest BIOS loaded by GRUB or another loader."); } memcpy (saved_gbios, tmp, size); gbios_size = size; unmapmem (tmp, size); return; } void gbios_load (void) { phys_t gphys_start; void *start; if (cpu_is_bsp()) { /* * VM0 boots with host BIOS. */ return; } if (saved_gbios == NULL) { panic("Guest BIOS is not loaded by GRUB or another loader"); } gphys_start = GBIOS_GPHYS_END + 1 - gbios_size; start = mapmem(MAPMEM_GPHYS, gphys_start, gbios_size); if (start == NULL) { panic("Failed to map guest BIOS area."); } memcpy(start, saved_gbios, gbios_size); unmapmem(start, gbios_size); } INITFUNC("passvm2", gbios_load); tinyvisor/vmm/core/svm_vmcb.h0000644006644000001440000002115111733245403016602 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_SVM_VMCB_H #define _CORE_SVM_VMCB_H #include enum vmcb_tlb_control { VMCB_TLB_CONTROL_DO_NOTHING = 0, VMCB_TLB_CONTROL_FLUSH_TLB = 1, }; enum vmcb_eventinj_type { VMCB_EVENTINJ_TYPE_INTR = 0, VMCB_EVENTINJ_TYPE_NMI = 2, VMCB_EVENTINJ_TYPE_EXCEPTION = 3, VMCB_EVENTINJ_TYPE_SOFT_INTR = 4, }; struct vmcb_seg { u16 sel; u16 attr; u32 limit; u64 base; } __attribute__ ((packed)); struct vmcb { /* VMCB Control Area */ /* 0x000 */ u16 intercept_read_cr; u16 intercept_write_cr; /* 0x004 */ u16 intercept_read_dr; u16 intercept_write_dr; /* 0x008 */ u32 intercept_exception; /* 0x00C */ unsigned int intercept_intr : 1; /* 0 */ unsigned int intercept_nmi : 1; unsigned int intercept_smi : 1; unsigned int intercept_init : 1; unsigned int intercept_vintr : 1; /* 4 */ unsigned int intercept_cr0_ts_or_mp : 1; unsigned int intercept_rd_idtr : 1; unsigned int intercept_rd_gdtr : 1; unsigned int intercept_rd_ldtr : 1; /* 8 */ unsigned int intercept_rd_tr : 1; unsigned int intercept_wr_idtr : 1; unsigned int intercept_wr_gdtr : 1; unsigned int intercept_wr_ldtr : 1; /* 12 */ unsigned int intercept_wr_tr : 1; unsigned int intercept_rdtsc : 1; unsigned int intercept_rdpmc : 1; unsigned int intercept_pushf : 1; /* 16 */ unsigned int intercept_popf : 1; unsigned int intercept_cpuid : 1; unsigned int intercept_rsm : 1; unsigned int intercept_iret : 1; /* 20 */ unsigned int intercept_int_n : 1; unsigned int intercept_invd : 1; unsigned int intercept_pause : 1; unsigned int intercept_hlt : 1; /* 24 */ unsigned int intercept_invlpg : 1; unsigned int intercept_invlpga : 1; unsigned int intercept_ioio_prot : 1; unsigned int intercept_msr_prot : 1; /* 28 */ unsigned int intercept_task_switches : 1; unsigned int intercept_ferr_freeze : 1; unsigned int intercept_shutdown : 1; /* 0x010 */ unsigned int intercept_vmrun : 1; /* 0 */ unsigned int intercept_vmmcall : 1; unsigned int intercept_vmload : 1; unsigned int intercept_vmsave : 1; unsigned int intercept_stgi : 1; /* 4 */ unsigned int intercept_clgi : 1; unsigned int intercept_skinit : 1; unsigned int intercept_rdtscp : 1; unsigned int intercept_icebp : 1; /* 8 */ unsigned int intercept_wbinvd : 1; unsigned int intercept_monitor : 1; unsigned int intercept_mwait_uncond : 1; unsigned int intercept_mwait : 1; /* 12 */ unsigned int reserved010 : 19; /* 31-13 */ /* 0x014 */ u32 reserved01[3]; /* 0x014 */ u32 reserved02[4]; /* 0x020 */ u32 reserved03[4]; /* 0x030 */ u64 iopm_base_pa; /* 0x040 */ u64 msrpm_base_pa; /* 0x048 */ u64 tsc_offset; /* 0x050 */ /* 0x058 */ unsigned int guest_asid : 32; /* 31-0 */ enum vmcb_tlb_control tlb_control : 8; /* 39-32 */ unsigned int reserved058 : 24; /* 63-40 */ /* 0x060 */ unsigned int v_tpr : 8; /* 7-0 */ unsigned int v_irq : 1; /* 8 */ unsigned int reserved060_9 : 7; /* 15-9 */ unsigned int v_intr_prio : 4; /* 19-16 */ unsigned int v_ign_tpr : 1; /* 20 */ unsigned int reserved060_21 : 3; /* 23-21 */ unsigned int v_intr_masking : 1; /* 24 */ unsigned int reserved060_25 : 7; /* 31-25 */ unsigned int v_intr_vector : 8; /* 39-32 */ unsigned int reserved060_40 : 24; /* 63-40 */ /* 0x068 */ unsigned int interrupt_shadow : 1; /* 0 */ u64 reserved068 : 63; /* 63-1 */ /* 0x070 */ u64 exitcode; /* 0x070 */ u64 exitinfo1; /* 0x078 */ u64 exitinfo2; /* 0x080 */ u64 exitintinfo; /* 0x088 */ /* 0x090 */ unsigned int np_enable : 1; /* 0 */ u64 reserved090 : 63; /* 63-1 */ /* 0x098 */ u32 reserved09[2]; /* 0x098 */ u32 reserved0a[2]; /* 0x0A0 */ u64 eventinj; /* 0x0A8 */ u64 n_cr3; /* 0x0B0 */ /* 0x0B8 */ unsigned int lbr_virtualization_enable : 1; /* 0 */ u64 reserved0b8 : 63; /* 63-1 */ /* 0x0C0 */ u32 reserved0c[4]; /* 0x0C0 */ u32 reserved0d[4]; /* 0x0D0 */ u32 reserved0e[4]; /* 0x0E0 */ u32 reserved0f[4]; /* 0x0F0 */ u32 reserved1[64]; /* 0x100 */ u32 reserved2[64]; /* 0x200 */ u32 reserved3[64]; /* 0x300 */ /* VMCB State Save Area */ struct vmcb_seg es; /* 0x400 */ struct vmcb_seg cs; /* 0x410 */ struct vmcb_seg ss; /* 0x420 */ struct vmcb_seg ds; /* 0x430 */ struct vmcb_seg fs; /* 0x440 */ struct vmcb_seg gs; /* 0x450 */ struct vmcb_seg gdtr; /* 0x460 */ struct vmcb_seg ldtr; /* 0x470 */ struct vmcb_seg idtr; /* 0x480 */ struct vmcb_seg tr; /* 0x490 */ u32 reserved4a[4]; /* 0x4A0 */ u32 reserved4b[4]; /* 0x4B0 */ u32 reserved4c_0[2]; /* 0x4C0 */ u8 reserved4c_8[3]; /* 0x4C8 */ u8 cpl; /* 0x4CB */ u32 reserved4c_c; /* 0x4CC */ u64 efer; /* 0x4D0 */ u32 reserved4d[2]; /* 0x4D8 */ u32 reserved4e[4]; /* 0x4E0 */ u32 reserved4f[4]; /* 0x4F0 */ u32 reserved50[4]; /* 0x500 */ u32 reserved51[4]; /* 0x510 */ u32 reserved52[4]; /* 0x520 */ u32 reserved53[4]; /* 0x530 */ u32 reserved54[2]; /* 0x540 */ u64 cr4; /* 0x548 */ u64 cr3; /* 0x550 */ u64 cr0; /* 0x558 */ u64 dr7; /* 0x560 */ u64 dr6; /* 0x568 */ u64 rflags; /* 0x570 */ u64 rip; /* 0x578 */ u32 reserved58[4]; /* 0x580 */ u32 reserved59[4]; /* 0x590 */ u32 reserved5a[4]; /* 0x5A0 */ u32 reserved5b[4]; /* 0x5B0 */ u32 reserved5c[4]; /* 0x5C0 */ u32 reserved5d[2]; /* 0x5D0 */ u64 rsp; /* 0x5D8 */ u32 reserved5e[4]; /* 0x5E0 */ u32 reserved5f[2]; /* 0x5F0 */ u64 rax; /* 0x5F8 */ u64 star; /* 0x600 */ u64 lstar; /* 0x608 */ u64 cstar; /* 0x610 */ u64 sfmask; /* 0x618 */ u64 kernel_gs_base; /* 0x620 */ u64 sysenter_cs; /* 0x628 */ u64 sysenter_esp; /* 0x630 */ u64 sysenter_eip; /* 0x638 */ u64 cr2; /* 0x640 */ u32 reserved64[2]; /* 0x648 */ u32 reserved65[4]; /* 0x650 */ u32 reserved66[2]; /* 0x660 */ u64 g_pat; /* 0x668 */ u64 dbgctl; /* 0x670 */ u64 br_from; /* 0x678 */ u64 br_to; /* 0x680 */ u64 lastexcpfrom; /* 0x688 */ u64 lastexcpto; /* 0x690 */ u32 reserved69[2]; /* 0x698 */ u32 reserved6a[4]; /* 0x6A0 */ u32 reserved6b[4]; /* 0x6B0 */ u32 reserved6c[4]; /* 0x6C0 */ u32 reserved6d[4]; /* 0x6D0 */ u32 reserved6e[4]; /* 0x6E0 */ u32 reserved6f[4]; /* 0x6F0 */ u32 reserved7[64]; /* 0x700 */ u32 reserved8[64]; /* 0x800 */ u32 reserved9[64]; /* 0x900 */ u32 reserveda[64]; /* 0xA00 */ u32 reservedb[64]; /* 0xB00 */ u32 reservedc[64]; /* 0xC00 */ u32 reservedd[64]; /* 0xD00 */ u32 reservede[64]; /* 0xE00 */ u32 reservedf[64]; /* 0xF00 */ } __attribute__ ((packed)); struct exitinfo1_ioio { unsigned int type_in : 1; unsigned int zero : 1; unsigned int str : 1; unsigned int rep : 1; unsigned int sz8 : 1; unsigned int sz16 : 1; unsigned int sz32 : 1; unsigned int a16 : 1; unsigned int a32 : 1; unsigned int a64 : 1; unsigned int reserved1 : 6; unsigned int port : 16; } __attribute__ ((packed)); struct exitinfo2_task_switch { unsigned int err : 32; unsigned int reserved1 : 4; unsigned int iret : 1; unsigned int reserved2 : 1; unsigned int jump : 1; unsigned int reserved3 : 5; unsigned int has_err : 1; unsigned int reserved4 : 3; unsigned int rf : 1; unsigned int reserved5 : 15; } __attribute__ ((packed)); struct vmcb_eventinj { unsigned int vector : 8; enum vmcb_eventinj_type type : 3; unsigned int ev : 1; unsigned int reserved1 : 19; unsigned int v : 1; unsigned int errorcode : 32; } __attribute__ ((packed)); #endif tinyvisor/vmm/core/vmmcall_log.c0000644006644000001440000001242711733245403017263 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include "current.h" #include "mm.h" #include "putchar.h" #include "vmmcall.h" static putchar_func_t old; static u8 *buf; static ulong bufsize, offset; static void log_putchar (unsigned char c) { if (buf) { buf[offset++] = c; if (offset >= bufsize) offset = 4; asm_lock_incl ((u32 *)(void *)buf); } old (c); } static void log_set_buf (void) { u16 cs; ulong physaddr; current->vmctl.read_sreg_sel (SREG_CS, &cs); if (cs & 3) return; if (buf != NULL) { unmapmem (buf, bufsize); buf = NULL; } current->vmctl.read_general_reg (GENERAL_REG_RBX, &physaddr); current->vmctl.read_general_reg (GENERAL_REG_RCX, &bufsize); if (physaddr == 0 || bufsize == 0) return; buf = mapmem_gphys (physaddr, bufsize, MAPMEM_WRITE); if (buf == NULL) { return; } offset = 4; if (old == NULL) putchar_set_func (log_putchar, &old); } static void vmmcall_log_init (void) { old = NULL; buf = NULL; vmmcall_register ("log_set_buf", log_set_buf); } INITFUNC ("vmmcal0", vmmcall_log_init); /************************************************************ #include #include #include #include #include struct log_buf { u32 n; char buf[65536 - 4]; }; static u32 callnum; static u32 offset; static volatile struct log_buf *buf; static atomic_t exit_logget_linux_flag; static struct semaphore exit_logget_linux_sem; static struct delayed_work logget_linux_work; static int getchar_logget_linux (void) { u8 c; if (buf->n) { c = buf->buf[offset++]; if (offset >= sizeof buf->buf) offset = 0; asm volatile ("lock decl %0" : : "m" (buf->n) : "memory"); return c; } else { return -1; } } static void logget_linux_polling (struct work_struct *unused) { int c; static char linebuf[256]; static int lineoff = 0; while ((c = getchar_logget_linux ()) != -1) { if (lineoff == sizeof linebuf - 1 || c == '\n') { linebuf[lineoff] = '\0'; printk (KERN_INFO "VMM: %s\n", linebuf); lineoff = 0; if (c == '\n') continue; } linebuf[lineoff++] = c ? c : ' '; } if (atomic_read (&exit_logget_linux_flag)) { printk ("\nlogget_linux_polling: exiting\n"); up (&exit_logget_linux_sem); } else { schedule_delayed_work (&logget_linux_work, 1); } } static int __init logget_linux_init (void) { asm volatile ("vmcall" : "=a" (callnum) : "a" (0), "b" ("log_set_buf")); if (callnum == 0) { printk ("logget-linux: vmcall failed.\n"); return -EINVAL; } buf = (struct log_buf *)kmalloc (sizeof *buf, GFP_KERNEL); if (!buf) { printk ("logget-linux: kmalloc failed.\n"); return -ENOMEM; } buf->n = 0; asm volatile ("vmcall" : : "a" (callnum), "b" (virt_to_phys (buf)) , "c" (sizeof *buf)); offset = 0; atomic_set (&exit_logget_linux_flag, 0); INIT_DELAYED_WORK (&logget_linux_work, logget_linux_polling); schedule_delayed_work (&logget_linux_work, 1); return 0; } static void __exit logget_linux_exit (void) { asm volatile ("vmcall" : : "a" (callnum), "b" (0)); init_MUTEX_LOCKED (&exit_logget_linux_sem); atomic_set (&exit_logget_linux_flag, 1); printk ("exit_logget_linux: waiting for logget_linux_polling\n"); down (&exit_logget_linux_sem); } module_init (logget_linux_init); module_exit (logget_linux_exit); ************************************************************ obj-m := logget-linux.o CurrentKernel : make -C /lib/modules/`uname -r`/build SUBDIRS=`pwd` modules clean : -rm -f Module.symvers *.o *.ko *.mod.c .*.cmd *~ .tmp_versions/''* -rmdir .tmp_versions load : -rmmod logget-linux insmod logget-linux.ko unload : rmmod logget-linux ************************************************************/ tinyvisor/vmm/core/vt_io.c0000644006644000001440000001210311753454341016103 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include "asm.h" #include "constants.h" #include "convert.h" #include "current.h" #include "mm.h" #include "panic.h" #include "cpu_interpreter.h" #include "vt_internal.h" void vt_io (void) { union { struct exit_qual_io s; ulong v; } eqi; ioport_t port; void *data; vmmerr_t err; asm_vmread (VMCS_EXIT_QUALIFICATION, &eqi.v); switch (eqi.s.op) { default: case EXIT_QUAL_IO_OP_DX: port = current->u.vt.vr.rdx & 0xFFFF; break; case EXIT_QUAL_IO_OP_IMMEDIATE: port = eqi.s.port; break; } switch (eqi.s.str) { case EXIT_QUAL_IO_STR_NOT_STRING: data = ¤t->u.vt.vr.rax; current->updateip = false; switch (eqi.s.dir) { case EXIT_QUAL_IO_DIR_IN: switch (eqi.s.size) { case EXIT_QUAL_IO_SIZE_1BYTE: call_io (IOTYPE_INB, port, data); break; case EXIT_QUAL_IO_SIZE_2BYTE: call_io (IOTYPE_INW, port, data); break; case EXIT_QUAL_IO_SIZE_4BYTE: call_io (IOTYPE_INL, port, data); break; default: panic ("vt_io(IN) unknown size"); } break; case EXIT_QUAL_IO_DIR_OUT: switch (eqi.s.size) { case EXIT_QUAL_IO_SIZE_1BYTE: call_io (IOTYPE_OUTB, port, data); break; case EXIT_QUAL_IO_SIZE_2BYTE: call_io (IOTYPE_OUTW, port, data); break; case EXIT_QUAL_IO_SIZE_4BYTE: call_io (IOTYPE_OUTL, port, data); break; default: panic ("vt_io(OUT) unknown size"); } break; } if (!current->updateip) add_ip (); break; case EXIT_QUAL_IO_STR_STRING: /* INS/OUTS can be used with an address-size override prefix. However, VMCS doesn't have address-size of the I/O instruction. */ /* we use an interpreter here to avoid the problem */ err = cpu_interpreter (); if (err == VMMERR_SUCCESS) break; panic ("I/O INSTRUCTION EMULATION FAILED" " (err: %d)", err); } } static void iobmp_allocation (void) { vmmerr_t err; err = alloc_page (¤t->u.vt.io.iobmp[0], ¤t->u.vt.io.iobmpphys[0]); if (err) { panic("Failed to allocate IO bitmap."); } err = alloc_page (¤t->u.vt.io.iobmp[1], ¤t->u.vt.io.iobmpphys[1]); if (err) { panic("Failed to allocate IO bitmap."); } /* * Set All 1 to io bitmap, because vm->io.iofunc is all 0 by * default, and this means guest software can't access host i/o * ports. */ memset (current->u.vt.io.iobmp[0], -1, PAGESIZE); memset (current->u.vt.io.iobmp[1], -1, PAGESIZE); } static void load_iobmpaddr (void) { u32 low0, high0, low1, high1; conv64to32 (current->u.vt.io.iobmpphys[0], &low0, &high0); conv64to32 (current->u.vt.io.iobmpphys[1], &low1, &high1); asm_vmwrite (VMCS_ADDR_IOBMP_A, low0); asm_vmwrite (VMCS_ADDR_IOBMP_A_HIGH, high0); asm_vmwrite (VMCS_ADDR_IOBMP_B, low1); asm_vmwrite (VMCS_ADDR_IOBMP_B_HIGH, high1); } static void enable_iobmp (void) { ulong tmp; asm_vmread (VMCS_PROC_BASED_VMEXEC_CTL, &tmp); tmp |= VMCS_PROC_BASED_VMEXEC_CTL_USEIOBMP_BIT; asm_vmwrite (VMCS_PROC_BASED_VMEXEC_CTL, tmp); } static void set_iobmp (struct vcpu *v, ioport_t port, int bit) { u8 *p; port &= 0xFFFF; p = (u8 *)v->u.vt.io.iobmp[port >> 15]; port &= 0x7FFF; if (bit) p[port >> 3] |= 1 << (port & 7); else p[port >> 3] &= ~(1 << (port & 7)); } void vt_iopass_init (void) { iobmp_allocation (); load_iobmpaddr (); enable_iobmp (); current->u.vt.io.iobmpflag = true; } void vt_extern_iopass (struct vcpu *p, ioport_t port, bool pass) { if (!p->u.vt.io.iobmpflag) return; set_iobmp (p, port, !pass); } tinyvisor/vmm/core/msg.c0000644006644000001440000000734611733245403015561 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include "mm.h" #include "msg.h" static LIST1_DEFINE_HEAD_INIT (struct msg_data, msg_data_free); static LIST1_DEFINE_HEAD_INIT (struct msg_data, msg_data_used); static spinlock_t msg_lock; static void msg_init_global (void) { spinlock_init (&msg_lock); } static struct msg_data * _findname (char *name) { struct msg_data *d; LIST1_FOREACH (msg_data_used, d) { if (!strcmp (name, d->name)) return d; } return NULL; } int msg_findname (char *name, int *pid, int *gen, int *desc) { struct msg_data *d; int r = -1; spinlock_lock (&msg_lock); d = _findname (name); if (d) { *pid = d->pid; *gen = d->gen; *desc = d->desc; r = 0; } spinlock_unlock (&msg_lock); return r; } int msg_register (char *name, int pid, int gen, int desc) { int r = -1; struct msg_data *d; spinlock_lock (&msg_lock); if (_findname (name)) goto err; d = LIST1_POP (msg_data_free); if (d == NULL) { d = alloc (sizeof *d); if (d == NULL) { goto err; } } memcpy (d->name, name, MSG_NAMELEN); d->name[MSG_NAMELEN - 1] = '\0'; d->pid = pid; d->gen = gen; d->desc = desc; LIST1_ADD (msg_data_used, d); r = 0; err: spinlock_unlock (&msg_lock); return r; } int msg_unregister (char *name) { int r = -1; struct msg_data *d; spinlock_lock (&msg_lock); d = _findname (name); if (d == NULL) goto err; LIST1_DEL (msg_data_used, d); LIST1_ADD (msg_data_free, d); r = 0; err: spinlock_unlock (&msg_lock); return r; } void msg_unregisterall (int pid) { struct msg_data *d; spinlock_lock (&msg_lock); retry: LIST1_FOREACH (msg_data_used, d) { if (d->pid == pid) { LIST1_DEL (msg_data_used, d); LIST1_ADD (msg_data_free, d); goto retry; } } spinlock_unlock (&msg_lock); } int msg_unregister2 (int pid, int desc) { struct msg_data *d; int r = -1; spinlock_lock (&msg_lock); retry: LIST1_FOREACH (msg_data_used, d) { if (d->pid == pid && d->desc == desc) { LIST1_DEL (msg_data_used, d); LIST1_ADD (msg_data_free, d); r = 0; goto retry; } } spinlock_unlock (&msg_lock); return r; } INITFUNC ("global4", msg_init_global); tinyvisor/vmm/core/vt_main.c0000644006644000001440000006277312206363272016436 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #include #include #include #include #include #include "apic_pass.h" #include "apic.h" #include "asm.h" #include "bitmap.h" #include "constants.h" #include "cpu.h" #include "cpu_emul.h" #include "cpu_mmu.h" #include "current.h" #include "extint.h" #include "guest_boot.h" #include "int.h" #include "panic.h" #include "pcpu.h" #include "reboot.h" #include "thread.h" #include "vcpu.h" #include "vmmcall.h" #include "vmmcall_status.h" #include "vt.h" #include "vt_internal.h" enum vt_status { VT_VMENTRY_SUCCESS, VT_VMENTRY_FAILED, VT_VMEXIT, }; static u32 stat_intcnt = 0; static u32 stat_hwexcnt = 0; static u32 stat_swexcnt = 0; static u32 stat_pfcnt = 0; static u32 stat_iocnt = 0; static u32 stat_hltcnt = 0; static void do_mov_cr (void) { ulong val; union { struct exit_qual_cr s; ulong v; } eqc; asm_vmread (VMCS_EXIT_QUALIFICATION, &eqc.v); switch (eqc.s.type) { case EXIT_QUAL_CR_TYPE_MOV_TO_CR: vt_read_general_reg (eqc.s.reg, &val); vt_write_control_reg (eqc.s.num, val); break; case EXIT_QUAL_CR_TYPE_MOV_FROM_CR: vt_read_control_reg (eqc.s.num, &val); vt_write_general_reg (eqc.s.reg, val); break; case EXIT_QUAL_CR_TYPE_CLTS: vt_read_control_reg (CONTROL_REG_CR0, &val); val &= ~CR0_TS_BIT; vt_write_control_reg (CONTROL_REG_CR0, val); break; case EXIT_QUAL_CR_TYPE_LMSW: vt_read_control_reg (CONTROL_REG_CR0, &val); val &= ~0xFFFF; val |= eqc.s.lmsw_src; vt_write_control_reg (CONTROL_REG_CR0, val); break; default: panic ("Not implemented."); } add_ip (); } static void do_cpuid (void) { cpu_emul_cpuid (); add_ip (); } static void do_msr_fault (void) { struct vt_intr_data *vid = ¤t->u.vt.intr; if (vid->intr_info.s.valid == INTR_INFO_VALID_VALID) { panic ("Can't inject general protection fault (MSR) because the other event is already pending. " "vector 0x%x type 0x%x, err_valid 0x%x", vid->intr_info.s.vector, vid->intr_info.s.type, vid->intr_info.s.err); } vid->intr_info.v = 0; vid->intr_info.s.vector = EXCEPTION_GP; vid->intr_info.s.type = INTR_INFO_TYPE_HARD_EXCEPTION; vid->intr_info.s.err = INTR_INFO_ERR_VALID; vid->intr_info.s.valid = INTR_INFO_VALID_VALID; vid->exception_errcode = 0; vid->instruction_len = 0; } static void do_rdmsr (void) { if (cpu_emul_rdmsr ()) do_msr_fault (); else add_ip (); } static void do_wrmsr (void) { if (cpu_emul_wrmsr ()) do_msr_fault (); else add_ip (); } static void do_exception (void) { union { struct intr_info s; ulong v; } vii; ulong len; vmmerr_t err; ulong errc; asm_vmread (VMCS_VMEXIT_INTR_INFO, &vii.v); if (vii.s.valid != INTR_INFO_VALID_VALID) { return; } switch (vii.s.type) { case INTR_INFO_TYPE_HARD_EXCEPTION: STATUS_UPDATE (asm_lock_incl (&stat_hwexcnt)); if (vii.s.vector == EXCEPTION_DB && current->u.vt.vr.sw.enable) { break; } if (vii.s.vector == EXCEPTION_PF) { ulong cr2; asm_vmread (VMCS_VMEXIT_INTR_ERRCODE, &errc); asm_vmread (VMCS_EXIT_QUALIFICATION, &cr2); if (current->u.vt.ept_enabled && current->u.vt.vr.pg) { /* * page fault causes VM-exit * even though EPT is enabled and page * fault is masked. */ if (current->u.vt.intr.intr_info.s.valid == INTR_INFO_VALID_VALID) { panic ("Can't inject a page fault because the other event is already pending. " "vector 0x%x type 0x%x, err_valid 0x%x", current->u.vt.intr.intr_info.s.vector, current->u.vt.intr.intr_info.s.type, current->u.vt.intr.intr_info.s.err); } current->u.vt.intr.intr_info.v = vii.v; current->u.vt.vr.cr2 = cr2; current->u.vt.intr.exception_errcode = errc; break; } cpu_mmu_spt_pagefault (errc, cr2); STATUS_UPDATE (asm_lock_incl (&stat_pfcnt)); } else if (!current->u.vt.vr.pe) { /* Real mode */ switch (vii.s.vector) { case EXCEPTION_GP: err = cpu_interpreter (); if (err == VMMERR_SUCCESS) break; panic ("General protection fault in real mode and can't emulate the instruction (err: %d)", err); case EXCEPTION_DB: if (cpu_emul_realmode_int (1)) { panic ("cpu_emul_realmode_int (1) error"); } break; default: panic ("Unimplemented exception in real mode: " "0x%02X %s\n", vii.s.vector, exception_name (vii.s.vector)); } } else { if (current->u.vt.intr.intr_info.s.valid == INTR_INFO_VALID_VALID) { panic ("Can't inject a exception because the other event is already pending. " "old: vector 0x%x type 0x%x, err_valid 0x%x " "new: vector 0x%x type 0x%x, err_valid 0x%x", current->u.vt.intr.intr_info.s.vector, current->u.vt.intr.intr_info.s.type, current->u.vt.intr.intr_info.s.err, vii.s.vector, vii.s.type, vii.s.err); } if ((current->u.vt.intr.intr_info.v | 0x8000000) == vii.v) { printf("DEBUG: Injecting the same exception twice.\n"); } current->u.vt.intr.intr_info.v = vii.v; if (vii.s.err == INTR_INFO_ERR_VALID) { asm_vmread (VMCS_VMEXIT_INTR_ERRCODE, &errc); current->u.vt.intr.exception_errcode = errc; if (vii.s.vector == EXCEPTION_GP) { printf ("DEBUG: General protection fault on CPU%d. error code 0x%lx\n", get_cpu_id(), errc); } } current->u.vt.intr.instruction_len = 0; } break; case INTR_INFO_TYPE_SOFT_EXCEPTION: if (current->u.vt.intr.intr_info.s.valid == INTR_INFO_VALID_VALID) { panic ("Can't inject a soft exception because the other event is already pending. " "vector 0x%x type 0x%x, err_valid 0x%x", current->u.vt.intr.intr_info.s.vector, current->u.vt.intr.intr_info.s.type, current->u.vt.intr.intr_info.s.err); } STATUS_UPDATE (asm_lock_incl (&stat_swexcnt)); current->u.vt.intr.intr_info.v = vii.v; asm_vmread (VMCS_VMEXIT_INSTRUCTION_LEN, &len); current->u.vt.intr.instruction_len = len; break; case INTR_INFO_TYPE_NMI: panic("NMI recieved while executing guest software."); break; case INTR_INFO_TYPE_EXTERNAL: default: panic ("intr_info_type %d not implemented", vii.s.type); } } static void do_invlpg (void) { ulong linear; asm_vmread (VMCS_EXIT_QUALIFICATION, &linear); cpu_mmu_spt_invalidate (linear); add_ip (); } void vt_invlpg (ulong addr) { cpu_mmu_spt_invalidate (addr); } /* VMCALL: guest calls VMM */ static void do_vmcall (void) { add_ip (); vmmcall (); } static void vt_event_delivery_setup (void) { struct vt_intr_data *vid = ¤t->u.vt.intr; if (vid->intr_info.s.valid == INTR_INFO_VALID_VALID) { asm_vmwrite (VMCS_VMENTRY_INTR_INFO_FIELD, vid->intr_info.v); if (vid->intr_info.s.err == INTR_INFO_ERR_VALID) asm_vmwrite (VMCS_VMENTRY_EXCEPTION_ERRCODE, vid->exception_errcode); asm_vmwrite (VMCS_VMENTRY_INSTRUCTION_LEN, vid->instruction_len); } } static enum vt_status call_vt_vmlaunch (void) { if (asm_vmlaunch_regs (¤t->u.vt.vr)) return VT_VMENTRY_FAILED; return VT_VMEXIT; } static enum vt_status call_vt_vmresume (void) { if (asm_vmresume_regs (¤t->u.vt.vr)) return VT_VMENTRY_FAILED; return VT_VMEXIT; } static void vt_vm_run (void) { enum vt_status status; if (!current->u.vt.launched) { current->u.vt.launched = true; status = call_vt_vmlaunch (); } else { status = call_vt_vmresume (); } if (status != VT_VMEXIT) { if (status == VT_VMENTRY_FAILED) panic ("VM entry failed."); else panic ("Strange status."); } } /* FIXME: bad handling of TF bit */ static void vt_vm_run_with_tf (void) { ulong rflags; vt_read_flags (&rflags); rflags |= RFLAGS_TF_BIT; vt_write_flags (rflags); vt_vm_run (); vt_read_flags (&rflags); rflags &= ~RFLAGS_TF_BIT; vt_write_flags (rflags); } static void vt_event_delivery_check (void) { union { struct intr_info s; ulong v; } ivif; struct vt_intr_data *vid = ¤t->u.vt.intr; if (vid->intr_info.s.valid == INTR_INFO_VALID_VALID) { /* * Check if VM Exits occured during event delivery. */ asm_vmread (VMCS_IDT_VECTORING_INFO_FIELD, &ivif.v); if (ivif.s.valid == INTR_INFO_VALID_INVALID) { vid->intr_info.s.valid = INTR_INFO_VALID_INVALID; } else if (ivif.v != vid->intr_info.v) { panic ( "VMCS_IDT_VECTORING_INFO 0x%lX " "is different from " "VMCS_VMENTRY_INTR_INFO before VM-enter 0x%X\n", ivif.v, vid->intr_info.v); } } } static void do_hlt (void) { cpu_emul_hlt (); add_ip (); } static void task_switch_load_segdesc (u16 sel, ulong gdtr_base, ulong gdtr_limit, ulong base, ulong limit, ulong acr) { ulong addr, ldt_acr, desc_base, desc_limit; union { struct segdesc s; u64 v; } desc; vmmerr_t r; /* FIXME: set busy bit */ if (sel == 0) return; if (sel & SEL_LDT_BIT) { asm_vmread (VMCS_GUEST_LDTR_ACCESS_RIGHTS, &ldt_acr); asm_vmread (VMCS_GUEST_LDTR_BASE, &desc_base); asm_vmread (VMCS_GUEST_LDTR_LIMIT, &desc_limit); if (ldt_acr & ACCESS_RIGHTS_UNUSABLE_BIT) panic ("loadseg: LDT unusable. sel=0x%X, idx=0x%lX\n", sel, base); addr = sel & ~(SEL_LDT_BIT | SEL_PRIV_MASK); } else { desc_base = gdtr_base; desc_limit = gdtr_limit; addr = sel & ~(SEL_LDT_BIT | SEL_PRIV_MASK); } if ((addr | 7) > desc_limit) panic ("loadseg: limit check failed"); addr += desc_base; r = read_linearaddr_q (addr, &desc.v); if (r != VMMERR_SUCCESS) panic ("loadseg: cannot read descriptor"); if (desc.s.s == SEGDESC_S_CODE_OR_DATA_SEGMENT) desc.s.type |= 1; /* accessed bit */ asm_vmwrite (acr, (desc.v >> 40) & ACCESS_RIGHTS_MASK); asm_vmwrite (base, SEGDESC_BASE (desc.s)); asm_vmwrite (limit, ((desc.s.limit_15_0 | (desc.s.limit_19_16 << 16)) << (desc.s.g ? 12 : 0)) | (desc.s.g ? 0xFFF : 0)); } static void do_task_switch (void) { vmmerr_t r; union { struct exit_qual_ts s; ulong v; } eqt; ulong tr_sel; ulong gdtr_base, gdtr_limit; union { struct segdesc s; u64 v; } tss1_desc, tss2_desc; struct tss32 tss32_1, tss32_2; ulong rflags, tmp; u16 tmp16; /* FIXME: 16bit TSS */ /* FIXME: generate an exception if errors */ /* FIXME: virtual 8086 mode */ asm_vmread (VMCS_EXIT_QUALIFICATION, &eqt.v); asm_vmread (VMCS_GUEST_TR_SEL, &tr_sel); printf ("task switch from 0x%lX to 0x%X\n", tr_sel, eqt.s.sel); vt_read_gdtr (&gdtr_base, &gdtr_limit); r = read_linearaddr_q (gdtr_base + tr_sel, &tss1_desc.v); if (r != VMMERR_SUCCESS) goto err; r = read_linearaddr_q (gdtr_base + eqt.s.sel, &tss2_desc.v); if (r != VMMERR_SUCCESS) goto err; if (tss1_desc.s.type == SEGDESC_TYPE_16BIT_TSS_BUSY) panic ("task switch from 16bit TSS is not implemented."); if (tss1_desc.s.type != SEGDESC_TYPE_32BIT_TSS_BUSY) panic ("bad TSS descriptor 0x%llX", tss1_desc.v); if (eqt.s.src == EXIT_QUAL_TS_SRC_IRET || eqt.s.src == EXIT_QUAL_TS_SRC_JMP) tss1_desc.s.type = SEGDESC_TYPE_32BIT_TSS_AVAILABLE; if (eqt.s.src == EXIT_QUAL_TS_SRC_IRET) { if (tss2_desc.s.type == SEGDESC_TYPE_16BIT_TSS_BUSY) panic ("task switch to 16bit TSS is not implemented."); if (tss2_desc.s.type != SEGDESC_TYPE_32BIT_TSS_BUSY) panic ("bad TSS descriptor 0x%llX", tss1_desc.v); } else { if (tss2_desc.s.type == SEGDESC_TYPE_16BIT_TSS_AVAILABLE) panic ("task switch to 16bit TSS is not implemented."); if (tss2_desc.s.type != SEGDESC_TYPE_32BIT_TSS_AVAILABLE) panic ("bad TSS descriptor 0x%llX", tss1_desc.v); tss2_desc.s.type = SEGDESC_TYPE_32BIT_TSS_BUSY; } r = read_linearaddr_tss (SEGDESC_BASE (tss1_desc.s), &tss32_1, sizeof tss32_1); if (r != VMMERR_SUCCESS) goto err; r = read_linearaddr_tss (SEGDESC_BASE (tss2_desc.s), &tss32_2, sizeof tss32_2); if (r != VMMERR_SUCCESS) goto err; /* save old state */ vt_read_flags (&rflags); if (eqt.s.src == EXIT_QUAL_TS_SRC_IRET) rflags &= ~RFLAGS_NT_BIT; vt_read_general_reg (GENERAL_REG_RAX, &tmp); tss32_1.eax = tmp; vt_read_general_reg (GENERAL_REG_RCX, &tmp); tss32_1.ecx = tmp; vt_read_general_reg (GENERAL_REG_RDX, &tmp); tss32_1.edx = tmp; vt_read_general_reg (GENERAL_REG_RBX, &tmp); tss32_1.ebx = tmp; vt_read_general_reg (GENERAL_REG_RSP, &tmp); tss32_1.esp = tmp; vt_read_general_reg (GENERAL_REG_RBP, &tmp); tss32_1.ebp = tmp; vt_read_general_reg (GENERAL_REG_RSI, &tmp); tss32_1.esi = tmp; vt_read_general_reg (GENERAL_REG_RDI, &tmp); tss32_1.edi = tmp; vt_read_sreg_sel (SREG_ES, &tmp16); tss32_1.es = tmp16; vt_read_sreg_sel (SREG_CS, &tmp16); tss32_1.cs = tmp16; vt_read_sreg_sel (SREG_SS, &tmp16); tss32_1.ss = tmp16; vt_read_sreg_sel (SREG_DS, &tmp16); tss32_1.ds = tmp16; vt_read_sreg_sel (SREG_FS, &tmp16); tss32_1.fs = tmp16; vt_read_sreg_sel (SREG_GS, &tmp16); tss32_1.gs = tmp16; tss32_1.eflags = rflags; vt_read_ip (&tmp); tss32_1.eip = tmp; r = write_linearaddr_q (gdtr_base + tr_sel, tss1_desc.v); if (r != VMMERR_SUCCESS) goto err; r = write_linearaddr_tss (SEGDESC_BASE (tss1_desc.s), &tss32_1, sizeof tss32_1); if (r != VMMERR_SUCCESS) goto err; /* load new state */ rflags = tss32_2.eflags; if (eqt.s.src == EXIT_QUAL_TS_SRC_CALL || eqt.s.src == EXIT_QUAL_TS_SRC_INTR) { rflags |= RFLAGS_NT_BIT; tss32_2.link = tr_sel; } rflags |= RFLAGS_ALWAYS1_BIT; vt_write_general_reg (GENERAL_REG_RAX, tss32_2.eax); vt_write_general_reg (GENERAL_REG_RCX, tss32_2.ecx); vt_write_general_reg (GENERAL_REG_RDX, tss32_2.edx); vt_write_general_reg (GENERAL_REG_RBX, tss32_2.ebx); vt_write_general_reg (GENERAL_REG_RSP, tss32_2.esp); vt_write_general_reg (GENERAL_REG_RBP, tss32_2.ebp); vt_write_general_reg (GENERAL_REG_RSI, tss32_2.esi); vt_write_general_reg (GENERAL_REG_RDI, tss32_2.edi); asm_vmwrite (VMCS_GUEST_ES_SEL, tss32_2.es); asm_vmwrite (VMCS_GUEST_CS_SEL, tss32_2.cs); asm_vmwrite (VMCS_GUEST_SS_SEL, tss32_2.ss); asm_vmwrite (VMCS_GUEST_DS_SEL, tss32_2.ds); asm_vmwrite (VMCS_GUEST_FS_SEL, tss32_2.fs); asm_vmwrite (VMCS_GUEST_GS_SEL, tss32_2.gs); asm_vmwrite (VMCS_GUEST_TR_SEL, eqt.s.sel); asm_vmwrite (VMCS_GUEST_LDTR_SEL, tss32_2.ldt); asm_vmwrite (VMCS_GUEST_ES_ACCESS_RIGHTS, ACCESS_RIGHTS_UNUSABLE_BIT); asm_vmwrite (VMCS_GUEST_CS_ACCESS_RIGHTS, ACCESS_RIGHTS_UNUSABLE_BIT); asm_vmwrite (VMCS_GUEST_SS_ACCESS_RIGHTS, ACCESS_RIGHTS_UNUSABLE_BIT); asm_vmwrite (VMCS_GUEST_DS_ACCESS_RIGHTS, ACCESS_RIGHTS_UNUSABLE_BIT); asm_vmwrite (VMCS_GUEST_FS_ACCESS_RIGHTS, ACCESS_RIGHTS_UNUSABLE_BIT); asm_vmwrite (VMCS_GUEST_GS_ACCESS_RIGHTS, ACCESS_RIGHTS_UNUSABLE_BIT); asm_vmwrite (VMCS_GUEST_TR_ACCESS_RIGHTS, ACCESS_RIGHTS_UNUSABLE_BIT); asm_vmwrite (VMCS_GUEST_LDTR_ACCESS_RIGHTS, ACCESS_RIGHTS_UNUSABLE_BIT); vt_write_flags (rflags); vt_write_ip (tss32_2.eip); vt_write_control_reg (CONTROL_REG_CR3, tss32_2.cr3); r = write_linearaddr_q (gdtr_base + eqt.s.sel, tss2_desc.v); if (r != VMMERR_SUCCESS) goto err; r = write_linearaddr_tss (SEGDESC_BASE (tss2_desc.s), &tss32_2, sizeof tss32_2); if (r != VMMERR_SUCCESS) goto err; /* load segment descriptors */ if (rflags & RFLAGS_VM_BIT) panic ("switching to virtual 8086 mode"); task_switch_load_segdesc (eqt.s.sel, gdtr_base, gdtr_limit, VMCS_GUEST_TR_BASE, VMCS_GUEST_TR_LIMIT, VMCS_GUEST_TR_ACCESS_RIGHTS); task_switch_load_segdesc (tss32_2.ldt, gdtr_base, gdtr_limit, VMCS_GUEST_LDTR_BASE, VMCS_GUEST_LDTR_LIMIT, VMCS_GUEST_LDTR_ACCESS_RIGHTS); task_switch_load_segdesc (tss32_2.es, gdtr_base, gdtr_limit, VMCS_GUEST_ES_BASE, VMCS_GUEST_ES_LIMIT, VMCS_GUEST_ES_ACCESS_RIGHTS); task_switch_load_segdesc (tss32_2.cs, gdtr_base, gdtr_limit, VMCS_GUEST_CS_BASE, VMCS_GUEST_CS_LIMIT, VMCS_GUEST_CS_ACCESS_RIGHTS); task_switch_load_segdesc (tss32_2.ss, gdtr_base, gdtr_limit, VMCS_GUEST_SS_BASE, VMCS_GUEST_SS_LIMIT, VMCS_GUEST_SS_ACCESS_RIGHTS); task_switch_load_segdesc (tss32_2.ds, gdtr_base, gdtr_limit, VMCS_GUEST_DS_BASE, VMCS_GUEST_DS_LIMIT, VMCS_GUEST_DS_ACCESS_RIGHTS); task_switch_load_segdesc (tss32_2.fs, gdtr_base, gdtr_limit, VMCS_GUEST_FS_BASE, VMCS_GUEST_FS_LIMIT, VMCS_GUEST_FS_ACCESS_RIGHTS); task_switch_load_segdesc (tss32_2.gs, gdtr_base, gdtr_limit, VMCS_GUEST_GS_BASE, VMCS_GUEST_GS_LIMIT, VMCS_GUEST_GS_ACCESS_RIGHTS); vt_read_control_reg (CONTROL_REG_CR0, &tmp); tmp |= CR0_TS_BIT; vt_write_control_reg (CONTROL_REG_CR0, tmp); return; err: panic ("do_task_switch: error %d", r); } /* Copy from bitvisor 1.3 and modify */ static void do_xsetbv (void) { cpu_emul_xsetbv(); add_ip (); } static void vt_exit_reason (void) { ulong exit_reason; asm_vmread (VMCS_EXIT_REASON, &exit_reason); if (exit_reason & EXIT_REASON_VMENTRY_FAILURE_BIT) { panic ("VM Entry failure."); } switch (exit_reason & EXIT_REASON_MASK) { case EXIT_REASON_MOV_CR: do_mov_cr (); break; case EXIT_REASON_CPUID: do_cpuid (); break; case EXIT_REASON_IO_INSTRUCTION: STATUS_UPDATE (asm_lock_incl (&stat_iocnt)); vt_io (); break; case EXIT_REASON_RDMSR: do_rdmsr (); break; case EXIT_REASON_WRMSR: do_wrmsr (); break; case EXIT_REASON_EXCEPTION_OR_NMI: do_exception (); break; case EXIT_REASON_EXTERNAL_INT: STATUS_UPDATE (asm_lock_incl (&stat_intcnt)); /* * extint_check_interrupt will be inject the pending * interrupt or keep it. */ break; case EXIT_REASON_INTERRUPT_WINDOW: /* * extint_check_interrupt will be inject the pending * interrupt. */ break; case EXIT_REASON_INVLPG: do_invlpg (); break; case EXIT_REASON_VMCALL: /* for debugging */ do_vmcall (); break; case EXIT_REASON_HLT: STATUS_UPDATE (asm_lock_incl (&stat_hltcnt)); do_hlt (); break; case EXIT_REASON_TASK_SWITCH: do_task_switch (); break; case EXIT_REASON_INIT_SIGNAL: if (cpu_is_bsp()) { /* * Some controller (For example, ACPI * controller) might asserted INIT signal. * To reboot machine, we seem to need to * execute vmxoff on CPU0. */ asm_vmxoff(); apic_send_init(get_apic_id()); freeze(); } else { printf("Reset cpu 0x%x\n", get_cpu_id()); vcpu_reset(); vcpu_reset_apic(); } break; case EXIT_REASON_XSETBV: do_xsetbv (); break; case EXIT_REASON_EPT_VIOLATION: vt_ept_violation(); break; case EXIT_REASON_EPT_MISCONFIG: panic("EPT misconfig"); break; default: panic ("Unhandled VM exit (0x%lx)", exit_reason); } } static void vt_halt (void) { struct { ulong sel; ulong acr; ulong limit; } es, cs, ss, ds, fs, gs; ulong rflags; asm_vmread (VMCS_GUEST_ES_SEL, &es.sel); asm_vmread (VMCS_GUEST_CS_SEL, &cs.sel); asm_vmread (VMCS_GUEST_SS_SEL, &ss.sel); asm_vmread (VMCS_GUEST_DS_SEL, &ds.sel); asm_vmread (VMCS_GUEST_FS_SEL, &fs.sel); asm_vmread (VMCS_GUEST_GS_SEL, &gs.sel); asm_vmread (VMCS_GUEST_ES_ACCESS_RIGHTS, &es.acr); asm_vmread (VMCS_GUEST_CS_ACCESS_RIGHTS, &cs.acr); asm_vmread (VMCS_GUEST_SS_ACCESS_RIGHTS, &ss.acr); asm_vmread (VMCS_GUEST_DS_ACCESS_RIGHTS, &ds.acr); asm_vmread (VMCS_GUEST_FS_ACCESS_RIGHTS, &fs.acr); asm_vmread (VMCS_GUEST_GS_ACCESS_RIGHTS, &gs.acr); asm_vmread (VMCS_GUEST_ES_LIMIT, &es.limit); asm_vmread (VMCS_GUEST_CS_LIMIT, &cs.limit); asm_vmread (VMCS_GUEST_SS_LIMIT, &ss.limit); asm_vmread (VMCS_GUEST_DS_LIMIT, &ds.limit); asm_vmread (VMCS_GUEST_FS_LIMIT, &fs.limit); asm_vmread (VMCS_GUEST_GS_LIMIT, &gs.limit); asm_vmread (VMCS_GUEST_RFLAGS, &rflags); asm_vmwrite (VMCS_GUEST_ES_SEL, 8); asm_vmwrite (VMCS_GUEST_CS_SEL, 8); asm_vmwrite (VMCS_GUEST_SS_SEL, 8); asm_vmwrite (VMCS_GUEST_DS_SEL, 8); asm_vmwrite (VMCS_GUEST_FS_SEL, 8); asm_vmwrite (VMCS_GUEST_GS_SEL, 8); asm_vmwrite (VMCS_GUEST_ES_ACCESS_RIGHTS, 0xC093); asm_vmwrite (VMCS_GUEST_CS_ACCESS_RIGHTS, 0xC09B); asm_vmwrite (VMCS_GUEST_SS_ACCESS_RIGHTS, 0xC093); asm_vmwrite (VMCS_GUEST_DS_ACCESS_RIGHTS, 0xC093); asm_vmwrite (VMCS_GUEST_FS_ACCESS_RIGHTS, 0xC093); asm_vmwrite (VMCS_GUEST_GS_ACCESS_RIGHTS, 0xC093); asm_vmwrite (VMCS_GUEST_ES_LIMIT, 0xFFFFFFFF); asm_vmwrite (VMCS_GUEST_CS_LIMIT, 0xFFFFFFFF); asm_vmwrite (VMCS_GUEST_SS_LIMIT, 0xFFFFFFFF); asm_vmwrite (VMCS_GUEST_DS_LIMIT, 0xFFFFFFFF); asm_vmwrite (VMCS_GUEST_FS_LIMIT, 0xFFFFFFFF); asm_vmwrite (VMCS_GUEST_GS_LIMIT, 0xFFFFFFFF); asm_vmwrite (VMCS_GUEST_RFLAGS, RFLAGS_ALWAYS1_BIT | RFLAGS_IOPL_0 | (rflags & RFLAGS_IF_BIT)); asm_vmwrite (VMCS_GUEST_ACTIVITY_STATE, VMCS_GUEST_ACTIVITY_STATE_HLT); vt_vm_run (); if (false) { /* DEBUG */ ulong exit_reason; asm_vmread (VMCS_EXIT_REASON, &exit_reason); if (exit_reason & EXIT_REASON_VMENTRY_FAILURE_BIT) panic ("HALT FAILED."); } asm_vmwrite (VMCS_GUEST_ACTIVITY_STATE, VMCS_GUEST_ACTIVITY_STATE_ACTIVE); asm_vmwrite (VMCS_GUEST_ES_SEL, es.sel); asm_vmwrite (VMCS_GUEST_CS_SEL, cs.sel); asm_vmwrite (VMCS_GUEST_SS_SEL, ss.sel); asm_vmwrite (VMCS_GUEST_DS_SEL, ds.sel); asm_vmwrite (VMCS_GUEST_FS_SEL, fs.sel); asm_vmwrite (VMCS_GUEST_GS_SEL, gs.sel); asm_vmwrite (VMCS_GUEST_ES_ACCESS_RIGHTS, es.acr); asm_vmwrite (VMCS_GUEST_CS_ACCESS_RIGHTS, cs.acr); asm_vmwrite (VMCS_GUEST_SS_ACCESS_RIGHTS, ss.acr); asm_vmwrite (VMCS_GUEST_DS_ACCESS_RIGHTS, ds.acr); asm_vmwrite (VMCS_GUEST_FS_ACCESS_RIGHTS, fs.acr); asm_vmwrite (VMCS_GUEST_GS_ACCESS_RIGHTS, gs.acr); asm_vmwrite (VMCS_GUEST_ES_LIMIT, es.limit); asm_vmwrite (VMCS_GUEST_CS_LIMIT, cs.limit); asm_vmwrite (VMCS_GUEST_SS_LIMIT, ss.limit); asm_vmwrite (VMCS_GUEST_DS_LIMIT, ds.limit); asm_vmwrite (VMCS_GUEST_FS_LIMIT, fs.limit); asm_vmwrite (VMCS_GUEST_GS_LIMIT, gs.limit); asm_vmwrite (VMCS_GUEST_RFLAGS, rflags); vt_event_delivery_check (); vt_exit_reason (); } static void vt_mainloop (void) { vmmerr_t err; ulong cr0, acr; u64 efer; enable_interrupt(); for (;;) { schedule (); apic_handle_wait_for_sipi_state(); disable_interrupt(); if (current->halt) { vt_halt(); current->halt = false; enable_interrupt(); continue; } enable_interrupt(); /* when the state is switching between real mode and protected mode, we try emulation first */ /* SWITCHING: mov %cr0,%eax or $CR0_PE_BIT,%eax mov %eax,%cr0 ljmp $0x8,$1f | SWITCHING STATE 1: | mov $0x10,%eax | segment registers hold the contents mov %eax,%ds | in previous mode. we use interpreter mov %eax,%es | to emulate this situation. mov %eax,%fs | maximum 32 instructions are emulated mov %eax,%gs | because the interpreter is too slow. mov %eax,%ss | ... */ if (current->u.vt.vr.sw.enable) { current->u.vt.vr.sw.num++; if (current->u.vt.vr.sw.num >= 32) { /* consider emulation is not needed after 32 instructions are executed */ current->u.vt.vr.sw.enable = 0; continue; } vt_read_control_reg (CONTROL_REG_CR0, &cr0); if (cr0 & CR0_PG_BIT) { vt_read_msr (MSR_IA32_EFER, &efer); if (efer & MSR_IA32_EFER_LME_BIT) { vt_read_sreg_acr (SREG_CS, &acr); if (acr & ACCESS_RIGHTS_L_BIT) { /* long mode */ current->u.vt.vr.sw.enable = 0; continue; } } } err = cpu_interpreter (); if (err == VMMERR_SUCCESS) /* emulation successful */ continue; else if (err == VMMERR_UNSUPPORTED_OPCODE || err == VMMERR_SW) ; /* unsupported/run as it is */ else /* failed */ panic ("vt_mainloop ERR %d", err); /* continue when the instruction is not supported or should be executed as it is. (sw.enable may be changed after cpu_interpreter()) */ } disable_interrupt(); extint_check_interrupt (); vt_event_delivery_setup (); if (current->u.vt.vr.sw.enable) { /* when the state is switching, do single step */ vt_vm_run_with_tf (); } else { /* not switching */ vt_vm_run (); } cpu_mmu_spt_tlbflush (); vt_event_delivery_check (); vt_exit_reason (); enable_interrupt(); } } static char * vt_status (void) { static char buf[1024]; snprintf (buf, 1024, "Interrupts: %u\n" "Hardware exceptions: %u\n" " Page fault: %u\n" " Others: %u\n" "Software exception: %u\n" "Watched I/O: %u\n" "Halt: %u\n" , stat_intcnt, stat_hwexcnt, stat_pfcnt , stat_hwexcnt - stat_pfcnt, stat_swexcnt , stat_iocnt, stat_hltcnt); return buf; } static void vt_register_status_callback (void) { register_status_callback (vt_status); } void vt_run_vm (void) { vt_mainloop (); } INITFUNC ("global4", vt_register_status_callback); tinyvisor/vmm/core/bitmap.h0000644006644000001440000000577311733245403016256 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_BITMAP_H #define _CORE_BITMAP_H #include #include #include "asm.h" #define BITS_PER_ULONG (sizeof(ulong) * 8) #define ELEMENTS_COUNT(size) (((size) + sizeof(ulong) - 1) / sizeof(ulong)) #define BITMAP_DECLARE(type_name, size) \ typedef struct { \ ulong e[ELEMENTS_COUNT(size)]; \ } type_name #define BITMAP_INIT(bitmap) \ do { \ memset ((bitmap), 0, sizeof(*(bitmap))); \ } while (0) #define BITMAP_SET(bitmap, bit) \ (asm_lock_test_and_set_ulong ((bitmap)->e + (bit) / BITS_PER_ULONG, \ (bit) % BITS_PER_ULONG)) #define BITMAP_CLEAR(bitmap, bit) \ (asm_lock_test_and_clear_ulong ((bitmap)->e + (bit) / BITS_PER_ULONG, \ (bit) % BITS_PER_ULONG)) #define BITMAP_TEST(bitmap, bit) \ (asm_lock_test_ulong ((bitmap)->e + (bit) / BITS_PER_ULONG, \ ((bit) % BITS_PER_ULONG) )) static inline long bitmap_bsr (ulong e[], int size) { int i; int bit = -1; for (i = (ELEMENTS_COUNT(size) - 1); i >= 0; i--) { bit = asm_bsr_ulong (e + i); if (bit >= 0) { return i * BITS_PER_ULONG + bit; } } return bit; } #define BITMAP_BSR(bitmap) \ (bitmap_bsr ((bitmap)->e, sizeof (*(bitmap)))) static inline long bitmap_bsf (ulong e[], int size) { int i; int bit; for (i = 0; i < ELEMENTS_COUNT(size); i++) { bit = asm_bsf_ulong (e + i); if (bit >= 0) { return i * BITS_PER_ULONG + bit; } } return bit; } #define BITMAP_BSF(bitmap) \ (bitmap_bsf ((bitmap)->e, sizeof (*(bitmap)))) #endif tinyvisor/vmm/core/main.c0000644006644000001440000002136712206320117015706 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #include #include #include #include #include #include #include #include #include "callrealmode.h" #include "convert.h" #include "current.h" #include "initfunc.h" #include "guest_boot.h" #include "mm.h" #include "multiboot.h" #include "gbiosloader.h" #include "panic.h" #include "param.h" #include "pcpu.h" #include "process.h" #include "regs.h" #include "smp.h" #include "svm.h" #include "svm_init.h" #include "tty.h" #include "vcpu.h" #include "vm.h" #include "vmmcall.h" #include "vramwrite.h" #include "vt.h" static struct multiboot_info multiboot_info; static void print_boot_msg (void) { #ifdef __x86_64__ printf ("Starting VMM (x86_64)...\n"); #else printf ("Starting VMM (x86_32)...\n"); #endif printf ("Copyright (c) 2007, 2008 University of Tsukuba\n"); printf ("Copyright (c) 2010-2013 Yuichi Watanabe\n"); printf ("All rights reserved.\n"); } static void print_startvm_msg (void) { printf ("Starting a virtual machine.\n"); } static void load_drivers(void) { printf("Loading drivers.\n"); call_initfunc("driver"); } static u8 detect_bios_boot_device (struct multiboot_info *mi) { if (mi->flags.boot_device) { return mi->boot_device.drive; } else { printf ("BIOS boot device detection failed. Using 0x80.\n"); return 0x80; } } static void copy_cmdline (void) { void *vaddr; if (multiboot_info.flags.cmdline) { vaddr = mapmem (MAPMEM_HPHYS, multiboot_info.cmdline, CMDLINE_SIZE); if (vaddr == NULL) { panic("Failed to map multiboot_info.cmdline."); } param_save(vaddr); unmapmem(vaddr, CMDLINE_SIZE); } } static void copy_gbios (void) { struct multiboot_modules *mod; if (multiboot_info.flags.mods && multiboot_info.mods_count) { mod = mapmem(MAPMEM_HPHYS, multiboot_info.mods_addr, sizeof(mod)); if (mod == NULL) { panic("Failed to map multiboot_info.mods_addr."); } printf("Guest BIOS found. size 0x%x\n", mod->mod_end - mod->mod_start); gbios_save(mod->mod_start, mod->mod_end - mod->mod_start); unmapmem(mod, sizeof(mod));; } else { printf("Guest BIOS not found.\n"); } } /* make CPU's virtualization extension usable */ static void virtualization_init_pcpu (void) { currentcpu->fullvirtualize = FULLVIRTUALIZE_NONE; if (vt_available ()) { vt_init (); currentcpu->fullvirtualize = FULLVIRTUALIZE_VT; } if (svm_available ()) { svm_init (); currentcpu->fullvirtualize = FULLVIRTUALIZE_SVM; } } /* set current vcpu for full virtualization */ static void vmctl_init (void) { switch (currentcpu->fullvirtualize) { case FULLVIRTUALIZE_NONE: panic ("This processor does not support" " Intel VT or AMD Virtualization"); break; case FULLVIRTUALIZE_VT: vt_vmctl_init (); break; case FULLVIRTUALIZE_SVM: svm_vmctl_init (); break; } } static void load_guestboot(u8 bios_boot_drive) { void *p; u8 boot_drive; if (!cpu_is_bsp()) { return; } /* * vm0 boots from host BOIS. */ p = mapmem_hphys (GUEST_BOOT_OFFSET, GUEST_BOOT_LENGTH, MAPMEM_WRITE); if (p == NULL) { panic("Failed to map the host BIOS."); } memcpy (p, guest_boot_start, GUEST_BOOT_LENGTH); unmapmem (p, GUEST_BOOT_LENGTH); current->vmctl.write_realmode_seg (SREG_CS, 0x0); current->vmctl.write_ip (GUEST_BOOT_OFFSET); if (param_get_str(VM0_NAME ".boot_int18", 0, NULL, 0) == VMMERR_SUCCESS) { current->vmctl.write_general_reg (GENERAL_REG_RDI, 1); printf("Boot using int18.\n"); } else { if (param_get_u8(VM0_NAME ".boot_drive", 0, &boot_drive) == VMMERR_SUCCESS) { current->vmctl.write_general_reg( GENERAL_REG_RCX, boot_drive); printf("Boot from 0x%x drive.\n", boot_drive); } else { current->vmctl.write_general_reg( GENERAL_REG_RCX, bios_boot_drive); printf("Boot from 0x%x drive.\n", bios_boot_drive); } if (param_get_str(VM0_NAME ".boot_partition", 0, NULL, 0) == VMMERR_SUCCESS) { current->vmctl.write_general_reg( GENERAL_REG_RSI, 1); printf("Use loader of active partition\n"); } } } static void sync_cursor_pos (void) { unsigned int row, col; u16 dx; vramwrite_get_cursor_pos (&col, &row); conv8to16 (col, row, &dx); current->vmctl.write_general_reg (GENERAL_REG_RBX, 0); current->vmctl.write_general_reg (GENERAL_REG_RDX, dx); } static void setup_vm (void) { bool vbsp; u8 bios_boot_drive = 0; struct vm *vm = NULL; if (cpu_is_bsp()) { bios_boot_drive = detect_bios_boot_device (&multiboot_info); } sync_all_processors (); vbsp = vm_current_is_vbsp(); if (vbsp) { vm = vm_new(); if (vm == NULL) { panic("new_vm failed"); } } sync_all_processors (); if (!vbsp) { vm = vm_find(); } if (new_vcpu(vm, vbsp) == NULL) { panic ("new_vcpu failed"); } vmctl_init (); sync_all_processors (); current->vmctl.vminit (); /* * Initialize general functions of vm and vcpu. */ sync_all_processors (); if (vbsp) { call_initfunc("gvm"); } sync_all_processors (); call_initfunc ("vcpu"); /* * Initialize functions of pass-vm and its vcpu. */ sync_all_processors (); if (!cpu_is_bsp() && vbsp) { call_initfunc("passvm"); } sync_all_processors (); if (cpu_is_bsp()) { call_initfunc("passvm"); } sync_all_processors (); call_initfunc ("passcpu"); sync_all_processors (); vcpu_reset(); load_guestboot(bios_boot_drive); current->initialized = true; sync_all_processors (); if (vbsp) { vm_dump(); } sync_all_processors (); } static void run_vm (void) { if (!current->initialized) { panic("VCPU on CPU%d is not initialized.", get_cpu_id()); } current->vmctl.run_vm (); } static void ap_main (void) { apic_id_t shell_apic_id; call_initfunc ("ap"); call_initfunc ("pcpu"); if (param_get_u32("shell", 0, &shell_apic_id) == VMMERR_SUCCESS) { if (get_apic_id() == shell_apic_id) { int i; for (i = 0; i < 14; i++) { sync_all_processors(); } for (;;) { shell(); } } } setup_vm(); sync_all_processors(); /* 12 */ if (current->vbsp) { if (!current->vm->iommu_enabled) { panic("IOMMU is not enabled. VMM can't start more than one VMs"); } } sync_all_processors(); /* 13 */ sync_all_processors(); /* 14 */ run_vm(); panic ("VM stopped."); } static void bsp_main (void) { apic_id_t shell_apic_id; call_initfunc ("bsp"); call_initfunc ("pcpu"); load_drivers(); setup_vm(); #ifdef DUMP_MEM_AND_PCI mm_dump_mem_address_space(); pci_dump_resources(); #endif call_initfunc ("start"); sync_all_processors(); /* 12 */ sync_all_processors(); /* 13 */ print_startvm_msg(); sync_cursor_pos (); vramwrite_exit_global(); sync_all_processors(); /* 14 */ if (param_get_u32("shell", 0, &shell_apic_id) == VMMERR_SUCCESS) { if (get_apic_id() == shell_apic_id) { for (;;) { shell(); } } } run_vm(); panic ("VM stopped."); } asmlinkage void vmm_start (struct multiboot_info *mi_arg) { tty_init_global(); print_boot_msg(); memcpy (&multiboot_info, mi_arg, sizeof (struct multiboot_info)); initfunc_init (); call_initfunc ("global"); call_initfunc ("vmmcal"); call_initfunc ("msg"); start_all_processors (bsp_main, ap_main); } INITFUNC ("pcpu3", virtualization_init_pcpu); INITFUNC ("global3", copy_cmdline); INITFUNC ("global3", copy_gbios); tinyvisor/vmm/core/cpu_mmu_spt3.c0000644006644000001440000011036712165305216017406 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ /* MMU emulation, Shadow Page Tables (SPT) */ /* Copy from bitvisor 1.3 and modify */ #include #include #include #include #include #include "asm.h" #include "constants.h" #include "cpu_mmu.h" #include "cpu_mmu_spt.h" #include "current.h" #include "mm.h" #include "mmio.h" #include "msr_pass.h" #include "panic.h" #include "pcpu.h" #include "vmmcall_status.h" struct map_page_data1 { unsigned int write : 1; unsigned int user : 1; unsigned int wp : 1; }; struct map_page_data2 { unsigned int rw : 1; unsigned int us : 1; unsigned int nx : 1; u32 cache_flag; }; #define GFN_GLOBAL 0xFFFFFFFFFFFFFFFEULL #define GFN_UNUSED 0xFFFFFFFFFFFFFFFFULL static bool guest64 (void); static void update_cr3 (void); static void invalidate_page (ulong virtual_addr); static void init_global (void); static int init_vcpu (void); /* key: bit 63-12: gfn bit 11,10: 2to3 bit 9-7: glevels (not largepage) bit 6: largepage bit 5: wp=0 bit 4: nx=1 bit 3: us=0 bit 2: rw=0 bit 0: modified */ #define KEY_GFNMASK 0xFFFFFFFFFFFFF000ULL #define KEY_GFN_SHIFT 12 #define KEY_2TO3_SHIFT 10 #define KEY_LARGEPAGE 0x40ULL #define KEY_WP0 0x20ULL #define KEY_NX 0x10ULL #define KEY_US0 0x8ULL #define KEY_RW0 0x4ULL #define KEY_GLVL2 (2 << 7) #define KEY_GLVL3 (3 << 7) #define KEY_GLVL4 (4 << 7) #define KEY_LPMASK 0xFFFFFFFFFFE00000ULL #define KEY_LP2MASK 0xFFFFFFFFC0000000ULL #define KEY_CMPMASK 0xFFFFFFFFFFFFFFFCULL #define KEY_MODIFIED 0x1ULL #define CLEARINFO1(v) (((v) >> 12) & 0x1FF) #define CLEARINFO2(v) (((v) >> 21) & 0x1FF) #define NUM_OF_SPTTBL 32 #define NUM_OF_SPTRWMAP 4096 #define NUM_OF_SPTSHADOW1 2048 #define NUM_OF_SPTSHADOW2 512 #define HASHSIZE_OF_SPTRWMAP 4096 #define HASHSIZE_OF_SPTSHADOW1 2048 #define HASHSIZE_OF_SPTSHADOW2 1024 #define NUM_OF_SPTSHADOWOFF 31 #define NUM_OF_SPTSHADOW1MAP 512 struct cpu_mmu_spt_rwmap { LIST3_DEFINE (struct cpu_mmu_spt_rwmap, rwmap, short); LIST3_DEFINE (struct cpu_mmu_spt_rwmap, hash, short); u64 gfn; /* bit 0 is fail flag */ u64 *pte; u64 hphys; }; struct cpu_mmu_spt_shadow; struct cpu_mmu_spt_shadow1map { LIST3_DEFINE (struct cpu_mmu_spt_shadow1map, shadow1map, short); LIST3_DEFINE (struct cpu_mmu_spt_shadow1map, ref, short); struct cpu_mmu_spt_shadow *shadow1; u64 *pde; }; struct cpu_mmu_spt_shadow { LIST3_DEFINE (struct cpu_mmu_spt_shadow, shadow, short); LIST3_DEFINE (struct cpu_mmu_spt_shadow, hash, short); u64 phys; u64 key; u8 clear_n; u8 clear_off[NUM_OF_SPTSHADOWOFF]; u64 clear_area; LIST3_DEFINE_HEAD (shadow1map_ref, struct cpu_mmu_spt_shadow1map, ref); }; struct cpu_mmu_spt_data_internal { void *cr3tbl; u64 cr3tbl_phys; void *tbl[NUM_OF_SPTTBL]; u64 tbl_phys[NUM_OF_SPTTBL]; int cnt; int levels; struct cpu_mmu_spt_rwmap rwmap[NUM_OF_SPTRWMAP]; spinlock_t rwmap_lock; LIST3_DEFINE_HEAD (rwmap_fail, struct cpu_mmu_spt_rwmap, rwmap); LIST3_DEFINE_HEAD (rwmap_normal, struct cpu_mmu_spt_rwmap, rwmap); LIST3_DEFINE_HEAD (rwmap_free, struct cpu_mmu_spt_rwmap, rwmap); LIST3_DEFINE_HEAD (rwmap_hash[HASHSIZE_OF_SPTRWMAP], struct cpu_mmu_spt_rwmap, hash); struct cpu_mmu_spt_shadow shadow1[NUM_OF_SPTSHADOW1]; struct cpu_mmu_spt_shadow1map shadow1map[NUM_OF_SPTSHADOW1MAP]; LIST3_DEFINE_HEAD (shadow1map_free, struct cpu_mmu_spt_shadow1map, shadow1map); LIST3_DEFINE_HEAD (shadow1map_list, struct cpu_mmu_spt_shadow1map, shadow1map); rw_spinlock_t shadow1_lock; LIST3_DEFINE_HEAD (shadow1_modified, struct cpu_mmu_spt_shadow, shadow); LIST3_DEFINE_HEAD (shadow1_normal, struct cpu_mmu_spt_shadow, shadow); LIST3_DEFINE_HEAD (shadow1_free, struct cpu_mmu_spt_shadow, shadow); LIST3_DEFINE_HEAD (shadow1_hash[HASHSIZE_OF_SPTSHADOW1], struct cpu_mmu_spt_shadow, hash); struct cpu_mmu_spt_shadow shadow2[NUM_OF_SPTSHADOW2]; rw_spinlock_t shadow2_lock; LIST3_DEFINE_HEAD (shadow2_modified, struct cpu_mmu_spt_shadow, shadow); LIST3_DEFINE_HEAD (shadow2_normal, struct cpu_mmu_spt_shadow, shadow); LIST3_DEFINE_HEAD (shadow2_free, struct cpu_mmu_spt_shadow, shadow); LIST3_DEFINE_HEAD (shadow2_hash[HASHSIZE_OF_SPTSHADOW2], struct cpu_mmu_spt_shadow, hash); bool wp; ulong cr0, cr3, cr4; u64 efer; }; struct sptlist { LIST1_DEFINE (struct sptlist); struct cpu_mmu_spt_data_internal *spt; }; struct findshadow { struct cpu_mmu_spt_shadow *pn, *pm; }; typedef struct cpu_mmu_spt_data_internal spt_t; static LIST1_DEFINE_HEAD (struct sptlist, list1_spt); static u32 stat_mapcnt = 0; static u32 stat_cr3cnt = 0; static u32 stat_invlpgcnt = 0; static u32 stat_wpcnt = 0; static u32 stat_ptfoundcnt = 0; static u32 stat_ptfullcnt = 0; static u32 stat_ptnewcnt = 0; static u32 stat_pdfoundcnt = 0; static u32 stat_pdfullcnt = 0; static u32 stat_pdnewcnt = 0; static u32 stat_ptgoodcnt = 0; static u32 stat_pthitcnt = 0; static u32 stat_ptnew2cnt = 0; static u32 stat_pdgoodcnt = 0; static u32 stat_pdhitcnt = 0; static u32 stat_pdnew2cnt = 0; static u32 stat_clrcnt = 0; static u32 stat_clr2cnt = 0; static void get_cr0_cr3_cr4_and_efer (ulong *cr0, ulong *cr3, ulong *cr4, u64 *efer) { spt_t *spt; spt = current->spt.data; *cr0 = spt->cr0; *cr3 = spt->cr3; *cr4 = spt->cr4; *efer = spt->efer; } static unsigned int rwmap_hash_index (u64 gfn) { return gfn & (HASHSIZE_OF_SPTRWMAP - 1); } static unsigned int shadow1_hash_index (u64 key) { return (key >> KEY_GFN_SHIFT) & (HASHSIZE_OF_SPTSHADOW1 - 1); } static unsigned int shadow2_hash_index (u64 key) { return (key >> KEY_GFN_SHIFT) & (HASHSIZE_OF_SPTSHADOW2 - 1); } static bool update_rwmap (spt_t *cspt, u64 gfn, void *pte, u64 hphys) { struct cpu_mmu_spt_rwmap *p; unsigned int hr, hrtmp; bool r = false; u64 oldpte; const u64 mask = PTE_ADDR_MASK64; spinlock_lock (&cspt->rwmap_lock); while ((p = LIST3_POP (cspt->rwmap_fail, rwmap))) { hrtmp = rwmap_hash_index (p->gfn >> 1); LIST3_DEL (cspt->rwmap_hash[hrtmp], hash, p); oldpte = *p->pte; if ((oldpte & mask) == p->hphys) { *p->pte = oldpte & ~(PTE_D_BIT | PTE_RW_BIT); r = true; } LIST3_PUSH (cspt->rwmap_free, rwmap, p); } if (pte != NULL) { hr = rwmap_hash_index (gfn); LIST3_FOREACH (cspt->rwmap_hash[hr], hash, p) { if (p->pte == pte) { LIST3_DEL (cspt->rwmap_hash[hr], hash, p); LIST3_DEL (cspt->rwmap_normal, rwmap, p); goto found; } } p = LIST3_POP (cspt->rwmap_free, rwmap); if (p == NULL) { p = LIST3_POP (cspt->rwmap_normal, rwmap); hrtmp = rwmap_hash_index (p->gfn >> 1); LIST3_DEL (cspt->rwmap_hash[hrtmp], hash, p); oldpte = *p->pte; if ((oldpte & mask) == p->hphys) *p->pte = oldpte & ~(PTE_D_BIT | PTE_RW_BIT); } p->pte = pte; found: p->gfn = gfn << 1; p->hphys = hphys; LIST3_ADD (cspt->rwmap_normal, rwmap, p); LIST3_PUSH (cspt->rwmap_hash[hr], hash, p); } spinlock_unlock (&cspt->rwmap_lock); return r; } static void update_shadow (spt_t *cspt, u64 gfn0, u64 *pte, bool needrw) { spt_t *spt; struct sptlist *listspt; bool rw = true; u64 key, keytmp; struct cpu_mmu_spt_shadow *p, *pn; unsigned int hs, hr; struct cpu_mmu_spt_rwmap *q; key = gfn0 << KEY_GFN_SHIFT; LIST1_FOREACH (list1_spt, listspt) { spt = listspt->spt; hs = shadow1_hash_index (key); if (needrw) rw_spinlock_lock_ex (&spt->shadow1_lock); else rw_spinlock_lock_sh (&spt->shadow1_lock); LIST3_FOREACH_DELETABLE (spt->shadow1_hash[hs], hash, p, pn) { keytmp = p->key; if (keytmp & (KEY_LARGEPAGE | KEY_MODIFIED)) continue; if ((keytmp & KEY_GFNMASK) != key) continue; if (!needrw) { rw = false; break; } LIST3_DEL (spt->shadow1_normal, shadow, p); LIST3_ADD (spt->shadow1_modified, shadow, p); p->key |= KEY_MODIFIED; } if (needrw) rw_spinlock_unlock_ex (&spt->shadow1_lock); else rw_spinlock_unlock_sh (&spt->shadow1_lock); if (!rw) break; hs = shadow2_hash_index (key); if (needrw) rw_spinlock_lock_ex (&spt->shadow2_lock); else rw_spinlock_lock_sh (&spt->shadow2_lock); LIST3_FOREACH_DELETABLE (spt->shadow2_hash[hs], hash, p, pn) { keytmp = p->key; if (keytmp & (KEY_LARGEPAGE | KEY_MODIFIED)) continue; if ((keytmp & KEY_GFNMASK) != key) continue; if (!needrw) { rw = false; break; } LIST3_DEL (spt->shadow2_normal, shadow, p); LIST3_ADD (spt->shadow2_modified, shadow, p); p->key |= KEY_MODIFIED; } if (needrw) rw_spinlock_unlock_ex (&spt->shadow2_lock); else rw_spinlock_unlock_sh (&spt->shadow2_lock); if (!rw) break; } if (!rw) { hr = rwmap_hash_index (gfn0); spinlock_lock (&cspt->rwmap_lock); q = LIST3_POP (cspt->rwmap_hash[hr], hash); if (q && (q->gfn >> 1) == gfn0 && q->pte == pte) { if (q->gfn & 1) LIST3_DEL (cspt->rwmap_fail, rwmap, q); else LIST3_DEL (cspt->rwmap_normal, rwmap, q); LIST3_PUSH (cspt->rwmap_free, rwmap, q); } else if (q) { LIST3_PUSH (cspt->rwmap_hash[hr], hash, q); } spinlock_unlock (&cspt->rwmap_lock); *pte &= ~PTE_RW_BIT; } } static void update_clearinfo (struct cpu_mmu_spt_shadow *shadow, unsigned int off) { unsigned int i, j; j = off >> 1; i = shadow->clear_n; if (i < NUM_OF_SPTSHADOWOFF) { shadow->clear_off[i++] = j; shadow->clear_n = i; } else if (i == NUM_OF_SPTSHADOWOFF) { i++; shadow->clear_n = i; } shadow->clear_area |= 1ULL << (off >> 3); } static void find_shadow1_from_hash (spt_t *cspt, u64 key, struct findshadow *q) { unsigned int hs; struct cpu_mmu_spt_shadow *p; q->pn = NULL; q->pm = NULL; hs = shadow1_hash_index (key); LIST3_FOREACH (cspt->shadow1_hash[hs], hash, p) { if (key == (p->key & KEY_CMPMASK)) { if (p->key & KEY_MODIFIED) q->pm = p; else q->pn = p; return; } } } static void find_shadow2_from_hash (spt_t *cspt, u64 key, struct findshadow *q) { unsigned int hs; struct cpu_mmu_spt_shadow *p; q->pn = NULL; q->pm = NULL; hs = shadow2_hash_index (key); LIST3_FOREACH (cspt->shadow2_hash[hs], hash, p) { if (key == (p->key & KEY_CMPMASK)) { if (p->key & KEY_MODIFIED) q->pm = p; else q->pn = p; return; } } } static bool is_shadow1_pde_ok (spt_t *cspt, u64 pde, u64 v, struct findshadow *fs, u64 mask) { u64 phys; struct cpu_mmu_spt_shadow *p; phys = pde & mask; p = fs->pm; if (p && phys == p->phys) { if (p->clear_n == 0) return false; update_clearinfo (p, CLEARINFO1 (v)); return true; } p = fs->pn; if (p && phys == p->phys) { LIST3_DEL (cspt->shadow1_normal, shadow, p); LIST3_ADD (cspt->shadow1_normal, shadow, p); update_clearinfo (p, CLEARINFO1 (v)); return true; } return false; } static bool is_shadow2_pdpe_ok (spt_t *cspt, u64 pdpe, u64 v, struct findshadow *fs, u64 mask) { u64 phys; struct cpu_mmu_spt_shadow *p; phys = pdpe & mask; p = fs->pm; if (p && phys == p->phys) { if (p->clear_n == 0) return false; update_clearinfo (p, CLEARINFO2 (v)); return true; } p = fs->pn; if (p && phys == p->phys) { LIST3_DEL (cspt->shadow2_normal, shadow, p); LIST3_ADD (cspt->shadow2_normal, shadow, p); update_clearinfo (p, CLEARINFO2 (v)); return true; } return false; } static u64 find_shadow1 (spt_t *cspt, u64 key, u64 v, struct findshadow *fs) { struct cpu_mmu_spt_shadow *p; p = fs->pn; if (p) goto found; return 0; found: LIST3_DEL (cspt->shadow1_normal, shadow, p); LIST3_ADD (cspt->shadow1_normal, shadow, p); update_clearinfo (p, CLEARINFO1 (v)); return p->phys | PDE_P_BIT | ((key & KEY_LARGEPAGE) ? PDE_AVAILABLE1_BIT : 0); } static u64 find_shadow2 (spt_t *cspt, u64 v, struct findshadow *fs) { struct cpu_mmu_spt_shadow *p; p = fs->pn; if (p) goto found; return 0; found: LIST3_DEL (cspt->shadow2_normal, shadow, p); LIST3_ADD (cspt->shadow2_normal, shadow, p); update_clearinfo (p, CLEARINFO2 (v)); return p->phys | PDE_P_BIT; } static void clear_shadow (struct cpu_mmu_spt_shadow *shadow) { unsigned int i, j, n; u64 *p, tmp; u8 *pp; n = shadow->clear_n; if (n) { p = (u64 *)phys_to_virt (shadow->phys); if (n < NUM_OF_SPTSHADOWOFF) { pp = shadow->clear_off; for (i = 0; i < n; i++) { j = *pp++; j <<= 1; p[j] = 0; p[j + 1] = 0; } STATUS_UPDATE (asm_lock_incl (&stat_clr2cnt)); } else { tmp = shadow->clear_area; if (!tmp) panic ("clear_shadow"); pp = (u8 *)p; if (tmp & 1) goto start1; do { do { tmp >>= 1; pp += 64; } while (!(tmp & 1)); start1: j = 0; do { tmp >>= 1; j += 64; } while (tmp & 1); memset (pp, 0, j); pp += j; } while (tmp); STATUS_UPDATE (asm_lock_incl (&stat_clrcnt)); } shadow->clear_n = 0; shadow->clear_area = 0; } } static void clean_modified_shadow2 (spt_t *cspt, bool freeflag) { struct cpu_mmu_spt_shadow *p, *n; unsigned int hs; LIST3_FOREACH_DELETABLE (cspt->shadow2_modified, shadow, p, n) { clear_shadow (p); if (freeflag) { LIST3_DEL (cspt->shadow2_modified, shadow, p); LIST3_PUSH (cspt->shadow2_free, shadow, p); hs = shadow2_hash_index (p->key); LIST3_DEL (cspt->shadow2_hash[hs], hash, p); } } } static void clean_modified_shadow1 (spt_t *cspt, bool freeflag) { struct cpu_mmu_spt_shadow *p; struct cpu_mmu_spt_shadow1map *q; unsigned int hs; if (freeflag) { while ((p = LIST3_POP (cspt->shadow1_modified, shadow))) { clear_shadow (p); while ((q = LIST3_POP (p->shadow1map_ref, ref))) { LIST3_DEL (cspt->shadow1map_list, shadow1map, q); if ((*q->pde & PDE_ADDR_MASK64) == p->phys) *q->pde = 0; LIST3_PUSH (cspt->shadow1map_free, shadow1map, q); } hs = shadow1_hash_index (p->key); LIST3_DEL (cspt->shadow1_hash[hs], hash, p); LIST3_PUSH (cspt->shadow1_free, shadow, p); } } else { LIST3_FOREACH (cspt->shadow1_modified, shadow, p) clear_shadow (p); } } static bool new_shadow1 (spt_t *cspt, u64 key, u64 v, u64 *pde, struct findshadow *fs) { struct cpu_mmu_spt_shadow *p; unsigned int hs; hs = shadow1_hash_index (key); if (fs->pm) { p = fs->pm; clear_shadow (p); LIST3_DEL (cspt->shadow1_modified, shadow, p); STATUS_UPDATE (asm_lock_incl (&stat_ptfoundcnt)); goto found; } p = LIST3_POP (cspt->shadow1_free, shadow); if (p == NULL) { p = LIST3_POP (cspt->shadow1_modified, shadow); if (p) { LIST3_PUSH (cspt->shadow1_modified, shadow, p); goto clean; } p = LIST3_POP (cspt->shadow1_normal, shadow); if (p) { LIST3_ADD (cspt->shadow1_modified, shadow, p); p->key |= KEY_MODIFIED; } STATUS_UPDATE (asm_lock_incl (&stat_ptfullcnt)); clean: clean_modified_shadow1 (cspt, true); p = LIST3_POP (cspt->shadow1_free, shadow); } STATUS_UPDATE (asm_lock_incl (&stat_ptnewcnt)); p->key = key; LIST3_ADD (cspt->shadow1_hash[hs], hash, p); found: LIST3_ADD (cspt->shadow1_normal, shadow, p); p->key &= ~KEY_MODIFIED; update_clearinfo (p, CLEARINFO1 (v)); *pde = p->phys | PDE_P_BIT | ((key & KEY_LARGEPAGE) ? PDE_AVAILABLE1_BIT : 0); fs->pn = p; fs->pm = NULL; return true; } static bool new_shadow2 (spt_t *cspt, u64 key, u64 v, u64 *pde, struct findshadow *fs) { struct cpu_mmu_spt_shadow *p; unsigned int hs; hs = shadow2_hash_index (key); if (fs->pm) { p = fs->pm; clear_shadow (p); LIST3_DEL (cspt->shadow2_modified, shadow, p); STATUS_UPDATE (asm_lock_incl (&stat_pdfoundcnt)); goto found; } p = LIST3_POP (cspt->shadow2_free, shadow); if (p == NULL) { p = LIST3_POP (cspt->shadow2_modified, shadow); if (p) { LIST3_PUSH (cspt->shadow2_modified, shadow, p); goto clean_ret; } p = LIST3_POP (cspt->shadow2_normal, shadow); if (p) { LIST3_ADD (cspt->shadow2_modified, shadow, p); p->key |= KEY_MODIFIED; } STATUS_UPDATE (asm_lock_incl (&stat_pdfullcnt)); clean_ret: clean_modified_shadow2 (cspt, true); return false; } STATUS_UPDATE (asm_lock_incl (&stat_pdnewcnt)); p->key = key; LIST3_ADD (cspt->shadow2_hash[hs], hash, p); found: LIST3_ADD (cspt->shadow2_normal, shadow, p); p->key &= ~KEY_MODIFIED; update_clearinfo (p, CLEARINFO2 (v)); *pde = p->phys | PDE_P_BIT; fs->pn = p; fs->pm = NULL; return true; } static bool makerdonly (spt_t *cspt, u64 key) { spt_t *spt; struct sptlist *listspt; u64 gfn, newpte, oldpte; bool r = true; struct cpu_mmu_spt_rwmap *p, *pn; unsigned int hr; if (key & KEY_LARGEPAGE) return true; gfn = key >> KEY_GFN_SHIFT; LIST1_FOREACH (list1_spt, listspt) { spt = listspt->spt; spinlock_lock (&spt->rwmap_lock); hr = rwmap_hash_index (gfn); LIST3_FOREACH_DELETABLE (spt->rwmap_hash[hr], hash, p, pn) { if ((p->gfn >> 1) != gfn) continue; if (!(p->gfn & 1)) { LIST3_DEL (spt->rwmap_normal, rwmap, p); LIST3_ADD (spt->rwmap_fail, rwmap, p); p->gfn |= 1; } oldpte = *p->pte; pte_changed: if ((oldpte & PTE_ADDR_MASK64) != p->hphys) { newpte = 0; } else if (spt == cspt) { *p->pte = oldpte & ~(PTE_D_BIT | PTE_RW_BIT); newpte = 0; } else { newpte = oldpte & ~PTE_RW_BIT; if (asm_lock_cmpxchgq (p->pte, &oldpte, newpte)) goto pte_changed; } if (newpte & PTE_D_BIT) { r = false; continue; } LIST3_DEL (spt->rwmap_fail, rwmap, p); LIST3_PUSH (spt->rwmap_free, rwmap, p); LIST3_DEL (spt->rwmap_hash[hr], hash, p); } spinlock_unlock (&spt->rwmap_lock); } return r; } static void modified_shadow1 (spt_t *cspt, struct cpu_mmu_spt_shadow *p) { if (!(p->key & KEY_MODIFIED)) { LIST3_DEL (cspt->shadow1_normal, shadow, p); LIST3_ADD (cspt->shadow1_modified, shadow, p); p->key |= KEY_MODIFIED; } } static void modified_shadow2 (spt_t *cspt, struct cpu_mmu_spt_shadow *p) { if (!(p->key & KEY_MODIFIED)) { LIST3_DEL (cspt->shadow2_normal, shadow, p); LIST3_ADD (cspt->shadow2_modified, shadow, p); p->key |= KEY_MODIFIED; } } static void add_shadow1map (spt_t *cspt, struct cpu_mmu_spt_shadow *shadow1, u64 *pde) { struct cpu_mmu_spt_shadow1map *p; LIST3_FOREACH (shadow1->shadow1map_ref, ref, p) { if (p->pde == pde) return; } p = LIST3_POP (cspt->shadow1map_free, shadow1map); if (p == NULL) { p = LIST3_POP (cspt->shadow1map_list, shadow1map); if ((*p->pde & PDE_ADDR_MASK64) == p->shadow1->phys) *p->pde = 0; LIST3_DEL (p->shadow1->shadow1map_ref, ref, p); } p->pde = pde; p->shadow1 = shadow1; LIST3_ADD (cspt->shadow1map_list, shadow1map, p); LIST3_ADD (shadow1->shadow1map_ref, ref, p); } static bool setpde (spt_t *cspt, pmap_t *p, u64 pde, u64 key, u64 gfnw, u64 v, u64 mask, struct map_page_data2 m) { bool r = true; struct findshadow fs; u64 pdeflags, u; pdeflags = (m.rw ? PDE_RW_BIT : 0) | (m.us ? PDE_US_BIT : 0) | (m.nx ? PDE_NX_BIT : 0); u = PDE_AVAILABLE1_BIT | PDE_RW_BIT | PDE_US_BIT | PDE_P_BIT; if (pde) { rw_spinlock_lock_sh (&cspt->shadow1_lock); find_shadow1_from_hash (cspt, key, &fs); if (is_shadow1_pde_ok (cspt, pde, v, &fs, mask)) { rw_spinlock_unlock_sh (&cspt->shadow1_lock); pde &= ~(PDE_RW_BIT | PDE_US_BIT | PDE_NX_BIT); pmap_write (p, pde | pdeflags, u); STATUS_UPDATE (asm_lock_incl (&stat_ptgoodcnt)); return r; } rw_spinlock_unlock_sh (&cspt->shadow1_lock); rw_spinlock_lock_ex (&cspt->shadow1_lock); if (fs.pn && (fs.pn->key & KEY_MODIFIED)) { fs.pm = fs.pn; fs.pn = NULL; } } else { rw_spinlock_lock_ex (&cspt->shadow1_lock); find_shadow1_from_hash (cspt, key, &fs); } pde = find_shadow1 (cspt, key, v, &fs); if (pde) { add_shadow1map (cspt, fs.pn, pmap_pointer (p)); pmap_write (p, pde | pdeflags, u); STATUS_UPDATE (asm_lock_incl (&stat_pthitcnt)); goto ret; } r = new_shadow1 (cspt, key, v, &pde, &fs); if (!r) goto ret; add_shadow1map (cspt, fs.pn, pmap_pointer (p)); pmap_write (p, pde | pdeflags, u); if (gfnw != GFN_UNUSED && !(key & KEY_LARGEPAGE) && gfnw == (key >> KEY_GFN_SHIFT)) { modified_shadow1 (cspt, fs.pn); goto ret; } rw_spinlock_unlock_ex (&cspt->shadow1_lock); if (!makerdonly (cspt, key)) { STATUS_UPDATE (asm_lock_incl (&stat_ptnew2cnt)); rw_spinlock_lock_ex (&cspt->shadow1_lock); modified_shadow1 (cspt, fs.pn); rw_spinlock_unlock_ex (&cspt->shadow1_lock); } return r; ret: rw_spinlock_unlock_ex (&cspt->shadow1_lock); return r; } static bool setpdpe (spt_t *cspt, pmap_t *p, u64 pdpe, u64 key, u64 gfnw, u64 v, u64 mask) { bool r = true; struct findshadow fs; if (pdpe) { rw_spinlock_lock_sh (&cspt->shadow2_lock); find_shadow2_from_hash (cspt, key, &fs); if (is_shadow2_pdpe_ok (cspt, pdpe, v, &fs, mask)) { rw_spinlock_unlock_sh (&cspt->shadow2_lock); STATUS_UPDATE (asm_lock_incl (&stat_pdgoodcnt)); return r; } rw_spinlock_unlock_sh (&cspt->shadow2_lock); rw_spinlock_lock_ex (&cspt->shadow2_lock); if (fs.pn && (fs.pn->key & KEY_MODIFIED)) { fs.pm = fs.pn; fs.pn = NULL; } } else { rw_spinlock_lock_ex (&cspt->shadow2_lock); find_shadow2_from_hash (cspt, key, &fs); } pdpe = find_shadow2 (cspt, v, &fs); if (pdpe) { pmap_write (p, pdpe, PDE_P_BIT); STATUS_UPDATE (asm_lock_incl (&stat_pdhitcnt)); goto ret; } r = new_shadow2 (cspt, key, v, &pdpe, &fs); if (!r) goto ret; pmap_write (p, pdpe, PDE_P_BIT); if (gfnw != GFN_UNUSED && !(key & KEY_LARGEPAGE) && gfnw == (key >> KEY_GFN_SHIFT)) { modified_shadow2 (cspt, fs.pn); goto ret; } rw_spinlock_unlock_ex (&cspt->shadow2_lock); if (!makerdonly (cspt, key)) { STATUS_UPDATE (asm_lock_incl (&stat_pdnew2cnt)); rw_spinlock_lock_ex (&cspt->shadow2_lock); modified_shadow2 (cspt, fs.pn); rw_spinlock_unlock_ex (&cspt->shadow2_lock); } return r; ret: rw_spinlock_unlock_ex (&cspt->shadow2_lock); return r; } static bool mapsub (spt_t *cspt, pmap_t *pp, u64 *entry, int level, bool clearall) { u64 tmp; int l; if (clearall) { pmap_setlevel (pp, cspt->levels); pmap_clear (pp); cspt->cnt = 0; } pmap_setlevel (pp, level); tmp = pmap_read (pp); for (; (l = pmap_getreadlevel (pp)) > level; tmp = pmap_read (pp)) { pmap_setlevel (pp, l); if (cspt->cnt == NUM_OF_SPTTBL) return false; pmap_write (pp, cspt->tbl_phys[cspt->cnt++] | PDE_P_BIT, PDE_P_BIT); pmap_setlevel (pp, l - 1); pmap_clear (pp); pmap_setlevel (pp, level); } *entry = tmp; return true; } static void map_page (u64 v, struct map_page_data1 m1, struct map_page_data2 m2[5], u64 gfns[5], int glvl, phys_t hphys) { pmap_t p; u64 tmp; u64 key1, key2; u64 gfnw; static const int levels = 3; u64 pte; spt_t *const cspt = current->spt.data; const u64 mask = PTE_ADDR_MASK64; hphys &= (~PAGESIZE_MASK); STATUS_UPDATE (asm_lock_incl (&stat_mapcnt)); if (glvl == 1) { key1 = ((gfns[0] << KEY_GFN_SHIFT) & KEY_LPMASK) | KEY_LARGEPAGE; key2 = ((gfns[0] << KEY_GFN_SHIFT) & KEY_LP2MASK) | KEY_LARGEPAGE; } else if (glvl == 2) { if (gfns[1] == GFN_GLOBAL || gfns[1] == GFN_UNUSED) { key1 = ((gfns[0] << KEY_GFN_SHIFT) & KEY_LPMASK) | KEY_LARGEPAGE; } else { key1 = (gfns[1] << KEY_GFN_SHIFT) | KEY_GLVL2; key1 |= ((v >> 21) & 1) << KEY_2TO3_SHIFT; } key2 = (gfns[2] << KEY_GFN_SHIFT) | KEY_GLVL2; key2 |= ((v >> 30) & 3) << KEY_2TO3_SHIFT; } else if (glvl == 3 || glvl == 4) { if (gfns[1] == GFN_GLOBAL || gfns[1] == GFN_UNUSED) { key1 = ((gfns[0] << KEY_GFN_SHIFT) & KEY_LPMASK) | KEY_LARGEPAGE; } else { key1 = (gfns[1] << KEY_GFN_SHIFT) | KEY_GLVL3; } key2 = (gfns[2] << KEY_GFN_SHIFT) | KEY_GLVL3; } else { panic ("map_page: glvl error"); for (;;); } if (!cspt->wp) { /* guest us,rw user,write shadow us,rw 0,0 0,0 0,1 [B] 0,0 0,1 0,1 [A][B] 0,1 *,* 0,1 [B] 1,0 0,0 1,0 1,0 0,1 0,1 [A][B] 1,0 1,0 1,0 1,0 1,1 (page fault) 1,1 *,* 1,1 */ if (!m1.user && m1.write) { if (!m2[0].rw) m2[0].us = 0; /* [A] */ if (!m2[1].rw) m2[1].us = 0; /* [A] */ } if (!m2[0].us) m2[0].rw = 1; /* [B] */ if (!m2[1].us) m2[1].rw = 1; /* [B] */ key1 |= KEY_WP0; key2 |= KEY_WP0; } if (glvl >= 2) { if (m2[2].nx) key2 |= KEY_NX; if (!m2[2].us) key2 |= KEY_US0; if (!m2[2].rw) key2 |= KEY_RW0; } gfnw = GFN_UNUSED; if (m1.write) gfnw = gfns[0]; pmap_open_vmm (&p, cspt->cr3tbl_phys, cspt->levels); pmap_setvirt (&p, v, levels); if (!mapsub (cspt, &p, &tmp, levels, false)) { if (!mapsub (cspt, &p, &tmp, levels, true)) panic ("mapsub failed 1"); } if (!setpdpe (cspt, &p, tmp, key2, gfnw, v, mask)) { if (!mapsub (cspt, &p, &tmp, levels, true)) panic ("mapsub failed 2"); if (!setpdpe (cspt, &p, tmp, key2, gfnw, v, mask)) panic ("setpdpe failed 1"); } pmap_setlevel (&p, 2); tmp = pmap_read (&p); if (!setpde (cspt, &p, tmp, key1, gfnw, v, mask, m2[1])) { if (!mapsub (cspt, &p, &tmp, levels, true)) panic ("mapsub failed 3"); if (!setpdpe (cspt, &p, tmp, key2, gfnw, v, mask)) panic ("setpdpe failed 2"); pmap_setlevel (&p, 2); tmp = pmap_read (&p); if (!setpde (cspt, &p, tmp, key1, gfnw, v, mask, m2[1])) panic ("setpde failed 1"); } pmap_setlevel (&p, 1); tmp = pmap_read (&p); pte = hphys | PTE_P_BIT | (m2[0].rw ? PTE_RW_BIT : 0) | (m2[0].us ? PTE_US_BIT : 0) | (m2[0].nx ? PTE_NX_BIT : 0) | (m1.write ? PTE_D_BIT : 0) | mm_cache_flag_to_pte_attr (m2[0].cache_flag); if ((tmp | PTE_A_BIT | PTE_D_BIT) == (pte | PTE_A_BIT | PTE_D_BIT)) goto skip; pmap_write (&p, pte, PTE_P_BIT | PTE_RW_BIT | PTE_US_BIT | PTE_PWT_BIT | PTE_PCD_BIT | PTE_PAT_BIT | PTE_D_BIT); if (m2[0].rw) { update_rwmap (cspt, gfns[0], pmap_pointer (&p), hphys); update_shadow (cspt, gfns[0], pmap_pointer (&p), m1.write); } skip: pmap_close (&p); } static void clear_rwmap (spt_t *cspt) { int i; spinlock_lock (&cspt->rwmap_lock); LIST3_HEAD_INIT (cspt->rwmap_fail, rwmap); LIST3_HEAD_INIT (cspt->rwmap_normal, rwmap); LIST3_HEAD_INIT (cspt->rwmap_free, rwmap); for (i = 0; i < NUM_OF_SPTRWMAP; i++) LIST3_ADD (cspt->rwmap_free, rwmap, &cspt->rwmap[i]); for (i = 0; i < HASHSIZE_OF_SPTRWMAP; i++) LIST3_HEAD_INIT (cspt->rwmap_hash[i], hash); spinlock_unlock (&cspt->rwmap_lock); } static void clear_shadow1 (spt_t *cspt) { unsigned int i; rw_spinlock_lock_ex (&cspt->shadow1_lock); LIST3_HEAD_INIT (cspt->shadow1_modified, shadow); LIST3_HEAD_INIT (cspt->shadow1_normal, shadow); LIST3_HEAD_INIT (cspt->shadow1_free, shadow); for (i = 0; i < NUM_OF_SPTSHADOW1; i++) { clear_shadow (&cspt->shadow1[i]); LIST3_ADD (cspt->shadow1_free, shadow, &cspt->shadow1[i]); } for (i = 0; i < HASHSIZE_OF_SPTSHADOW1; i++) LIST3_HEAD_INIT (cspt->shadow1_hash[i], hash); rw_spinlock_unlock_ex (&cspt->shadow1_lock); } static void clear_shadow1map (spt_t *cspt) { unsigned int i; rw_spinlock_lock_ex (&cspt->shadow1_lock); LIST3_HEAD_INIT (cspt->shadow1map_free, shadow1map); LIST3_HEAD_INIT (cspt->shadow1map_list, shadow1map); for (i = 0; i < NUM_OF_SPTSHADOW1MAP; i++) { LIST3_ADD (cspt->shadow1map_free, shadow1map, &cspt->shadow1map[i]); } rw_spinlock_unlock_ex (&cspt->shadow1_lock); } static void clear_shadow2 (spt_t *cspt) { unsigned int i; rw_spinlock_lock_ex (&cspt->shadow2_lock); LIST3_HEAD_INIT (cspt->shadow2_modified, shadow); LIST3_HEAD_INIT (cspt->shadow2_normal, shadow); LIST3_HEAD_INIT (cspt->shadow2_free, shadow); for (i = 0; i < NUM_OF_SPTSHADOW2; i++) { clear_shadow (&cspt->shadow2[i]); LIST3_ADD (cspt->shadow2_free, shadow, &cspt->shadow2[i]); } for (i = 0; i < NUM_OF_SPTSHADOW2; i++) clear_shadow (&cspt->shadow2[i]); for (i = 0; i < HASHSIZE_OF_SPTSHADOW2; i++) LIST3_HEAD_INIT (cspt->shadow2_hash[i], hash); rw_spinlock_unlock_ex (&cspt->shadow2_lock); } static void invalidate_page (ulong v) { pmap_t p; u64 tmp; spt_t *const cspt = current->spt.data; STATUS_UPDATE (asm_lock_incl (&stat_invlpgcnt)); if (true) { /* FIXME: clean* seems good but slow */ rw_spinlock_lock_sh (&cspt->shadow1_lock); clean_modified_shadow1 (cspt, false); rw_spinlock_unlock_sh (&cspt->shadow1_lock); rw_spinlock_lock_sh (&cspt->shadow2_lock); clean_modified_shadow2 (cspt, false); rw_spinlock_unlock_sh (&cspt->shadow2_lock); return; } pmap_open_vmm (&p, cspt->cr3tbl_phys, cspt->levels); pmap_setvirt (&p, v, 2); tmp = pmap_read (&p); if (tmp & PDE_P_BIT) { if (tmp & PDE_AVAILABLE1_BIT) { pmap_write (&p, 0, 0xFFF); if (cspt->levels >= 3) { pmap_setvirt (&p, v ^ PAGESIZE2M, 2); tmp = pmap_read (&p); if (tmp & PDE_P_BIT) pmap_write (&p, 0, 0xFFF); } } else { pmap_setlevel (&p, 1); tmp = pmap_read (&p); pmap_write (&p, 0, 0xFFF); } } pmap_close (&p); } static void update_cr3 (void) { pmap_t p; ulong cr0, cr3, cr4; u64 efer; spt_t *const cspt = current->spt.data; STATUS_UPDATE (asm_lock_incl (&stat_cr3cnt)); current->vmctl.read_control_reg (CONTROL_REG_CR0, &cr0); current->vmctl.read_control_reg (CONTROL_REG_CR3, &cr3); current->vmctl.read_control_reg (CONTROL_REG_CR4, &cr4); current->vmctl.read_msr (MSR_IA32_EFER, &efer); if (cr0 != cspt->cr0 || cr3 != cspt->cr3 || cr4 != cspt->cr4 || efer != cspt->efer) { cspt->cr0 = cr0; cspt->cr3 = cr3; cspt->cr4 = cr4; cspt->efer = efer; } else { /* fast path */ rw_spinlock_lock_sh (&cspt->shadow1_lock); clean_modified_shadow1 (cspt, false); rw_spinlock_unlock_sh (&cspt->shadow1_lock); rw_spinlock_lock_sh (&cspt->shadow2_lock); clean_modified_shadow2 (cspt, false); rw_spinlock_unlock_sh (&cspt->shadow2_lock); return; } cspt->levels = guest64 () ? 4 : 3; pmap_open_vmm (&p, cspt->cr3tbl_phys, cspt->levels); pmap_clear (&p); pmap_close (&p); cspt->cnt = 0; current->vmctl.spt_setcr3 (cspt->cr3tbl_phys); if (cspt->wp && !(cr0 & CR0_WP_BIT)) { cspt->wp = false; STATUS_UPDATE (asm_lock_incl (&stat_wpcnt)); } if (!cspt->wp && (cr0 & CR0_WP_BIT)) { cspt->wp = true; STATUS_UPDATE (asm_lock_incl (&stat_wpcnt)); } update_rwmap (cspt, 0, NULL, 0); rw_spinlock_lock_ex (&cspt->shadow1_lock); clean_modified_shadow1 (cspt, true); rw_spinlock_unlock_ex (&cspt->shadow1_lock); rw_spinlock_lock_ex (&cspt->shadow2_lock); clean_modified_shadow2 (cspt, true); rw_spinlock_unlock_ex (&cspt->shadow2_lock); } static bool spt_tlbflush (void) { return update_rwmap (current->spt.data, 0, NULL, 0); } static char * spt_status (void) { static char buf[1024]; snprintf (buf, 1024, "MMU:\n" " MOV CR3: %u INVLPG: %u\n" " Map: %u WP: %u Clear: %u, %u\n" "Shadow page table:\n" " Found: %u Full: %u New: %u\n" " Good: %u Hit: %u New2: %u\n" "Shadow page directory:\n" " Found: %u Full: %u New: %u\n" " Good: %u Hit: %u New2: %u\n" , stat_cr3cnt, stat_invlpgcnt , stat_mapcnt, stat_wpcnt, stat_clrcnt, stat_clr2cnt , stat_ptfoundcnt, stat_ptfullcnt, stat_ptnewcnt , stat_ptgoodcnt, stat_pthitcnt, stat_ptnew2cnt , stat_pdfoundcnt, stat_pdfullcnt, stat_pdnewcnt , stat_pdgoodcnt, stat_pdhitcnt, stat_pdnew2cnt); return buf; } static void init_global (void) { LIST1_HEAD_INIT (list1_spt); register_status_callback (spt_status); } static int init_vcpu (void) { int i; struct sptlist *listspt; spt_t *cspt; cspt = alloc (sizeof *cspt); memset (cspt, 0, sizeof *cspt); current->spt.data = cspt; alloc_page (&cspt->cr3tbl, &cspt->cr3tbl_phys); for (i = 0; i < NUM_OF_SPTTBL; i++) alloc_page (&cspt->tbl[i], &cspt->tbl_phys[i]); cspt->cnt = 0; memset (cspt->cr3tbl, 0, PAGESIZE); for (i = 0; i < NUM_OF_SPTSHADOW1; i++) { alloc_page (NULL, &cspt->shadow1[i].phys); cspt->shadow1[i].key = 0; cspt->shadow1[i].clear_n = NUM_OF_SPTSHADOWOFF + 1; cspt->shadow1[i].clear_area = ~0ULL; LIST3_HEAD_INIT (cspt->shadow1[i].shadow1map_ref, ref); } for (i = 0; i < NUM_OF_SPTSHADOW2; i++) { alloc_page (NULL, &cspt->shadow2[i].phys); cspt->shadow2[i].key = 0; cspt->shadow2[i].clear_n = NUM_OF_SPTSHADOWOFF + 1; cspt->shadow2[i].clear_area = ~0ULL; } spinlock_init (&cspt->rwmap_lock); rw_spinlock_init (&cspt->shadow1_lock); rw_spinlock_init (&cspt->shadow2_lock); clear_rwmap (cspt); clear_shadow1 (cspt); clear_shadow1map (cspt); clear_shadow2 (cspt); cspt->wp = false; cspt->cr0 = ~0; cspt->cr3 = 0; cspt->cr4 = 0; cspt->efer = 0; listspt = alloc (sizeof *listspt); listspt->spt = cspt; LIST1_PUSH (list1_spt, listspt); return 0; } static bool guest64 (void) { u64 efer; current->vmctl.read_msr (MSR_IA32_EFER, &efer); if (efer & MSR_IA32_EFER_LMA_BIT) return true; return false; } /* this function is called when shadow page table entries are cleared from TLB. every VM exit in VT. */ bool cpu_mmu_spt_tlbflush (void) { return spt_tlbflush (); } /* this function is called when a guest sets CR3 */ void cpu_mmu_spt_updatecr3 (void) { update_cr3 (); } /* this function is called by INVLPG in a guest */ /* deletes TLB entry regardless of G bit */ void cpu_mmu_spt_invalidate (ulong virtual_addr) { invalidate_page (virtual_addr); } static void set_m1 (u64 entry0, bool write, bool user, bool wp, struct map_page_data1 *m1) { m1->write = write; m1->user = user; m1->wp = wp; } static void set_m2 (u64 entries[5], int levels, struct map_page_data2 m2[5]) { unsigned int rw = 1, us = 1, nx = 0; int i; u64 entry; for (i = levels; i >= 0; i--) { entry = entries[i]; if (!(entry & PDE_RW_BIT)) rw = 0; if (!(entry & PDE_US_BIT)) us = 0; if (entry & PDE_NX_BIT) nx = 1; m2[i].rw = rw; m2[i].us = us; m2[i].nx = nx; } m2[0].cache_flag = msr_pte_to_cache_flag(entries[0]); if (!(entries[0] & PTE_D_BIT)) m2[0].rw = 0; } static void set_gfns (u64 entries[5], int levels, u64 gfns[5]) { int i; u64 entry; for (i = levels; i >= 0; i--) { entry = entries[i]; if (i == 1 && (entry & PDE_PS_BIT)) { if (entry & PDE_G_BIT) gfns[i] = GFN_GLOBAL; else gfns[i] = GFN_UNUSED; continue; } gfns[i] = (entry & PTE_ADDR_MASK64) >> PAGESIZE_SHIFT; } } /* handling a page fault of a guest */ void cpu_mmu_spt_pagefault (ulong err, ulong cr2) { int levels; vmmerr_t ret; bool wr, us, ex, wp; ulong cr0, cr3, cr4; struct map_page_data1 m1; struct map_page_data2 m2[5]; u64 efer, gfns[5], entries[5]; phys_t hphys; get_cr0_cr3_cr4_and_efer (&cr0, &cr3, &cr4, &efer); wr = !!(err & PAGEFAULT_ERR_WR_BIT); us = !!(err & PAGEFAULT_ERR_US_BIT); ex = !!(err & PAGEFAULT_ERR_ID_BIT); wp = !!(cr0 & CR0_WP_BIT); ret = mmu_get_pte (cr2, cr0, cr3, cr4, efer, wr, us, ex, entries, &levels); if (ret != VMMERR_SUCCESS) { mmu_generate_pagefault(ret, err & PAGEFAULT_ERR_WR_BIT, err & PAGEFAULT_ERR_US_BIT, cr2); return; } set_m1 (entries[0], wr, us, wp, &m1); set_m2 (entries, levels, m2); set_gfns (entries, levels, gfns); mmio_lock(); ret = mmio_pagefault(gfns[0] << PAGESIZE_SHIFT); mmio_unlock(); if (ret != VMMERR_NODEV) { if (ret != VMMERR_SUCCESS && (ret < VMMERR_PAGE_NOT_PRESENT || ret > VMMERR_PAGE_BAD_RESERVED_BIT)) { panic("Failed to emulate accessing to MMIO area. ret 0x%x", ret); } return; } hphys = current->vm->gmm.gp2hp((gfns[0] << PAGESIZE_SHIFT) + (cr2 & PAGESIZE_MASK)); if (hphys == GMM_NO_MAPPING) { ret = cpu_interpreter(); if (ret != VMMERR_SUCCESS && (ret < VMMERR_PAGE_NOT_PRESENT || ret > VMMERR_PAGE_BAD_RESERVED_BIT)) { panic("Failed to emulate accessing to no mapping area. ret 0x%x", ret); } return; } map_page (cr2, m1, m2, gfns, levels, hphys); } static void cpu_mmu_spt_init_global (void) { init_global (); } void cpu_mmu_spt_init (void) { init_vcpu (); } INITFUNC ("global4", cpu_mmu_spt_init_global); tinyvisor/vmm/core/svm_msr.c0000644006644000001440000001101111753454341016446 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include "asm.h" #include "constants.h" #include "cpu_mmu_spt.h" #include "current.h" #include "mm.h" #include "msr_pass.h" #include "panic.h" #include "svm_msr.h" #include "svm_np.h" void svm_msr_update_lma (void) { static const u64 mask = MSR_IA32_EFER_LME_BIT | MSR_IA32_EFER_LMA_BIT; if (current->u.svm.lme && (current->u.svm.vr.cr0 & CR0_PG_BIT)) { if (current->u.svm.lma) return; #ifdef __x86_64__ current->u.svm.lma = true; current->u.svm.vi.vmcb->efer |= mask; #else panic ("Long mode is not supported!"); #endif } else { if (!current->u.svm.lma) return; current->u.svm.lma = false; current->u.svm.vi.vmcb->efer &= ~mask; } } bool svm_read_msr (u32 msrindex, u64 *msrdata) { bool r = false; struct vmcb *vmcb; u64 data; static const u64 mask = MSR_IA32_EFER_LME_BIT | MSR_IA32_EFER_LMA_BIT; vmcb = current->u.svm.vi.vmcb; switch (msrindex) { case MSR_IA32_SYSENTER_CS: *msrdata = vmcb->sysenter_cs; break; case MSR_IA32_SYSENTER_ESP: *msrdata = vmcb->sysenter_esp; break; case MSR_IA32_SYSENTER_EIP: *msrdata = vmcb->sysenter_eip; break; case MSR_IA32_EFER: data = vmcb->efer; data &= ~mask; if (current->u.svm.lme) data |= MSR_IA32_EFER_LME_BIT; if (current->u.svm.lma) data |= MSR_IA32_EFER_LMA_BIT; *msrdata = data; break; case MSR_IA32_STAR: *msrdata = vmcb->star; break; case MSR_IA32_LSTAR: *msrdata = vmcb->lstar; break; case MSR_AMD_CSTAR: *msrdata = vmcb->cstar; break; case MSR_IA32_FMASK: *msrdata = vmcb->sfmask; break; case MSR_IA32_FS_BASE: *msrdata = vmcb->fs.base; break; case MSR_IA32_GS_BASE: *msrdata = vmcb->gs.base; break; case MSR_IA32_KERNEL_GS_BASE: *msrdata = vmcb->kernel_gs_base; break; default: r = msr_read(msrindex, msrdata); } return r; } bool svm_write_msr (u32 msrindex, u64 msrdata) { bool r = false; struct vmcb *vmcb; static const u64 mask = MSR_IA32_EFER_LME_BIT | MSR_IA32_EFER_LMA_BIT; vmcb = current->u.svm.vi.vmcb; switch (msrindex) { case MSR_IA32_SYSENTER_CS: vmcb->sysenter_cs = msrdata; break; case MSR_IA32_SYSENTER_ESP: vmcb->sysenter_esp = msrdata; break; case MSR_IA32_SYSENTER_EIP: vmcb->sysenter_eip = msrdata; break; case MSR_IA32_EFER: current->u.svm.lme = !!(msrdata & MSR_IA32_EFER_LME_BIT); vmcb->efer = (vmcb->efer & mask) | (msrdata & ~mask); /* FIXME: Reserved bits should be checked here. */ svm_msr_update_lma (); if (!current->u.svm.np) cpu_mmu_spt_updatecr3 (); else svm_np_updatecr3 (); break; case MSR_IA32_STAR: vmcb->star = msrdata; break; case MSR_IA32_LSTAR: vmcb->lstar = msrdata; break; case MSR_AMD_CSTAR: vmcb->cstar = msrdata; break; case MSR_IA32_FMASK: vmcb->sfmask = msrdata; break; case MSR_IA32_FS_BASE: vmcb->fs.base = msrdata; break; case MSR_IA32_GS_BASE: vmcb->gs.base = msrdata; break; case MSR_IA32_KERNEL_GS_BASE: vmcb->kernel_gs_base = msrdata; break; default: r = msr_write(msrindex, msrdata); } return r; } tinyvisor/vmm/core/apic_regs.h0000644006644000001440000000712412072152324016722 0ustar yuichi_xyusers/* * Copyright (c) 2010-2013 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_APIC_REGS_H #define _CORE_APIC_REGS_H #include "vcpu.h" #define APIC_BASE_ADDRESS 0xfee00000 #define APIC_MEM_SIZE 0x400 #define APIC_APIC_ID_OFFSET 0x20 #define APIC_APIC_ID_LENGTH 4 #define APIC_ID_MASK 0xff000000 #define APIC_ID_SHIFT 24 #define APIC_VERSION_OFFSET 0x30 #define APIC_EOI_OFFSET 0xb0 #define APIC_EOI_LENGTH 4 #define APIC_LOGICAL_APIC_ID_OFFSET 0xd0 #define APIC_LOGICAL_APIC_ID_LENGTH 4 #define APIC_SPURIOUS_INTR_VECT_OFFSET 0xf0 #define APIC_SOFTWARE_ENABLE_BIT 0x100 #define APIC_ISR_OFFSET 0x100 #define APIC_ICR_LOW_OFFSET 0x300 #define APIC_ICR_LOW_LENGTH 4 #define ICR_VECTOR_SHIFT 0 #define ICR_VECTOR_MASK 0x0ff #define ICR_DELIVERY_MODE_MASK 0x700 #define ICR_DELIVERY_MODE_FIXED 0x000 #define ICR_DELIVERY_MODE_LOWEST_PRI 0x100 #define ICR_DELIVERY_MODE_NMI 0x400 #define ICR_DELIVERY_MODE_INIT 0x500 #define ICR_DELIVERY_MODE_STARTUP 0x600 #define ICR_DEST_MODE_MASK 0x800 #define ICR_DEST_MODE_PHYSICAL 0x000 #define ICR_DEST_MODE_LOGICAL 0x800 #define ICR_STATUS_BIT 0x1000 #define ICR_STATUS_IDLE 0x0000 #define ICR_STATUS_PENDING 0x1000 #define ICR_LEVEL_BIT 0x4000 #define ICR_LEVEL_DEASSERT 0x0000 #define ICR_LEVEL_ASSERT 0x4000 #define ICR_TRIGGER_BIT 0x8000 #define ICR_TRIGGER_EDGE 0x0000 #define ICR_TRIGGER_LEVEL 0x8000 #define ICR_DSH_MASK 0xc0000 #define ICR_DSH_DEST 0x00000 #define ICR_DSH_SELF 0x40000 #define ICR_DSH_ALL 0x80000 #define ICR_DSH_OTHER 0xc0000 #define APIC_ICR_HIGH_OFFSET 0x310 #define APIC_ICR_HIGH_LENGTH 4 #define ICR_DEST_MASK 0xff000000 #define ICR_DEST_SHIFT 24 #define APIC_LVT_LINT0_OFFSET 0x350 #define APIC_LVT_LINT1_OFFSET 0x360 #define APIC_LVT_ERROR_OFFSET 0x370 inline static apic_id_t apic_get_apic_id (u32 icr_high) { return (icr_high & ICR_DEST_MASK) >> ICR_DEST_SHIFT; } inline static bool apic_is_logical_dest_mode (u32 icr_low) { return (icr_low & ICR_DEST_MODE_MASK) == ICR_DEST_MODE_LOGICAL; } inline static vector_t apic_get_vector (u32 icr_low) { return (icr_low & ICR_VECTOR_MASK) >> ICR_VECTOR_SHIFT; } #endif tinyvisor/vmm/core/svm_panic.c0000644006644000001440000000433211733245403016742 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include "asm.h" #include "constants.h" #include "current.h" #include "seg.h" #include "svm_exitcode.h" #include "svm_panic.h" static void svm_panic_dump2 (void) { } void svm_panic_dump (void) { current->vmctl.panic_dump = svm_panic_dump2; printf ("VMCB %p (phys %08llX)\n", current->u.svm.vi.vmcb, current->u.svm.vi.vmcb_phys); printf ("EXITCODE: "); printexitcode (current->u.svm.vi.vmcb->exitcode); printf ("EXITINFO1 %08llX ", current->u.svm.vi.vmcb->exitinfo1); printf ("EXITINFO2 %08llX ", current->u.svm.vi.vmcb->exitinfo2); printf ("EXITINTINFO %08llX\n", current->u.svm.vi.vmcb->exitintinfo); } tinyvisor/vmm/core/putchar.c0000644006644000001440000000410711733245403016431 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include "putchar.h" #include static putchar_func_t putchar_func; static spinlock_t putchar_lock = SPINLOCK_INITIALIZER; void putchar (unsigned char c) { spinlock_lock (&putchar_lock); if (putchar_func != NULL) putchar_func (c); spinlock_unlock (&putchar_lock); } void putchar_set_func (putchar_func_t newfunc, putchar_func_t *oldfunc) { spinlock_lock (&putchar_lock); if (oldfunc) *oldfunc = putchar_func; putchar_func = newfunc; spinlock_unlock (&putchar_lock); } tinyvisor/vmm/core/vm.h0000644006644000001440000000511412143435701015407 0ustar yuichi_xyusers/* * Copyright (c) 2010-2013 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_VM_H #define _CORE_VM_H #include #include #include #include #include #include "cpu.h" #include "gmm.h" #include "gmm_ident.h" #include "gmm_trans.h" #include "io_io.h" #include "mmio.h" #include "vcpu.h" #include "int.h" #include "vt.h" #define VM0_NAME "vm0" struct vm { LIST2_DEFINE(struct vm, vm_list); spinlock_t vcpu_list_lock; LIST2_DEFINE_HEAD(struct vcpu, vcpu_list); /* protected by vcpu_list_lock */ unsigned int vcpu_count; /* protected by vcpu_list_lock */ apic_id_t vbsp_apic_id; char name[VM_NAME_BUF_SIZE]; struct io_io_data io; rw_spinlock_t mmio_rwlock; struct mmio_data mmio; struct gmm_func gmm; union { struct gmm_ident gmm_ident; struct gmm_trans gmm_trans; }; struct vt_vm_data vt; bool iommu_enabled; u64 driver_data[]; /* variable length array */ }; struct vm *vm_new(void); struct vm *vm_find(void); bool vm_current_is_vbsp(void); void vm_dump(void); vmmerr_t vm_reset(void); #endif /* _CORE_VM_H */ tinyvisor/vmm/core/seg.c0000644006644000001440000002347511733245403015552 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include "apic.h" #include "asm.h" #include "constants.h" #include "mm.h" #include "pcpu.h" #include "process_sysenter.h" #include "seg.h" static struct pcpu boot_pcpu; static struct pcpu_gs boot_pcpu_gs; static u8 boot_ring0stack[PAGESIZE]; void get_seg_base (ulong gdtbase, u16 ldtr, u16 sel, ulong *segbase) { ulong ldtbase; struct segdesc *p; if (sel == 0) { *segbase = 0; } else if (sel & SEL_LDT_BIT) { p = (struct segdesc *)(gdtbase + (ldtr & SEL_MASK)); if (!p->p) goto err; ldtbase = SEGDESC_BASE (*p); p = (struct segdesc *)(ldtbase + (sel & SEL_MASK)); if (!p->p) goto err; *segbase = SEGDESC_BASE (*p); } else { p = (struct segdesc *)(gdtbase + (sel & SEL_MASK)); if (!p->p) goto err; *segbase = SEGDESC_BASE (*p); } return; err: printf ("ERROR: get_seg_base failed!\n"); *segbase = 0; } u32 get_seg_access_rights (u16 sel) { ulong tmp, ret; if (sel) { asm_lar (sel, &tmp); ret = (tmp >> 8) & ACCESS_RIGHTS_MASK; } else { ret = ACCESS_RIGHTS_UNUSABLE_BIT; } return ret; } static void set_segdesc (struct segdesc *d, u32 limit, u32 base, enum segdesc_type type, enum segdesc_s s, unsigned int dpl, unsigned int p, unsigned int avl, enum segdesc_l l, enum segdesc_d_b d_b) { d->base_15_0 = base; d->base_23_16 = base >> 16; d->type = type; d->s = s; d->dpl = dpl; d->p = p; d->avl = avl; d->l = l; d->d_b = d_b; d->base_31_24 = base >> 24; if (limit <= 0xFFFFF) { d->g = 0; d->limit_15_0 = limit >> 0; d->limit_19_16 = limit >> 16; } else { d->g = 1; d->limit_15_0 = limit >> 12; d->limit_19_16 = limit >> 28; } } static void set_segdesc_sys64 (struct segdesc *d32, u32 limit, u64 base, enum segdesc_type type, unsigned int dpl, unsigned int p, unsigned int avl) { struct syssegdesc64 *d; d = (struct syssegdesc64 *)d32; d->base_15_0 = base; d->base_23_16 = base >> 16; d->type = type; d->zero1 = 0; d->dpl = dpl; d->p = p; d->avl = avl; d->reserved1 = 0; d->base_31_24 = base >> 24; d->base_63_32 = base >> 32; d->reserved2 = 0; d->zero2 = 0; d->reserved3 = 0; if (limit <= 0xFFFFF) { d->g = 0; d->limit_15_0 = limit >> 0; d->limit_19_16 = limit >> 16; } else { d->g = 1; d->limit_15_0 = limit >> 12; d->limit_19_16 = limit >> 28; } } static void set_gatedesc (struct gatedesc32 *d, u32 offset, u32 sel, u32 param_count, enum gatedesc_type type, unsigned int dpl, unsigned int p) { d->offset_15_0 = offset; d->offset_31_16 = offset >> 16; d->sel = sel; d->param_count = param_count; d->zero1 = 0; d->type = type; d->zero2 = 0; d->dpl = dpl; d->p = p; } static void fill_segdesctbl (struct segdesc *gdt, struct tss32 *tss32, struct tss64 *tss64, struct pcpu_gs *gs) { int i; /* set_segdesc (d, limit, base, type, s, dpl, p, avl, l, d_b) */ /* SEG_SEL_CODE32 */ set_segdesc (&gdt[1], 0xFFFFFFFF, 0x00000000, SEGDESC_TYPE_EXECREAD_CODE, SEGDESC_S_CODE_OR_DATA_SEGMENT, 0, 1, 0, SEGDESC_L_16_OR_32, SEGDESC_D_B_32); /* SEG_SEL_DATA32 */ set_segdesc (&gdt[2], 0xFFFFFFFF, 0x00000000, SEGDESC_TYPE_RDWR_DATA, SEGDESC_S_CODE_OR_DATA_SEGMENT, 0, 1, 0, SEGDESC_L_16_OR_32, SEGDESC_D_B_32); /* SEG_SEL_CODE32U */ set_segdesc (&gdt[3], 0xFFFFFFFF, 0x00000000, SEGDESC_TYPE_EXECREAD_CODE, SEGDESC_S_CODE_OR_DATA_SEGMENT, 3, 1, 0, SEGDESC_L_16_OR_32, SEGDESC_D_B_32); /* SEG_SEL_DATA32U */ set_segdesc (&gdt[4], 0xFFFFFFFF, 0x00000000, SEGDESC_TYPE_RDWR_DATA, SEGDESC_S_CODE_OR_DATA_SEGMENT, 3, 1, 0, SEGDESC_L_16_OR_32, SEGDESC_D_B_32); /* SEG_SEL_TSS32 */ set_segdesc (&gdt[5], sizeof *tss32 - 1, (ulong)tss32, SEGDESC_TYPE_32BIT_TSS_AVAILABLE, SEGDESC_S_SYSTEM_SEGMENT, 0, 1, 0, 0, SEGDESC_D_B_16); /* SEG_SEL_CODE16 */ set_segdesc (&gdt[6], 0x0000FFFF, 0x00000000, SEGDESC_TYPE_EXECREAD_CODE, SEGDESC_S_CODE_OR_DATA_SEGMENT, 0, 1, 0, 0, SEGDESC_D_B_16); /* SEG_SEL_DATA16 */ set_segdesc (&gdt[7], 0x0000FFFF, 0x00000000, SEGDESC_TYPE_RDWR_DATA, SEGDESC_S_CODE_OR_DATA_SEGMENT, 0, 1, 0, 0, SEGDESC_D_B_16); /* SEG_SEL_PCPU32 */ set_segdesc (&gdt[8], sizeof *gs - 1, (ulong)gs, SEGDESC_TYPE_RDWR_DATA, SEGDESC_S_CODE_OR_DATA_SEGMENT, 0, 1, 0, SEGDESC_L_16_OR_32, SEGDESC_D_B_32); /* SEG_SEL_CALLGATE32 */ set_gatedesc ((struct gatedesc32 *)&gdt[9], (u32)(ulong)syscall_entry_lret, SEG_SEL_CODE32, 0, GATEDESC_TYPE_32BIT_CALL, 3, 1); /* SEG_SEL_CODE64 */ set_segdesc (&gdt[10], 0xFFFFFFFF, 0x00000000, SEGDESC_TYPE_EXECREAD_CODE, SEGDESC_S_CODE_OR_DATA_SEGMENT, 0, 1, 0, SEGDESC_L_64, SEGDESC_D_B_64); /* SEG_SEL_DATA64 */ set_segdesc (&gdt[11], 0xFFFFFFFF, 0x00000000, SEGDESC_TYPE_RDWR_DATA, SEGDESC_S_CODE_OR_DATA_SEGMENT, 0, 1, 0, SEGDESC_L_64, SEGDESC_D_B_64); /* SEG_SEL_CODE64U */ set_segdesc (&gdt[12], 0xFFFFFFFF, 0x00000000, SEGDESC_TYPE_EXECREAD_CODE, SEGDESC_S_CODE_OR_DATA_SEGMENT, 3, 1, 0, SEGDESC_L_64, SEGDESC_D_B_64); /* SEG_SEL_DATA64U */ set_segdesc (&gdt[13], 0xFFFFFFFF, 0x00000000, SEGDESC_TYPE_RDWR_DATA, SEGDESC_S_CODE_OR_DATA_SEGMENT, 3, 1, 0, SEGDESC_L_64, SEGDESC_D_B_64); /* SEG_SEL_TSS64 */ set_segdesc_sys64 (&gdt[14], sizeof *tss64 - 1, (ulong)tss64, SEGDESC_TYPE_64BIT_TSS_AVAILABLE, 0, 1, 0); /* SEG_SEL_PCPU64 */ set_segdesc (&gdt[16], sizeof *gs - 1, (ulong)gs, SEGDESC_TYPE_RDWR_DATA, SEGDESC_S_CODE_OR_DATA_SEGMENT, 0, 1, 0, SEGDESC_L_64, SEGDESC_D_B_64); /* Unused */ i = 17; ASSERT (i <= NUM_OF_SEGDESCTBL); for (; i < NUM_OF_SEGDESCTBL; i++) set_segdesc (&gdt[i], 0x00000000, 0x00000000, SEGDESC_TYPE_RDWR_DATA, SEGDESC_S_CODE_OR_DATA_SEGMENT, 0, 0, 0, 0, SEGDESC_D_B_16); } static void load_segment (struct segdesc *gdt) { asm_wrgdtr ((ulong)gdt, sizeof (gdt[0]) * NUM_OF_SEGDESCTBL - 1); #ifdef __x86_64__ asm_wrcs (SEG_SEL_CODE64); asm_wrds (SEG_SEL_DATA64); asm_wres (SEG_SEL_DATA64); asm_wrfs (SEG_SEL_DATA64); asm_wrgs (SEG_SEL_PCPU64); asm_wrss (SEG_SEL_DATA64); asm_wrldtr (0); asm_wrtr (SEG_SEL_TSS64); #else asm_wrcs (SEG_SEL_CODE32); asm_wrds (SEG_SEL_DATA32); asm_wres (SEG_SEL_DATA32); asm_wrfs (SEG_SEL_DATA32); asm_wrgs (SEG_SEL_PCPU32); asm_wrss (SEG_SEL_DATA32); asm_wrldtr (0); asm_wrtr (SEG_SEL_TSS32); #endif } /* for initializing AP. this uses alloc() */ void segment_init_ap(void) { struct pcpu *newpcpu; struct pcpu_gs *newpcpu_gs; void *newstack; vmmerr_t err; newpcpu = alloc (sizeof *newpcpu); if (newpcpu == NULL) { panic("Failed to allocate memory for struct pcpu."); } memcpy (newpcpu, &pcpu_default, sizeof (struct pcpu)); newpcpu->apic_id = apic_read_id(); newpcpu->bsp = false; newpcpu->disable_interrupt = 1; newpcpu_gs = alloc (sizeof *newpcpu_gs); if (newpcpu_gs == NULL) { panic("Failed to allocate memory for struct pcpu_gs."); } memset (newpcpu_gs, 0, sizeof *newpcpu_gs); newpcpu_gs->currentcpu = newpcpu; err = alloc_page(&newstack, NULL); if (err) { panic("Failed to allocate stack for AP."); } newpcpu->tss32.esp0 = (ulong)((u8 *)newstack + PAGESIZE); newpcpu->tss32.ss0 = SEG_SEL_DATA32; newpcpu->tss32.iomap = sizeof (newpcpu->tss32); newpcpu->tss64.rsp0 = (ulong)((u8 *)newstack + PAGESIZE); newpcpu->tss64.iomap = sizeof (newpcpu->tss64); fill_segdesctbl (newpcpu->segdesctbl, &newpcpu->tss32, &newpcpu->tss64, newpcpu_gs); load_segment (newpcpu->segdesctbl); } /* for the first initialization. alloc() cannot be used */ static void segment_init_global (void) { memcpy (&boot_pcpu, &pcpu_default, sizeof (struct pcpu)); boot_pcpu.apic_id = apic_read_id(); boot_pcpu.disable_interrupt = 1; boot_pcpu.bsp = true; boot_pcpu_gs.currentcpu = &boot_pcpu; boot_pcpu.tss32.esp0 = (ulong)&boot_ring0stack[PAGESIZE]; boot_pcpu.tss32.ss0 = SEG_SEL_DATA32; boot_pcpu.tss32.iomap = sizeof (boot_pcpu.tss32); boot_pcpu.tss64.rsp0 = (ulong)&boot_ring0stack[PAGESIZE]; boot_pcpu.tss64.iomap = sizeof (boot_pcpu.tss64); fill_segdesctbl (boot_pcpu.segdesctbl, &boot_pcpu.tss32, &boot_pcpu.tss64, &boot_pcpu_gs); load_segment (boot_pcpu.segdesctbl); } INITFUNC ("global0", segment_init_global); tinyvisor/vmm/core/thread.c0000644006644000001440000001657111733245403016242 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include #include #include #include "mm.h" #include "panic.h" #include "pcpu.h" #include "thread.h" #include "thread_switch.h" #define MAXNUM_OF_THREADS 256 #define CPU_ID_ANY MAX_CPU_ID + 1 extern ulong volatile syscallstack asm ("%gs:gs_syscallstack"); enum thread_state { THREAD_EXIT, THREAD_RUN, THREAD_WILL_STOP, THREAD_STOP, }; struct thread_context { ulong r12, r13, r14_edi, r15_esi, rbx, rbp, rip; }; struct thread_data { LIST1_DEFINE (struct thread_data); struct thread_context *context; tid_t tid; enum thread_state state; cpu_id_t cpu_id; bool boot; void *stack; int pid; ulong syscallstack; phys_t process_switch; bool process_switch_enable; }; static struct thread_data td[MAXNUM_OF_THREADS]; static LIST1_DEFINE_HEAD_INIT(struct thread_data, td_free); static LIST1_DEFINE_HEAD_INIT(struct thread_data, td_runnable); static spinlock_t thread_lock; static void thread_data_init (struct thread_data *d, struct thread_context *c, void *stack, cpu_id_t cpu_id) { d->context = c; d->cpu_id = cpu_id; d->boot = false; d->stack = stack; d->pid = 0; d->syscallstack = 0; d->process_switch_enable = false; d->state = THREAD_RUN; } static void thread_data_save (struct thread_data *d) { d->stack = currentcpu->stackaddr; d->pid = currentcpu->pid; d->syscallstack = syscallstack; } static void thread_data_load (struct thread_data *d) { currentcpu->stackaddr = d->stack; currentcpu->pid = d->pid; syscallstack = d->syscallstack; if (d->process_switch_enable) mm_process_switch (d->process_switch); } tid_t thread_gettid (void) { return currentcpu->tid; } static void switched (void) { spinlock_unlock (&thread_lock); } void schedule (void) { struct thread_data *d; tid_t oldtid, newtid; spinlock_lock (&thread_lock); LIST1_FOREACH (td_runnable, d) { if (d->cpu_id == CPU_ID_ANY || d->cpu_id == get_cpu_id()) goto found; } spinlock_unlock (&thread_lock); return; found: LIST1_DEL (td_runnable, d); oldtid = currentcpu->tid; newtid = d->tid; thread_data_save (&td[oldtid]); currentcpu->tid = newtid; thread_data_load (d); switch (td[oldtid].state) { case THREAD_EXIT: LIST1_ADD (td_free, &td[oldtid]); break; case THREAD_RUN: LIST1_ADD (td_runnable, &td[oldtid]); break; case THREAD_WILL_STOP: td[oldtid].state = THREAD_STOP; break; case THREAD_STOP: default: panic ("schedule: bad state tid=%d state=%d", oldtid, td[oldtid].state); } thread_switch (&td[oldtid].context, d->context, 0); switched (); } asmlinkage void thread_start1 (void (*func) (void *), void *arg) { switched (); func (arg); thread_exit (); } tid_t thread_new_bind(void (*func) (void *), void *arg, int stacksize, cpu_id_t cpu_id) { u8 *stack, *q; struct thread_data *d; struct thread_context c; tid_t r; stack = alloc (stacksize); if (stack == NULL) { panic("thread_new: Failed to allocate a stack."); } q = stack + stacksize; c.rbp = 0; c.rip = (ulong)thread_start0; #define PUSH(n) memcpy (q -= sizeof (n), &(n), sizeof (n)) PUSH (arg); PUSH (func); PUSH (c); #undef PUSH spinlock_lock (&thread_lock); d = LIST1_POP (td_free); ASSERT (d); thread_data_init (d, (struct thread_context *)q, stack, cpu_id); LIST1_ADD (td_runnable, d); r = d->tid; spinlock_unlock (&thread_lock); return r; } tid_t thread_new (void (*func) (void *), void *arg, int stacksize) { return thread_new_bind(func, arg, stacksize, CPU_ID_ANY); } static enum thread_state thread_set_state (tid_t tid, enum thread_state state) { enum thread_state oldstate; spinlock_lock (&thread_lock); oldstate = td[tid].state; td[tid].state = state; spinlock_unlock (&thread_lock); return oldstate; } void thread_wakeup (tid_t tid) { switch (thread_set_state (tid, THREAD_RUN)) { case THREAD_RUN: printf ("WARNING: waking up runnable thread tid=%d\n", tid); break; case THREAD_WILL_STOP: break; case THREAD_STOP: spinlock_lock (&thread_lock); LIST1_ADD (td_runnable, &td[tid]); spinlock_unlock (&thread_lock); break; case THREAD_EXIT: default: panic ("thread_wakeup: bad state tid=%d state=%d", tid, td[tid].state); } } void thread_will_stop (void) { switch (thread_set_state (currentcpu->tid, THREAD_WILL_STOP)) { case THREAD_RUN: break; case THREAD_WILL_STOP: printf ("WARNING: thread_will_stop called twice tid=%d\n", currentcpu->tid); break; case THREAD_STOP: case THREAD_EXIT: default: panic ("thread_will_stop: bad state tid=%d state=%d", currentcpu->tid, td[currentcpu->tid].state); } } void thread_exit (void) { switch (thread_set_state (currentcpu->tid, THREAD_EXIT)) { case THREAD_EXIT: printf ("WARNING: thread already exited tid=%d\n", currentcpu->tid); break; case THREAD_RUN: break; case THREAD_WILL_STOP: printf ("thread_exit called after thread_will_stop tid=%d\n", currentcpu->tid); break; case THREAD_STOP: default: panic ("thread_exit: bad state tid=%d state=%d", currentcpu->tid, td[currentcpu->tid].state); } schedule (); } void thread_set_process_switch (phys_t switchto) { td[currentcpu->tid].process_switch = switchto; td[currentcpu->tid].process_switch_enable = true; } static void thread_init_global (void) { int i; spinlock_init (&thread_lock); for (i = 0; i < MAXNUM_OF_THREADS; i++) { td[i].tid = i; td[i].state = THREAD_EXIT; LIST1_ADD (td_free, &td[i]); } } static void thread_init_pcpu (void) { struct thread_data *d; spinlock_lock (&thread_lock); d = LIST1_POP (td_free); ASSERT (d); thread_data_init (d, NULL, NULL, get_cpu_id()); d->boot = true; currentcpu->tid = d->tid; spinlock_unlock (&thread_lock); } INITFUNC ("global3", thread_init_global); INITFUNC ("pcpu0", thread_init_pcpu); tinyvisor/vmm/core/mm.c0000644006644000001440000005425512165305216015404 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include #include #include #include "asm.h" #include "callrealmode.h" #include "current.h" #include "entry.h" #include "mm.h" #include "panic.h" #include "vramwrite.h" #define MAXNUM_OF_SYSMEMMAP 256 #define HOST_PTE_ATTR_WB 0 #define HOST_PTE_ATTR_WT (PTE_PWT_BIT) #define HOST_PTE_ATTR_WUC (PTE_PCD_BIT) #define HOST_PTE_ATTR_UC (PTE_PCD_BIT | PTE_PWT_BIT) #define HOST_PTE_ATTR_WP (PTE_PAT_BIT | PTE_PWT_BIT) #define HOST_PTE_ATTR_WC (PTE_PAT_BIT | PTE_PCD_BIT) extern u8 end[]; static phys_t memorysize = 0; static phys32_t top_of_low_avail_mem; static phys32_t vmm_start_phys; static struct page pagestruct[NUM_OF_PAGES]; static spinlock_t mapmem_lock; static virt_t mapmem_lastvirt = MAPMEM_ADDR_END - PAGESIZE; static struct resource mem_address_space; static struct resource sysmemmap[MAXNUM_OF_SYSMEMMAP]; static struct resource vmm_mem_resource; static int sysmemmaplen; struct memsizetmp { void *addr; int ok; }; int get_phys_mem_map_count(void) { return sysmemmaplen; } int get_phys_mem_map(int index, phys_t *base, phys_t *len, u32 *type) { if (index < 0 || index >= sysmemmaplen) { return 0; } *base = sysmemmap[index].start; *len = sysmemmap[index].end - sysmemmap[index].start + 1; *type = sysmemmap[index].data; return 1; } phys32_t mm_top_of_low_avail_mem() { return top_of_low_avail_mem; } struct resource * mm_next_mem_map(struct resource *resource) { return RM_RESOURCE_NEXT(&mem_address_space, resource); } static void getallsysmemmap (void) { int i; u32 n = 0, nn = 1; struct e820map e820map; phys_t memsize = 0; struct resource *entry; for (i = 0; i < MAXNUM_OF_SYSMEMMAP && nn; i++, n = nn) { if (callrealmode_getsysmemmap (n, &e820map, &nn)) panic ("getsysmemmap failed"); entry = sysmemmap + i; entry->start = e820map.base; entry->end = e820map.base + e820map.len - 1; entry->type = RESOURCE_TYPE_MEM; entry->data = e820map.type; entry->name = "mem"; rm_insert_resource(&mem_address_space, entry); if (entry->data == MEM_TYPE_AVAILABLE) { memsize += e820map.len; if (entry->end <= 0xffffffff && entry->end > top_of_low_avail_mem) { top_of_low_avail_mem = entry->end; } } } memorysize = memsize; sysmemmaplen = i; } void mm_dump_mem_address_space(void) { rm_dump_resources(&mem_address_space); } static void debug_sysmemmap_print (void) { int index = 0; phys_t hphys; phys_t len; u32 type; while (get_phys_mem_map(index++, &hphys, &len, &type)) { printf("%llx len %llx type %x\n", hphys, len, type); } printf ("Done.\n"); } /* Find a physical address for VMM. 0 is returned on error */ static phys32_t find_vmm_phys (void) { phys32_t base32, limit32, phys; phys_t limit64; phys_t base; phys_t len; u32 type; int index = 0; phys = 0; while(get_phys_mem_map(index++, &base, &len, &type)) { if (type != MEM_TYPE_AVAILABLE) continue; /* only available area can be used */ if (base >= 0x100000000ULL) continue; /* we can't use over 4GB */ limit64 = base + len - 1; if (limit64 >= 0x100000000ULL) limit64 = 0xFFFFFFFFULL; /* ignore over 4GB */ base32 = base; limit32 = limit64; if (base32 > limit32) continue; /* avoid strange value */ if (base32 > (0xFFFFFFFF - VMMSIZE_ALL + 1)) continue; /* we need more than VMMSIZE_ALL */ if (limit32 < VMMSIZE_ALL) continue; /* skip shorter than VMMSIZE_ALL */ base32 = (base32 + 0x003FFFFF) & 0xFFC00000; /* align 4MB */ limit32 = ((limit32 + 1) & 0xFFC00000) - 1; /* align 4MB */ if (base32 > limit32) continue; /* lack space after alignment */ if (limit32 - base32 >= (VMMSIZE_ALL - 1) && /* enough */ phys < limit32 - (VMMSIZE_ALL - 1)) { /* use top of it */ phys = limit32 - (VMMSIZE_ALL - 1); } } return phys; } struct page * virt_to_page (virt_t virt) { unsigned int i; i = (virt - VMM_START_VIRT) >> PAGESIZE_SHIFT; ASSERT (i < NUM_OF_PAGES); return &pagestruct[i]; } virt_t phys_to_virt (phys_t phys) { return (virt_t)(phys - vmm_start_phys + VMM_START_VIRT); } struct page * phys_to_page (phys_t phys) { return virt_to_page (phys_to_virt (phys)); } virt_t page_to_virt (struct page *p) { return p->virt; } phys_t page_to_phys (struct page *p) { return p->phys; } u32 vmm_start_inf() { return vmm_start_phys ; } u32 vmm_term_inf() { return vmm_start_phys+VMMSIZE_ALL ; } #if 0 void dump_pt(char *name, void *page_table) { u64 *pt = page_table; int i; printf("%s %p\n", name, pt); for (i = 0; i < PTE_NUM_IN_TABLE_64 / 4; i++) { printf(" %016llx %016llx %016llx %016llx\n", pt[0], pt[1], pt[2], pt[3]); pt += 4; } } #endif static void move_vmm (void) { int i; ulong cr3; /* Create a page directory to map vmm area */ for (i = 0; i < VMMSIZE_ALL >> PAGESIZE2M_SHIFT; i++) vmm_pd1[i] = (vmm_start_phys + (i << PAGESIZE2M_SHIFT)) | PDE_P_BIT | PDE_RW_BIT | PDE_PS_BIT | PDE_A_BIT | PDE_D_BIT; /* map vmm area at 0xC0000000 temporarily */ entry_pdp[3] = (((u64)(ulong)vmm_pd1) - 0x40000000) | PDPE_ATTR; asm_rdcr3 (&cr3); asm_wrcr3 (cr3); /* make a new page directory for switching from/to real mode */ /* virt 0x00000000 identity mapping */ vmm_pdp[0] = sym_to_phys (entry_pd0) | PDPE_ATTR; /* virt 0x40000000 vmm area */ vmm_pdp[1] = sym_to_phys (vmm_pd1) | PDPE_ATTR; #ifndef __x86_64__ vmm_base_cr3 = sym_to_phys (vmm_pdp); #else vmm_pml4[0] = sym_to_phys (vmm_pdp) | PDE_P_BIT | PDE_RW_BIT | PDE_US_BIT; vmm_base_cr3 = sym_to_phys (vmm_pml4); #endif /* make a new page directory for normal-use */ /* virt 0x40000000 vmm area */ vmm_main_pdp[1] = sym_to_phys (vmm_pd1) | PDPE_ATTR; /* virt 0x80000000 mapmem area */ vmm_main_pdp[2] = sym_to_phys (vmm_pd2) | PDPE_ATTR; #ifndef __x86_64__ vmm_main_cr3 = sym_to_phys (vmm_main_pdp); #else vmm_main_pml4[0] = sym_to_phys (vmm_main_pdp) | PDE_P_BIT | PDE_RW_BIT | PDE_US_BIT; vmm_main_cr3 = sym_to_phys (vmm_main_pml4); #endif #ifdef __x86_64__ /* * If I call move_vmm_area64, a machine is reset. * If I call memcpy, a machine continue to work. */ /* move_vmm_area64 (); */ memcpy((char *)0xC0100000L, (char *)0x40100000L, end - head); #else move_vmm_area32 (); #endif asm_wrcr3(vmm_main_cr3); } static void map_hphys (void) { #ifdef __x86_64__ void *virt; phys_t phys; u64 *pdp, *pd; u64 i; int pdpi, pdi; vmmerr_t err; err = alloc_page (&virt, &phys); if (err) { panic("Failed to allocate memory for a l3 page table."); } memset (virt, 0, PAGESIZE); vmm_main_pml4[1] = phys | PDE_P_BIT | PDE_RW_BIT | PDE_A_BIT; pdp = virt; pdpi = 0; pdi = 512; for (i = 0; i < NUM_OF_HPHYS_PAGES; i += 512) { if (pdi >= 512) { if (pdpi >= 512) panic ("NUM_OF_HPHYS_PAGES is too large."); err = alloc_page (&virt, &phys); if (err) { panic("Failed to allocate memory for a l2 page table."); } memset (virt, 0, PAGESIZE); pdp[pdpi++] = phys | PDE_P_BIT | PDE_RW_BIT | PDE_A_BIT; pd = virt; pdi = 0; } pd[pdi++] = (i << PAGESIZE_SHIFT) | PDE_P_BIT | PDE_RW_BIT | PDE_PS_BIT | PDE_A_BIT | PDE_D_BIT; } #endif } static void mm_init_global (void) { int i; vmmerr_t err; spinlock_init (&mapmem_lock); rm_init_resource(&mem_address_space, 0, 0xffffffffffffffffLL, RESOURCE_TYPE_MEM, 0, "mem-space"); getallsysmemmap (); vmm_start_phys = find_vmm_phys (); if (vmm_start_phys == 0) { printf("Failed to allocate %d MiB for VMM.\n", VMMSIZE_ALL >> 20); debug_sysmemmap_print (); panic("Failed to allocate %d MiB for VMM.\n", VMMSIZE_ALL >> 20); } printf ("%lld bytes (%lld MiB) RAM available.\n", memorysize, memorysize >> 20); printf ("VMM will use 0x%08X-0x%08X (%d MiB).\n", vmm_start_phys, vmm_start_phys + VMMSIZE_ALL, VMMSIZE_ALL >> 20); rm_init_resource(&vmm_mem_resource, vmm_start_phys, vmm_start_phys + VMMSIZE_ALL - 1, RESOURCE_TYPE_MEM, MEM_TYPE_AVAILABLE, "vmm"); err = rm_insert_resource(rm_find_resource(&mem_address_space, vmm_start_phys), &vmm_mem_resource); if (err) { panic("Failed to insert the vmm memory to sysmemmap. err 0x%x", err); } vramwrite_exit_global(); move_vmm (); mm_alloc_init (); for (i = 0; i < NUM_OF_PAGES; i++) { pagestruct[i].type = PAGE_TYPE_RESERVED; pagestruct[i].allocsize = 0; pagestruct[i].phys = vmm_start_phys + PAGESIZE * i; pagestruct[i].virt = VMM_START_VIRT + PAGESIZE * i; } for (i = 0; i < NUM_OF_PAGES; i++) { if ((u64)(long)head <= pagestruct[i].virt && pagestruct[i].virt < (u64)(long)end) continue; mm_page_free (&pagestruct[i]); } map_hphys (); vramwrite_mm_initialized(); } /* get a physical address of a symbol sym */ phys_t sym_to_phys (void *sym) { return ((virt_t)sym) - 0x40000000 + vmm_start_phys; } bool phys_in_vmm (phys_t phys) { return (phys >= vmm_start_phys) && (phys < vmm_start_phys + VMMSIZE_ALL); } /**********************************************************************/ /*** accessing page tables ***/ void pmap_open_vmm (pmap_t *m, ulong cr3, int levels) { m->levels = levels; m->readlevel = levels; m->curlevel = levels - 1; m->entry[levels] = (cr3 & ~PAGESIZE_MASK) | PDE_P_BIT; m->type = PMAP_TYPE_VMM; } void pmap_open_guest (pmap_t *m, ulong cr3, int levels, bool atomic) { m->levels = levels; m->readlevel = levels; m->curlevel = levels - 1; if (levels == 3) m->entry[levels] = (cr3 & (~0x1F | CR3_PWT_BIT | CR3_PCD_BIT)) | PDE_P_BIT; else m->entry[levels] = (cr3 & (~PAGESIZE_MASK | CR3_PWT_BIT | CR3_PCD_BIT)) | PDE_P_BIT; if (atomic) m->type = PMAP_TYPE_GUEST_ATOMIC; else m->type = PMAP_TYPE_GUEST; } void pmap_close (pmap_t *m) { } int pmap_getreadlevel (pmap_t *m) { return m->readlevel + 1; } void pmap_setlevel (pmap_t *m, int level) { m->curlevel = level - 1; } void pmap_setvirt (pmap_t *m, virt_t virtaddr, int level) { const u64 masks[3][4] = { { 0xFFFFF000, 0xFFC00000, 0x00000000, 0x00000000, }, { 0xFFFFF000, 0xFFE00000, 0xC0000000, 0x00000000, }, { 0x0000FFFFFFFFF000ULL, 0x0000FFFFFFE00000ULL, 0x0000FFFFC0000000ULL, 0x0000FF8000000000ULL, } }; u64 mask; pmap_setlevel (m, level); while (m->readlevel < m->levels) { mask = masks[m->levels - 2][m->readlevel]; if ((m->curaddr & mask) == (virtaddr & mask)) break; m->readlevel++; } m->curaddr = virtaddr; } static u64 pmap_rd32 (pmap_t *m, u64 phys, u32 attr) { u32 r = 0; switch (m->type) { case PMAP_TYPE_VMM: r = *(u32 *)phys_to_virt (phys); break; case PMAP_TYPE_GUEST: read_gphys_l (phys, &r, attr); break; case PMAP_TYPE_GUEST_ATOMIC: cmpxchg_gphys_l (phys, &r, r, attr); break; } return r; } static u64 pmap_rd64 (pmap_t *m, u64 phys, u32 attr) { u64 r = 0; switch (m->type) { case PMAP_TYPE_VMM: r = *(u64 *)phys_to_virt (phys); break; case PMAP_TYPE_GUEST: read_gphys_q (phys, &r, attr); break; case PMAP_TYPE_GUEST_ATOMIC: cmpxchg_gphys_q (phys, &r, r, attr); break; } return r; } static bool pmap_wr32 (pmap_t *m, u64 phys, u32 attr, u64 oldentry, u64 *entry) { u32 tmp; bool r = false; switch (m->type) { case PMAP_TYPE_VMM: *(u32 *)phys_to_virt (phys) = *entry; break; case PMAP_TYPE_GUEST: write_gphys_l (phys, *entry, attr); break; case PMAP_TYPE_GUEST_ATOMIC: tmp = oldentry; r = cmpxchg_gphys_l (phys, &tmp, *entry, attr); if (r) *entry = tmp; break; } return r; } static bool pmap_wr64 (pmap_t *m, u64 phys, u32 attr, u64 oldentry, u64 *entry) { bool r = false; switch (m->type) { case PMAP_TYPE_VMM: *(u64 *)phys_to_virt (phys) = *entry; break; case PMAP_TYPE_GUEST: write_gphys_q (phys, *entry, attr); break; case PMAP_TYPE_GUEST_ATOMIC: r = cmpxchg_gphys_q (phys, &oldentry, *entry, attr); if (r) *entry = oldentry; break; } return r; } u64 pmap_read (pmap_t *m) { u64 tmp; u32 tblattr; while (m->readlevel > m->curlevel) { tmp = m->entry[m->readlevel]; if (!(tmp & PDE_P_BIT)) return 0; if (m->readlevel == 1 && (tmp & PDE_PS_BIT)) { if (m->curlevel == 0) { /* * If large page, and requested level * is 1 (m->curlevel == 0), return * pseudo PTE. */ tmp &= ~PDE_PS_BIT; if (tmp & PDE_4M_PAT_BIT) { tmp |= PTE_PAT_BIT; tmp &= ~PDE_4M_PAT_BIT; } if (m->levels == 2) { tmp &= ~0x3FF000ULL; tmp |= (m->curaddr & 0x3FF000); } else { tmp &= ~0x1FF000ULL; tmp |= (m->curaddr & 0x1FF000); } } return tmp; } tblattr = tmp & (PDE_PWT_BIT | PDE_PCD_BIT); if (m->levels == 3 && m->readlevel == 3) tmp &= 0xFFFFFFE0; else tmp &= 0x0000FFFFFFFFF000ULL; m->readlevel--; if (m->levels == 2) { tmp |= (m->curaddr >> (10 + 10 * m->readlevel)) & 0xFFC; m->entryaddr[m->readlevel] = tmp; m->entry[m->readlevel] = pmap_rd32 (m, tmp, tblattr); } else { tmp |= (m->curaddr >> (9 + 9 * m->readlevel)) & 0xFF8; m->entryaddr[m->readlevel] = tmp; m->entry[m->readlevel] = pmap_rd64 (m, tmp, tblattr); } } return m->entry[m->curlevel]; } bool pmap_write (pmap_t *m, u64 e, uint attrmask) { uint attrdef = PTE_RW_BIT | PTE_US_BIT | PTE_A_BIT; u32 tblattr; bool fail; ASSERT (m->readlevel <= m->curlevel); if (m->levels == 3 && m->curlevel == 2) attrdef = 0; else if (m->curlevel == 0) attrdef |= PTE_D_BIT; e &= (~0xFFFULL) | attrmask; e |= attrdef & ~attrmask; tblattr = m->entry[m->curlevel + 1] & (PDE_PWT_BIT | PDE_PCD_BIT); if (m->levels == 2) fail = pmap_wr32 (m, m->entryaddr[m->curlevel], tblattr, m->entry[m->curlevel], &e); else fail = pmap_wr64 (m, m->entryaddr[m->curlevel], tblattr, m->entry[m->curlevel], &e); m->entry[m->curlevel] = e; if (fail) m->readlevel = m->curlevel; return fail; } void * pmap_pointer (pmap_t *m) { ASSERT (m->readlevel <= m->curlevel); ASSERT (m->type == PMAP_TYPE_VMM); return (void *)phys_to_virt (m->entryaddr[m->curlevel]); } void pmap_clear (pmap_t *m) { ASSERT (m->readlevel <= m->curlevel + 1); ASSERT (m->entry[m->curlevel + 1] & PDE_P_BIT); ASSERT (!(m->curlevel == 0 && (m->entry[1] & PDE_PS_BIT))); ASSERT (m->type == PMAP_TYPE_VMM); memset ((void *)phys_to_virt (m->entry[m->curlevel + 1] & ~0xFFF), 0, (m->levels == 3 && m->curlevel == 2) ? 8 * 4 : PAGESIZE); m->readlevel = m->curlevel + 1; } vmmerr_t pmap_autoalloc (pmap_t *m) { int level; void *tmp; phys_t phys; vmmerr_t err; ASSERT (m->type == PMAP_TYPE_VMM); level = m->curlevel; if (m->readlevel <= level) return VMMERR_SUCCESS; if (!(m->entry[m->readlevel] & PDE_P_BIT)) goto readskip; for (;;) { pmap_read (m); if (m->readlevel <= level) return VMMERR_SUCCESS; ASSERT (!(m->entry[m->readlevel] & PDE_P_BIT)); readskip: err = alloc_page (&tmp, &phys); if (err) { printf("pmap_autoalloc: Failed to allocate memory for a page table."); return VMMERR_NOMEM; } memset (tmp, 0, PAGESIZE); m->curlevel = m->readlevel; pmap_write (m, phys | PDE_P_BIT, PDE_P_BIT); m->curlevel = level; } } void pmap_dump (pmap_t *m) { printf ("entry[0]=0x%08llX ", m->entry[0]); printf ("entry[1]=0x%08llX ", m->entry[1]); printf ("entry[2]=0x%08llX\n", m->entry[2]); printf ("entry[3]=0x%08llX ", m->entry[3]); printf ("entry[4]=0x%08llX\n", m->entry[4]); printf ("entryaddr[0]=0x%08llX ", m->entryaddr[0]); printf ("entryaddr[1]=0x%08llX\n", m->entryaddr[1]); printf ("entryaddr[2]=0x%08llX ", m->entryaddr[2]); printf ("entryaddr[3]=0x%08llX\n", m->entryaddr[3]); printf ("curaddr=0x%08lX ", m->curaddr); printf ("curlevel=%d ", m->curlevel); printf ("readlevel=%d ", m->readlevel); printf ("levels=%d ", m->levels); printf ("type=%d\n", m->type); } /**********************************************************************/ /*** accessing memory ***/ static void * mapped_hphys_addr (phys_t hphys, uint len) { #if NUM_OF_HPHYS_PAGES == 0 return NULL; #else if ((hphys >> PAGESIZE_SHIFT) >= NUM_OF_HPHYS_PAGES) return NULL; if (((hphys + len - 1) >> PAGESIZE_SHIFT) >= NUM_OF_HPHYS_PAGES) return NULL; return (void *)(virt_t)(HPHYS_ADDR + hphys); #endif } static void * mapped_gphys_addr(phys_t gphys, uint len, u32 flags) { #if NUM_OF_HPHYS_PAGES == 0 return NULL; #else phys_t p1, p2; phys_t hphys, hphys1, hphys2; hphys = current->vm->gmm.gp2hp(gphys); if (hphys == GMM_NO_MAPPING) { return NULL; } hphys1 = hphys & ~PAGESIZE_MASK; p1 = gphys & ~PAGESIZE_MASK; p2 = (gphys + len - 1) & ~PAGESIZE_MASK; while (p1 != p2) { p1 += PAGESIZE; hphys1 += PAGESIZE; if (hphys1 != (hphys2 = current->vm->gmm.gp2hp(p1))) { return NULL; } if (hphys2 == GMM_NO_MAPPING) { return NULL; } } return mapped_hphys_addr(hphys, len); #endif } static void * mapmem_alloc (pmap_t *m, uint offset, uint len) { u64 pte; virt_t virt; uint n, i; int loopcount = 0; n = (offset + len + PAGESIZE_MASK) >> PAGESIZE_SHIFT; virt = mapmem_lastvirt; retry: for (i = 0; i < n; i++) { virt += PAGESIZE; if (virt >= MAPMEM_ADDR_END) { virt = MAPMEM_ADDR_START; loopcount++; if (loopcount > 1) { /* Not enough virtual address space. */ return NULL; } goto retry; } pmap_setvirt (m, virt, 1); pte = pmap_read (m); if (pte & PTE_P_BIT) { /* The virtual address is already used. */ virt += PAGESIZE; goto retry; } } mapmem_lastvirt = virt; return (void *)(virt + offset); } u64 mm_cache_flag_to_pte_attr (int flags) { switch (flags & MAPMEM_CACHE_MASK) { case MAPMEM_WB: return HOST_PTE_ATTR_WB; case MAPMEM_UC: return HOST_PTE_ATTR_UC; case MAPMEM_WUC: return HOST_PTE_ATTR_WUC; case MAPMEM_WC: return HOST_PTE_ATTR_WC; case MAPMEM_WT: return HOST_PTE_ATTR_WT; case MAPMEM_WP: return HOST_PTE_ATTR_WP; default: panic ("Unknown cashe flag %d", flags & MAPMEM_CACHE_MASK); } } static int mapmem_domap(pmap_t *m, void *virt_addr, int flags, phys_t phys_addr, uint len) { virt_t virt; u64 pte; phys_t phys, hphys; uint i, num; vmmerr_t err; virt = (virt_t)virt_addr & ~PAGESIZE_MASK; phys = phys_addr & ~PAGESIZE_MASK; num = ((phys_addr & PAGESIZE_MASK) + len + PAGESIZE_MASK) >> PAGESIZE_SHIFT; for (i = 0; i < num; i++) { pmap_setvirt (m, virt, 1); err = pmap_autoalloc(m); if (err) { printf("Failed to create page table. cpu %d virt 0x%lx\n", get_cpu_id(), virt); goto unmap; } if (flags & MAPMEM_GPHYS) { hphys = current->vm->gmm.gp2hp(phys); if (hphys == GMM_NO_MAPPING) { printf("Failed to map no gp2hp mapping area. cpu %d gphys 0x%llx\n", get_cpu_id(), phys); goto unmap; } } else { hphys = phys; } if ((pmap_read (m) & PTE_P_BIT) != 0) { printf("mapmem_domap: virt_addr %p, phys_addr 0x%llx, pte %llx, i %d\n", virt_addr, phys_addr, pmap_read(m), i); } ASSERT ((pmap_read (m) & PTE_P_BIT) == 0); pte = (hphys & ~PAGESIZE_MASK) | PTE_P_BIT | mm_cache_flag_to_pte_attr (flags); if (flags & MAPMEM_WRITE) { pte |= PTE_RW_BIT; } pmap_write (m, pte, PTE_P_BIT | PTE_RW_BIT | PTE_PWT_BIT | PTE_PCD_BIT | PTE_PAT_BIT); asm_invlpg ((void *)(virt)); virt += PAGESIZE; phys += PAGESIZE; } return 0; unmap: virt = (virt_t)virt_addr & ~PAGESIZE_MASK; num = i; for (i = 0; i < num; i++) { pmap_setvirt(m, virt, 1); if (pmap_read(m) & PTE_P_BIT) pmap_write(m, 0, 0); asm_invlpg((void *)(virt)); virt += PAGESIZE; } return -1; } void unmapmem(void *virt_addr, uint len) { pmap_t m; virt_t virt; ulong hostcr3; uint num, i; if ((virt_t)virt_addr < MAPMEM_ADDR_START || (virt_t)virt_addr >= MAPMEM_ADDR_END) return; virt = (virt_t)virt_addr & ~PAGESIZE_MASK; num = (((virt_t)virt_addr & PAGESIZE_MASK) + len + PAGESIZE_MASK) >> PAGESIZE_SHIFT; spinlock_lock(&mapmem_lock); asm_rdcr3(&hostcr3); pmap_open_vmm(&m, hostcr3, PMAP_LEVELS); for (i = 0; i < num; i++) { pmap_setvirt(&m, virt, 1); if (pmap_read(&m) & PTE_P_BIT) pmap_write(&m, 0, 0); asm_invlpg((void *)(virt)); virt += PAGESIZE; } pmap_close(&m); spinlock_unlock(&mapmem_lock); } void * mapmem(u32 flags, phys_t physaddr, uint len) { void *virt; pmap_t m; ulong hostcr3; ASSERT (!(flags & ~MAPMEM_VALID_FLAG)); if ((flags & MAPMEM_CACHE_MASK) != MAPMEM_WB) goto skip; if (flags & MAPMEM_GPHYS) { virt = mapped_gphys_addr(physaddr, len, flags); } else { virt = mapped_hphys_addr(physaddr, len); } if (virt) { return virt; } skip: spinlock_lock(&mapmem_lock); asm_rdcr3(&hostcr3); pmap_open_vmm(&m, hostcr3, PMAP_LEVELS); virt = mapmem_alloc(&m, physaddr & PAGESIZE_MASK, len); if (virt == NULL) { goto out; } if (mapmem_domap(&m, virt, flags, physaddr, len)) { virt = NULL; goto out; } out: pmap_close(&m); spinlock_unlock(&mapmem_lock); return virt; } void * mapmem_hphys (phys_t physaddr, uint len, u32 flags) { return mapmem (MAPMEM_HPHYS | flags, physaddr, len); } void * mapmem_gphys (phys_t physaddr, uint len, u32 flags) { return mapmem (MAPMEM_GPHYS | flags, physaddr, len); } INITFUNC ("global2", mm_init_global); tinyvisor/vmm/core/param.h0000644006644000001440000000334711733245403016075 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_PARAM_H #define _CORE_PARAM_H #include #include #define CMDLINE_SIZE 1024 void param_save(const char *cmdline); #endif /* _CORE_PARAM_H */ tinyvisor/vmm/core/initfunc.h0000644006644000001440000000322311733245403016605 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_INITFUNC_H #define _CORE_INITFUNC_H void initfunc_init (void); #endif tinyvisor/vmm/core/vt_internal.h0000644006644000001440000001306111753454341017321 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_VT_INTERNAL_H #define _CORE_VT_INTERNAL_H #include #include "asm.h" #include "constants.h" #include "regs.h" #include "cpu_seg.h" struct vcpu; enum exit_qual_cr_lmsw { EXIT_QUAL_CR_LMSW_REGISTER = 0, EXIT_QUAL_CR_LMSW_MEMORY = 1, }; enum exit_qual_cr_type { EXIT_QUAL_CR_TYPE_MOV_TO_CR = 0, EXIT_QUAL_CR_TYPE_MOV_FROM_CR = 1, EXIT_QUAL_CR_TYPE_CLTS = 2, EXIT_QUAL_CR_TYPE_LMSW = 3, }; enum exit_qual_io_dir { EXIT_QUAL_IO_DIR_OUT = 0, EXIT_QUAL_IO_DIR_IN = 1, }; enum exit_qual_io_op { EXIT_QUAL_IO_OP_DX = 0, EXIT_QUAL_IO_OP_IMMEDIATE = 1, }; enum exit_qual_io_rep { EXIT_QUAL_IO_REP_NOT_REP = 0, EXIT_QUAL_IO_REP_REP = 1, }; enum exit_qual_io_size { EXIT_QUAL_IO_SIZE_1BYTE = 0, EXIT_QUAL_IO_SIZE_2BYTE = 1, EXIT_QUAL_IO_SIZE_4BYTE = 3, }; enum exit_qual_io_str { EXIT_QUAL_IO_STR_NOT_STRING = 0, EXIT_QUAL_IO_STR_STRING = 1, }; enum exit_qual_ts_src { EXIT_QUAL_TS_SRC_CALL = 0, EXIT_QUAL_TS_SRC_IRET = 1, EXIT_QUAL_TS_SRC_JMP = 2, EXIT_QUAL_TS_SRC_INTR = 3, }; struct regs_in_vmcs_sreg { u16 sel; ulong limit; ulong acr; ulong base; }; struct regs_in_vmcs_desc { ulong base; ulong limit; }; struct regs_in_vmcs { struct regs_in_vmcs_sreg es, cs, ss, ds, fs, gs, ldtr, tr; struct regs_in_vmcs_desc gdtr, idtr; ulong cr0, cr3, cr4; ulong dr7, rflags; }; struct exit_qual_cr { enum control_reg num : 4; enum exit_qual_cr_type type : 2; enum exit_qual_cr_lmsw lmsw : 1; unsigned int reserved1 : 1; enum general_reg reg : 4; unsigned int reserved2 : 4; unsigned int lmsw_src : 16; } __attribute__ ((packed)); struct exit_qual_io { enum exit_qual_io_size size : 3; enum exit_qual_io_dir dir : 1; enum exit_qual_io_str str : 1; enum exit_qual_io_rep rep : 1; enum exit_qual_io_op op : 1; unsigned int reserved1 : 9; unsigned int port : 16; } __attribute__ ((packed)); struct exit_qual_ts { unsigned int sel : 16; unsigned int reserved1 : 14; enum exit_qual_ts_src src : 2; unsigned int reserved2 : 32; }; void vt_reset (void); void vt_vminit (void); void vt_vmexit (void); void shutdown_vmm (void); void printexitreason (int num); char *message_exitreason (int num); void vt_io (void); void vt_iopass_init (void); void vt_extern_iopass (struct vcpu *p, ioport_t port, bool pass); void vt_invlpg (ulong addr); void vt_run_vm (void); void vt_msr_update_lma (void); int vt_add_guest_msr (ulong index); bool vt_read_guest_msr (int i, u64 *data); bool vt_write_guest_msr (int i, u64 data); bool vt_read_msr (u32 msrindex, u64 *msrdata); bool vt_write_msr (u32 msrindex, u64 msrdata); void vt_msr_init (void); void vt_panic_dump (void); void vt_get_current_regs_in_vmcs (struct regs_in_vmcs *p); void vt_read_general_reg (enum general_reg reg, ulong *val); void vt_write_general_reg (enum general_reg reg, ulong val); void vt_read_control_reg (enum control_reg reg, ulong *val); void vt_write_control_reg (enum control_reg reg, ulong val); void vt_read_sreg_sel (enum sreg s, u16 *val); void vt_read_sreg_acr (enum sreg s, ulong *val); void vt_read_sreg_base (enum sreg s, ulong *val); void vt_read_sreg_limit (enum sreg s, ulong *val); void vt_spt_setcr3 (ulong cr3); void vt_read_ip (ulong *val); void vt_write_ip (ulong val); void vt_read_flags (ulong *val); void vt_write_flags (ulong val); void vt_read_gdtr (ulong *base, ulong *limit); void vt_write_gdtr (ulong base, ulong limit); void vt_read_idtr (ulong *base, ulong *limit); void vt_write_idtr (ulong base, ulong limit); void vt_write_realmode_seg (enum sreg s, u16 val); vmmerr_t vt_writing_sreg (enum sreg s); #ifdef CONFIG_VT_EPT void vt_ept_init(void); void vt_ept_violation(void); void vt_ept_pg_change(bool pg); #else static inline vmmerr_t vt_ept_init(void) { return VMMERR_NOSUP; } static inline void vt_ept_violation(void) { } static inline void vt_ept_pg_change(bool pe) { } #endif static inline void add_ip (void) { ulong ip, len; asm_vmread (VMCS_GUEST_RIP, &ip); asm_vmread (VMCS_VMEXIT_INSTRUCTION_LEN, &len); ip += len; asm_vmwrite (VMCS_GUEST_RIP, ip); } #endif tinyvisor/vmm/core/vt_regs.c0000644006644000001440000005012512165305216016434 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include "asm.h" #include "constants.h" #include "cpu_mmu_spt.h" #include "current.h" #include "entry.h" #include "mm.h" #include "panic.h" #include #include "seg.h" #include "vt_internal.h" #define REALMODE_IDTR_BASE 0 #define REALMODE_IDTR_LIMIT 0 #define REALMODE_TR_LIMIT (65536 / 8 - 1) #define REALMODE_TR_ACR 0x8B #define REALMODE_TR_BASE sym_to_phys (head) #define CR4_PASSTHROUGH CR4_OSXSAVE_BIT #define VMREAD(a,b) do { \ ulong tmp; \ \ asm_vmread ((a), &tmp); \ *(b) = tmp; \ } while (0) void vt_read_general_reg (enum general_reg reg, ulong *val) { switch (reg) { case GENERAL_REG_RAX: *val = current->u.vt.vr.rax; break; case GENERAL_REG_RCX: *val = current->u.vt.vr.rcx; break; case GENERAL_REG_RDX: *val = current->u.vt.vr.rdx; break; case GENERAL_REG_RBX: *val = current->u.vt.vr.rbx; break; case GENERAL_REG_RSP: asm_vmread (VMCS_GUEST_RSP, val); break; case GENERAL_REG_RBP: *val = current->u.vt.vr.rbp; break; case GENERAL_REG_RSI: *val = current->u.vt.vr.rsi; break; case GENERAL_REG_RDI: *val = current->u.vt.vr.rdi; break; case GENERAL_REG_R8: *val = current->u.vt.vr.r8; break; case GENERAL_REG_R9: *val = current->u.vt.vr.r9; break; case GENERAL_REG_R10: *val = current->u.vt.vr.r10; break; case GENERAL_REG_R11: *val = current->u.vt.vr.r11; break; case GENERAL_REG_R12: *val = current->u.vt.vr.r12; break; case GENERAL_REG_R13: *val = current->u.vt.vr.r13; break; case GENERAL_REG_R14: *val = current->u.vt.vr.r14; break; case GENERAL_REG_R15: *val = current->u.vt.vr.r15; break; default: panic ("Unknown register."); } } void vt_write_general_reg (enum general_reg reg, ulong val) { switch (reg) { case GENERAL_REG_RAX: current->u.vt.vr.rax = val; break; case GENERAL_REG_RCX: current->u.vt.vr.rcx = val; break; case GENERAL_REG_RDX: current->u.vt.vr.rdx = val; break; case GENERAL_REG_RBX: current->u.vt.vr.rbx = val; break; case GENERAL_REG_RSP: asm_vmwrite (VMCS_GUEST_RSP, val); break; case GENERAL_REG_RBP: current->u.vt.vr.rbp = val; break; case GENERAL_REG_RSI: current->u.vt.vr.rsi = val; break; case GENERAL_REG_RDI: current->u.vt.vr.rdi = val; break; case GENERAL_REG_R8: current->u.vt.vr.r8 = val; break; case GENERAL_REG_R9: current->u.vt.vr.r9 = val; break; case GENERAL_REG_R10: current->u.vt.vr.r10 = val; break; case GENERAL_REG_R11: current->u.vt.vr.r11 = val; break; case GENERAL_REG_R12: current->u.vt.vr.r12 = val; break; case GENERAL_REG_R13: current->u.vt.vr.r13 = val; break; case GENERAL_REG_R14: current->u.vt.vr.r14 = val; break; case GENERAL_REG_R15: current->u.vt.vr.r15 = val; break; default: panic ("Unknown register."); } } void vt_read_control_reg (enum control_reg reg, ulong *val) { switch (reg) { case CONTROL_REG_CR0: asm_vmread (VMCS_CR0_READ_SHADOW, val); break; case CONTROL_REG_CR2: *val = current->u.vt.vr.cr2; break; case CONTROL_REG_CR3: *val = current->u.vt.vr.cr3; break; case CONTROL_REG_CR4: asm_vmread (VMCS_CR4_READ_SHADOW, val); break; default: panic ("Unknown control register."); } } static void pe_change_switch_tr (bool pe) { struct vt_realmode_data *rd; rd = ¤t->u.vt.realmode; if (pe) { asm_vmwrite (VMCS_GUEST_TR_LIMIT, rd->tr_limit); asm_vmwrite (VMCS_GUEST_TR_ACCESS_RIGHTS, rd->tr_acr); asm_vmwrite (VMCS_GUEST_TR_BASE, rd->tr_base); } else { asm_vmread (VMCS_GUEST_TR_LIMIT, &rd->tr_limit); asm_vmread (VMCS_GUEST_TR_ACCESS_RIGHTS, &rd->tr_acr); asm_vmread (VMCS_GUEST_TR_BASE, &rd->tr_base); asm_vmwrite (VMCS_GUEST_TR_LIMIT, REALMODE_TR_LIMIT); asm_vmwrite (VMCS_GUEST_TR_ACCESS_RIGHTS, REALMODE_TR_ACR); asm_vmwrite (VMCS_GUEST_TR_BASE, REALMODE_TR_BASE); } } static void pe_change_enable_sw (bool pe) { ulong rflags, tmp; struct vt_vmentry_regs *vr; /* save all segment selectors */ vr = ¤t->u.vt.vr; if (!(vr->sw.enable & SW_SREG_ES_BIT)) VMREAD (VMCS_GUEST_ES_SEL, &vr->sw.es); if (!(vr->sw.enable & SW_SREG_CS_BIT)) VMREAD (VMCS_GUEST_CS_SEL, &vr->sw.cs); if (!(vr->sw.enable & SW_SREG_SS_BIT)) VMREAD (VMCS_GUEST_SS_SEL, &vr->sw.ss); if (!(vr->sw.enable & SW_SREG_DS_BIT)) VMREAD (VMCS_GUEST_DS_SEL, &vr->sw.ds); if (!(vr->sw.enable & SW_SREG_FS_BIT)) VMREAD (VMCS_GUEST_FS_SEL, &vr->sw.fs); if (!(vr->sw.enable & SW_SREG_GS_BIT)) VMREAD (VMCS_GUEST_GS_SEL, &vr->sw.gs); /* enable emulation */ vr->sw.num = 0; /* number of emulated instructions */ vr->sw.enable = SW_SREG_ES_BIT | SW_SREG_CS_BIT | SW_SREG_SS_BIT | SW_SREG_DS_BIT | SW_SREG_FS_BIT | SW_SREG_GS_BIT; if (pe) { /* real address mode to protected mode */ /* clear a virtual 8086 mode flag */ asm_vmread (VMCS_GUEST_RFLAGS, &rflags); rflags &= ~RFLAGS_VM_BIT; asm_vmwrite (VMCS_GUEST_RFLAGS, rflags); /* * To keep segment base and limit in real mode, * we don't touch them. */ /* * Set segment access rights to proper value for protect mode. * The DPL of CS and SS must be zero. */ asm_vmwrite (VMCS_GUEST_ES_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_CS_ACCESS_RIGHTS, 0x9B); asm_vmwrite (VMCS_GUEST_SS_ACCESS_RIGHTS, 0x93); asm_vmwrite (VMCS_GUEST_DS_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_FS_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_GS_ACCESS_RIGHTS, 0xF3); /* * If a selector of CS or SS is a multiple of 4, * it is usable as it is without emulation * A null selector is also acceptable */ if ((vr->sw.cs & 3) == 0) { asm_vmwrite (VMCS_GUEST_CS_SEL, vr->sw.cs); vr->sw.enable &= ~SW_SREG_CS_BIT; } if ((vr->sw.ss & 3) == 0) { asm_vmwrite (VMCS_GUEST_SS_SEL, vr->sw.ss); vr->sw.enable &= ~SW_SREG_SS_BIT; } vr->sw.enable &= ~(SW_SREG_ES_BIT | SW_SREG_DS_BIT | SW_SREG_FS_BIT | SW_SREG_GS_BIT); } else { /* protected mode to real address mode */ /* set a virtual 8086 mode flag */ asm_vmread (VMCS_GUEST_RFLAGS, &rflags); rflags |= RFLAGS_VM_BIT; asm_vmwrite (VMCS_GUEST_RFLAGS, rflags); /* * If the guest is in virtual-8086 mode, base-address * fields must be the selector field shifted left 4 * bits. BASE fields must be < 0xfffff. */ /* FIXME: segment base must be a multiple of 16. if not, it will be panic. */ asm_vmread (VMCS_GUEST_CS_BASE, &tmp); asm_vmwrite (VMCS_GUEST_CS_SEL, tmp >> 4); if ((tmp >> 4) == vr->sw.cs) vr->sw.enable &= ~SW_SREG_CS_BIT; asm_vmread (VMCS_GUEST_ES_BASE, &tmp); if (tmp > 0xfffff) { tmp = 0; asm_vmwrite (VMCS_GUEST_ES_BASE, tmp); } asm_vmwrite (VMCS_GUEST_ES_SEL, tmp >> 4); if ((tmp >> 4) == vr->sw.es) vr->sw.enable &= ~SW_SREG_ES_BIT; asm_vmread (VMCS_GUEST_SS_BASE, &tmp); if (tmp > 0xfffff) { tmp = 0; asm_vmwrite (VMCS_GUEST_SS_BASE, tmp); } asm_vmwrite (VMCS_GUEST_SS_SEL, tmp >> 4); if ((tmp >> 4) == vr->sw.ss) vr->sw.enable &= ~SW_SREG_SS_BIT; asm_vmread (VMCS_GUEST_DS_BASE, &tmp); if (tmp > 0xfffff) { tmp = 0; asm_vmwrite (VMCS_GUEST_DS_BASE, tmp); } asm_vmwrite (VMCS_GUEST_DS_SEL, tmp >> 4); if ((tmp >> 4) == vr->sw.ds) vr->sw.enable &= ~SW_SREG_DS_BIT; asm_vmread (VMCS_GUEST_FS_BASE, &tmp); if (tmp > 0xfffff) { tmp = 0; asm_vmwrite (VMCS_GUEST_FS_BASE, tmp); } asm_vmwrite (VMCS_GUEST_FS_SEL, tmp >> 4); if ((tmp >> 4) == vr->sw.fs) vr->sw.enable &= ~SW_SREG_FS_BIT; asm_vmread (VMCS_GUEST_GS_BASE, &tmp); if (tmp > 0xfffff) { tmp = 0; asm_vmwrite (VMCS_GUEST_GS_BASE, tmp); } asm_vmwrite (VMCS_GUEST_GS_SEL, tmp >> 4); if ((tmp >> 4) == vr->sw.gs) vr->sw.enable &= ~SW_SREG_GS_BIT; /* * If the guest will be virtual-8086, limit fields * must be 0000FFFFH. */ /* set segment access rights to proper value */ asm_vmwrite (VMCS_GUEST_ES_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_CS_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_SS_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_DS_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_FS_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_GS_ACCESS_RIGHTS, 0xF3); /* * If the guest will be virtual-8086, access-rights * fields must be 000000F3H */ asm_vmwrite (VMCS_GUEST_ES_LIMIT, 0xFFFF); asm_vmwrite (VMCS_GUEST_CS_LIMIT, 0xFFFF); asm_vmwrite (VMCS_GUEST_SS_LIMIT, 0xFFFF); asm_vmwrite (VMCS_GUEST_DS_LIMIT, 0xFFFF); asm_vmwrite (VMCS_GUEST_FS_LIMIT, 0xFFFF); asm_vmwrite (VMCS_GUEST_GS_LIMIT, 0xFFFF); } } static void pe_change (bool pe) { ulong idtr_base, idtr_limit; /* IDTR is different between real mode emulation and protected mode */ vt_read_idtr (&idtr_base, &idtr_limit); vt_write_idtr (REALMODE_IDTR_BASE, REALMODE_IDTR_LIMIT); current->u.vt.vr.pe = pe; vt_write_idtr (idtr_base, idtr_limit); /* switching TR */ pe_change_switch_tr (pe); /* enable emulation */ pe_change_enable_sw (pe); } void vt_write_control_reg (enum control_reg reg, ulong val) { ulong cr0_0, cr0_1; ulong cr4_0, cr4_1; ulong host_val; switch (reg) { case CONTROL_REG_CR0: asm_vmwrite (VMCS_CR0_READ_SHADOW, val); if (!(val & CR0_PE_BIT)) val &= ~CR0_PG_BIT; if (!!(val & CR0_PE_BIT) != !!current->u.vt.vr.pe) { pe_change (!!(val & CR0_PE_BIT)); } if (!!(val & CR0_PG_BIT) != !!current->u.vt.vr.pg) { current->u.vt.vr.pg = !!(val & CR0_PG_BIT); vt_ept_pg_change(current->u.vt.vr.pg); cpu_mmu_spt_updatecr3(); } vt_msr_update_lma (); if (!(current->u.vt.ept_enabled && current->u.vt.vr.pg)) { val |= CR0_WP_BIT; } asm_rdmsr (MSR_IA32_VMX_CR0_FIXED0, &cr0_0); asm_rdmsr (MSR_IA32_VMX_CR0_FIXED1, &cr0_1); val &= cr0_1; val |= cr0_0; asm_vmwrite (VMCS_GUEST_CR0, val); cpu_mmu_spt_updatecr3 (); /* FIXME! Do we need this? */ break; case CONTROL_REG_CR2: current->u.vt.vr.cr2 = val; break; case CONTROL_REG_CR3: current->u.vt.vr.cr3 = val; if (current->u.vt.ept_enabled && current->u.vt.vr.pg) { asm_vmwrite(VMCS_GUEST_CR3, val); } cpu_mmu_spt_updatecr3(); break; case CONTROL_REG_CR4: asm_vmwrite (VMCS_CR4_READ_SHADOW, val); asm_rdcr4(&host_val); host_val = (host_val & ~CR4_PASSTHROUGH) | (val & CR4_PASSTHROUGH); asm_wrcr4(host_val); asm_vmread(VMCS_HOST_CR4, &host_val); host_val = (host_val & ~CR4_PASSTHROUGH) | (val & CR4_PASSTHROUGH); asm_vmwrite(VMCS_HOST_CR4, host_val); asm_rdmsr (MSR_IA32_VMX_CR4_FIXED0, &cr4_0); asm_rdmsr (MSR_IA32_VMX_CR4_FIXED1, &cr4_1); val &= cr4_1; val |= cr4_0; if (!(current->u.vt.ept_enabled && current->u.vt.vr.pg)) { /* * Shadow paging requires PAE for both 32 bit * and 64 bit guest. */ val |= CR4_PAE_BIT; } asm_vmwrite(VMCS_GUEST_CR4, val); cpu_mmu_spt_updatecr3 (); break; default: panic ("Unknown control register."); } } void vt_read_sreg_sel (enum sreg s, u16 *val) { ulong tmp; switch (s) { case SREG_ES: if (!(current->u.vt.vr.sw.enable & SW_SREG_ES_BIT)) asm_vmread (VMCS_GUEST_ES_SEL, &tmp); else tmp = current->u.vt.vr.sw.es; *val = tmp; break; case SREG_CS: if (!(current->u.vt.vr.sw.enable & SW_SREG_CS_BIT)) asm_vmread (VMCS_GUEST_CS_SEL, &tmp); else tmp = current->u.vt.vr.sw.cs; *val = tmp; break; case SREG_SS: if (!(current->u.vt.vr.sw.enable & SW_SREG_SS_BIT)) asm_vmread (VMCS_GUEST_SS_SEL, &tmp); else tmp = current->u.vt.vr.sw.ss; *val = tmp; break; case SREG_DS: if (!(current->u.vt.vr.sw.enable & SW_SREG_DS_BIT)) asm_vmread (VMCS_GUEST_DS_SEL, &tmp); else tmp = current->u.vt.vr.sw.ds; *val = tmp; break; case SREG_FS: if (!(current->u.vt.vr.sw.enable & SW_SREG_FS_BIT)) asm_vmread (VMCS_GUEST_FS_SEL, &tmp); else tmp = current->u.vt.vr.sw.fs; *val = tmp; break; case SREG_GS: if (!(current->u.vt.vr.sw.enable & SW_SREG_GS_BIT)) asm_vmread (VMCS_GUEST_GS_SEL, &tmp); else tmp = current->u.vt.vr.sw.gs; *val = tmp; break; default: panic ("Unknown sreg."); } } void vt_read_sreg_acr (enum sreg s, ulong *val) { switch (s) { case SREG_ES: asm_vmread (VMCS_GUEST_ES_ACCESS_RIGHTS, val); break; case SREG_CS: asm_vmread (VMCS_GUEST_CS_ACCESS_RIGHTS, val); break; case SREG_SS: asm_vmread (VMCS_GUEST_SS_ACCESS_RIGHTS, val); break; case SREG_DS: asm_vmread (VMCS_GUEST_DS_ACCESS_RIGHTS, val); break; case SREG_FS: asm_vmread (VMCS_GUEST_FS_ACCESS_RIGHTS, val); break; case SREG_GS: asm_vmread (VMCS_GUEST_GS_ACCESS_RIGHTS, val); break; default: panic ("Unknown sreg."); } } void vt_read_sreg_base (enum sreg s, ulong *val) { ulong tmp; switch (s) { case SREG_ES: case SREG_CS: case SREG_SS: case SREG_DS: if (current->u.vt.lma) { vt_read_sreg_acr (SREG_CS, &tmp); if (tmp & ACCESS_RIGHTS_L_BIT) { *val = 0; return; } } break; default: break; } switch (s) { case SREG_ES: asm_vmread (VMCS_GUEST_ES_BASE, val); break; case SREG_CS: asm_vmread (VMCS_GUEST_CS_BASE, val); break; case SREG_SS: asm_vmread (VMCS_GUEST_SS_BASE, val); break; case SREG_DS: asm_vmread (VMCS_GUEST_DS_BASE, val); break; case SREG_FS: asm_vmread (VMCS_GUEST_FS_BASE, val); break; case SREG_GS: asm_vmread (VMCS_GUEST_GS_BASE, val); break; default: panic ("Unknown sreg."); } } void vt_read_sreg_limit (enum sreg s, ulong *val) { ulong tmp; if (current->u.vt.lma) { vt_read_sreg_acr (SREG_CS, &tmp); if (tmp & ACCESS_RIGHTS_L_BIT) { *val = ~0UL; return; } } switch (s) { case SREG_ES: asm_vmread (VMCS_GUEST_ES_LIMIT, val); break; case SREG_CS: asm_vmread (VMCS_GUEST_CS_LIMIT, val); break; case SREG_SS: asm_vmread (VMCS_GUEST_SS_LIMIT, val); break; case SREG_DS: asm_vmread (VMCS_GUEST_DS_LIMIT, val); break; case SREG_FS: asm_vmread (VMCS_GUEST_FS_LIMIT, val); break; case SREG_GS: asm_vmread (VMCS_GUEST_GS_LIMIT, val); break; default: panic ("Unknown sreg."); } } void vt_spt_setcr3 (ulong cr3) { if (current->u.vt.ept_enabled && current->u.vt.vr.pg) { return; } asm_vmwrite (VMCS_GUEST_CR3, cr3); } void vt_read_ip (ulong *val) { asm_vmread (VMCS_GUEST_RIP, val); } void vt_write_ip (ulong val) { asm_vmwrite (VMCS_GUEST_RIP, val); current->updateip = true; } void vt_read_flags (ulong *val) { asm_vmread (VMCS_GUEST_RFLAGS, val); if (!current->u.vt.vr.pe) *val &= ~RFLAGS_VM_BIT; } void vt_write_flags (ulong val) { if (!current->u.vt.vr.pe) val |= RFLAGS_VM_BIT; asm_vmwrite (VMCS_GUEST_RFLAGS, val); } void vt_read_gdtr (ulong *base, ulong *limit) { asm_vmread (VMCS_GUEST_GDTR_BASE, base); asm_vmread (VMCS_GUEST_GDTR_LIMIT, limit); } void vt_write_gdtr (ulong base, ulong limit) { asm_vmwrite (VMCS_GUEST_GDTR_BASE, base); asm_vmwrite (VMCS_GUEST_GDTR_LIMIT, limit); } void vt_read_idtr (ulong *base, ulong *limit) { if (current->u.vt.vr.pe) { asm_vmread (VMCS_GUEST_IDTR_BASE, base); asm_vmread (VMCS_GUEST_IDTR_LIMIT, limit); } else { *base = current->u.vt.realmode.idtr.base; *limit = current->u.vt.realmode.idtr.limit; } } void vt_write_idtr (ulong base, ulong limit) { if (current->u.vt.vr.pe) { asm_vmwrite (VMCS_GUEST_IDTR_BASE, base); asm_vmwrite (VMCS_GUEST_IDTR_LIMIT, limit); } else { current->u.vt.realmode.idtr.base = base; current->u.vt.realmode.idtr.limit = limit; } } void vt_get_current_regs_in_vmcs (struct regs_in_vmcs *p) { asm_rdes (&p->es.sel); asm_rdcs (&p->cs.sel); asm_rdss (&p->ss.sel); asm_rdds (&p->ds.sel); asm_rdfs (&p->fs.sel); asm_rdgs (&p->gs.sel); asm_rdldtr (&p->ldtr.sel); asm_rdtr (&p->tr.sel); asm_rdcr0 (&p->cr0); asm_rdcr3 (&p->cr3); asm_rdcr4 (&p->cr4); asm_lsl (p->es.sel, &p->es.limit); asm_lsl (p->cs.sel, &p->cs.limit); asm_lsl (p->ss.sel, &p->ss.limit); asm_lsl (p->ds.sel, &p->ds.limit); asm_lsl (p->fs.sel, &p->fs.limit); asm_lsl (p->gs.sel, &p->gs.limit); asm_lsl (p->ldtr.sel, &p->ldtr.limit); asm_lsl (p->tr.sel, &p->tr.limit); p->es.acr = get_seg_access_rights (p->es.sel); p->cs.acr = get_seg_access_rights (p->cs.sel); p->ss.acr = get_seg_access_rights (p->ss.sel); p->ds.acr = get_seg_access_rights (p->ds.sel); p->fs.acr = get_seg_access_rights (p->fs.sel); p->gs.acr = get_seg_access_rights (p->gs.sel); p->ldtr.acr = get_seg_access_rights (p->ldtr.sel); p->tr.acr = get_seg_access_rights (p->tr.sel); asm_rdgdtr (&p->gdtr.base, &p->gdtr.limit); asm_rdidtr (&p->idtr.base, &p->idtr.limit); get_seg_base (p->gdtr.base, p->ldtr.sel, p->es.sel, &p->es.base); get_seg_base (p->gdtr.base, p->ldtr.sel, p->cs.sel, &p->cs.base); get_seg_base (p->gdtr.base, p->ldtr.sel, p->ss.sel, &p->ss.base); get_seg_base (p->gdtr.base, p->ldtr.sel, p->ds.sel, &p->ds.base); get_seg_base (p->gdtr.base, p->ldtr.sel, p->fs.sel, &p->fs.base); get_seg_base (p->gdtr.base, p->ldtr.sel, p->gs.sel, &p->gs.base); get_seg_base (p->gdtr.base, p->ldtr.sel, p->ldtr.sel, &p->ldtr.base); get_seg_base (p->gdtr.base, p->ldtr.sel, p->tr.sel, &p->tr.base); asm_rddr7 (&p->dr7); asm_rdrflags (&p->rflags); } void vt_write_realmode_seg (enum sreg s, u16 val) { switch (s) { case SREG_ES: asm_vmwrite (VMCS_GUEST_ES_SEL, val); asm_vmwrite (VMCS_GUEST_ES_BASE, val << 4); asm_vmwrite (VMCS_GUEST_ES_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_ES_LIMIT, 0xFFFF); break; case SREG_CS: asm_vmwrite (VMCS_GUEST_CS_SEL, val); asm_vmwrite (VMCS_GUEST_CS_BASE, val << 4); /* * In virtual 8086 mode, access-right field for CS * segment must be 000000F3H */ asm_vmwrite (VMCS_GUEST_CS_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_CS_LIMIT, 0xFFFF); break; case SREG_SS: asm_vmwrite (VMCS_GUEST_SS_SEL, val); asm_vmwrite (VMCS_GUEST_SS_BASE, val << 4); asm_vmwrite (VMCS_GUEST_SS_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_SS_LIMIT, 0xFFFF); break; case SREG_DS: asm_vmwrite (VMCS_GUEST_DS_SEL, val); asm_vmwrite (VMCS_GUEST_DS_BASE, val << 4); asm_vmwrite (VMCS_GUEST_DS_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_DS_LIMIT, 0xFFFF); break; case SREG_FS: asm_vmwrite (VMCS_GUEST_FS_SEL, val); asm_vmwrite (VMCS_GUEST_FS_BASE, val << 4); asm_vmwrite (VMCS_GUEST_FS_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_FS_LIMIT, 0xFFFF); break; case SREG_GS: asm_vmwrite (VMCS_GUEST_GS_SEL, val); asm_vmwrite (VMCS_GUEST_GS_BASE, val << 4); asm_vmwrite (VMCS_GUEST_GS_ACCESS_RIGHTS, 0xF3); asm_vmwrite (VMCS_GUEST_GS_LIMIT, 0xFFFF); break; default: panic ("Unknown sreg."); } } vmmerr_t vt_writing_sreg (enum sreg s) { switch (s) { case SREG_ES: current->u.vt.vr.sw.enable &= ~SW_SREG_ES_BIT; break; case SREG_CS: current->u.vt.vr.sw.enable &= ~SW_SREG_CS_BIT; break; case SREG_SS: current->u.vt.vr.sw.enable &= ~SW_SREG_SS_BIT; break; case SREG_DS: current->u.vt.vr.sw.enable &= ~SW_SREG_DS_BIT; break; case SREG_FS: current->u.vt.vr.sw.enable &= ~SW_SREG_FS_BIT; break; case SREG_GS: current->u.vt.vr.sw.enable &= ~SW_SREG_GS_BIT; break; case SREG_DEFAULT: return VMMERR_AVOID_COMPILER_WARNING; } return VMMERR_SW; } tinyvisor/vmm/core/gmm_trans.c0000644006644000001440000001510212140421510016733 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ /* * Guest Memory Manager whose guest-address is translated into * host-address via a mapping table. */ #include #include #include #include #include #include #include #include #include #include #include #include "current.h" #include "mm.h" #include "gmm.h" #include "gmm_trans.h" #define MAXNUM_OF_TRANS_MEM_MAP 64 static phys_t gmm_trans_gp2hp (phys_t gphys) { struct gmm_trans_mem_map* mem_map; int low, mid, high; low = 0; mem_map = current->vm->gmm_trans.mem_map; high = current->vm->gmm_trans.mem_map_count - 1; while (low <= high) { mid = (low + high) / 2; if (gphys < mem_map[mid].gphys_start) { high = mid - 1; } else if (gphys > mem_map[mid].gphys_end) { low = mid + 1; } else { return mem_map[mid].hphys.start + (gphys - mem_map[mid].gphys_start); } } if (pci_assigned_mmio_addr(gphys, NULL)) { return gphys; } return GMM_NO_MAPPING; } static int gmm_trans_get_mem_map(int index, phys_t *base, phys_t *len, u32 *type) { struct gmm_trans *gmm_trans; struct gmm_trans_mem_map *mem_map; gmm_trans = ¤t->vm->gmm_trans; if (index < 0 || index >= gmm_trans->mem_map_count) { return 0; } ASSERT(gmm_trans->mem_map); mem_map = gmm_trans->mem_map + index; *base = mem_map->gphys_start; *len = mem_map->gphys_end - mem_map->gphys_start + 1; *type = mem_map->hphys.data; return 1; } static int gmm_trans_get_mem_map_count(void) { return current->vm->gmm_trans.mem_map_count; } static void gmm_trans_clear_mem(void) { struct gmm_trans *gmm_trans; struct gmm_trans_mem_map *mem_map; phys_t hphys; void *vaddr; int i; gmm_trans = ¤t->vm->gmm_trans; ASSERT(gmm_trans->mem_map); for (i = 0; i < gmm_trans->mem_map_count; i++) { mem_map = gmm_trans->mem_map; for (hphys = ROUND_DOWN(mem_map->hphys.start, PAGESIZE); hphys < ROUND_UP(mem_map->hphys.end, PAGESIZE); hphys += PAGESIZE) { vaddr = mapmem_hphys(hphys, PAGESIZE, MAPMEM_WRITE); memset(vaddr, 0, PAGESIZE); unmapmem(vaddr, PAGESIZE); } } } static struct gmm_func gmm_trans_func = { .gp2hp = gmm_trans_gp2hp, .get_mem_map = gmm_trans_get_mem_map, .get_mem_map_count = gmm_trans_get_mem_map_count, .clear_mem = gmm_trans_clear_mem }; int gmm_trans_alloc_avail(int count, struct resource *parent, phys_t start, phys_t end) { struct gmm_trans_mem_map *new; char *name = current->vm->name; struct gmm_trans* gmm_trans; phys_t low_size; gmm_trans = ¤t->vm->gmm_trans; while(count < MAXNUM_OF_TRANS_MEM_MAP) { new = gmm_trans->mem_map + count; if (rm_alloc_avail_resource(parent, &new->hphys, start, end, PAGESIZE, RESOURCE_TYPE_MEM, MEM_TYPE_AVAILABLE, name) != VMMERR_SUCCESS) { break; } if (count > 0) { if ((new - 1)->gphys_end == mm_top_of_low_avail_mem()) { new->gphys_start = 0x100000000; } else { new->gphys_start = (new - 1)->gphys_end + 1; } } else { new->gphys_start = 0; } new->gphys_end = new->gphys_start + (new->hphys.end - new->hphys.start); count++; if (new->gphys_start < mm_top_of_low_avail_mem() && new->gphys_end > mm_top_of_low_avail_mem()) { new->gphys_end = mm_top_of_low_avail_mem(); low_size = new->gphys_end - new->gphys_start + 1; /* * Add memory map in high mem. */ new = gmm_trans->mem_map + count; rm_init_resource(&new->hphys, (new - 1)->hphys.start + low_size, (new - 1)->hphys.end, RESOURCE_TYPE_MEM, MEM_TYPE_AVAILABLE, "dummy"); new->gphys_start = 0x100000000; new->gphys_end = new->gphys_start + (new->hphys.end - new->hphys.start); count++; } } return count; } static void gmm_trans_init_mem_map(void) { int index = 0; int count = 0; struct gmm_trans* gmm_trans; struct resource *parent; phys_t start, end; char param_name[VM_NAME_BUF_SIZE + 4]; vmmerr_t err; gmm_trans = ¤t->vm->gmm_trans; gmm_trans->mem_map = alloc(sizeof(struct resource) * MAXNUM_OF_TRANS_MEM_MAP); if (gmm_trans->mem_map == NULL) { panic("gmm_trans_init_mem_map: Failed to alloc mem_map"); } snprintf(param_name, VM_NAME_BUF_SIZE + 4, "%s.mem", current->vm->name); while ((err = param_get_u64_range(param_name, index++, &start, &end)) != VMMERR_NOTEXIST) { if (err != VMMERR_SUCCESS) { printf("Failed to get %s(%d) paramater. err 0x%x\n", param_name, index - 1, err); continue; } parent = NULL; while ((parent = mm_next_mem_map(parent)) != NULL) { if (parent->data != MEM_TYPE_AVAILABLE) { continue; } count = gmm_trans_alloc_avail(count, parent, start, end); if (count >= MAXNUM_OF_TRANS_MEM_MAP) { goto out; } } } out: gmm_trans->mem_map_count = count; } static void gmm_trans_init (void) { if (cpu_is_bsp()) { return; } memcpy((void *)¤t->vm->gmm, (void *)&gmm_trans_func, sizeof(gmm_trans_func)); gmm_trans_init_mem_map(); } INITFUNC ("passvm0", gmm_trans_init); tinyvisor/vmm/core/entry.h0000644006644000001440000000415012011447123016120 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_ENTRY_H #define _CORE_ENTRY_H #include #include #define APINIT_SEGMENT 0x0000 #define APINIT_OFFSET 0xF000 extern u8 head[]; extern u64 entry_pdp[512], entry_pd0[512]; extern u64 vmm_pml4[512], vmm_pdp[512], vmm_pd1[512], vmm_pd2[512]; extern u64 vmm_main_pml4[512], vmm_main_pdp[512]; extern ulong vmm_base_cr3, vmm_main_cr3; extern u8 cpuinit_start[], cpuinit_end[]; extern u32 apinit_procs; extern u8 apinit_lock; asmlinkage void move_vmm_area32 (void); asmlinkage void move_vmm_area64 (void); #endif tinyvisor/vmm/core/apic.c0000644006644000001440000001321312167264643015706 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #include #include #include #include #include "apic.h" #include "apic_regs.h" #include "asm.h" #include "constants.h" #include void *apic_virt_base = NULL; static bool apic_available(void) { u32 a, b, c, d; asm_cpuid(1, 0, &a, &b, &c, &d); if (!(d & CPUID_1_EDX_APIC_BIT)) return false; return true; } void apic_wait_for_idle(void) { while ((apic_read32(APIC_ICR_LOW_OFFSET) & ICR_STATUS_BIT) != ICR_STATUS_IDLE); } static void apic_assert_init(void) { disable_interrupt(); apic_wait_for_idle(); apic_write32(APIC_ICR_LOW_OFFSET, ICR_DSH_OTHER | ICR_TRIGGER_LEVEL | ICR_DELIVERY_MODE_INIT | ICR_LEVEL_ASSERT); enable_interrupt(); } static void apic_deassert_init(void) { disable_interrupt(); apic_wait_for_idle(); apic_write32(APIC_ICR_LOW_OFFSET, ICR_DSH_OTHER | ICR_TRIGGER_LEVEL | ICR_DELIVERY_MODE_INIT); enable_interrupt(); } static void apic_send_startup_ipi(phys_t apinit_addr) { disable_interrupt(); apic_wait_for_idle(); apic_write32(APIC_ICR_LOW_OFFSET, ICR_DSH_OTHER | ICR_LEVEL_ASSERT | ICR_DELIVERY_MODE_STARTUP | (apinit_addr >> 12)); enable_interrupt(); } apic_id_t apic_read_id (void) { if (apic_available ()) { u32 a, b, c, d; asm_cpuid (1, 0, &a, &b, &c, &d); return (b & APIC_ID_MASK) >> APIC_ID_SHIFT; } else { return 0; } } void apic_broadcast_nmi(void) { if (apic_virt_base == NULL) { return; } disable_interrupt(); apic_wait_for_idle(); apic_write32(APIC_ICR_LOW_OFFSET, ICR_DSH_OTHER | ICR_LEVEL_ASSERT | ICR_DELIVERY_MODE_NMI); enable_interrupt(); } void apic_start_ap (phys_t apinit_addr) { int i; apic_assert_init(); usleep(200000); apic_deassert_init(); usleep (200000); for (i = 0; i < 2; i++) { apic_send_startup_ipi(apinit_addr); usleep (200000); } } bool apic_check_apic_interrupt(vector_t vector) { u32 isr; isr = apic_read32(APIC_ISR_OFFSET + 0x10 * (vector / 32)); if (isr & (1 << (vector % 32))) { return true; } else { return false; } } void apic_write_eoi(void) { apic_write32(APIC_EOI_OFFSET, 0); } u32 apic_read_icrh(void) { return apic_read32(APIC_ICR_HIGH_OFFSET); } void apic_send_ipi(vector_t vector, apic_id_t dest) { disable_interrupt(); apic_wait_for_idle(); apic_write32(APIC_ICR_HIGH_OFFSET, dest << ICR_DEST_SHIFT); apic_write32(APIC_ICR_LOW_OFFSET, ICR_DSH_DEST | ICR_TRIGGER_EDGE |ICR_LEVEL_ASSERT | ICR_DELIVERY_MODE_FIXED | ICR_DEST_MODE_PHYSICAL | vector); enable_interrupt(); } void apic_send_init(apic_id_t dest) { disable_interrupt(); apic_wait_for_idle(); apic_write32(APIC_ICR_HIGH_OFFSET, dest << ICR_DEST_SHIFT); apic_write32(APIC_ICR_LOW_OFFSET, ICR_TRIGGER_LEVEL | ICR_DELIVERY_MODE_INIT | ICR_LEVEL_ASSERT); usleep(200000); apic_write32(APIC_ICR_HIGH_OFFSET, dest << ICR_DEST_SHIFT); apic_write32(APIC_ICR_LOW_OFFSET, ICR_TRIGGER_LEVEL | ICR_DELIVERY_MODE_INIT); enable_interrupt(); } static void apic_init(void) { if (!apic_available ()) { panic("APIC is not available."); } apic_virt_base = mapmem(MAPMEM_HPHYS | MAPMEM_WRITE | MAPMEM_UC, APIC_BASE_ADDRESS, PAGESIZE); if (apic_virt_base == NULL) { panic("Failed to map APIC."); } } static void apic_pcpu_init(void) { u64 reg_val; /* Clear logical apic id */ apic_write32(APIC_LOGICAL_APIC_ID_OFFSET, 0); /* Enable APIC */ asm_rdmsr64(MSR_IA32_APIC_BASE, ®_val); reg_val |= MSR_IA32_APIC_BASE_APIC_GLOBAL_ENABLE_BIT; asm_wrmsr64(MSR_IA32_APIC_BASE, reg_val); } void apic_enable(void) { u64 reg_val; reg_val = apic_read32(APIC_SPURIOUS_INTR_VECT_OFFSET); reg_val |= APIC_SOFTWARE_ENABLE_BIT; apic_write32(APIC_SPURIOUS_INTR_VECT_OFFSET, reg_val); } void apic_disable(void) { u64 reg_val; /* * Disable APIC. APIC can still issue IPIs. */ disable_interrupt(); apic_wait_for_idle(); reg_val = apic_read32(APIC_SPURIOUS_INTR_VECT_OFFSET); reg_val &= ~APIC_SOFTWARE_ENABLE_BIT; apic_write32(APIC_SPURIOUS_INTR_VECT_OFFSET, reg_val); enable_interrupt(); } INITFUNC("global5", apic_init); INITFUNC("pcpu1", apic_pcpu_init); tinyvisor/vmm/core/putchar.h0000644006644000001440000000342011733227577016447 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_PUTCHAR_H #define _CORE_PUTCHAR_H typedef void (*putchar_func_t) (unsigned char); void putchar (unsigned char c); void putchar_set_func (putchar_func_t newfunc, putchar_func_t *oldfunc); #endif tinyvisor/vmm/core/extint.h0000644006644000001440000000400711733245403016302 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_EXTINT_H #define _CORE_EXTINT_H #include #include #include "bitmap.h" #include "cpu.h" BITMAP_DECLARE (int_bitmap_t, VECTOR_COUNT/8); struct extint_data { int_bitmap_t pending_8259a_int; int_bitmap_t pending_apic_int; int_bitmap_t inservice_apic_int; int_bitmap_t pending_eoi; }; void extint_pend_interrupt (vector_t vector); void extint_check_interrupt (void); void extint_apic_eoi(void); #endif /* _CORE_EXTINT_H */ tinyvisor/vmm/core/cpu_emul.h0000644006644000001440000000362212165305216016601 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_CPU_EMUL_H #define _CORE_CPU_EMUL_H #include #include void cpu_emul_cpuid (void); bool cpu_emul_rdmsr (void); bool cpu_emul_wrmsr (void); void cpu_emul_hlt (void); void cpu_emul_cli (void); void cpu_emul_sti (void); vmmerr_t cpu_emul_realmode_int (u8 num); void cpu_emul_xsetbv (void); #endif tinyvisor/vmm/core/debug.c0000644006644000001440000000721311733245403016052 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include #include #include "constants.h" #include "cpu_mmu.h" #include "mm.h" #include "panic.h" #include "serial.h" static int memdump, memfree; enum memdump_type { MEMDUMP_GPHYS, MEMDUMP_HVIRT, MEMDUMP_GVIRT, MEMDUMP_HPHYS, }; struct memdump_data { u64 physaddr; u64 cr0, cr3, cr4, efer; ulong virtaddr; }; static int memdump_msghandler (int m, int c, void *recvbuf, int recvlen, void *sendbuf, int sendlen) { u64 physaddr; u8 *q, *tmp; int i; struct memdump_data *d; u64 ent[5]; int levels; if (m != 1) return -1; if (recvlen < sizeof (struct memdump_data)) return -1; d = (struct memdump_data *)recvbuf; q = sendbuf; switch ((enum memdump_type)c) { case MEMDUMP_GPHYS: physaddr = d->physaddr; for (i = 0; i < sendlen; i++) read_gphys_b (physaddr + i, &q[i], 0); break; case MEMDUMP_HVIRT: for (i = 0; i < sendlen; i++) q[i] = ((u8 *)d->virtaddr)[i]; break; case MEMDUMP_HPHYS: tmp = mapmem_hphys (d->physaddr, sendlen, 0); if (tmp) { memcpy (q, tmp, sendlen); unmapmem (tmp, sendlen); } else { printf ("mapmem_hphys failed (phys=0x%llX)\n", d->physaddr); } break; case MEMDUMP_GVIRT: for (i = 0; i < sendlen; i++) { if (mmu_get_pte (d->virtaddr + i, d->cr0, d->cr3, d->cr4, d->efer, false, false, false, ent, &levels) == VMMERR_SUCCESS) { physaddr = (ent[0] & PTE_ADDR_MASK64) | ((d->virtaddr + i) & 0xFFF); } else { printf ("get_pte failed (virt=0x%lX)\n", d->virtaddr + i); break; } read_gphys_b (physaddr, &q[i], 0); } break; default: return -1; } return 0; } static int memfree_msghandler (int m, int c) { int n; if (m == 0) { n = num_of_available_pages (); printf ("%d pages (%d KiB) free\n", n, n * 4); } return 0; } static void debug_msgregister (void) { memdump = msgregister ("memdump", memdump_msghandler); memfree = msgregister ("free", memfree_msghandler); } INITFUNC ("msg0", debug_msgregister); tinyvisor/vmm/core/cpu_seg.h0000644006644000001440000000711711753454341016426 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_CPU_SEG_H #define _CORE_CPU_SEG_H #include "asm.h" #include "cpu_interpreter.h" #include #include enum sreg { SREG_ES = 0, SREG_CS = 1, SREG_SS = 2, SREG_DS = 3, SREG_FS = 4, SREG_GS = 5, SREG_DEFAULT = 7, }; #define GUESTSEG_READ_B(p,offset,data) do { \ vmmerr_t err; \ err = cpu_seg_read_b (p, offset, data); \ if (err) \ return err; \ } while (0) #define GUESTSEG_READ_W(p,offset,data) do { \ vmmerr_t err; \ err = cpu_seg_read_w (p, offset, data); \ if (err) \ return err; \ } while (0) #define GUESTSEG_READ_L(p,offset,data) do { \ vmmerr_t err; \ err = cpu_seg_read_l (p, offset, data); \ if (err) \ return err; \ } while (0) #define GUESTSEG_READ_Q(p,offset,data) do { \ vmmerr_t err; \ err = cpu_seg_read_q (p, offset, data); \ if (err) \ return err; \ } while (0) #define GUESTSEG_WRITE_B(p,offset,data) do { \ vmmerr_t err; \ err = cpu_seg_write_b (p, offset, data); \ if (err) \ return err; \ } while (0) #define GUESTSEG_WRITE_W(p,offset,data) do { \ vmmerr_t err; \ err = cpu_seg_write_w (p, offset, data); \ if (err) \ return err; \ } while (0) #define GUESTSEG_WRITE_L(p,offset,data) do { \ vmmerr_t err; \ err = cpu_seg_write_l (p, offset, data); \ if (err) \ return err; \ } while (0) #define GUESTSEG_WRITE_Q(p,offset,data) do { \ vmmerr_t err; \ err = cpu_seg_write_q (p, offset, data); \ if (err) \ return err; \ } while (0) vmmerr_t cpu_seg_read_b (enum sreg s, ulong offset, u8 *data); vmmerr_t cpu_seg_read_w (enum sreg s, ulong offset, u16 *data); vmmerr_t cpu_seg_read_l (enum sreg s, ulong offset, u32 *data); vmmerr_t cpu_seg_read_q (enum sreg s, ulong offset, u64 *data); vmmerr_t cpu_seg_write_b (enum sreg s, ulong offset, u8 data); vmmerr_t cpu_seg_write_w (enum sreg s, ulong offset, u16 data); vmmerr_t cpu_seg_write_l (enum sreg s, ulong offset, u32 data); vmmerr_t cpu_seg_write_q (enum sreg s, ulong offset, u64 data); uint seg_get_cpl(void); bool seg_user_mode(void); #endif tinyvisor/vmm/core/pcpu.c0000644006644000001440000000360011733227577015743 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include "pcpu.h" struct pcpu pcpu_default = { }; #define DEFINE_GS_OFFSET(name, offset) \ asm (".globl " #name "; " #name " = " #offset) DEFINE_GS_OFFSET (gs_inthandling, 0); DEFINE_GS_OFFSET (gs_currentcpu, 8); DEFINE_GS_OFFSET (gs_syscallstack, 16); DEFINE_GS_OFFSET (gs_current, 24); DEFINE_GS_OFFSET (gs_nmi, 32); tinyvisor/vmm/core/assert.c0000644006644000001440000000344711733245403016272 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include "panic.h" void assertion_failed (char *x, const char *funcname, char *filename, int linenum) { panic ("Assertion failed!(%s) function %s file %s line %d", x, funcname, filename, linenum); } tinyvisor/vmm/core/convert.h0000644006644000001440000000440511733245403016451 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_CONVERT_H #define _CORE_CONVERT_H #include static inline void conv64to32 (u64 src, u32 *dest_l, u32 *dest_h) { *dest_l = src; *dest_h = src >> 32; } static inline void conv32to64 (u32 src_l, u32 src_h, u64 *dest) { *dest = src_l | (u64)src_h << 32; } static inline void conv32to16 (u32 src, u16 *dest_l, u16 *dest_h) { *dest_l = src; *dest_h = src >> 16; } static inline void conv16to32 (u16 src_l, u16 src_h, u32 *dest) { *dest = src_l | (u32)src_h << 16; } static inline void conv16to8 (u16 src, u8 *dest_l, u8 *dest_h) { *dest_l = src; *dest_h = src >> 8; } static inline void conv8to16 (u8 src_l, u8 src_h, u16 *dest) { *dest = src_l | (u16)src_h << 8; } #endif tinyvisor/vmm/core/cpuid.c0000644006644000001440000000410311753454341016070 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include "cpuid.h" #include "current.h" #include "panic.h" void call_cpuid (u32 ia, u32 ic, u32 *oa, u32 *ob, u32 *oc, u32 *od) { asm_cpuid (ia, ic, oa, ob, oc, od); if (ia == 1) { /* *ob &= ~CPUID_1_EBX_NUMOFLP_MASK; */ /* *ob |= ~CPUID_1_EBX_NUMOFLP_1; */ *oc &= ~CPUID_1_ECX_VMX_BIT; /* *od &= ~CPUID_1_EDX_PAE_BIT; */ /* *od &= ~CPUID_1_EDX_APIC_BIT; */ } else if (ia == 4) { /* *oa &= ~CPUID_4_EAX_NUMOFTHREADS_MASK; */ /* *oa &= ~CPUID_4_EAX_NUMOFCORES_MASK; */ } } tinyvisor/vmm/core/io_io.h0000644006644000001440000000345111733245403016067 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_IO_IO_H #define _CORE_IO_IO_H #include #include #include "constants.h" struct io_io_data { iofunc_t iofunc[NUM_OF_IOPORT]; }; void call_io (iotype_t type, ioport_t port, void *data); #endif tinyvisor/vmm/core/cpu.c0000644006644000001440000000605712072152324015554 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #include #include #include #include "asm.h" #include "constants.h" #include "pcpu.h" #include "panic.h" #if 0 static int support_monitor = 1; #endif cpu_id_t get_cpu_id (void) { if (!currentcpu_available()) { return 0; } return currentcpu->apic_id; } bool cpu_is_bsp(void) { return currentcpu->bsp; } void cpu_relax(void) { asm_pause(); } #if 0 vmmerr_t monitor_size(size_t *max, size_t *min) { u32 a, b, c, d; if (!support_monitor) { if (cpu_is_bsp()) { printf("monitor and mwait is not supported\n"); } return 1; } asm_cpuid (1, 0, &a, &b, &c, &d); if ((c & 0x8) == 0) { if (cpu_is_bsp()) { printf("monitor and mwait is not supported\n"); } support_monitor = 0; *max = *min = 0; return 1; } asm_cpuid (5, 0, &a, &b, &c, &d); *max = b; *min = a; return 0; } void setup_monitor (void *addr) { if (!support_monitor) { return; } asm_monitor(addr, 0, 0); } void wait_for_updating () { if (!support_monitor) { /* * Local apic is not set up yet, so that * we can't wake up even if we execute hlt */ freeze(); } asm_mwait(0, 0); } #endif /* 0 */ void enable_interrupt(void) { if (currentcpu_available()) { ASSERT(currentcpu->disable_interrupt > 0); if ( --currentcpu->disable_interrupt == 0) { asm_sti(); } } else { asm_sti(); } } void disable_interrupt(void) { asm_cli(); if (currentcpu_available()) { currentcpu->disable_interrupt++; } } tinyvisor/vmm/core/asm.h0000644006644000001440000004123712165305216015554 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_ASM_H #define _CORE_ASM_H #include #include "desc.h" #include struct vt_vmentry_regs { ulong rax, rcx, rdx, rbx, cr2, rbp, rsi, rdi; ulong r8, r9, r10, r11, r12, r13, r14, r15; ulong cr3; int pe, pg; struct { int enable, num; u16 es, cs, ss, ds, fs, gs; } sw; }; struct svm_vmrun_regs { ulong cr0, rcx, rdx, rbx, cr4, rbp, rsi, rdi; ulong r8, r9, r10, r11, r12, r13, r14, r15; ulong cr3; }; #define SW_SREG_ES_BIT (1 << 0) #define SW_SREG_CS_BIT (1 << 1) #define SW_SREG_SS_BIT (1 << 2) #define SW_SREG_DS_BIT (1 << 3) #define SW_SREG_FS_BIT (1 << 4) #define SW_SREG_GS_BIT (1 << 5) #define ASM_VMCALL "vmcall" asmlinkage int asm_vmlaunch_regs_32 (struct vt_vmentry_regs *p); asmlinkage int asm_vmresume_regs_32 (struct vt_vmentry_regs *p); asmlinkage int asm_vmlaunch_regs_64 (struct vt_vmentry_regs *p); asmlinkage int asm_vmresume_regs_64 (struct vt_vmentry_regs *p); asmlinkage void asm_vmrun_regs_32 (struct svm_vmrun_regs *p, ulong vmcb_phys, ulong vmcbhost_phys); asmlinkage void asm_vmrun_regs_64 (struct svm_vmrun_regs *p, ulong vmcb_phys, ulong vmcbhost_phys); static inline void asm_cpuid (u32 num, u32 numc, u32 *a, u32 *b, u32 *c, u32 *d) { asm volatile ("cpuid" : "=a" (*a), "=b" (*b), "=c" (*c), "=d" (*d) : "a" (num), "c" (numc)); } static inline void asm_rdmsr32 (ulong num, u32 *a, u32 *d) { asm volatile ("rdmsr" : "=a" (*a), "=d" (*d) : "c" (num)); } static inline void asm_wrmsr32 (ulong num, u32 a, u32 d) { asm volatile ("wrmsr" : : "c" (num), "a" (a), "d" (d)); } static inline void asm_rdmsr64 (ulong num, u64 *value) { u32 a, d; asm_rdmsr32 (num, &a, &d); *value = (u64)a | ((u64)d << 32); } static inline void asm_wrmsr64 (ulong num, u64 value) { u32 a, d; a = (u32)value; d = (u32)(value >> 32); asm_wrmsr32 (num, a, d); } static inline void asm_rdmsr (ulong num, ulong *value) { #ifdef __x86_64__ u64 value64; asm_rdmsr64 (num, &value64); *value = value64; #else u32 value32; u32 dummy; asm_rdmsr32 (num, &value32, &dummy); *value = value32; #endif } static inline void asm_wrmsr (ulong num, ulong value) { #ifdef __x86_64__ asm_wrmsr64 (num, (u64)value); #else asm_wrmsr32 (num, (u32)value, 0); #endif } static inline void asm_rdcr0 (ulong *cr0) { asm volatile ("mov %%cr0,%0" : "=r" (*cr0)); } static inline void asm_wrcr0 (ulong cr0) { asm volatile ("mov %0,%%cr0" : : "r" (cr0)); } static inline void asm_rdcr2 (ulong *cr2) { asm volatile ("mov %%cr2,%0" : "=r" (*cr2)); } static inline void asm_wrcr2 (ulong cr2) { asm volatile ("mov %0,%%cr2" : : "r" (cr2)); } static inline void asm_rdcr3 (ulong *cr3) { asm volatile ("mov %%cr3,%0" : "=r" (*cr3)); } static inline void asm_wrcr3 (ulong cr3) { asm volatile ("mov %0,%%cr3" : : "r" (cr3)); } static inline void asm_rdcr4 (ulong *cr4) { asm volatile ("mov %%cr4,%0" : "=r" (*cr4)); } static inline void asm_wrcr4 (ulong cr4) { asm volatile ("mov %0,%%cr4" : : "r" (cr4)); } #ifdef __x86_64__ static inline void asm_rdcr8 (u64 *cr8) { asm volatile ("mov %%cr8,%0" : "=r" (*cr8)); } static inline void asm_wrcr8 (ulong cr8) { asm volatile ("mov %0,%%cr8" : : "r" (cr8)); } #endif /* f3 0f c7 33 vmxon (%ebx) */ static inline void asm_vmxon (void *vmxon_region) { asm volatile ("vmxon %0" : : "m" (*(ulong *)vmxon_region) : "cc", "memory"); } /* 0f 01 c4 vmxoff */ static inline void asm_vmxoff (void) { asm volatile ("vmxoff" : : : "cc"); } /* 66 0f c7 33 vmclear (%ebx) */ static inline void asm_vmclear (void *p) { #ifdef AS_DOESNT_SUPPORT_VMX asm volatile (".byte 0x66, 0x0f, 0xc7, 0x33" : : "b" (p) : "cc", "memory"); #else asm volatile ("vmclear %0" : : "m" (*(ulong *)p) : "cc", "memory"); #endif } /* 0f c7 33 vmptrld (%ebx) */ static inline void asm_vmptrld (void *p) { asm volatile ("vmptrld %0" : : "m" (*(ulong *)p) : "cc", "memory"); } /* 0f c7 3b vmptrst (%ebx) */ static inline void asm_vmptrst (void *p) { asm volatile ("vmptrst %0" : : "m" (*(ulong *)p) : "cc", "memory"); } /* 0f 79 c2 vmwrite %edx,%eax */ static inline void asm_vmwrite (ulong index, ulong val) { #ifdef AS_DOESNT_SUPPORT_VMX asm volatile (".byte 0x0f, 0x79, 0xc2" : : "a" (index), "d" (val) : "cc"); #else asm volatile ("vmwrite %1,%0" : : "r" (index), "rm" (val) : "cc"); #endif } static inline void asm_vmwrite32(ulong index, u32 val) { ulong ulong_val = val; asm volatile ("vmwrite %1,%0" : : "r" (index), "rm" (ulong_val) : "cc"); } static inline void asm_vmwrite64(ulong index, u64 val) { #ifdef __x86_64__ asm volatile ("vmwrite %1,%0" : : "r" (index), "rm" (val) : "cc"); #else ulong low, high; low = val; high = val >> 32; asm_vmwrite(index, low); asm_vmwrite(index + 1, high); #endif } /* 0f 01 c2 vmlaunch */ static inline int asm_vmlaunch_regs (struct vt_vmentry_regs *p) { #ifdef __x86_64__ return asm_vmlaunch_regs_64 (p); #else return asm_vmlaunch_regs_32 (p); #endif } /* 0f 01 c3 vmresume */ static inline int asm_vmresume_regs (struct vt_vmentry_regs *p) { #ifdef __x86_64__ return asm_vmresume_regs_64 (p); #else return asm_vmresume_regs_32 (p); #endif } /* 0f 78 c2 vmread %eax,%edx */ static inline void asm_vmread (ulong index, ulong *val) { asm volatile ("vmread %1,%0" : "=rm" (*val) : "r" (index) : "cc"); } static inline void asm_vmread32(ulong index, u32 *val) { ulong ulong_val; asm volatile ("vmread %1,%0" : "=rm" (ulong_val) : "r" (index) : "cc"); *val = ulong_val; } static inline void asm_vmread64(ulong index, u64 *val) { #ifdef __x86_64__ asm volatile ("vmread %1,%0" : "=rm" (*val) : "r" (index) : "cc"); #else ulong low, high; asm_vmread(index, &low); asm_vmread(index + 1, &high); *val = low | (high << 32); #endif } static inline void asm_invept(void *desc) { #ifdef __x86_64__ asm volatile ("invept (%0), %%rax" : : "r" (desc), "a" (1) : "cc"); #else asm volatile ("invept (%0), %%eax" : : "r" (desc), "a" (1) : "cc"); #endif } static inline void asm_rdes (u16 *es) { asm volatile ("mov %%es,%0" : "=rm" (*es)); } static inline void asm_rdcs (u16 *cs) { asm volatile ("mov %%cs,%0" : "=rm" (*cs)); } static inline void asm_rdss (u16 *ss) { asm volatile ("mov %%ss,%0" : "=rm" (*ss)); } static inline void asm_rdds (u16 *ds) { asm volatile ("mov %%ds,%0" : "=rm" (*ds)); } static inline void asm_rdfs (u16 *fs) { asm volatile ("mov %%fs,%0" : "=rm" (*fs)); } static inline void asm_rdgs (u16 *gs) { asm volatile ("mov %%gs,%0" : "=rm" (*gs)); } static inline void asm_wres (u16 es) { asm volatile ("mov %0, %%es" : : "rm" ((ulong)es)); } static inline void asm_wrcs (u16 cs) { #ifdef __x86_64__ asm volatile ("pushq %0; push $1f; lretq; 1:" : : "g" ((ulong)cs)); #else asm volatile ("pushl %0; push $1f; lret; 1:" : : "g" ((ulong)cs)); #endif } static inline void asm_wrss (u16 ss) { asm volatile ("mov %0, %%ss" : : "rm" ((ulong)ss)); } static inline void asm_wrds (u16 ds) { asm volatile ("mov %0, %%ds" : : "rm" ((ulong)ds)); } static inline void asm_wrfs (u16 fs) { asm volatile ("mov %0, %%fs" : : "rm" ((ulong)fs)); } static inline void asm_wrgs (u16 gs) { asm volatile ("mov %0, %%gs" : : "rm" ((ulong)gs)); } static inline void asm_rdldtr (u16 *ldtr) { asm volatile ("sldt %0" : "=rm" (*ldtr)); } static inline void asm_wrldtr (u16 ldtr) { asm volatile ("lldt %0" : : "rm" (ldtr)); } static inline void asm_rdtr (u16 *tr) { asm volatile ("str %0" : "=rm" (*tr)); } static inline void asm_wrtr (u16 tr) { asm volatile ("ltr %0" : : "rm" (tr)); } static inline void asm_lsl (u32 sel, ulong *limit) { asm volatile ("lsl %1,%0" : "=r" (*limit) : "rm" ((ulong)sel)); /* avoid assembler bug */ } static inline void asm_lar (u32 sel, ulong *ar) { asm volatile ("lar %1,%0" : "=r" (*ar) : "rm" ((ulong)sel)); /* avoid assembler bug */ } static inline void asm_rdgdtr (ulong *gdtbase, ulong *gdtlimit) { struct descreg gdtr; asm volatile ("sgdt %0" : "=m" (gdtr)); *gdtbase = gdtr.base; *gdtlimit = gdtr.limit; } static inline void asm_rdidtr (ulong *idtbase, ulong *idtlimit) { struct descreg idtr; asm volatile ("sidt %0" : "=m" (idtr)); *idtbase = idtr.base; *idtlimit = idtr.limit; } static inline void asm_wrgdtr (ulong gdtbase, ulong gdtlimit) { struct descreg gdtr; gdtr.base = gdtbase; gdtr.limit = gdtlimit; asm volatile ("lgdt %0" : : "m" (gdtr)); } static inline void asm_wridtr (ulong idtbase, ulong idtlimit) { struct descreg idtr; idtr.base = idtbase; idtr.limit = idtlimit; asm volatile ("lidt %0" : : "m" (idtr)); } static inline void asm_rddr7 (ulong *dr7) { asm volatile ("mov %%dr7,%0" : "=r" (*dr7)); } static inline void asm_rdrflags (ulong *rflags) { asm volatile ( #ifdef __x86_64__ "pushfq ; popq %0" #else "pushfl ; popl %0" #endif : "=rm" (*rflags)); } static inline void asm_inb (ioport_t port, u8 *data) { asm volatile ("inb %%dx,%%al" : "=a" (*data) : "d" (port)); } static inline void asm_inw (ioport_t port, u16 *data) { asm volatile ("inw %%dx,%%ax" : "=a" (*data) : "d" (port)); } static inline void asm_inl (ioport_t port, u32 *data) { asm volatile ("inl %%dx,%%eax" : "=a" (*data) : "d" (port)); } static inline void asm_outb (ioport_t port, u8 data) { asm volatile ("outb %%al,%%dx" : : "a" (data) , "d" (port)); } static inline void asm_outw (ioport_t port, u16 data) { asm volatile ("outw %%ax,%%dx" : : "a" (data) , "d" (port)); } static inline void asm_outl (ioport_t port, u32 data) { asm volatile ("outl %%eax,%%dx" : : "a" (data) , "d" (port)); } static inline void asm_cli (void) { asm volatile ("cli"); } static inline void asm_sti (void) { asm volatile ("sti"); } static inline void asm_wrrsp_and_jmp (ulong rsp, void *jmpto) { asm volatile ( #ifdef __x86_64__ "mov %0,%%rsp;" "xor %%rbp,%%rbp;" "push %%rbp;" "jmp *%1" #else "mov %0,%%esp;" "xor %%ebp,%%ebp;" "push %%ebp;" "jmp *%1" #endif : : "g" (rsp) , "r" (jmpto)); } static inline void asm_wrrsp_and_ret (ulong rsp, ulong rax) { asm volatile ( #ifdef __x86_64__ "mov %0,%%rsp; ret" #else "mov %0,%%esp; ret" #endif : : "g" (rsp) , "a" (rax)); } static inline void asm_wbinvd (void) { asm volatile ("wbinvd"); } static inline void asm_invlpg (void *p) { asm volatile ("invlpg %0" : : "m" (*(u8 *)p)); } static inline void asm_cli_and_hlt (void) { asm volatile ("cli; hlt"); } static inline void asm_sti_and_hlt (void) { asm volatile ("sti; hlt"); } static inline void asm_pause (void) { asm volatile ("pause"); } static inline void asm_rdrsp (ulong *rsp) { #ifdef __x86_64__ asm volatile ("mov %%rsp,%0" : "=rm" (*rsp)); #else asm volatile ("mov %%esp,%0" : "=rm" (*rsp)); #endif } static inline void asm_rdtsc (u32 *a, u32 *d) { asm volatile ("rdtsc" : "=a" (*a), "=d" (*d)); } static inline void asm_mul_and_div (u32 mul1, u32 mul2, u32 div1, u32 *quotient, u32 *remainder) { asm volatile ("mull %4 ; divl %5" : "=&a" (*quotient) , "=&d" (*remainder) : "0" (mul1) , "1" (0) , "rm" (mul2) , "rm" (div1) : "cc"); } static inline void asm_lock_incl (u32 *d) { asm volatile ("lock incl %0" : "=m" (*d)); } /* if (*dest == *cmp) { *dest = eq; return false; } else { *cmp = *dest; return true; } */ static inline bool asm_lock_cmpxchgl (u32 *dest, u32 *cmp, u32 eq) { int tmp = 0; asm volatile ("lock cmpxchgl %4,%1 ; je 1f ; inc %2 ; 1:" : "=&a" (*cmp) , "=m" (*dest) , "=&r" (tmp) : "0" (*cmp) , "r" (eq) , "2" (0) : "memory", "cc"); return (bool)tmp; } static inline bool asm_lock_cmpxchgq (u64 *dest, u64 *cmp, u64 eq) { int tmp; #ifdef __x86_64__ asm volatile ("lock cmpxchgq %4,%1 ; je 1f ; inc %2 ; 1:" : "=&a" (*cmp) , "=m" (*dest) , "=&r" (tmp) : "0" (*cmp) , "r" (eq) , "2" (0) : "memory", "cc"); #else asm volatile ("lock cmpxchg8b %1 ; je 1f ; inc %2 ; 1:" : "=&A" (*cmp) , "=m" (*dest) , "=&r" (tmp) : "0" (*cmp) , "b" ((u32)eq) , "c" ((u32)(eq >> 32)) , "2" (0) : "memory", "cc"); #endif return (bool)tmp; } /* old = *mem; *mem = newval; return old; */ static inline ulong asm_lock_swap_ulong (ulong *mem, ulong newval) { ulong oldval; asm volatile ("xchg %0,%1" : "=r" (oldval) , "=m" (*mem) : "0" (newval)); return oldval; } static inline ulong asm_lock_test_ulong (ulong *mem, int bit) { ulong val; asm volatile ("bt %2,%0\n" "setc %%al" : "=m" (*mem) , "=r" (val) : "r" (bit) , "1" (0)); return val; } static inline ulong asm_lock_test_and_set_ulong (ulong *mem, int bit) { ulong oldval; asm volatile ("lock bts %2,%0\n" "setc %%al" : "=m" (*mem) , "=a" (oldval) : "r" (bit) , "1" (0)); return oldval; } static inline ulong asm_lock_test_and_clear_ulong (ulong *mem, int bit) { ulong oldval; asm volatile ("lock btr %2,%0\n" "setc %%al" : "=m" (*mem) , "=a" (oldval) : "r" (bit) , "1" (0)); return oldval; } /* * Bit scan reverse. * Find the most significant set bit. */ static inline long asm_bsr_ulong (ulong *mem) { long bit; if (*mem == 0) { return -1; } asm volatile ("bsr %1,%0\n" : "=r" (bit) : "m" (*mem)); return bit; } /* * BIT scan forward. * Find the least significant set bit. */ static inline long asm_bsf_ulong (ulong *mem) { long bit; if (*mem == 0) { return -1; } asm volatile ("bsf %1,%0\n" : "=r" (bit) : "m" (*mem)); return bit; } /* 0f 01 d8 vmrun */ static inline void asm_vmrun_regs (struct svm_vmrun_regs *p, ulong vmcb_phys, ulong vmcbhost_phys) { #ifdef __x86_64__ asm_vmrun_regs_64 (p, vmcb_phys, vmcbhost_phys); #else asm_vmrun_regs_32 (p, vmcb_phys, vmcbhost_phys); #endif } /* Copy from bitvisor 1.3 */ /* 0f 01 d1 xsetbv */ static inline void asm_xsetbv (u32 c, u32 a, u32 d) { asm volatile (".byte 0x0F, 0x01, 0xD1" /* xsetbv */ : : "c" (c), "a" (a), "d" (d)); } static inline void asm_monitor (void *addr, u32 c, u32 d) { asm volatile ("monitor" :: "a" (addr), "c" (c), "d" (d)); } static inline void asm_mwait (u32 a, u32 c) { asm volatile ("mwait" ::"a" (a), "c" (c)); } #endif tinyvisor/vmm/core/msr_pass.c0000644006644000001440000001014411753454341016615 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include "apic_pass.h" #include "asm.h" #include "current.h" #include "int.h" #include "mm.h" #include "panic.h" #define PAT_ENCODING_UC 0x00 #define PAT_ENCODING_WC 0x01 #define PAT_ENCODING_WT 0x04 #define PAT_ENCODING_WP 0x05 #define PAT_ENCODING_WB 0x06 #define PAT_ENCODING_WUC 0x07 #define MSR_IA32_PAT_GUEST_INIT_VAL 0x0007040600070406LL /* UC WUC WT WB UC WUC WT WB */ static u64 read_pat() { return current->msr_data.pat_reg; } static void write_pat(u64 msrdata) { int i; u8 pat_encoding; u32 flag; current->msr_data.pat_reg = msrdata; for (i = 0; i < MSR_DATA_PAT_COUNT; i++) { pat_encoding = (msrdata >> (8 * i)) & 0x7; switch (pat_encoding) { case 0: flag = MAPMEM_UC; break; case 1: flag = MAPMEM_WC; break; case 4: flag = MAPMEM_WT; break; case 5: flag = MAPMEM_WP; break; case 6: flag = MAPMEM_WB; break; case 7: flag = MAPMEM_WUC; break; default: panic ("Unsupported pat encoding 0x%x", pat_encoding); } current->msr_data.pat_to_cache_flag[i] = flag; } } bool msr_read(u32 msrindex, u64 *msrdata) { switch (msrindex) { case MSR_IA32_TIME_STAMP_COUNTER: asm_rdmsr64(MSR_IA32_TIME_STAMP_COUNTER, msrdata); *msrdata += current->tsc_offset; break; case MSR_IA32_PAT: read_pat(msrdata); break; default: asm_rdmsr64(msrindex, msrdata); } return false; } u32 msr_pte_to_cache_flag(u64 pte) { int pat_index; pat_index = ((pte & PTE_PWT_BIT) ? 1 : 0) | ((pte & PTE_PCD_BIT) ? 2 : 0) | ((pte & PTE_PAT_BIT) ? 4 : 0); return current->msr_data.pat_to_cache_flag[pat_index]; } bool msr_write(u32 msrindex, u64 msrdata) { u64 tmp; /* FIXME: Exception handling */ switch (msrindex) { case MSR_IA32_BIOS_UPDT_TRIG: printf ("msr_pass: microcode updates cannot be loaded.\n"); break; case MSR_IA32_TIME_STAMP_COUNTER: asm_rdmsr64(MSR_IA32_TIME_STAMP_COUNTER, &tmp); current->tsc_offset = msrdata - tmp; current->vmctl.tsc_offset_changed (); break; case MSR_IA32_APIC_BASE: if (msrdata & MSR_IA32_APIC_BASE_APIC_GLOBAL_ENABLE_BIT) { tmp = msrdata & MSR_IA32_APIC_BASE_APIC_BASE_MASK; apic_base_changed(tmp); if (phys_in_vmm(tmp)) panic ("relocating APIC Base to VMM address!"); } goto pass; case MSR_IA32_PAT: write_pat(msrdata); break; default: pass: asm_wrmsr64(msrindex, msrdata); } return false; } static void msr_init(void) { current->vmctl.write_msr(MSR_IA32_PAT, MSR_IA32_PAT_GUEST_INIT_VAL); } INITFUNC("passcpu0", msr_init); tinyvisor/vmm/core/serial.c0000644006644000001440000000743412011466501016242 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include #include "asm.h" #include "current.h" #include "io_io.h" #include "serial.h" #define INIT_RATELSB RATELSB_115200 #define INIT_RATEMSB 0x0 #define INIT_INTR 0x0 #define INIT_FIFOCTL 0x0 #define INIT_LINECTL LINECTL_DATA8BIT #define INIT_MODECTL 0x3 /* RTS | DTR */ static spinlock_t serial_lock = SPINLOCK_INITIALIZER; static void serial_init (unsigned int port) { spinlock_lock(&serial_lock); asm_outb (port + PORT_LINECTL, LINECTL_DLAB_BIT); asm_outb (port + PORT_RATELSB, INIT_RATELSB); asm_outb (port + PORT_RATEMSB, INIT_RATEMSB); asm_outb (port + PORT_LINECTL, INIT_LINECTL); asm_outb (port + PORT_MODECTL, INIT_MODECTL); asm_outb (port + PORT_INTRCTL, INIT_INTR); asm_outb (port + PORT_FIFOCTL, INIT_FIFOCTL); spinlock_unlock(&serial_lock); } static void serial_send (unsigned int port, unsigned char data) { u8 status; spinlock_lock(&serial_lock); do asm_inb (port + PORT_LINESTAT, &status); while (!(status & LINESTAT_TX_BIT)); asm_outb (port + PORT_DATA, data); spinlock_unlock(&serial_lock); } static unsigned char serial_recv (unsigned int port) { u8 status, data; spinlock_lock(&serial_lock); asm_inb (port + PORT_LINESTAT, &status); while (!(status & LINESTAT_RX_BIT)) { spinlock_unlock(&serial_lock); schedule (); spinlock_lock(&serial_lock); asm_inb (port + PORT_LINESTAT, &status); } asm_inb (port + PORT_DATA, &data); spinlock_unlock(&serial_lock); return data; } static int serialin_msghandler (int m, int c) { int ret = 0; if (m == 0) ret = serial_recv (SERIAL_PORT1); return ret; } static int serialout_msghandler (int m, int c) { if (m == 0) serial_send (SERIAL_PORT1, (unsigned char)c); return 0; } void serial_putchar (unsigned char c) { if (c == '\n') serial_send (SERIAL_PORT1, '\r'); else if (c == '\0') c = ' '; serial_send (SERIAL_PORT1, c); } void serial_init_global(void) { serial_init(SERIAL_PORT1); } static void serial_init_msg (void) { msgregister ("serialin", serialin_msghandler); msgregister ("serialout", serialout_msghandler); } INITFUNC ("msg0", serial_init_msg); tinyvisor/vmm/core/apic_pass.h0000644006644000001440000000370712140421510016723 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_APIC_PASS_H #define _CORE_APIC_PASS_H #include #include #include "pcpu.h" void apic_read_cr8(u64 *val); void apic_write_cr8(u64 val); #if 0 void apic_halt_cpu(void); #endif void apic_enter_wait_for_sipi_state(void); void apic_handle_wait_for_sipi_state(void); void apic_base_changed(ulong apic_base); void apic_send_init_others(void); #endif /* _CORE_APIC_PASS_H */ tinyvisor/vmm/core/process_sysenter.h0000644006644000001440000000364211733245403020405 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_PROCESS_SYSENTER_H #define _CORE_PROCESS_SYSENTER_H #include #include extern u8 processuser_sysenter[], processuser_no_sysenter[]; extern u8 processuser_syscall[]; asmlinkage void syscall_entry_sysexit (void); asmlinkage void syscall_entry_lret (void); asmlinkage void syscall_entry_sysret64 (void); #endif tinyvisor/vmm/core/gmm.c0000644006644000001440000001662611733245403015554 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ /* * Guest Memory Manager (framework) */ #include #include #include #include #include #include "callrealmode.h" #include "constants.h" #include "convert.h" #include "cpu_seg.h" #include "current.h" #include "io_io.h" #include "misc.h" #include "mm.h" /* * Modify int15 entry in IVT to execute iow to INT15_IOPORT. * INT15_IOPORT need to be less than 0x100. * 0xe0 seems not to be used, referencing the datasheet of P55 PCH. */ #define INT15_IOPORT 0xe0 #define INT15_VECTOR_PHYS (0x15 * 4) static void emulate_int15(void) { ulong rax, rbx, rcx, rdx, rdi, rflags; u8 ah, al; u32 type; phys_t base, len; current->vmctl.read_general_reg (GENERAL_REG_RAX, &rax); conv16to8 ((u16)rax, &al, &ah); switch(ah) { case 0xE8: if (al == 0x20) goto emulate_e820; if (al == 0x01) goto err_status_ret; if (al == 0x81) goto errret; break; case 0x88: goto err_status_ret; case 0x8a: case 0xC7: goto errret; case 0xDA: if (al == 0x88) goto errret; break; } /* continue, jump to the original interrupt handler (BIOS) */ return; errret: /* printf ("DEBUG: emulate_int15: return a error. ah 0x%x al 0x%x\n", ah, al); */ /* on error set CF */ current->vmctl.write_ip (0x25C); current->vmctl.read_flags (&rflags); current->vmctl.write_flags (rflags | RFLAGS_IF_BIT | RFLAGS_CF_BIT); return; err_status_ret: /* printf ("DEBUG: emulate_int15: return a error. ah 0x%x al 0x%x\n", ah, al); */ /* on error, ah=0x86 and set CF */ rax = (rax & ~0xFF00UL) | 0x8600; current->vmctl.write_general_reg (GENERAL_REG_RAX, rax); current->vmctl.write_ip (0x25C); current->vmctl.read_flags (&rflags); current->vmctl.write_flags (rflags | RFLAGS_IF_BIT | RFLAGS_CF_BIT); return; /* emulate_88: */ /* printf("DEBUG: int 15 ah=0x88\n"); */ /* rax = modify_ulong_u16(rax, 15 * 1024); */ /* current->vmctl.write_general_reg (GENERAL_REG_RAX, rax); */ /* current->vmctl.write_ip (0x25C); */ /* current->vmctl.read_flags (&rflags); */ /* current->vmctl.write_flags ((rflags | RFLAGS_IF_BIT) & ~RFLAGS_CF_BIT); */ /* return; */ emulate_e820: /* E820 */ current->vmctl.read_general_reg (GENERAL_REG_RBX, &rbx); current->vmctl.read_general_reg (GENERAL_REG_RCX, &rcx); current->vmctl.read_general_reg (GENERAL_REG_RDX, &rdx); current->vmctl.read_general_reg (GENERAL_REG_RDI, &rdi); rdi = (u16)rdi; if ((u32)rdx != 0x534D4150) goto errret; if ((u32)rcx < 0x14) goto errret; if (current->vm->gmm.get_mem_map((int)rbx, &base, &len, &type)) { /* printf("DEBUG: E820 0x%llx 0x%llx %d\n", base, len, type); */ if (rbx < current->vm->gmm.get_mem_map_count() - 1) { rbx = rbx + 1; } else { rbx = 0; } } else { rbx = 0; base = 0; len = 0; type = 0; } /* FIXME: cpu_seg_write fails if ES:[DI] page is not present */ /* nor writable (virtual 8086 mode only) */ rax = rdx; rcx = 0x14; if (cpu_seg_write_q (SREG_ES, rdi + 0x0, base)) panic ("emulate_int15: write base failed"); if (cpu_seg_write_q (SREG_ES, rdi + 0x8, len)) panic ("emulate_int15: write len failed"); if (cpu_seg_write_l (SREG_ES, rdi + 0x10, type)) panic ("emulate_int15: write type failed"); current->vmctl.write_general_reg (GENERAL_REG_RAX, rax); current->vmctl.write_general_reg (GENERAL_REG_RBX, rbx); current->vmctl.write_general_reg (GENERAL_REG_RCX, rcx); current->vmctl.write_ip (0x25C); current->vmctl.read_flags (&rflags); current->vmctl.write_flags ((rflags | RFLAGS_IF_BIT) & ~RFLAGS_CF_BIT); return; } static int int15_ioport(iotype_t type, ioport_t port, void *data) { ulong cr0, rflags, rip; bool ok = false; /* first check: port, type and cpu mode */ if (port == INT15_IOPORT && type == IOTYPE_OUTW) { current->vmctl.read_control_reg (CONTROL_REG_CR0, &cr0); if (cr0 & CR0_PE_BIT) { current->vmctl.read_flags (&rflags); if (rflags & RFLAGS_VM_BIT) ok = true; /* virtual 8086 mode */ } else { ok = true; /* real mode */ } } /* second check: ip is correct */ if (ok) { current->vmctl.read_ip (&rip); if (rip != 0x255) ok = false; } if (ok) { emulate_int15(); return 1; /* no pass */ } else { printf ("int15_ioport: I/O port=0x%x type=%d\n", port, type); return 0; /* pass */ } } static void install_int15_hook (void) { u32 old; if (!cpu_is_bsp()) { return; } /* 9 bytes hook program */ /* 0000:0255 E7 1F out %ax, $0x1F */ /* 0000:0257 EA ljmp */ /* 0000:0258 XX YY xx yy xxyy:XXYY */ /* 0000:025C CA 02 lret $2 */ /* save old interrupt vector */ read_hphys_l (INT15_VECTOR_PHYS, &old, 0); write_hphys_l (0x254, (INT15_IOPORT << 16) | 0xEA00E700, 0); write_hphys_l (0x258, old, 0); write_hphys_w (0x25C, 0x02CA, 0); /* set interrupt vector to 0x0000:0x0255 */ write_hphys_l (INT15_VECTOR_PHYS, 0x00000255, 0); set_iofunc (INT15_IOPORT, int15_ioport); } int gmm_get_mem_map(int index, phys_t *base, phys_t *len, u32 *type) { return current->vm->gmm.get_mem_map(index, base, len, type); } int gmm_get_mem_map_count(void) { return current->vm->gmm.get_mem_map_count(); } phys_t gmm_gp2hp(phys_t gphys) { return current->vm->gmm.gp2hp(gphys); } phys32_t gmm_top_of_low_avail_mem(void) { phys_t top_of_low = 0; phys_t gphys, len, end; u32 type; int index = 0; while (gmm_get_mem_map(index++, &gphys, &len, &type)) { if (type == MEM_TYPE_AVAILABLE) { end = gphys + len -1; if (end <= 0xffffffff && end > top_of_low) { top_of_low = end; } } } return top_of_low; } phys_t gmm_top_of_high_avail_mem(void) { phys_t top_of_high = 0; phys_t gphys, len, end; u32 type; int index = 0; while (gmm_get_mem_map(index++, &gphys, &len, &type)) { if (type == MEM_TYPE_AVAILABLE) { end = gphys + len -1; if (end >= 0x100000000LL && end > top_of_high) { top_of_high = end; } } } return top_of_high; } INITFUNC ("passvm1", install_int15_hook); tinyvisor/vmm/core/smp.c0000644006644000001440000001315412011203114015543 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include #include "apic.h" #include "constants.h" #include "entry.h" #include "int.h" #include "mm.h" #include "panic.h" #include "seg.h" #include "smp.h" #define APINIT_ADDR ((APINIT_SEGMENT << 4) + APINIT_OFFSET) #define APINIT_SIZE (cpuinit_end - cpuinit_start) #define APINIT_POINTER(n) ((void *)(apinit + ((u8 *)&n - cpuinit_start))) static void ap_start (void); static int num_of_processors = 1; static spinlock_t num_of_processors_lock; static void (*bsp_main) (void), (*ap_main) (void); static void *newstack_tmp; static spinlock_t sync_lock; volatile static u32 sync_id; volatile static volatile u32 sync_count; static spinlock_t *apinitlock; volatile static bool all_cpu_started = false; /* this function is called after starting AP and switching a stack */ /* unlock the spinlock because the stack is switched */ static asmlinkage void apinitproc1 (void) { void *newstack; newstack = newstack_tmp; spinlock_unlock (apinitlock); spinlock_lock (&num_of_processors_lock); num_of_processors++; spinlock_unlock (&num_of_processors_lock); segment_init_ap(); currentcpu->stackaddr = newstack; int_init_ap (); for (;;) { if (all_cpu_started) { break; } cpu_relax(); } ap_main (); } static asmlinkage void bspinitproc1 (void) { ap_start (); bsp_main (); panic ("bspinitproc1"); } /* this function is called on AP by entry.s */ /* other APs are waiting for spinlock */ /* the stack is cpuinit_tmpstack defined in entry.s */ /* this function allocates a stack and calls apinitproc1 with the new stack */ asmlinkage void apinitproc0 (void) { void *newstack; vmmerr_t err; /* Switch page tables from vmm_base_cr3 to vmm_main_cr3. */ asm_wrcr3 (vmm_main_cr3); err = alloc_pages (&newstack, NULL, VMM_STACKSIZE / PAGESIZE); if (err) { panic("Failed to allocate pages for stack."); } newstack_tmp = newstack; asm_wrrsp_and_jmp ((ulong)newstack + VMM_STACKSIZE, apinitproc1); } static void ap_start (void) { volatile u32 *num; u8 *apinit; spinlock_init (&num_of_processors_lock); spinlock_init (&sync_lock); sync_id = 0; sync_count = 0; apinit = mapmem (MAPMEM_HPHYS | MAPMEM_WRITE, APINIT_ADDR, APINIT_SIZE); if (apinit == NULL) { panic("Failed to map apinit area."); } memcpy (apinit, cpuinit_start, APINIT_SIZE); num = (volatile u32 *)APINIT_POINTER (apinit_procs); apinitlock = (spinlock_t *)APINIT_POINTER (apinit_lock); *num = 1; spinlock_init (apinitlock); apic_start_ap(APINIT_ADDR); for (;;) { if (*num == get_number_of_processors ()) break; cpu_relax(); } all_cpu_started = true; unmapmem ((void *)apinit, APINIT_SIZE); } static void bspinitproc0 () { void *newstack; vmmerr_t err; err = alloc_pages (&newstack, NULL, VMM_STACKSIZE / PAGESIZE); if (err) { panic("Failed to allocate pages for stack."); } currentcpu->stackaddr = newstack; asm_wrrsp_and_jmp ((ulong)newstack + VMM_STACKSIZE, bspinitproc1); } void panic_wakeup_all (void) { apic_broadcast_nmi(); } void sync_all_processors (void) { u32 saved_id; bool ret = false; int num; u64 timeout = 0; bool detect_lockup = time_initialized (); num = get_number_of_processors (); spinlock_lock (&sync_lock); saved_id = sync_id; sync_count++; if (sync_count == num) { sync_count = 0; sync_id++; ret = true; } spinlock_unlock (&sync_lock); if (detect_lockup) { timeout = get_cpu_time() + 30 * 1000 * 1000; /* 30 sec */ } while (!ret) { spinlock_lock (&sync_lock); if (sync_id != saved_id) { ret = true; } spinlock_unlock (&sync_lock); if (detect_lockup) { if (time_after (get_cpu_time (), timeout)) { panic ("Other cpu does not come."); } } cpu_relax(); } } void start_all_processors (void (*bsp) (void), void (*ap) (void)) { bsp_main = bsp; ap_main = ap; bspinitproc0(); } int get_number_of_processors () { int num; spinlock_lock (&num_of_processors_lock); num = num_of_processors; spinlock_unlock (&num_of_processors_lock); return num; } tinyvisor/vmm/core/vt_msr.c0000644006644000001440000002074411753454341016307 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include "asm.h" #include "constants.h" #include "current.h" #include "int.h" #include "mm.h" #include "msr_pass.h" #include "panic.h" #include "vt_internal.h" #define MAXNUM_OF_VT_MSR 512 static void write_count (void) { asm_vmwrite (VMCS_VMEXIT_MSR_STORE_COUNT, current->u.vt.msr.count); asm_vmwrite (VMCS_VMEXIT_MSR_LOAD_COUNT, current->u.vt.msr.count); asm_vmwrite (VMCS_VMENTRY_MSR_LOAD_COUNT, current->u.vt.msr.count); } void vt_msr_update_lma (void) { u64 efer; ulong ctl; static const u64 mask = MSR_IA32_EFER_LME_BIT | MSR_IA32_EFER_LMA_BIT; if (current->u.vt.lme && current->u.vt.vr.pg) { if (current->u.vt.lma) return; #ifdef __x86_64__ current->u.vt.lma = true; asm_vmread (VMCS_VMENTRY_CTL, &ctl); ctl |= VMCS_VMENTRY_CTL_64_GUEST_BIT; asm_vmwrite (VMCS_VMENTRY_CTL, ctl); vt_read_guest_msr (current->u.vt.msr.efer, &efer); efer |= mask; vt_write_guest_msr (current->u.vt.msr.efer, efer); #else panic ("Long mode is not supported!"); #endif } else { if (!current->u.vt.lma) return; current->u.vt.lma = false; asm_vmread (VMCS_VMENTRY_CTL, &ctl); ctl &= ~VMCS_VMENTRY_CTL_64_GUEST_BIT; asm_vmwrite (VMCS_VMENTRY_CTL, ctl); vt_read_guest_msr (current->u.vt.msr.efer, &efer); efer &= ~mask; vt_write_guest_msr (current->u.vt.msr.efer, efer); } } int vt_add_guest_msr (ulong index) { int i; u64 data; for (i = 0; i < current->u.vt.msr.count; i++) { if (current->u.vt.msr.vmm[i].index == index) return i; } if (i >= MAXNUM_OF_VT_MSR) return -1; asm_rdmsr64 (index, &data); current->u.vt.msr.vmm[i].index = index; current->u.vt.msr.vmm[i].reserved = 0; current->u.vt.msr.vmm[i].data = data; current->u.vt.msr.guest[i].index = index; current->u.vt.msr.guest[i].reserved = 0; current->u.vt.msr.guest[i].data = data; current->u.vt.msr.count = i + 1; write_count (); return i; } bool vt_read_guest_msr (int i, u64 *data) { if (i >= 0) *data = current->u.vt.msr.guest[i].data; else return true; return false; } bool vt_write_guest_msr (int i, u64 data) { if (i >= 0) current->u.vt.msr.guest[i].data = data; else return true; return false; } bool vt_read_msr (u32 msrindex, u64 *msrdata) { ulong a; u64 data; bool r = false; static const u64 mask = MSR_IA32_EFER_LME_BIT | MSR_IA32_EFER_LMA_BIT; switch (msrindex) { case MSR_IA32_SYSENTER_CS: asm_vmread (VMCS_GUEST_IA32_SYSENTER_CS, &a); *msrdata = a; break; case MSR_IA32_SYSENTER_ESP: asm_vmread (VMCS_GUEST_IA32_SYSENTER_ESP, &a); *msrdata = a; break; case MSR_IA32_SYSENTER_EIP: asm_vmread (VMCS_GUEST_IA32_SYSENTER_EIP, &a); *msrdata = a; break; case MSR_IA32_EFER: r = vt_read_guest_msr (current->u.vt.msr.efer, &data); if (r) break; data &= ~mask; if (current->u.vt.lme) data |= MSR_IA32_EFER_LME_BIT; if (current->u.vt.lma) data |= MSR_IA32_EFER_LMA_BIT; *msrdata = data; break; case MSR_IA32_STAR: r = vt_read_guest_msr (current->u.vt.msr.star, msrdata); break; case MSR_IA32_LSTAR: r = vt_read_guest_msr (current->u.vt.msr.lstar, msrdata); break; case MSR_AMD_CSTAR: r = vt_read_guest_msr (current->u.vt.msr.cstar, msrdata); break; case MSR_IA32_FMASK: r = vt_read_guest_msr (current->u.vt.msr.fmask, msrdata); break; case MSR_IA32_FS_BASE: asm_vmread (VMCS_GUEST_FS_BASE, &a); *msrdata = a; break; case MSR_IA32_GS_BASE: asm_vmread (VMCS_GUEST_GS_BASE, &a); *msrdata = a; break; case MSR_IA32_KERNEL_GS_BASE: r = vt_read_guest_msr (current->u.vt.msr.kerngs, msrdata); break; default: msr_read(msrindex, msrdata); } return r; } bool vt_write_msr (u32 msrindex, u64 msrdata) { u64 data; bool r = false; static const u64 mask = MSR_IA32_EFER_LME_BIT | MSR_IA32_EFER_LMA_BIT; switch (msrindex) { case MSR_IA32_SYSENTER_CS: asm_vmwrite (VMCS_GUEST_IA32_SYSENTER_CS, (ulong)msrdata); break; case MSR_IA32_SYSENTER_ESP: asm_vmwrite (VMCS_GUEST_IA32_SYSENTER_ESP, (ulong)msrdata); break; case MSR_IA32_SYSENTER_EIP: asm_vmwrite (VMCS_GUEST_IA32_SYSENTER_EIP, (ulong)msrdata); break; case MSR_IA32_EFER: r = vt_read_guest_msr (current->u.vt.msr.efer, &data); if (r) break; current->u.vt.lme = !!(msrdata & MSR_IA32_EFER_LME_BIT); data &= mask; data |= msrdata & ~mask; /* FIXME: Reserved bits should be checked here. */ r = vt_write_guest_msr (current->u.vt.msr.efer, data); vt_msr_update_lma (); cpu_mmu_spt_updatecr3 (); break; case MSR_IA32_STAR: r = vt_write_guest_msr (current->u.vt.msr.star, msrdata); break; case MSR_IA32_LSTAR: r = vt_write_guest_msr (current->u.vt.msr.lstar, msrdata); break; case MSR_AMD_CSTAR: r = vt_write_guest_msr (current->u.vt.msr.cstar, msrdata); break; case MSR_IA32_FMASK: r = vt_write_guest_msr (current->u.vt.msr.fmask, msrdata); break; case MSR_IA32_FS_BASE: asm_vmwrite (VMCS_GUEST_FS_BASE, (ulong)msrdata); break; case MSR_IA32_GS_BASE: asm_vmwrite (VMCS_GUEST_GS_BASE, (ulong)msrdata); break; case MSR_IA32_KERNEL_GS_BASE: r = vt_write_guest_msr (current->u.vt.msr.kerngs, msrdata); break; case MSR_IA32_PAT: if (current->u.vt.ept_enabled) { asm_vmwrite64(VMCS_GUEST_IA32_PAT, msrdata); } msr_write(msrindex, msrdata); break; default: msr_write(msrindex, msrdata); } return r; } void vt_msr_init (void) { phys_t msr_vmm_phys, msr_guest_phys; void *msr_vmm_virt, *msr_guest_virt; vmmerr_t err; err = alloc_pages (&msr_vmm_virt, &msr_vmm_phys, (MAXNUM_OF_VT_MSR * sizeof (struct vt_msr_entry) + PAGESIZE - 1) >> PAGESIZE_SHIFT); if (err) { panic("Failed to allocate memory for MSR of VMM."); } err = alloc_pages (&msr_guest_virt, &msr_guest_phys, (MAXNUM_OF_VT_MSR * sizeof (struct vt_msr_entry) + PAGESIZE - 1) >> PAGESIZE_SHIFT); if (err) { panic("Failed to allocate memory for MSR of a guest."); } current->u.vt.msr.vmm = msr_vmm_virt; current->u.vt.msr.guest = msr_guest_virt; current->u.vt.msr.count = 0; write_count (); asm_vmwrite (VMCS_VMEXIT_MSRLOAD_ADDR, msr_vmm_phys); asm_vmwrite (VMCS_VMEXIT_MSRLOAD_ADDR_HIGH, msr_vmm_phys >> 32); asm_vmwrite (VMCS_VMEXIT_MSRSTORE_ADDR, msr_guest_phys); asm_vmwrite (VMCS_VMEXIT_MSRSTORE_ADDR_HIGH, msr_guest_phys >> 32); asm_vmwrite (VMCS_VMENTRY_MSRLOAD_ADDR, msr_guest_phys); asm_vmwrite (VMCS_VMENTRY_MSRLOAD_ADDR_HIGH, msr_guest_phys >> 32); current->u.vt.msr.efer = vt_add_guest_msr (MSR_IA32_EFER); current->u.vt.msr.star = vt_add_guest_msr (MSR_IA32_STAR); current->u.vt.msr.lstar = vt_add_guest_msr (MSR_IA32_LSTAR); current->u.vt.msr.cstar = vt_add_guest_msr (MSR_AMD_CSTAR); current->u.vt.msr.fmask = vt_add_guest_msr (MSR_IA32_FMASK); current->u.vt.msr.kerngs = vt_add_guest_msr (MSR_IA32_KERNEL_GS_BASE); vt_write_guest_msr (current->u.vt.msr.efer, 0); vt_write_guest_msr (current->u.vt.msr.star, 0); vt_write_guest_msr (current->u.vt.msr.lstar, 0); vt_write_guest_msr (current->u.vt.msr.cstar, 0); vt_write_guest_msr (current->u.vt.msr.fmask, 0); vt_write_guest_msr (current->u.vt.msr.kerngs, 0); } tinyvisor/vmm/core/vt.c0000644006644000001440000001323311771577030015422 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include "constants.h" #include "convert.h" #include "cpu_emul.h" #include "cpuid.h" #include "current.h" #include "panic.h" #include "pcpu.h" #include "vmctl.h" #include "vt.h" #include "vt_internal.h" static void vt_extint_pending (bool pending); static bool vt_extint_is_blocked (); static void vt_tsc_offset_changed (void); static void vt_generate_pagefault (ulong err, ulong cr2); static void vt_generate_external_int (vector_t vector); static struct vmctl_func func = { .vminit = vt_vminit, .vmexit = vt_vmexit, .run_vm = vt_run_vm, .generate_pagefault = vt_generate_pagefault, .generate_external_int = vt_generate_external_int, .read_general_reg = vt_read_general_reg, .write_general_reg = vt_write_general_reg, .read_control_reg = vt_read_control_reg, .write_control_reg = vt_write_control_reg, .read_sreg_sel = vt_read_sreg_sel, .read_sreg_acr = vt_read_sreg_acr, .read_sreg_base = vt_read_sreg_base, .read_sreg_limit = vt_read_sreg_limit, .spt_setcr3 = vt_spt_setcr3, .read_ip = vt_read_ip, .write_ip = vt_write_ip, .read_flags = vt_read_flags, .write_flags = vt_write_flags, .read_gdtr = vt_read_gdtr, .write_gdtr = vt_write_gdtr, .read_idtr = vt_read_idtr, .write_idtr = vt_write_idtr, .write_realmode_seg = vt_write_realmode_seg, .writing_sreg = vt_writing_sreg, .read_msr = vt_read_msr, .write_msr = vt_write_msr, .cpuid = call_cpuid, .extint_pending = vt_extint_pending, .extint_is_blocked = vt_extint_is_blocked, .extern_iopass = vt_extern_iopass, .tsc_offset_changed = vt_tsc_offset_changed, .panic_dump = vt_panic_dump, .invlpg = vt_invlpg, .reset = vt_reset, }; void vt_vmctl_init (void) { memcpy ((void *)¤t->vmctl, (void *)&func, sizeof func); } static void vt_generate_pagefault (ulong err, ulong cr2) { struct vt_intr_data *vid = ¤t->u.vt.intr; if (vid->intr_info.s.valid == INTR_INFO_VALID_VALID) { panic ("Can't inject page fault because the other event is already pending. " "vector 0x%x type 0x%x, err_valid 0x%x", vid->intr_info.s.vector, vid->intr_info.s.type, vid->intr_info.s.err); } vid->intr_info.v = 0; vid->intr_info.s.vector = EXCEPTION_PF; vid->intr_info.s.type = INTR_INFO_TYPE_HARD_EXCEPTION; vid->intr_info.s.err = INTR_INFO_ERR_VALID; vid->intr_info.s.valid = INTR_INFO_VALID_VALID; vid->exception_errcode = err; vid->instruction_len = 0; current->u.vt.vr.cr2 = cr2; } static void vt_generate_external_int (vector_t vector) { struct vt_intr_data *vid = ¤t->u.vt.intr; if (vid->intr_info.s.valid == INTR_INFO_VALID_VALID) { panic ("Can't inject external interrupt because the other event is already pending. " "vector 0x%x type 0x%x, err_valid 0x%x", vid->intr_info.s.vector, vid->intr_info.s.type, vid->intr_info.s.err); } vid->intr_info.v = 0; vid->intr_info.s.vector = vector; vid->intr_info.s.type = INTR_INFO_TYPE_EXTERNAL; vid->intr_info.s.err = INTR_INFO_ERR_INVALID; vid->intr_info.s.valid = INTR_INFO_VALID_VALID; vid->instruction_len = 0; } static bool vt_extint_is_blocked (void) { ulong int_state; ulong rflags; struct vt_intr_data *vid = ¤t->u.vt.intr; vt_read_flags (&rflags); asm_vmread (VMCS_GUEST_INTERRUPTIBILITY_STATE, &int_state); return (!(rflags & RFLAGS_IF_BIT) || ((int_state & (VMCS_GUEST_INTERRUPTIBILITY_STATE_BLOCKING_BY_STI_BIT | VMCS_GUEST_INTERRUPTIBILITY_STATE_BLOCKING_BY_MOV_SS_BIT))) || vid->intr_info.s.valid == INTR_INFO_VALID_VALID); } static void vt_extint_pending (bool pending) { ulong ctl; asm_vmread (VMCS_PROC_BASED_VMEXEC_CTL, &ctl); if (pending) { /* * Make VM-exit occur at the beginning of next * interrupt window. */ ctl |= VMCS_PROC_BASED_VMEXEC_CTL_INTRWINEXIT_BIT; } else { ctl &= ~(ulong)VMCS_PROC_BASED_VMEXEC_CTL_INTRWINEXIT_BIT; } asm_vmwrite (VMCS_PROC_BASED_VMEXEC_CTL, ctl); } static void vt_tsc_offset_changed (void) { u32 l, h; conv64to32 (current->tsc_offset, &l, &h); asm_vmwrite (VMCS_TSC_OFFSET, l); asm_vmwrite (VMCS_TSC_OFFSET_HIGH, h); } tinyvisor/vmm/core/elf.h0000644006644000001440000001717111733245403015543 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /*- * Copyright (c) 1996-1998 John D. Polstra. * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * $FreeBSD: src/sys/sys/elf32.h,v 1.8.14.1 2005/12/30 22:13:58 marcel Exp $ */ /*- * Copyright (c) 1996-1998 John D. Polstra. * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * $FreeBSD: src/sys/sys/elf64.h,v 1.10.14.1 2005/12/30 22:13:58 marcel Exp $ */ #ifndef _CORE_ELF_H #define _CORE_ELF_H #include #ifdef __x86_64__ # define ELF_EHDR Elf64_Ehdr # define ELF_PHDR Elf64_Phdr #else # define ELF_EHDR Elf32_Ehdr # define ELF_PHDR Elf32_Phdr #endif /* from FreeBSD src/sys/sys/elf_common.h: */ #define EI_NIDENT 16 /* Size of e_ident array. */ #define PT_LOAD 1 /* Loadable segment. */ /* from FreeBSD src/sys/sys/elf32.h: */ typedef u32 Elf32_Addr; typedef u16 Elf32_Half; typedef u32 Elf32_Off; typedef i32 Elf32_Sword; typedef u32 Elf32_Word; typedef Elf32_Word Elf32_Hashelt; typedef struct { unsigned char e_ident[EI_NIDENT]; /* File identification. */ Elf32_Half e_type; /* File type. */ Elf32_Half e_machine; /* Machine architecture. */ Elf32_Word e_version; /* ELF format version. */ Elf32_Addr e_entry; /* Entry point. */ Elf32_Off e_phoff; /* Program header file offset. */ Elf32_Off e_shoff; /* Section header file offset. */ Elf32_Word e_flags; /* Architecture-specific flags. */ Elf32_Half e_ehsize; /* Size of ELF header in bytes. */ Elf32_Half e_phentsize; /* Size of program header entry. */ Elf32_Half e_phnum; /* Number of program header entries. */ Elf32_Half e_shentsize; /* Size of section header entry. */ Elf32_Half e_shnum; /* Number of section header entries. */ Elf32_Half e_shstrndx; /* Section name strings section. */ } Elf32_Ehdr; typedef struct { Elf32_Word p_type; /* Entry type. */ Elf32_Off p_offset; /* File offset of contents. */ Elf32_Addr p_vaddr; /* Virtual address in memory image. */ Elf32_Addr p_paddr; /* Physical address (not used). */ Elf32_Word p_filesz; /* Size of contents in file. */ Elf32_Word p_memsz; /* Size of contents in memory. */ Elf32_Word p_flags; /* Access permission flags. */ Elf32_Word p_align; /* Alignment in memory and file. */ } Elf32_Phdr; /* from FreeBSD src/sys/sys/elf64.h: */ typedef u64 Elf64_Addr; typedef u16 Elf64_Half; typedef u64 Elf64_Off; typedef i32 Elf64_Sword; typedef i64 Elf64_Sxword; typedef u32 Elf64_Word; typedef u64 Elf64_Xword; typedef Elf64_Word Elf64_Hashelt; typedef struct { unsigned char e_ident[EI_NIDENT]; /* File identification. */ Elf64_Half e_type; /* File type. */ Elf64_Half e_machine; /* Machine architecture. */ Elf64_Word e_version; /* ELF format version. */ Elf64_Addr e_entry; /* Entry point. */ Elf64_Off e_phoff; /* Program header file offset. */ Elf64_Off e_shoff; /* Section header file offset. */ Elf64_Word e_flags; /* Architecture-specific flags. */ Elf64_Half e_ehsize; /* Size of ELF header in bytes. */ Elf64_Half e_phentsize; /* Size of program header entry. */ Elf64_Half e_phnum; /* Number of program header entries. */ Elf64_Half e_shentsize; /* Size of section header entry. */ Elf64_Half e_shnum; /* Number of section header entries. */ Elf64_Half e_shstrndx; /* Section name strings section. */ } Elf64_Ehdr; typedef struct { Elf64_Word p_type; /* Entry type. */ Elf64_Word p_flags; /* Access permission flags. */ Elf64_Off p_offset; /* File offset of contents. */ Elf64_Addr p_vaddr; /* Virtual address in memory image. */ Elf64_Addr p_paddr; /* Physical address (not used). */ Elf64_Xword p_filesz; /* Size of contents in file. */ Elf64_Xword p_memsz; /* Size of contents in memory. */ Elf64_Xword p_align; /* Alignment in memory and file. */ } Elf64_Phdr; #endif tinyvisor/vmm/core/svm.h0000644006644000001440000000423411733245403015576 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_SVM_H #define _CORE_SVM_H #include "cpu.h" #include "svm_io.h" #include "svm_msr.h" #include "svm_vmcb.h" struct svm_intr_data { union { struct vmcb_eventinj s; u64 v; } intr_info; }; struct svm_vmcb_info { struct vmcb *vmcb; phys_t vmcb_phys; }; struct svm_np; struct svm { struct svm_vmrun_regs vr; struct svm_vmcb_info vi; struct svm_intr_data intr; struct svm_io io; struct svm_msr msr; struct svm_np *np; bool lme, lma; }; struct svm_pcpu_data { void *hsave; phys_t hsave_phys; struct vmcb *vmcbhost; phys_t vmcbhost_phys; }; void svm_vmctl_init (void); #endif tinyvisor/vmm/core/mm_process.c0000644006644000001440000002322012011466501017121 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include "asm.h" #include "comphappy.h" #include "entry.h" #include "mm.h" #include "panic.h" #include "thread.h" #include static spinlock_t mm_lock_process_virt_to_phys = SPINLOCK_INITIALIZER;; static void process_create_initial_map (void *virt, phys_t phys) { u32 *pde; int i; pde = virt; /* clear PDEs for user area */ for (i = 0; i < 0x400; i++) pde[i] = 0; } int mm_process_alloc (phys_t *phys2) { void *l2table; void *l3table; #ifdef __x86_64__ void *l4table; #endif phys_t phys; vmmerr_t err; err = alloc_page(&l2table, &phys); if (err) { return -1; } process_create_initial_map (l2table, phys); err = alloc_page(&l3table, phys2); if (err) { free_page(l2table); return -1; } memset(l3table, 0, PAGESIZE); /* virt 0x00000000 process area */ ((u64 *)l3table)[0] = phys | PDPE_ATTR; /* virt 0x40000000 vmm area */ ((u64 *)l3table)[1] = vmm_main_pdp[1]; /* virt 0x80000000 mapmem area */ ((u64 *)l3table)[2] = vmm_main_pdp[2]; #ifdef __x86_64__ phys = *phys2; err = alloc_page(&l4table, phys2); if (err) { free_page(l3table); free_page(l2table); return -1; } memcpy (l4table, vmm_main_pml4, PAGESIZE); ((u64 *)l4table)[0] = phys | PDE_P_BIT | PDE_RW_BIT | PDE_US_BIT; #endif return 0; } void mm_process_free (phys_t phys) { #ifdef __x86_64__ free_page_phys (((u64 *)phys_to_virt (((u64 *)phys_to_virt (phys))[0] & ~PAGESIZE_MASK))[0]); #endif free_page_phys (((u64 *)phys_to_virt (phys))[0]); free_page_phys (phys); } static vmmerr_t mm_process_mappage(virt_t virt, u64 pte) { ulong cr3; pmap_t m; vmmerr_t err; asm_rdcr3 (&cr3); pmap_open_vmm (&m, cr3, PMAP_LEVELS); pmap_setvirt (&m, virt, 1); err = pmap_autoalloc (&m); if (err) { printf("mm_process_mappage: Failed to prepare page tables."); goto out; } ASSERT (!(pmap_read (&m) & PTE_P_BIT)); pmap_write (&m, pte, 0xFFF); out: pmap_close (&m); asm_wrcr3 (cr3); return err; } static vmmerr_t mm_process_mapstack (virt_t virt) { ulong cr3; pmap_t m; u64 pte; void *tmp; phys_t phys; vmmerr_t err; asm_rdcr3 (&cr3); pmap_open_vmm (&m, cr3, PMAP_LEVELS); pmap_setvirt (&m, virt, 1); err = pmap_autoalloc (&m); if (err) { printf("mm_process_mapstack: Failed to prepare page tables."); goto out; } pte = pmap_read (&m); if (!(pte & PTE_P_BIT)) { err = alloc_page (&tmp, &phys); if (err) { printf("mm_process_mapstack: Failed to alloc a page."); goto out; } memset (tmp, 0, PAGESIZE); pte = phys | PTE_P_BIT | PTE_RW_BIT | PTE_US_BIT; } else { pte &= ~PTE_AVAILABLE1_BIT; } pmap_write (&m, pte, 0xFFF); out: pmap_close (&m); asm_wrcr3 (cr3); return err; } int mm_process_map_alloc (virt_t virt, uint len) { void *tmp; phys_t phys; uint npages; virt_t v; vmmerr_t err; if (virt >= VMM_START_VIRT) return -1; if (virt + len >= VMM_START_VIRT) return -1; if (virt > virt + len) return -1; len += virt & PAGESIZE_MASK; virt -= virt & PAGESIZE_MASK; npages = (len + PAGESIZE - 1) >> PAGESIZE_SHIFT; mm_process_unmap (virt, len); for (v = virt; npages > 0; v += PAGESIZE, npages--) { err = alloc_page (&tmp, &phys); if (err) { printf("Failed to allocate for a process."); goto err; } memset (tmp, 0, PAGESIZE); if (mm_process_mappage(v, phys | PTE_P_BIT | PTE_RW_BIT | PTE_US_BIT)) { printf("Failed to map to a process."); goto err; } } return 0; err: mm_process_unmap(virt, len); return -1; } static bool alloc_sharedmem_sub (u32 virt) { pmap_t m; ulong cr3; u64 pte; asm_rdcr3 (&cr3); pmap_open_vmm (&m, cr3, PMAP_LEVELS); pmap_setvirt (&m, virt, 1); pte = pmap_read (&m); pmap_close (&m); if (!(pte & PTE_P_BIT)) return true; return false; } int mm_process_map_shared_physpage (virt_t virt, phys_t phys, bool rw) { virt &= ~PAGESIZE_MASK; if (virt >= VMM_START_VIRT) return -1; mm_process_unmap (virt, PAGESIZE); if (mm_process_mappage (virt, phys | PTE_P_BIT | (rw ? PTE_RW_BIT : 0) | PTE_US_BIT | PTE_AVAILABLE2_BIT)) { return -1; } return 0; } static int process_virt_to_phys (phys_t procphys, virt_t virt, phys_t *phys) { u64 pte; int r = -1; pmap_t m; spinlock_lock (&mm_lock_process_virt_to_phys); pmap_open_vmm (&m, procphys, PMAP_LEVELS); pmap_setvirt (&m, virt, 1); pte = pmap_read (&m); if (pte & PTE_P_BIT) { *phys = (pte & PTE_ADDR_MASK) | (virt & ~PTE_ADDR_MASK); r = 0; } pmap_close (&m); spinlock_unlock (&mm_lock_process_virt_to_phys); return r; } void * mm_process_map_shared (phys_t procphys, void *buf, uint len, bool rw) { virt_t uservirt = 0x30000000; virt_t virt, virt_s, virt_e, off; phys_t phys; VAR_IS_INITIALIZED(phys); if (len == 0) return NULL; virt_s = (virt_t)buf; virt_e = (virt_t)buf + len; retry: for (virt = virt_s & ~0xFFF; virt < virt_e; virt += PAGESIZE) { uservirt -= PAGESIZE; ASSERT (uservirt > 0x20000000); if (!alloc_sharedmem_sub (uservirt)) goto retry; } for (virt = virt_s & ~0xFFF, off = 0; virt < virt_e; virt += PAGESIZE, off += PAGESIZE) { if (process_virt_to_phys (procphys, virt, &phys)) { mm_process_unmap ((virt_t)(uservirt + (virt_s & 0xFFF)), len); return NULL; } if (mm_process_map_shared_physpage (uservirt + off, phys, rw)) { panic("mm_process_map_shared: Fail to map."); } } return (void *)(uservirt + (virt_s & 0xFFF)); } static bool alloc_stack_sub (virt_t virt) { pmap_t m; ulong cr3; u64 pte; asm_rdcr3 (&cr3); pmap_open_vmm (&m, cr3, PMAP_LEVELS); pmap_setvirt (&m, virt, 1); pte = pmap_read (&m); pmap_close (&m); if (!(pte & PTE_P_BIT)) return true; if (pte & PTE_AVAILABLE1_BIT) return true; return false; } virt_t mm_process_map_stack (uint len) { uint i; virt_t virt = 0x3FFFF000; uint npages; npages = (len + PAGESIZE - 1) >> PAGESIZE_SHIFT; retry: virt -= PAGESIZE; for (i = 0; i < npages; i++) { ASSERT (virt - i * PAGESIZE > 0x20000000); if (!alloc_stack_sub (virt - i * PAGESIZE)) { virt = virt - i * PAGESIZE; goto retry; } } for (i = 0; i < npages; i++) mm_process_mapstack (virt - i * PAGESIZE); return virt + PAGESIZE; } int mm_process_unmap (virt_t virt, uint len) { uint npages; virt_t v; u64 pte; ulong cr3; pmap_t m; if (virt >= VMM_START_VIRT) return -1; if (virt + len >= VMM_START_VIRT) return -1; if (virt > virt + len) return -1; len += virt & PAGESIZE_MASK; virt -= virt & PAGESIZE_MASK; npages = (len + PAGESIZE - 1) >> PAGESIZE_SHIFT; asm_rdcr3 (&cr3); pmap_open_vmm (&m, cr3, PMAP_LEVELS); for (v = virt; npages > 0; v += PAGESIZE, npages--) { pmap_setvirt (&m, v, 1); pte = pmap_read (&m); if (!(pte & PDE_P_BIT)) continue; if (!(pte & PTE_AVAILABLE2_BIT)) /* if not shared memory */ free_page_phys (pte); pmap_write (&m, 0, 0); } pmap_close (&m); asm_wrcr3 (cr3); return 0; } int mm_process_unmapstack (virt_t virt, uint len) { uint npages; virt_t v; u64 pte; ulong cr3; pmap_t m; if (virt >= VMM_START_VIRT) return -1; if (virt + len >= VMM_START_VIRT) return -1; if (virt > virt + len) return -1; len += virt & PAGESIZE_MASK; virt -= virt & PAGESIZE_MASK; npages = (len + PAGESIZE - 1) >> PAGESIZE_SHIFT; asm_rdcr3 (&cr3); pmap_open_vmm (&m, cr3, PMAP_LEVELS); for (v = virt; npages > 0; v += PAGESIZE, npages--) { pmap_setvirt (&m, v, 1); pte = pmap_read (&m); if (!(pte & PDE_P_BIT)) continue; if (pte & PTE_AVAILABLE2_BIT) continue; pmap_write (&m, pte | PTE_AVAILABLE1_BIT, 0xFFF); } pmap_close (&m); asm_wrcr3 (cr3); return 0; } void mm_process_unmapall (void) { virt_t v; u64 pde; pmap_t m; ulong cr3; ASSERT (!mm_process_unmap (0, VMM_START_VIRT - 1)); asm_rdcr3 (&cr3); pmap_open_vmm (&m, cr3, PMAP_LEVELS); for (v = 0; v < VMM_START_VIRT; v += PAGESIZE2M) { pmap_setvirt (&m, v, 2); pde = pmap_read (&m); if (!(pde & PDE_P_BIT)) continue; free_page_phys (pde); pmap_write (&m, 0, 0); } pmap_close (&m); asm_wrcr3 (cr3); } phys_t mm_process_switch (phys_t switchto) { ulong oldcr3; asm_rdcr3 (&oldcr3); asm_wrcr3 ((ulong)switchto); thread_set_process_switch (switchto); return oldcr3; } tinyvisor/vmm/core/io_iohook.c0000644006644000001440000000736012140421510016732 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2012-2013 Yuichi Watanabe */ #include #include #include "current.h" #include "io_io.h" #include "panic.h" #include "vm.h" #ifdef DEBUG_IO_MONITOR static int kbdio_monitor (iotype_t type, ioport_t port, void *data) { if (type == IOTYPE_INB) printf ("IO Monitor test: INB PORT=0x60 DATA=0x%X\n", *(u8 *)data); return 0; /* pass */ } #endif #ifdef DEBUG_IO0x20_MONITOR #include "vramwrite.h" static void io0x20_monitor (iotype_t type, ioport_t port, void *data) { do_io_pass (type, port, data); if (type == IOTYPE_OUTB) { vramwrite_save_and_move_cursor (56, 23); printf ("OUT0x20,0x%02X", *(u8 *)data); vramwrite_restore_cursor (); } return /* no pass */ } #endif #if defined (F11PANIC) || defined (F12MSG) #include "keyboard.h" static int kbdio_dbg_monitor (iotype_t type, ioport_t port, void *data) { static int led = 0; static u8 lk = 0; if (type == IOTYPE_INB) { switch (*(u8 *)data) { case 0x57 | 0x80: /* F11 */ if (lk == 0x57) { #ifdef F11PANIC if (config.vmm.f11panic) panic ("F11 pressed."); #endif } break; case 0x58 | 0x80: /* F12 */ if (lk == 0x58) { #if defined(F12MSG) if (config.vmm.f12msg) { led ^= LED_CAPSLOCK_BIT | LED_NUMLOCK_BIT; setkbdled (led); printf ("F12 pressed.\n"); } #endif /* defined(F12MSG) */ } break; } lk = *(u8 *)data; } return 0; /* pass */ } #endif static int kbdcmd_monitor(iotype_t type, ioport_t port, void *data) { u8 data_u8; if (type == IOTYPE_OUTB) { data_u8 = *(u8 *)data; if (data_u8 == 0xfe) { /* reset machine */ if (vm_reset() == VMMERR_SUCCESS) { return 0; /* emulated */ } printf("Ignored a request to reboot by %s\n", vm_get_name()); return 0; /* emulated */ } } return 1; /* pass */ } static void setiohooks (void) { #ifdef DEBUG_IO_MONITOR set_iofunc (0x60, kbdio_monitor); #endif #ifdef DEBUG_IO0x20_MONITOR set_iofunc (0x20, io0x20_monitor); #endif #if defined (F11PANIC) || defined (F12MSG) if (config.vmm.f11panic || config.vmm.f12msg) set_iofunc (0x60, kbdio_dbg_monitor); #endif if (!cpu_is_bsp()) { set_iofunc(0x64, kbdcmd_monitor); } } INITFUNC ("passvm1", setiohooks); tinyvisor/vmm/core/thread_switch.s0000644006644000001440000000470611733227577017654 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ .include "longmode.h" .text .globl thread_switch .globl thread_start0 .if longmode .set thread_switch, thread_switch64 .set thread_start0, thread_start064 .else .set thread_switch, thread_switch32 .set thread_start0, thread_start032 .endif .code32 EBP_ARG1 = 8 EBP_ARG2 = 12 EBP_ARG3 = 16 .align 16 thread_switch32: push %ebp mov %esp,%ebp push %ebx push %esi push %edi mov EBP_ARG3(%ebp),%eax lea -8(%esp),%esp mov EBP_ARG1(%ebp),%ebx mov %esp,(%ebx) mov EBP_ARG2(%ebp),%esp lea 8(%esp),%esp pop %edi pop %esi pop %ebx pop %ebp ret .align 16 thread_start032: push $0 jmp thread_start1 .code64 .align 16 thread_switch64: push %rbp push %rbx push %r15 push %r14 push %r13 push %r12 mov %rdx,%rax mov %rsp,(%rdi) mov %rsi,%rsp pop %r12 pop %r13 pop %r14 pop %r15 pop %rbx pop %rbp ret .align 16 thread_start064: pop %rdi pop %rsi jmp thread_start1 tinyvisor/vmm/core/cpu_seg.c0000644006644000001440000001420311753454341016413 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include "constants.h" #include "cpu_mmu.h" #include "cpu_seg.h" #include "current.h" vmmerr_t cpu_seg_read_b (enum sreg s, ulong offset, u8 *data) { ulong linear; ulong acr; ulong base; current->vmctl.read_sreg_acr (s, &acr); current->vmctl.read_sreg_base (s, &base); if (acr & ACCESS_RIGHTS_UNUSABLE_BIT) return VMMERR_INVALID_GUESTSEG; if (!(acr & ACCESS_RIGHTS_P_BIT)) return VMMERR_GUESTSEG_NOT_PRESENT; /* FIXME: expand-down */ /* FIXME: limit check */ /* FIXME: CPL check */ /* FIXME: access rights check */ linear = base + offset; RIE (read_linearaddr_b (linear, data)); return VMMERR_SUCCESS; } vmmerr_t cpu_seg_read_w (enum sreg s, ulong offset, u16 *data) { ulong linear; ulong acr; ulong base; current->vmctl.read_sreg_acr (s, &acr); current->vmctl.read_sreg_base (s, &base); if (acr & ACCESS_RIGHTS_UNUSABLE_BIT) return VMMERR_INVALID_GUESTSEG; if (!(acr & ACCESS_RIGHTS_P_BIT)) return VMMERR_GUESTSEG_NOT_PRESENT; /* FIXME: expand-down */ /* FIXME: limit check */ /* FIXME: CPL check */ /* FIXME: access rights check */ linear = base + offset; RIE (read_linearaddr_w (linear, data)); return VMMERR_SUCCESS; } vmmerr_t cpu_seg_read_l (enum sreg s, ulong offset, u32 *data) { ulong linear; ulong acr; ulong base; current->vmctl.read_sreg_acr (s, &acr); current->vmctl.read_sreg_base (s, &base); if (acr & ACCESS_RIGHTS_UNUSABLE_BIT) return VMMERR_INVALID_GUESTSEG; if (!(acr & ACCESS_RIGHTS_P_BIT)) return VMMERR_GUESTSEG_NOT_PRESENT; /* FIXME: expand-down */ /* FIXME: limit check */ /* FIXME: CPL check */ /* FIXME: access rights check */ linear = base + offset; RIE (read_linearaddr_l (linear, data)); return VMMERR_SUCCESS; } vmmerr_t cpu_seg_read_q (enum sreg s, ulong offset, u64 *data) { ulong linear; ulong acr; ulong base; current->vmctl.read_sreg_acr (s, &acr); current->vmctl.read_sreg_base (s, &base); if (acr & ACCESS_RIGHTS_UNUSABLE_BIT) return VMMERR_INVALID_GUESTSEG; if (!(acr & ACCESS_RIGHTS_P_BIT)) return VMMERR_GUESTSEG_NOT_PRESENT; /* FIXME: expand-down */ /* FIXME: limit check */ /* FIXME: CPL check */ /* FIXME: access rights check */ linear = base + offset; RIE (read_linearaddr_q (linear, data)); return VMMERR_SUCCESS; } vmmerr_t cpu_seg_write_b (enum sreg s, ulong offset, u8 data) { ulong linear; ulong acr; ulong base; current->vmctl.read_sreg_acr (s, &acr); current->vmctl.read_sreg_base (s, &base); if (acr & ACCESS_RIGHTS_UNUSABLE_BIT) return VMMERR_INVALID_GUESTSEG; if (!(acr & ACCESS_RIGHTS_P_BIT)) return VMMERR_GUESTSEG_NOT_PRESENT; /* FIXME: expand-down */ /* FIXME: limit check */ /* FIXME: CPL check */ /* FIXME: access rights check */ linear = base + offset; RIE (write_linearaddr_b (linear, data)); return VMMERR_SUCCESS; } vmmerr_t cpu_seg_write_w (enum sreg s, ulong offset, u16 data) { ulong linear; ulong acr; ulong base; current->vmctl.read_sreg_acr (s, &acr); current->vmctl.read_sreg_base (s, &base); if (acr & ACCESS_RIGHTS_UNUSABLE_BIT) return VMMERR_INVALID_GUESTSEG; if (!(acr & ACCESS_RIGHTS_P_BIT)) return VMMERR_GUESTSEG_NOT_PRESENT; /* FIXME: expand-down */ /* FIXME: limit check */ /* FIXME: CPL check */ /* FIXME: access rights check */ linear = base + offset; RIE (write_linearaddr_w (linear, data)); return VMMERR_SUCCESS; } vmmerr_t cpu_seg_write_l (enum sreg s, ulong offset, u32 data) { ulong linear; ulong acr; ulong base; current->vmctl.read_sreg_acr (s, &acr); current->vmctl.read_sreg_base (s, &base); if (acr & ACCESS_RIGHTS_UNUSABLE_BIT) return VMMERR_INVALID_GUESTSEG; if (!(acr & ACCESS_RIGHTS_P_BIT)) return VMMERR_GUESTSEG_NOT_PRESENT; /* FIXME: expand-down */ /* FIXME: limit check */ /* FIXME: CPL check */ /* FIXME: access rights check */ linear = base + offset; RIE (write_linearaddr_l (linear, data)); return VMMERR_SUCCESS; } vmmerr_t cpu_seg_write_q (enum sreg s, ulong offset, u64 data) { ulong linear; ulong acr; ulong base; current->vmctl.read_sreg_acr (s, &acr); current->vmctl.read_sreg_base (s, &base); if (acr & ACCESS_RIGHTS_UNUSABLE_BIT) return VMMERR_INVALID_GUESTSEG; if (!(acr & ACCESS_RIGHTS_P_BIT)) return VMMERR_GUESTSEG_NOT_PRESENT; /* FIXME: expand-down */ /* FIXME: limit check */ /* FIXME: CPL check */ /* FIXME: access rights check */ linear = base + offset; RIE (write_linearaddr_q (linear, data)); return VMMERR_SUCCESS; } uint seg_get_cpl(void) { ulong acr; current->vmctl.read_sreg_acr(SREG_CS, &acr); return (acr & ACCESS_RIGHTS_DPL_MASK) > ACCESS_RIGHTS_DPL_SHIFT; } bool seg_user_mode(void) { return (seg_get_cpl() == 3) ? true : false; } tinyvisor/vmm/core/vcpu.c0000644006644000001440000001214512206320117015731 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #include #include #include #include #include "apic.h" #include "apic_pass.h" #include "current.h" #include "mm.h" #include "pcpu.h" #include #include "vcpu.h" /* call func with every vcpu */ /* return immediately if func returns true */ /* q is a pointer for any purpose */ void vcpu_list_foreach (struct vm *vm, bool (*func) (struct vcpu *p, void *q), void *q) { struct vcpu *p, *pn; spinlock_lock(&vm->vcpu_list_lock); LIST2_FOREACH_DELETABLE(vm->vcpu_list, vcpu_list, p, pn) { spinlock_unlock(&vm->vcpu_list_lock); if (func (p, q)) { break; } spinlock_lock(&vm->vcpu_list_lock); } spinlock_unlock(&vm->vcpu_list_lock); } struct vcpu * find_vcpu_with_apic_id (struct vm *vm, apic_id_t apic_id) { struct vcpu *p; spinlock_lock(&vm->vcpu_list_lock); LIST2_FOREACH(vm->vcpu_list, vcpu_list, p) { if (p->apic_id == apic_id) { spinlock_unlock(&vm->vcpu_list_lock); return p; } } spinlock_unlock(&vm->vcpu_list_lock); return NULL; } #include struct vcpu * new_vcpu (struct vm *vm, bool vbsp) { current = (struct vcpu *)alloc(sizeof (struct vcpu)); if (current == NULL) { return current; } memset(current, 0, sizeof (struct vcpu)); current->vbsp = vbsp; current->pcpu = currentcpu; current->apic_id = currentcpu->apic_id; current->vm = vm; int_init_hook(); spinlock_lock(&vm->vcpu_list_lock); LIST2_ADD(vm->vcpu_list, vcpu_list, current); vm->vcpu_count++; spinlock_unlock(&vm->vcpu_list_lock); return current; } struct vcpu * vcpu_next (struct vm *vm, struct vcpu *vcpu) { struct vcpu *next; spinlock_lock(&vm->vcpu_list_lock); next = LIST2_NEXT(vm->vcpu_list, vcpu_list, vcpu); spinlock_unlock(&vm->vcpu_list_lock); return next; } void vcpu_reset(void) { current->vmctl.reset (); current->vmctl.write_general_reg (GENERAL_REG_RAX, 0); current->vmctl.write_general_reg (GENERAL_REG_RCX, 0); current->vmctl.write_general_reg (GENERAL_REG_RDX, 0); current->vmctl.write_general_reg (GENERAL_REG_RBX, 0); current->vmctl.write_general_reg (GENERAL_REG_RSP, 0); current->vmctl.write_general_reg (GENERAL_REG_RBP, 0); current->vmctl.write_general_reg (GENERAL_REG_RSI, 0); current->vmctl.write_general_reg (GENERAL_REG_RDI, 0); current->vmctl.write_general_reg (GENERAL_REG_R8, 0); current->vmctl.write_general_reg (GENERAL_REG_R9, 0); current->vmctl.write_general_reg (GENERAL_REG_R10, 0); current->vmctl.write_general_reg (GENERAL_REG_R11, 0); current->vmctl.write_general_reg (GENERAL_REG_R12, 0); current->vmctl.write_general_reg (GENERAL_REG_R13, 0); current->vmctl.write_general_reg (GENERAL_REG_R14, 0); current->vmctl.write_general_reg (GENERAL_REG_R15, 0); current->vmctl.write_flags (RFLAGS_ALWAYS1_BIT); current->vmctl.write_realmode_seg (SREG_ES, 0); current->vmctl.write_realmode_seg (SREG_CS, 0xf000); current->vmctl.write_realmode_seg (SREG_SS, 0); current->vmctl.write_realmode_seg (SREG_DS, 0); current->vmctl.write_realmode_seg (SREG_FS, 0); current->vmctl.write_realmode_seg (SREG_GS, 0); current->vmctl.write_control_reg (CONTROL_REG_CR0, CR0_ET_BIT); current->vmctl.write_control_reg (CONTROL_REG_CR2, 0); current->vmctl.write_control_reg (CONTROL_REG_CR3, 0); current->vmctl.write_control_reg (CONTROL_REG_CR4, 0); current->vmctl.write_ip (0xfff0); current->vmctl.write_idtr (0, 0x3FF); current->vmctl.write_gdtr (0, 0xFFFF); if (!current->vbsp) { apic_enter_wait_for_sipi_state(); } } void vcpu_reset_apic(void) { extint_reset_apic(); apic_disable(); } tinyvisor/vmm/core/mmio.c0000644006644000001440000001562111733245403015727 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include #include #include "asm.h" #include "constants.h" #include "cpu_interpreter.h" #include "cpu_mmu.h" #include "current.h" #include "mm.h" #include "mmio.h" #include "panic.h" struct call_flush_tlb_data { phys_t start; phys_t end; bool ret; }; static int rangecheck (struct mmio_handle *h, phys_t gphys, uint len, phys_t *gphys2, uint *len2) { phys_t start, end, h_start, h_end; if (len == 0) { return 0; } start = gphys; end = gphys + len - 1; h_start = h->gphys; h_end = h->gphys + h->len - 1; if (start > h_end || end < h_start) { return 0; } if (start < h_start) { start = h_start; } if (end > h_end) { end = h_end; } if (gphys2) { *gphys2 = start; } if (len2) { *len2 = end - start + 1; } return 1; } void * mmio_memcpy(void *dest, const void *src, int len) { switch (len) { case 1: *(u8*)dest = *(u8*)src; break; case 2: *(u16*)dest = *(u16*)src; break; case 4: *(u32*)dest = *(u32*)src; break; case 8: *(u64*)dest = *(u64*)src; break; default: return memcpy(dest, src, len); } return dest; } static void mmio_gphys_access (phys_t gphysaddr, bool wr, void *buf, uint len, u32 flags) { void *virt; ASSERT (!(flags & ~MAPMEM_VALID_FLAG)); if (!len) return; virt = mapmem_gphys (gphysaddr, len, (wr ? MAPMEM_WRITE : 0) | flags); if (virt == NULL) { printf("mmio_gphys_access: Failed to map. " "gphysaddr=0x%llx, len=0x%x, wr=%d\n", gphysaddr, len, wr); if (!wr) { memset(buf, -1, len); } return; } if (wr) mmio_memcpy(virt, buf, len); else mmio_memcpy(buf, virt, len); unmapmem (virt, len); } static void call_mmio(struct mmio_handle *handle, phys_t gphys, bool wr, void *buf, uint length, u32 flags) { int emulated; uint len; while (length > 0) { for (len = 1; len < length; len <<= 1) { if (gphys & ((len << 1) - 1)) { break; } } emulated = handle->handler(handle->data, gphys, wr, buf, len, flags); if (!emulated) { mmio_gphys_access(gphys, wr, buf, len, flags); } gphys += len; length -= len; } } /* * Return 1 if this function accesses memory. * Return 0 if this function does not access memory.l */ int mmio_access_memory (phys_t gphysaddr, bool wr, void *buffer, uint length, u32 flags) { struct mmio_handle *h; int ret = 0; phys_t gphys2; uint len1, len2; u8 *buf = buffer; ASSERT (!(flags & ~MAPMEM_VALID_FLAG)); ASSERT((length & (length - 1)) == 0); LIST1_FOREACH (current->vm->mmio.mmio[MMIO_INDEX(gphysaddr)], h) { if (!length) break; if (rangecheck(h, gphysaddr, length, &gphys2, &len2)) { ret = 1; len1 = gphys2 - gphysaddr; mmio_gphys_access(gphysaddr, wr, buf, len1, flags); buf += len1; length -= len1; call_mmio(h, gphys2, wr, buf, len2, flags); gphysaddr = gphys2 + len2; buf += len2; length -= len2; } } if (ret) mmio_gphys_access(gphysaddr, wr, buf, length, flags); return ret; } vmmerr_t mmio_pagefault(phys_t gphysaddr) { vmmerr_t e; struct mmio_handle *h; gphysaddr &= ~PAGESIZE_MASK; LIST1_FOREACH (current->vm->mmio.mmio[MMIO_INDEX(gphysaddr)], h) { if (rangecheck (h, gphysaddr, PAGESIZE, NULL, NULL)) { e = cpu_interpreter (); return e; } } return VMMERR_NODEV; } static void mmio_add (int index, struct mmio_handle *handle) { struct mmio_handle *next; phys_t gphys; gphys = handle->gphys; LIST1_FOREACH (current->vm->mmio.mmio[index], next) { if (next->gphys > gphys) break; } if (next) LIST1_INSERT(current->vm->mmio.mmio[index], next, handle); else LIST1_ADD(current->vm->mmio.mmio[index], handle); } static void mmio_del (int index, struct mmio_handle *handle) { LIST1_DEL (current->vm->mmio.mmio[index], handle); } int mmio_do_nothing(void *data, phys_t gphys, bool wr, void *buf, uint len, u32 flags) { if (!wr) { memset(buf, -1, len); } return 1; /* emulated */ } int mmio_pass(void *data, phys_t gphys, bool wr, void *buf, uint len, u32 flags) { return 0; /* pass */ } void * mmio_register (phys_t gphys, uint len, mmio_handler_t *handler, void *data) { struct mmio_handle *handle; int index; index = MMIO_INDEX(gphys); rw_spinlock_lock_ex (¤t->vm->mmio_rwlock); LIST1_FOREACH (current->vm->mmio.mmio[index], handle) { if (rangecheck (handle, gphys, len, NULL, NULL)) { panic("MMIO regions are conflicted."); } } handle = alloc (sizeof *handle); if (handle == NULL) { panic("Failed to allocate memory for mmio_handle."); } handle->gphys = gphys; handle->len = len; handle->data = data; handle->handler = handler; mmio_add(index, handle); rw_spinlock_unlock_ex (¤t->vm->mmio_rwlock); return handle; } void mmio_unregister (void *handle) { struct mmio_handle *hdl; int index; hdl = handle; index = MMIO_INDEX(hdl->gphys); rw_spinlock_lock_ex (¤t->vm->mmio_rwlock); mmio_del(index, hdl); free (hdl); rw_spinlock_unlock_ex (¤t->vm->mmio_rwlock); } void mmio_lock (void) { rw_spinlock_lock_sh (¤t->vm->mmio_rwlock); } void mmio_unlock (void) { rw_spinlock_unlock_sh (¤t->vm->mmio_rwlock); } static void mmio_init (void) { int i; rw_spinlock_init (¤t->vm->mmio_rwlock); for (i = 0; i < 17; i++) LIST1_HEAD_INIT (current->vm->mmio.mmio[i]); } INITFUNC ("gvm0", mmio_init); tinyvisor/vmm/core/asm.s0000644006644000001440000001611511753454341015572 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ RAX = 0 RCX = 1 RDX = 2 RBX = 3 CR2 = 4 RBP = 5 RSI = 6 RDI = 7 R8 = 8 R9 = 9 R10 = 10 R11 = 11 R12 = 12 R13 = 13 R14 = 14 R15 = 15 VMCS_HOST_RSP = 0x6C14 VMCS_HOST_RIP = 0x6C16 .code32 .globl asm_vmlaunch_regs_32 .align 16 asm_vmlaunch_regs_32: push %ebp push %ebx push %esi push %edi mov 20(%esp),%edi # arg1 push %edi mov $VMCS_HOST_RSP,%eax mov %esp,%edx vmwrite %edx,%eax mov $VMCS_HOST_RIP,%eax mov $1f,%edx vmwrite %edx,%eax mov 4*CR2(%edi),%eax mov %eax,%cr2 mov 4*RAX(%edi),%eax mov 4*RCX(%edi),%ecx mov 4*RDX(%edi),%edx mov 4*RBX(%edi),%ebx mov 4*RBP(%edi),%ebp mov 4*RSI(%edi),%esi mov 4*RDI(%edi),%edi vmlaunch pop %edi xor %eax,%eax dec %eax jmp 2f .align 16 1: xchg (%esp),%edi mov %eax,4*RAX(%edi) mov %ecx,4*RCX(%edi) mov %edx,4*RDX(%edi) mov %ebx,4*RBX(%edi) mov %ebp,4*RBP(%edi) mov %esi,4*RSI(%edi) popl 4*RDI(%edi) mov %cr2,%eax mov %eax,4*CR2(%edi) xor %eax,%eax 2: pop %edi pop %esi pop %ebx pop %ebp ret .globl asm_vmresume_regs_32 .align 16 asm_vmresume_regs_32: push %ebp push %ebx push %esi push %edi mov 20(%esp),%edi # arg1 push %edi mov $VMCS_HOST_RSP,%eax mov %esp,%edx vmwrite %edx,%eax mov $VMCS_HOST_RIP,%eax mov $1f,%edx vmwrite %edx,%eax mov 4*CR2(%edi),%eax mov %eax,%cr2 mov 4*RAX(%edi),%eax mov 4*RCX(%edi),%ecx mov 4*RDX(%edi),%edx mov 4*RBX(%edi),%ebx mov 4*RBP(%edi),%ebp mov 4*RSI(%edi),%esi mov 4*RDI(%edi),%edi vmresume pop %edi xor %eax,%eax dec %eax jmp 2f .align 16 1: xchg (%esp),%edi mov %eax,4*RAX(%edi) mov %ecx,4*RCX(%edi) mov %edx,4*RDX(%edi) mov %ebx,4*RBX(%edi) mov %ebp,4*RBP(%edi) mov %esi,4*RSI(%edi) popl 4*RDI(%edi) mov %cr2,%eax mov %eax,4*CR2(%edi) xor %eax,%eax 2: pop %edi pop %esi pop %ebx pop %ebp ret .globl asm_vmrun_regs_32 .align 16 asm_vmrun_regs_32: push %ebp push %ebx push %esi push %edi mov 28(%esp),%eax # arg3 vmsave mov 20(%esp),%eax # arg1 mov 4*RCX(%eax),%ecx mov 4*RDX(%eax),%edx mov 4*RBX(%eax),%ebx mov 4*RBP(%eax),%ebp mov 4*RSI(%eax),%esi mov 4*RDI(%eax),%edi mov 24(%esp),%eax # arg2 vmload vmrun vmsave mov 20(%esp),%eax # arg1 mov %ecx,4*RCX(%eax) mov %edx,4*RDX(%eax) mov %ebx,4*RBX(%eax) mov %ebp,4*RBP(%eax) mov %esi,4*RSI(%eax) mov %edi,4*RDI(%eax) mov 28(%esp),%eax # arg3 vmload stgi pop %edi pop %esi pop %ebx pop %ebp ret .code64 .globl asm_vmlaunch_regs_64 .align 16 asm_vmlaunch_regs_64: push %rbp push %rbx push %r12 push %r13 push %r14 push %r15 push %rdi # arg1 mov $VMCS_HOST_RSP,%rax mov %rsp,%rdx vmwrite %rdx,%rax mov $VMCS_HOST_RIP,%rax mov $1f,%edx vmwrite %rdx,%rax mov 8*CR2(%rdi),%rax mov %rax,%cr2 mov 8*R8(%rdi),%r8 mov 8*R9(%rdi),%r9 mov 8*R10(%rdi),%r10 mov 8*R11(%rdi),%r11 mov 8*R12(%rdi),%r12 mov 8*R13(%rdi),%r13 mov 8*R14(%rdi),%r14 mov 8*R15(%rdi),%r15 mov 8*RAX(%rdi),%rax mov 8*RCX(%rdi),%rcx mov 8*RDX(%rdi),%rdx mov 8*RBX(%rdi),%rbx mov 8*RBP(%rdi),%rbp mov 8*RSI(%rdi),%rsi mov 8*RDI(%rdi),%rdi vmlaunch pop %rdi xor %rax,%rax dec %rax jmp 2f .align 16 1: xchg (%rsp),%rdi mov %rax,8*RAX(%rdi) mov %rcx,8*RCX(%rdi) mov %rdx,8*RDX(%rdi) mov %rbx,8*RBX(%rdi) mov %rbp,8*RBP(%rdi) mov %rsi,8*RSI(%rdi) popq 8*RDI(%rdi) mov %cr2,%rax mov %rax,8*CR2(%rdi) mov %r8,8*R8(%rdi) mov %r9,8*R9(%rdi) mov %r10,8*R10(%rdi) mov %r11,8*R11(%rdi) mov %r12,8*R12(%rdi) mov %r13,8*R13(%rdi) mov %r14,8*R14(%rdi) mov %r15,8*R15(%rdi) xor %rax,%rax 2: pop %r15 pop %r14 pop %r13 pop %r12 pop %rbx pop %rbp ret .globl asm_vmresume_regs_64 .align 16 asm_vmresume_regs_64: push %rbp push %rbx push %r12 push %r13 push %r14 push %r15 push %rdi # arg1 mov $VMCS_HOST_RSP,%rax mov %rsp,%rdx vmwrite %rdx,%rax mov $VMCS_HOST_RIP,%rax mov $1f,%edx vmwrite %rdx,%rax mov 8*CR2(%rdi),%rax mov %rax,%cr2 mov 8*R8(%rdi),%r8 mov 8*R9(%rdi),%r9 mov 8*R10(%rdi),%r10 mov 8*R11(%rdi),%r11 mov 8*R12(%rdi),%r12 mov 8*R13(%rdi),%r13 mov 8*R14(%rdi),%r14 mov 8*R15(%rdi),%r15 mov 8*RAX(%rdi),%rax mov 8*RCX(%rdi),%rcx mov 8*RDX(%rdi),%rdx mov 8*RBX(%rdi),%rbx mov 8*RBP(%rdi),%rbp mov 8*RSI(%rdi),%rsi mov 8*RDI(%rdi),%rdi vmresume pop %rdi xor %rax,%rax dec %rax jmp 2f .align 16 1: xchg (%rsp),%rdi mov %rax,8*RAX(%rdi) mov %rcx,8*RCX(%rdi) mov %rdx,8*RDX(%rdi) mov %rbx,8*RBX(%rdi) mov %rbp,8*RBP(%rdi) mov %rsi,8*RSI(%rdi) popq 8*RDI(%rdi) mov %cr2,%rax mov %rax,8*CR2(%rdi) mov %r8,8*R8(%rdi) mov %r9,8*R9(%rdi) mov %r10,8*R10(%rdi) mov %r11,8*R11(%rdi) mov %r12,8*R12(%rdi) mov %r13,8*R13(%rdi) mov %r14,8*R14(%rdi) mov %r15,8*R15(%rdi) xor %rax,%rax 2: pop %r15 pop %r14 pop %r13 pop %r12 pop %rbx pop %rbp ret .code64 .globl asm_vmrun_regs_64 .align 16 asm_vmrun_regs_64: push %rbp push %rbx push %r12 push %r13 push %r14 push %r15 mov %rdx,%rax # arg3 push %rdx # arg3 vmsave push %rdi # arg1 mov %rsi,%rax # arg2 mov 8*R8(%rdi),%r8 mov 8*R9(%rdi),%r9 mov 8*R10(%rdi),%r10 mov 8*R11(%rdi),%r11 mov 8*R12(%rdi),%r12 mov 8*R13(%rdi),%r13 mov 8*R14(%rdi),%r14 mov 8*R15(%rdi),%r15 mov 8*RCX(%rdi),%rcx mov 8*RDX(%rdi),%rdx mov 8*RBX(%rdi),%rbx mov 8*RBP(%rdi),%rbp mov 8*RSI(%rdi),%rsi mov 8*RDI(%rdi),%rdi vmload vmrun vmsave pop %rax # arg1 mov %rcx,8*RCX(%rax) mov %rdx,8*RDX(%rax) mov %rbx,8*RBX(%rax) mov %rbp,8*RBP(%rax) mov %rsi,8*RSI(%rax) mov %rdi,8*RDI(%rax) mov %r8,8*R8(%rax) mov %r9,8*R9(%rax) mov %r10,8*R10(%rax) mov %r11,8*R11(%rax) mov %r12,8*R12(%rax) mov %r13,8*R13(%rax) mov %r14,8*R14(%rax) mov %r15,8*R15(%rax) pop %rax # arg3 vmload stgi pop %r15 pop %r14 pop %r13 pop %r12 pop %rbx pop %rbp ret tinyvisor/vmm/core/pcpu.h0000644006644000001440000000674211733245403015746 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_PCPU_H #define _CORE_PCPU_H #include #include #include #include #include "asm.h" #include "desc.h" #include "seg.h" #include "svm.h" #include "thread.h" #include "vt.h" #define NUM_OF_SEGDESCTBL 32 #define PCPU_GS_ALIGN __attribute__ ((aligned (8))) enum fullvirtualize_type { FULLVIRTUALIZE_NONE, FULLVIRTUALIZE_VT, FULLVIRTUALIZE_SVM, }; struct pcpu_func { }; struct timer_data { LIST1_DEFINE (struct timer_data); bool enable; u64 settime; u64 interval; void (*callback) (void *handle, void *data); void *data; }; struct pcpu { struct pcpu_func func; struct segdesc segdesctbl[NUM_OF_SEGDESCTBL]; struct tss32 tss32; struct tss64 tss64; struct vt_pcpu_data vt; struct svm_pcpu_data svm; enum fullvirtualize_type fullvirtualize; bool bsp; apic_id_t apic_id; int pid; tid_t tid; void *stackaddr; u64 hz; u64 last_tsc; u64 last_time; u32 int_fatal; bool panic; int disable_interrupt; spinlock_t timer_lock; LIST1_DEFINE_HEAD(struct timer_data, timer_on_list); LIST1_DEFINE_HEAD(struct timer_data, timer_off_list); LIST1_DEFINE_HEAD(struct timer_data, timer_free_list); }; struct pcpu_gs { u64 inthandling PCPU_GS_ALIGN; /* %gs:0 (int.c, int_handler.s) */ void *currentcpu PCPU_GS_ALIGN; /* %gs:8 (pcpu.h) */ void *syscallstack PCPU_GS_ALIGN; /* %gs:16 (process.c, process_sysenter.s) */ void *current PCPU_GS_ALIGN; /* %gs:24 (current.h) */ u64 nmi; /* %gs:32 (nmi_pass.c) */ }; extern struct pcpu pcpu_default; extern struct pcpu *currentcpu asm ("%gs:gs_currentcpu"); static inline bool currentcpu_available(void) { u16 gs; /* FIXME: SWAPGS in 64bit long mode can't be used. */ asm_rdgs (&gs); if (gs == SEG_SEL_PCPU32 || gs == SEG_SEL_PCPU64) return true; else return false; } static inline apic_id_t get_apic_id (void) { return currentcpu->apic_id; } #endif tinyvisor/vmm/core/svm_init.c0000644006644000001440000001471112000734676016620 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include "asm.h" #include "constants.h" #include "current.h" #include "mm.h" #include "panic.h" #include "pcpu.h" #include "svm_init.h" #include "svm_np.h" #include "svm_vmcb.h" #include /* #define SVM_DEBUG */ #ifdef SVM_DEBUG #define SVM_DBG(...) \ do { \ printf(__VA_ARGS__); \ } while (0) #else #define SVM_DBG(...) #endif bool svm_available (void) { u32 a, b, c, d; u64 tmp; asm_cpuid (CPUID_EXT_0, 0, &a, &b, &c, &d); if (a < CPUID_EXT_1) { SVM_DBG("CPU%d does not support SVM.\n", get_cpu_id()); return false; } asm_cpuid (CPUID_EXT_1, 0, &a, &b, &c, &d); if (!(c & CPUID_EXT_1_ECX_SVM_BIT)) { SVM_DBG("CPU%d does not support SVM.\n", get_cpu_id()); return false; } asm_rdmsr64 (MSR_AMD_VM_CR, &tmp); if (!(tmp & MSR_AMD_VM_CR_SVMDIS_BIT)) return true; /* SVM is allowed */ asm_cpuid (CPUID_EXT_0, 0, &a, &b, &c, &d); if (a < CPUID_EXT_A) { printf ("SVM is disabled on CPU%d.\n", get_cpu_id()); return false; } asm_cpuid (CPUID_EXT_A, 0, &a, &b, &c, &d); if (!(d & CPUID_EXT_A_EDX_SVM_LOCK_BIT)) { printf ("SVM is disabled by BIOS on CPU%d.\n", get_cpu_id()); return false; } else { printf ("SVM is disabled with a key on CPU%d.\n", get_cpu_id()); return false; } } static bool svm_nested_paging_available (void) { return true; } static void svm_seg_reset (struct vmcb *p) { p->es.sel = 0; p->cs.sel = 0; p->ss.sel = 0; p->ds.sel = 0; p->fs.sel = 0; p->gs.sel = 0; p->gdtr.sel = 0; p->ldtr.sel = 0; p->idtr.sel = 0; p->tr.sel = 0; p->es.attr = 0x93; p->cs.attr = 0x9B; p->ss.attr = 0x93; p->ds.attr = 0x93; p->fs.attr = 0x93; p->gs.attr = 0x93; p->gdtr.attr = 0; p->ldtr.attr = 0; p->idtr.attr = 0; p->tr.attr = 0; p->es.limit = 0xFFFF; p->cs.limit = 0xFFFF; p->ss.limit = 0xFFFF; p->ds.limit = 0xFFFF; p->fs.limit = 0xFFFF; p->gs.limit = 0xFFFF; p->gdtr.limit = 0xFFFF; p->ldtr.limit = 0xFFFF; p->idtr.limit = 0xFFFF; p->tr.limit = 0xFFFF; p->es.base = 0; p->cs.base = 0; p->ss.base = 0; p->ds.base = 0; p->fs.base = 0; p->gs.base = 0; p->gdtr.base = 0; p->ldtr.base = 0; p->idtr.base = 0; p->tr.base = 0; } void svm_reset (void) { svm_seg_reset (current->u.svm.vi.vmcb); } static void svm_vmcb_init (void) { struct vmcb *p; vmmerr_t err; void *page; err = alloc_page (&page, ¤t->u.svm.vi.vmcb_phys); if (err) { panic("svm_vmcb_init: Failed to allocate memory for VMCB"); } current->u.svm.vi.vmcb = page; err = alloc_pages (¤t->u.svm.io.iobmp, ¤t->u.svm.io.iobmp_phys, 3); if (err) { panic("svm_vmcb_init: Failed to allocate memory for IO bitmap"); } err = alloc_pages (¤t->u.svm.msr.msrbmp, ¤t->u.svm.msr.msrbmp_phys, 2); if (err) { panic("svm_vmcb_init: Failed to allocate memory for MSR bitmap"); } memset (current->u.svm.io.iobmp, 0xFF, PAGESIZE * 3); memset (current->u.svm.msr.msrbmp, 0xFF, PAGESIZE * 2); p = current->u.svm.vi.vmcb; memset (p, 0, PAGESIZE); p->intercept_read_cr = ~4; p->intercept_write_cr = ~4; p->intercept_exception = 0x4000; p->intercept_intr = 1; p->intercept_nmi = 1; p->intercept_init = 1; /* FIXME */ p->intercept_invlpg = 1; p->intercept_invlpga = 1; p->intercept_ioio_prot = 1; p->intercept_msr_prot = 1; p->intercept_task_switches = 1; p->intercept_shutdown = 1; p->intercept_vmrun = 1; p->intercept_vmmcall = 1; p->iopm_base_pa = current->u.svm.io.iobmp_phys; p->msrpm_base_pa = current->u.svm.msr.msrbmp_phys; p->guest_asid = 1; /* FIXME */ p->tlb_control = VMCB_TLB_CONTROL_FLUSH_TLB; svm_seg_reset (p); p->cpl = 0; p->efer = MSR_IA32_EFER_SVME_BIT; p->cr0 = CR0_PG_BIT; p->rflags = RFLAGS_ALWAYS1_BIT; if (false && svm_nested_paging_available ()) { /* FIXME: Nested paging */ p->np_enable = 1; p->intercept_invlpg = 0; p->intercept_exception &= ~0x4000; p->intercept_read_cr &= ~8; p->intercept_write_cr &= ~8; asm_rdmsr64 (0x277, &p->g_pat); } } void svm_vminit (void) { current->u.svm.np = NULL; svm_vmcb_init (); /* svm_msr_init (); */ if (current->u.svm.vi.vmcb->np_enable) svm_np_init (); else cpu_mmu_spt_init (); } void svm_vmexit (void) { } void svm_init (void) { u64 p; u64 tmp; void *v; ulong efer; vmmerr_t err; asm_rdmsr (MSR_IA32_EFER, &efer); efer |= MSR_IA32_EFER_SVME_BIT; asm_wrmsr (MSR_IA32_EFER, efer); asm_rdmsr64 (MSR_AMD_VM_CR, &tmp); tmp |= MSR_AMD_VM_CR_DIS_A20M_BIT; asm_wrmsr64 (MSR_AMD_VM_CR, tmp); /* FIXME: size of a host state area is undocumented */ err = alloc_page(&v, &p); if (err) { panic("Failed to allocate a host state area of SVM."); } currentcpu->svm.hsave = v; currentcpu->svm.hsave_phys = p; asm_wrmsr64 (MSR_AMD_VM_HSAVE_PA, p); err = alloc_page (&v, &p); if (err) { panic("Failed to allocate a VMCB."); } memset (v, 0, PAGESIZE); currentcpu->svm.vmcbhost = v; currentcpu->svm.vmcbhost_phys = p; } tinyvisor/vmm/core/sleep.c0000644006644000001440000000627212167264643016111 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include "asm.h" #include "constants.h" #include /* read count of timer 0 */ static u16 get_timer0 (void) { u16 count; u8 l, h; asm_outb (PIT_CONTROL, PIT_CONTROL_BINARY | PIT_CONTROL_MODE2 | PIT_CONTROL_LATCH | PIT_CONTROL_COUNTER0); asm_inb (PIT_COUNTER0, &l); asm_inb (PIT_COUNTER0, &h); count = l | (h << 8); return count; } /* busyloop for usec microseconds */ void usleep (u32 usec) { if (time_initialized()) { u64 timeout; timeout = get_cpu_time() + usec; while (time_before (get_cpu_time (), timeout)) { cpu_relax(); } return; } else { u32 count, remainder, counter0, tmp, diff; while (usec > 3599591843U) { usleep (3599591843U); usec -= 3599591843U; } asm_mul_and_div (14318181, usec, 12000000, &count, &remainder); if (remainder >= 12000000 / 2) count++; counter0 = get_timer0 (); while (count) { while (1) { tmp = get_timer0 (); if (counter0 != tmp) { break; } cpu_relax(); } if (counter0 > tmp) { diff = counter0 - tmp; if (count < tmp) diff = count; } else { diff = 1; } count -= diff; counter0 = tmp; } } } static void sleep_set_timer_counter (void) { /* set PIT counter 0 to 65536 */ asm_outb (PIT_CONTROL, PIT_CONTROL_BINARY | PIT_CONTROL_MODE2 | PIT_CONTROL_16BIT | PIT_CONTROL_COUNTER0); asm_outb (PIT_COUNTER0, 0); asm_outb (PIT_COUNTER0, 0); } static void sleep_init_global (void) { sleep_set_timer_counter (); } INITFUNC ("global2", sleep_init_global); tinyvisor/vmm/core/rm.c0000644006644000001440000001605712141641520015402 0ustar yuichi_xyusers/* * Copyright (c) 2010-2013 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include void rm_init_resource(struct resource *resource, phys_t start, phys_t end, u32 type, u32 data, char *name) { LIST2_HEAD_INIT(resource->children); resource->start = start; resource->end = end; resource->type = type; resource->data = data; resource->name = name; } struct resource * rm_find_resource(struct resource *parent, phys_t address) { struct resource *cur; if (parent == NULL) { return NULL; } LIST2_FOREACH(parent->children, sibling, cur) { if (address >= cur->start && address <= cur->end) { return cur; } } return NULL; } vmmerr_t rm_insert_resource(struct resource *parent, struct resource *new) { struct resource *next, *prev; if (parent == NULL) { return VMMERR_INVAL; } if (new->start > new->end) { return VMMERR_INVAL; } if (new->start < parent->start || new->end > parent->end) { return VMMERR_RANGE; } LIST2_FOREACH(parent->children, sibling, next) { if (new->start < next->start) { break; } } if (next && new->end >= next->start) { return VMMERR_BUSY; } prev = LIST2_PREV(parent->children, sibling, next); if (prev && new->start <= prev->end) { return VMMERR_BUSY; } if (next) { LIST2_INSERT(parent->children, sibling, next, new); } else { LIST2_ADD(parent->children, sibling, new); } new->parent = parent; return VMMERR_SUCCESS; } /* * case1: (not-found) * avail_start avail_end start end * avail_start' * * case2: (found) * avail_start start avail_end end * avail_start' * * case3: (found) * avail_start start end avail_end * avail_start' avail_end' * * case4: (found) * start avail_start end avail_end * avail_end' * * case5 (found) * start avail_start avail_end end * * case6 (not-found) * start end avail_start avail_end * avail_end' * */ vmmerr_t rm_alloc_avail_resource(struct resource *parent, struct resource *new, phys_t start, phys_t end, phys_t align, u32 type, u32 data, char *name) { struct resource *next, *prev; phys_t avail_start; phys_t avail_end; if (parent == NULL) { return VMMERR_INVAL; } if (start > end) { return VMMERR_INVAL; } if (end < parent->start || start > parent->end) { return VMMERR_RANGE; } LIST2_FOREACH(parent->children, sibling, next) { prev = LIST2_PREV(parent->children, sibling, next); avail_start = prev ? prev->end + 1 : parent->start; if (next->start == 0) { continue; } avail_end = next->start - 1; if (avail_start < start) { avail_start = start; } if (avail_end > end) { avail_end = end; } avail_start = ROUND_UP(avail_start, align); avail_end = ROUND_DOWN(avail_end + 1, align) - 1; if (avail_start <= avail_end && avail_end < next->start) { goto found; } } prev = LIST2_PREV(parent->children, sibling, (struct resource *)NULL); avail_start = prev ? prev->end + 1 : parent->start; avail_end = parent->end; if (avail_start < start) { avail_start = start; } if (avail_end > end) { avail_end = end; } avail_start = ROUND_UP(avail_start, align); avail_end = ROUND_DOWN(avail_end + 1, align) - 1; if (avail_start > avail_end && avail_end <= parent->end) { return VMMERR_BUSY; } found: rm_init_resource(new, avail_start, avail_end, type, data, name); if (next) { LIST2_INSERT(parent->children, sibling, next, new); } else { LIST2_ADD(parent->children, sibling, new); } new->parent = parent; return VMMERR_SUCCESS; } vmmerr_t rm_alloc_resource(struct resource *parent, struct resource *new, size_t size, phys_t align, u32 type, u32 data, char *name) { struct resource *next, *prev; phys_t avail_start; phys_t avail_end; if (parent == NULL) { return VMMERR_INVAL; } if (size <= 0) { return VMMERR_INVAL; } if (size > (parent->end - parent->start + 1)) { return VMMERR_RANGE; } LIST2_FOREACH(parent->children, sibling, next) { prev = LIST2_PREV(parent->children, sibling, next); avail_start = prev ? prev->end + 1 : parent->start; avail_start = ROUND_UP(avail_start, align); avail_end = ROUND_DOWN(next->start, align) - 1; if (avail_start <= avail_end && avail_start + size - 1 <= avail_end && avail_end < next->start) { goto found; } } prev = LIST2_PREV(parent->children, sibling, (struct resource *)NULL); avail_start = prev ? prev->end + 1 : parent->start; avail_start = ROUND_UP(avail_start, align); avail_end = ROUND_DOWN(parent->end + 1, align) - 1; if (avail_start <= avail_end && avail_start + size -1 <= avail_end && avail_end <= parent->end) { goto found; } return VMMERR_BUSY; found: rm_init_resource(new, avail_start, avail_start + size - 1, type, data, name); if (next) { LIST2_INSERT(parent->children, sibling, next, new); } else { LIST2_ADD(parent->children, sibling, new); } new->parent = parent; return VMMERR_SUCCESS; } static void dump_resources(struct resource *resource, int level) { struct resource *child; char buf[17] = {0}; memset(buf, ' ', level <= 8 ? level * 2 : 16); printf("%s%016llx-%016llx type %x data %x %s\n", buf, resource->start, resource->end, resource->type, resource->data, resource->name); if (LIST2_NEXT(resource->children, sibling, (struct resource *)NULL) == NULL) { return; } LIST2_FOREACH(resource->children, sibling, child) { dump_resources(child, level + 1); } } void rm_dump_resources(struct resource *resource) { dump_resources(resource, 0); } tinyvisor/vmm/core/vmmcall_status.c0000644006644000001440000000624711733245403020030 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include #include #include #include #include "cpu_mmu.h" #include "current.h" #include "mm.h" #include "vmmcall.h" #include "vmmcall_status.h" struct status { LIST1_DEFINE (struct status); char *(*func) (void); char *ret; }; static LIST1_DEFINE_HEAD_INIT (struct status, list1_status); static spinlock_t status_lock = SPINLOCK_INITIALIZER; void register_status_callback (char *(*func) (void)) { #ifdef VMMCALL_STATUS_ENABLE struct status *s; s = alloc (sizeof *s); if (s == NULL) { return; } s->func = func; LIST1_ADD (list1_status, s); #endif } /* ebx=linear address of a buffer ecx=size of the buffer */ static void get_status (void) { struct status *s; uint len = 0; ulong rbx, rcx; char c; spinlock_lock (&status_lock); current->vmctl.read_general_reg (GENERAL_REG_RBX, &rbx); current->vmctl.read_general_reg (GENERAL_REG_RCX, &rcx); LIST1_FOREACH (list1_status, s) { s->ret = s->func (); len += strlen (s->ret); } current->vmctl.write_general_reg (GENERAL_REG_RCX, len); if (len <= rcx) { LIST1_FOREACH (list1_status, s) { while ((c = *s->ret++) != '\0') if (write_linearaddr_b (rbx++, c) != VMMERR_SUCCESS) goto err; } current->vmctl.write_general_reg (GENERAL_REG_RAX, 0); } else { err: current->vmctl.write_general_reg (GENERAL_REG_RAX, 1); } spinlock_unlock (&status_lock); } static void vmmcall_status_init (void) { #ifdef VMMCALL_STATUS_ENABLE vmmcall_register ("get_status", get_status); #endif } INITFUNC ("vmmcal0", vmmcall_status_init); tinyvisor/vmm/README0000644006644000001440000003346511733227577014574 0ustar yuichi_xyusersCopyrights and Licences --------------------------------------------------------------------------- 1) BitVisor /* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ --------------------------------------------------------------------------- 2) VPN module /* * Copyright (c) 2007, 2008 University of Tsukuba * Copyright (C) 2007, 2008 * National Institute of Information and Communications Technology * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ --------------------------------------------------------------------------- 3) OpenSSL OpenSSL License --------------- /* ==================================================================== * Copyright (c) 1998-2007 The OpenSSL Project. All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in * the documentation and/or other materials provided with the * distribution. * * 3. All advertising materials mentioning features or use of this * software must display the following acknowledgment: * "This product includes software developed by the OpenSSL Project * for use in the OpenSSL Toolkit. (http://www.openssl.org/)" * * 4. The names "OpenSSL Toolkit" and "OpenSSL Project" must not be used to * endorse or promote products derived from this software without * prior written permission. For written permission, please contact * openssl-core@openssl.org. * * 5. Products derived from this software may not be called "OpenSSL" * nor may "OpenSSL" appear in their names without prior written * permission of the OpenSSL Project. * * 6. Redistributions of any form whatsoever must retain the following * acknowledgment: * "This product includes software developed by the OpenSSL Project * for use in the OpenSSL Toolkit (http://www.openssl.org/)" * * THIS SOFTWARE IS PROVIDED BY THE OpenSSL PROJECT ``AS IS'' AND ANY * EXPRESSED OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE OpenSSL PROJECT OR * ITS CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED * OF THE POSSIBILITY OF SUCH DAMAGE. * ==================================================================== * * This product includes cryptographic software written by Eric Young * (eay@cryptsoft.com). This product includes software written by Tim * Hudson (tjh@cryptsoft.com). * */ Original SSLeay License ----------------------- /* Copyright (C) 1995-1998 Eric Young (eay@cryptsoft.com) * All rights reserved. * * This package is an SSL implementation written * by Eric Young (eay@cryptsoft.com). * The implementation was written so as to conform with Netscapes SSL. * * This library is free for commercial and non-commercial use as long as * the following conditions are aheared to. The following conditions * apply to all code found in this distribution, be it the RC4, RSA, * lhash, DES, etc., code; not just the SSL code. The SSL documentation * included with this distribution is covered by the same copyright terms * except that the holder is Tim Hudson (tjh@cryptsoft.com). * * Copyright remains Eric Young's, and as such any Copyright notices in * the code are not to be removed. * If this package is used in a product, Eric Young should be given attribution * as the author of the parts of the library used. * This can be in the form of a textual message at program startup or * in documentation (online or textual) provided with the package. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * "This product includes cryptographic software written by * Eric Young (eay@cryptsoft.com)" * The word 'cryptographic' can be left out if the rouines from the library * being used are not cryptographic related :-). * 4. If you include any Windows specific code (or a derivative thereof) from * the apps directory (application code) you must include an acknowledgement: * "This product includes software written by Tim Hudson (tjh@cryptsoft.com)" * * THIS SOFTWARE IS PROVIDED BY ERIC YOUNG ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * * The licence and distribution terms for any publically available version or * derivative of this code cannot be changed. i.e. this code cannot simply be * copied and put under another distribution licence * [including the GNU Public Licence.] */ --------------------------------------------------------------------------- 4) AES Copyright (c) 1998-2008, Brian Gladman, Worcester, UK. All rights reserved. LICENSE TERMS The redistribution and use of this software (with or without changes) is allowed without the payment of fees or royalties provided that: 1. source code distributions include the above copyright notice, this list of conditions and the following disclaimer; 2. binary distributions include the above copyright notice, this list of conditions and the following disclaimer in their documentation; 3. the name of the copyright holder is not used to endorse products built using this software without specific written permission. DISCLAIMER This software is provided 'as is' with no explicit or implied warranties in respect of its properties, including, but not limited to, correctness and/or fitness for purpose. --------------------------------------------------------------------------- 5) PCSC Copyright (c) 1999-2003 David Corcoran All rights reserved. Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met: 1. Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer. 2. Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the documentation and/or other materials provided with the distribution. 3. The name of the author may not be used to endorse or promote products derived from this software without specific prior written permission. Changes to this license can be made only by the copyright author with explicit written consent. THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. --------------------------------------------------------------------------- 6) ELF * Copyright (c) 1996-1998 John D. Polstra. * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF * SUCH DAMAGE. * --------------------------------------------------------------------------- 7) pkcs11.h /* pkcs11.h Copyright 2006, 2007 g10 Code GmbH Copyright 2006 Andreas Jellinghaus This file is free software; as a special exception the author gives unlimited permission to copy and/or distribute it, with or without modifications, as long as this notice is preserved. This file is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY, to the extent permitted by law; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. */ --------------------------------------------------------------------------- tinyvisor/vmm/include/0000755006644000001440000000000012206363325015310 5ustar yuichi_xyuserstinyvisor/vmm/include/io/0000755006644000001440000000000012206363325015717 5ustar yuichi_xyuserstinyvisor/vmm/include/io/serial.h0000644006644000001440000000603112011466501017341 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _CORE_SERIAL_REG_H #define _CORE_SERIAL_REG_H #define SERIAL_PORT1 0x3F8 /* COM1, ttyS0 */ #define SERIAL_NUM_OF_IOPORT 8 #define PORT_DATA 0x0 #define PORT_RATELSB 0x0 #define PORT_RATEMSB 0x1 #define PORT_INTRCTL 0x1 #define PORT_INTRSTAT 0x2 #define PORT_FIFOCTL 0x2 #define PORT_LINECTL 0x3 #define PORT_MODECTL 0x4 #define PORT_LINESTAT 0x5 #define PORT_MODESTAT 0x6 #define PORT_USER 0x7 #define RATELSB_115200 0x1 #define RATELSB_57600 0x2 #define RATELSB_38400 0x3 #define RATELSB_19200 0x6 #define RATELSB_9600 0xC #define RATELSB_4800 0x18 #define RATELSB_2400 0x30 #define RATELSB_1200 0x60 #define RATELSB_600 0xC0 #define INTRCTL_ETBREI_BIT 0x02 /* Enable TBR empty interrupt */ #define INTRSTAT_INT_NO_PENDING 0x01 /* 0 if interrupt pending */ #define INTRSTAT_TBR_EMPTY_INTR 0x02 /* TBR empty interrupt */ #define LINECTL_DATA8BIT 0x3 #define LINECTL_STOP2BIT 0x4 #define LINECTL_PARITY_ENABLE 0x8 #define LINECTL_PARITY_EVEN_BIT 0x10 #define LINECTL_PARITY 0x20 #define LINECTL_BREAK_BIT 0x40 #define LINECTL_DLAB_BIT 0x80 #define LINESTAT_RX_BIT 0x1 #define LINESTAT_OVERRUN_BIT 0x2 #define LINESTAT_PARITY_BIT 0x4 #define LINESTAT_FRAMING_BIT 0x8 #define LINESTAT_BREAK_BIT 0x10 #define LINESTAT_TXSTART_BIT 0x20 #define LINESTAT_TX_BIT 0x40 #define LINESTAT_RXFIFO_BIT 0x80 #define MODESTAT_CTS_BIT 0x10 /* Clear to send */ void serial_putchar (unsigned char c); #endif /* _CORE_SERIAL_REG_H */ tinyvisor/vmm/include/io/pic.h0000644006644000001440000000460711733245403016652 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __IO_PIC_H #define __IO_PIC_H #define PIC_MASTER_CMD_PORT 0x20 #define PIC_MASTER_IMR_PORT 0x21 #define PIC_SLAVE_CMD_PORT 0xa0 #define PIC_SLAVE_IMR_PORT 0xa1 /* CMD PORT */ #define PIC_ICW1_SELECT_MASK 0x10 #define PIC_ICW1_SELECT_MATCH 0x10 #define PIC_NON_SPECIFIC_EOI_MASK 0xf8 #define PIC_NON_SPECIFIC_EOI_MATCH 0x20 #define PIC_SPECIFIC_EOI_MASK 0xf8 #define PIC_SPECIFIC_EOI_MATCH 0x60 #define PIC_EOI_IRQ_MASK 0x07 #define PIC_OCW3_SELECT_MASK 0x98 #define PIC_OCW3_SELECT_MATCH 0x08 #define PIC_OCW3_READ_REG_MASK 0x03 #define PIC_OCW3_READ_ISR 0x03 #define PIC_OCW3_READ_IRR 0x02 /* IMR PORT */ #define PIC_ICW2_SELECT_MASK 0x18 #define PIC_ICW2_SELECT_MATCH 0x00 #define PIC_ICW3_SELECT_MASK 0x18 #define PIC_ICW3_SELECT_MATCH 0x01 #define PIC_ICW2_VECTOR_MASK 0xf8 #define PIC_ICW4_AUTO_EOI 0x02 #endif /* __IO_PIC_H */ tinyvisor/vmm/include/io/ioapic_emu.h0000644006644000001440000000351511741307010020176 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _IO_IOAPIC_EMU_H #define _IO_IOAPIC_EMU_H #define INVALID_GSI 0xffffffff #include #include typedef u32 gsi_t; vmmerr_t ioapic_get_vector(gsi_t gsi, vector_t *vector, bool *mask); void ioapic_trigger_int(gsi_t gsi); #endif /* _IO_IOAPIC_EMU_H */ tinyvisor/vmm/include/io/io.h0000644006644000001440000001061111733245403016476 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef __IO_IO_H #define __IO_IO_H #include #define write8(addr, val) do { *(volatile u8*)(addr) = (u8)(val); } while(0) #define write16(addr, val) do { *(volatile u16*)(addr) = (u16)(val); } while(0) #define write32(addr, val) do { *(volatile u32*)(addr) = (u32)(val); } while(0) #define write64(addr, val) do { *(volatile u64*)(addr) = (u64)(val); } while(0) #define read8(addr) (*(volatile u8*)(addr)) #define read16(addr) (*(volatile u16*)(addr)) #define read32(addr) (*(volatile u32*)(addr)) #define read64(addr) (*(volatile u64*)(addr)) static inline void in8 (ioport_t port, u8 *data) { __asm__ volatile ("inb %%dx, %%al" : "=a" (*data) : "d" (port)); } static inline void in16 (ioport_t port, u16 *data) { __asm__ volatile ("inw %%dx, %%ax" : "=a" (*data) : "d" (port)); } static inline void in32 (ioport_t port, u32 *data) { __asm__ volatile ("inl %%dx, %%eax" : "=a" (*data) : "d" (port)); } static inline void ins8 (ioport_t port, u8 *buf, u32 count) { __asm__ volatile ("cld; rep insb" : "=c" (count), "=D" (buf) : "c" (count), "d" (port), "D" (buf)); } static inline void ins16 (ioport_t port, u16 *buf, u32 count) { __asm__ volatile ("cld; rep insw" : "=c" (count), "=D" (buf) : "c" (count), "d" (port), "D" (buf)); } static inline void ins32 (ioport_t port, u32 *buf, u32 count) { __asm__ volatile ("cld; rep insl" : "=c" (count), "=D" (buf) : "c" (count), "d" (port), "D" (buf)); } static inline void insn (ioport_t port, void *buf, int unit_size, u32 total_size) { if (unit_size == 4) ins32 (port, buf, total_size/4); else if (unit_size == 2) ins16 (port, buf, total_size/2); else if (unit_size == 1) ins8 (port, buf, total_size); } static inline void out8 (ioport_t port, u8 data) { __asm__ volatile ("outb %%al, %%dx" : : "a" (data), "d" (port)); } static inline void out16 (ioport_t port, u16 data) { __asm__ volatile ("outw %%ax, %%dx" : : "a" (data), "d" (port)); } static inline void out32 (ioport_t port, u32 data) { __asm__ volatile ("outl %%eax, %%dx" : : "a" (data), "d" (port)); } static inline void outs8 (ioport_t port, u8 *buf, u32 count) { __asm__ volatile ("cld; rep outsb" : "=c" (count), "=S" (buf) : "c" (count), "d" (port), "S" (buf)); } static inline void outs16 (ioport_t port, u16 *buf, u32 count) { __asm__ volatile ("cld; rep outsw" : "=c" (count), "=S" (buf) : "c" (count), "d" (port), "S" (buf)); } static inline void outs32 (ioport_t port, u32 *buf, u32 count) { __asm__ volatile ("cld; rep outsl" : "=c" (count), "=S" (buf) : "c" (count), "d" (port), "S" (buf)); } static inline void outsn (ioport_t port, void *buf, int unit_size, u32 total_size) { if (unit_size == 4) outs32 (port, buf, total_size/4); else if (unit_size == 2) outs16 (port, buf, total_size/2); else if (unit_size == 1) outs8 (port, buf, total_size); } #endif /* __IO_IO_H */ tinyvisor/vmm/include/io/pic_emu.h0000644006644000001440000000344711733245403017521 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _IO_PIC_EMU_H #define _IO_PIC_EMU_H #define INVALID_IRQ 0xff typedef u8 irq_t; vmmerr_t picemu_get_vector(irq_t irq, vector_t *vector); void picemu_trigger_int(irq_t irq); void picemu_trigger_boot_int(irq_t irq); #endif /* _IO_PIC_EMU_H */ tinyvisor/vmm/include/io/vmrm.h0000644006644000001440000000327612143442661017062 0ustar yuichi_xyusers/* * Copyright (c) 2013 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __IO_VMRM_H #define __IO_VMRM_H struct resource *vmrm_mmio_resource(void); struct resource *vmrm_io_resource(void); #endif /* __IO_VMRM_H */ tinyvisor/vmm/include/io/acpi_emu.h0000644006644000001440000000323012143453571017653 0ustar yuichi_xyusers/* * Copyright (c) 2013 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __IO_ACPI_EMU_H #define __IO_ACPI_EMU_H ioport_t acpi_get_dev_base(void); #endif /* __IO_ACPI_EMU_H */ tinyvisor/vmm/include/io/pci.h0000644006644000001440000002165612167264643016666 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #ifndef __IO_PCI_H #define __IO_PCI_H #include #include #include #include struct idmask { u32 id, mask; }; #define idmask_match(a, b) ((a & b.mask) == b.id) #define PCI_ID_ANY 0 #define PCI_ID_ANY_MASK 0 #define PCI_ID(vendor_id, device_id) \ ((((u32)device_id & 0xFFFF) << 16) | ((u32)vendor_id & 0xFFFF)) #define PCI_DEVFN(dn, fn) \ ((dn << 3) | fn) #define PCI_DEV_NO(devfn) \ ((devfn & 0xF8) >> 3) #define PCI_FUNC_NO(devfn) \ (devfn & 0x7) #define PCI_LOCATION_STR_SIZE 8 #define PCI_LOCATION_FORMAT "%02x:%02x.%01x" #define PCI_LOCATION_VALUE(dev) dev->bus_no, PCI_DEV_NO(dev->devfn), PCI_FUNC_NO(dev->devfn) #define PCI_MMCONFIG_SIZE 4096 #define PCI_LEGACY_CONFIG_SIZE 256 #define PCI_CONFIG_VENDOR_ID 0x00 #define PCI_CONFIG_DEVICE_ID 0x02 #define PCI_CONFIG_COMMAND 0x04 #define PCI_CONFIG_COMMAND_INTERRUPT_DISABLE 0x0400 #define PCI_CONFIG_STATUS 0x06 #define PCI_CONFIG_REVISION_ID 0x08 #define PCI_CONFIG_CLASS_CODE 0x09 #define PCI_CONFIG_PROGRAMMING_IF 0x09 #define PCI_CONFIG_SUB_CLASS 0x0a #define PCI_CONFIG_BASE_CLASS 0x0b #define PCI_CONFIG_CACHE_LINE_SIZE 0x0c #define PCI_CONFIG_LATENCY_TIMER 0x0d #define PCI_CONFIG_HEADER_TYPE 0x0e #define PCI_CONFIG_BIST 0x0f #define PCI_CONFIG_BASE_ADDRESS0 0x10 #define PCI_CONFIG_BASE_ADDRESS1 0x14 #define PCI_CONFIG_BASE_ADDRESS2 0x18 #define PCI_CONFIG_BASE_ADDRESS3 0x1c #define PCI_CONFIG_BASE_ADDRESS4 0x20 #define PCI_CONFIG_BASE_ADDRESS5 0x24 #define PCI_CONFIG_CARDBUS_CIS_POINTER 0x28 #define PCI_CONFIG_SUBSYSTEM_VENDOR_ID 0x2c #define PCI_CONFIG_SUBSYSTEM_ID 0x2e #define PCI_CONFIG_EXPANSION_ROM 0x30 #define PCI_CONFIG_CAPABILITY_POINTER 0x34 #define PCI_CONFIG_INTERRUPT_LINE 0x3c #define PCI_CONFIG_INTERRUPT_PIN 0x3d #define PCI_CONFIG_MIN_GRANT 0x3e #define PCI_CONFIG_MAX_LATENCY 0x3f #define PCI_CONFIG_PRIMARY_BUS_NUMBER 0x18 #define PCI_CONFIG_SECONDARY_BUS_NUMBER 0x19 #define PCI_CONFIG_SUBORDINATE_BUS_NUMBER 0x1a #define PCI_CONFIG_SECONDARY_LATENCY_TIMER 0x1b #define PCI_CONFIG_IO_BASE 0x1c #define PCI_CONFIG_IO_LIMIT 0x1d #define PCI_CONFIG_SECONDARY_STATUS 0x1e #define PCI_CONFIG_MEMORY_BASE 0x20 #define PCI_CONFIG_MEMORY_LIMIT 0x22 #define PCI_CONFIG_PREFETCHABLE_BASE 0x24 #define PCI_CONFIG_PREFETCHABLE_LIMIT 0x26 #define PCI_CONFIG_PREFETCHABLE_BASE_UPPER 0x28 #define PCI_CONFIG_PREFETCHABLE_LIMIT_UPPER 0x2c #define PCI_CONFIG_IO_BASE_UPPER 0x30 #define PCI_CONFIG_IO_LIMIT_UPPER 0x32 #define PCI_CONFIG_BRIDGE_CONTROL 0x3e #define PCI_CONFIG_SECONDARY_BUS_RESET 0x40 #define PCI_CONFIG_HEADER_TYPE_MASK 0x7f #define PCI_CONFIG_HEADER_TYPE_0 0x00 #define PCI_CONFIG_HEADER_TYPE_1 0x01 #define PCI_CONFIG_HEADER_TYPE_MULTI_FUNCTION 0x80 #define PCI_CONFIG_BAR_NUM 6 #define PCI_CONFIG_HEADER1_BAR_NUM 2 #define PCI_CONFIG_BAR_SPACEMASK 0x00000001 #define PCI_CONFIG_BAR_MEMSPACE 0 #define PCI_CONFIG_BAR_IOSPACE 1 #define PCI_CONFIG_BAR_IOMASK 0x0000FFFC #define PCI_CONFIG_BAR_MEMMASK 0xFFFFFFF0 #define PCI_CONFIG_BAR_MEMTYPE_MASK 0x00000006 #define PCI_CONFIG_BAR_MEMTYPE_32 0x00000000 #define PCI_CONFIG_BAR_MEMTYPE_64 0x00000004 #define PCI_CONFIG_BAR_PREFETCHABLE 0x00000008 #define PCI_CONFIG_ROM_MEMMASK 0xFFFFFFFE #define PCI_CONFIG_IO_BASE_ADDRESS_MASK 0xf0 #define PCI_CONFIG_IO_BASE_CAP_MASK 0x0f #define PCI_CONFIG_IO_BASE_32_BIT 0x01 #define PCI_CONFIG_IO_LIMIT_ADDRESS_MASK 0xf0 #define PCI_CONFIG_IO_LIMIT_CAP_MASK 0x0f #define PCI_CONFIG_IO_LIMIT_32_BIT 0x01 #define PCI_CONFIG_MEMORY_BASE_ADDRESS_MASK 0xfff0 #define PCI_CONFIG_MEMORY_BASE_RESERVED_MASK 0x000f #define PCI_CONFIG_MEMORY_LIMIT_ADDRESS_MASK 0xfff0 #define PCI_CONFIG_MEMORY_LIMIT_RESERVED_MASK 0x000f #define PCI_CONFIG_PREFETCHABLE_BASE_ADDRESS_MASK 0xfff0 #define PCI_CONFIG_PREFETCHABLE_BASE_CAP_MASK 0x000f #define PCI_CONFIG_PREFETCHABLE_BASE_64_BIT 0x0001 #define PCI_CONFIG_PREFETCHABLE_LIMIT_ADDRESS_MASK 0xfff0 #define PCI_CONFIG_PREFETCHABLE_LIMIT_CAP_MASK 0x000f #define PCI_CONFIG_PREFETCHABLE_LIMIT_64_BIT 0x0001 #define PCI_CONFIG_VGA_ENABLE 0x0008 #define PCI_RESOURCE_NUM 9 #define PCI_RESOURCE_IO_WINDOW_INDEX 2 #define PCI_RESOURCE_MEMORY_WINDOW_INDEX 3 #define PCI_RESOURCE_PREFETCHABLE_WINDOW_INDEX 4 #define PCI_RESOURCE_VGA_MEM 5 #define PCI_RESOURCE_VGA_IO1 6 #define PCI_RESOURCE_VGA_IO2 7 #define PCI_RESOURCE_EXPANTION_ROM_INDEX 8 #define PCI_RESOURCE_PREFETCHABLE 0x01 #define PCI_RESOURCE_WINDOW 0x10 #define PCI_ASSIGNED_DEVICE_IRQ 0xff typedef u16 pci_off_t; struct pci_device { LIST_DEFINE(pci_device_list); LIST2_DEFINE(struct pci_device, vm_pci_device_list); struct pci_device *parent; LIST2_DEFINE(struct pci_device, sibling); struct pci_driver *driver; bool assigned; char name[PCI_LOCATION_STR_SIZE]; u16 seg; u8 bus_no; u8 devfn; union { struct { u16 vendor_id; u16 device_id; } __attribute__ ((packed)); u32 id; }; union { struct { u32 class_code; }; struct { u8 prog_if; u8 sub_class; u8 base_class; } __attribute__ ((packed)) ; }; union { u8 header_type; struct { unsigned int type: 7; unsigned int multi_function: 1; } __attribute__ ((packed)); }; struct resource resource[PCI_RESOURCE_NUM]; struct resource vmresource[PCI_RESOURCE_NUM]; /* * The followings are valid for PCI-PCI bridge. */ LIST2_DEFINE_HEAD(struct pci_device, children); u8 sec_bus; u8 sub_bus; u32 saved_config[PCI_MMCONFIG_SIZE / sizeof(u32)]; }; struct pci_driver { LIST_DEFINE(pci_driver_list); struct idmask id; struct idmask class; void (*new)(struct pci_device *dev); const char *name, *longname; }; void pci_register_driver (struct pci_driver *driver); struct pci_device *pci_next_assgined_pci_device(struct pci_device *cur); void pci_dump_resources(void); u8 pci_read_config_8(/* u16 seg, */ u8 bus, u8 devfn, pci_off_t offset); u16 pci_read_config_16(/* u16 seg, */ u8 bus, u8 devfn, pci_off_t offset); u32 pci_read_config_32(/* u16 seg, */ u8 bus, u8 devfn, pci_off_t offset); u64 pci_read_config_64(/* u16 seg, */ u8 bus, u8 devfn, pci_off_t offset); void pci_write_config_8(/* u16 seg, */ u8 bus, u8 devfn, pci_off_t offset, u8 data); void pci_write_config_16(/* u16 seg, */ u8 bus, u8 devfn, pci_off_t offset, u16 data); void pci_write_config_32(/* u16 seg, */ u8 bus, u8 devfn, pci_off_t offset, u32 data); void pci_write_config_64(/* u16 seg, */ u8 bus, u8 devfn, pci_off_t offset, u64 data); u8 pci_read_config8(struct pci_device *dev, pci_off_t offset); u16 pci_read_config16(struct pci_device *dev, pci_off_t offset); u32 pci_read_config32(struct pci_device *dev, pci_off_t offset); u64 pci_read_config64(struct pci_device *dev, pci_off_t offset); void pci_write_config8(struct pci_device *dev, pci_off_t offset, u8 data); void pci_write_config16(struct pci_device *dev, pci_off_t offset, u16 data); void pci_write_config32(struct pci_device *dev, pci_off_t offset, u32 data); void pci_write_config64(struct pci_device *dev, pci_off_t offset, u64 data); size_t pci_config_size(void); #ifdef CONFIG_IO_HOOK int pci_assigned_mmio_addr(phys_t addr, size_t *len); int pci_assigned_ioport(ioport_t port, ioport_t *len); void pci_dump_assignment(void); #else static inline int pci_assigned_mmio_addr(phys_t addr, size_t *len) { return 0; }; static inline int pci_assigned_ioport(ioport_t port, ioport_t *len) { return 0; }; static inline void pci_dump_assignment(void) {}; #endif #endif /* __IO_PCI_H */ tinyvisor/vmm/include/core/0000755006644000001440000000000012206363325016240 5ustar yuichi_xyuserstinyvisor/vmm/include/core/int.h0000644006644000001440000000354111733245403017206 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_INT_H #define __CORE_INT_H #include #define INT_HANDLED 1 #define INT_UNHANDLED 0 typedef int (int_handler_t)(vector_t vector, void *data); void set_int_hook(vector_t vector, int_handler_t *handler, void *data); void clear_int_hook(vector_t vector); #endif /* __CORE_INT_H */ tinyvisor/vmm/include/core/msg.h0000644006644000001440000000376711733245403017214 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* functions moved from process.h */ #ifndef __CORE_MSG_H #define __CORE_MSG_H void *msgsetfunc (int desc, void *func); int msgregister (char *name, void *func); int msgopen (char *name); int msgclose (int desc); int msgsendint (int desc, int data); int msgsenddesc (int desc, int data); int msgsendbuf (int desc, int data, void *sendbuf, int sendlen, void *recvbuf, int recvlen); int msgunregister (int desc); #endif /* __CORE_MSG_H */ tinyvisor/vmm/include/core/gmm.h0000644006644000001440000000354311733245403017176 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_GMM_H #define __CORE_GMM_H #include int gmm_get_mem_map(int index, phys_t *base, phys_t *len, u32 *type); int gmm_get_mem_map_count(void); phys_t gmm_gp2hp(phys_t gphys); phys32_t gmm_top_of_low_avail_mem(void); phys_t gmm_top_of_high_avail_mem(void); #endif /* __CORE_GMM_H */ tinyvisor/vmm/include/core/panic.h0000644006644000001440000000333711733227577017525 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_PANIC_H #define __CORE_PANIC_H void panic_test (void); void panic (char *format, ...) __attribute__ ((format (printf, 1, 2), noreturn)); #endif tinyvisor/vmm/include/core/printf.h0000644006644000001440000000401211733245403017710 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_PRINTF_H #define __CORE_PRINTF_H #include #include int printf (const char *format, ...) __attribute__ ((format (printf, 1, 2))); #ifndef S_SPLINT_S int vprintf (const char *format, va_list ap); #endif int snprintf (char *str, size_t size, const char *format, ...) __attribute__ ((format (printf, 3, 4))); #ifndef S_SPLINT_S int vsnprintf (char *str, size_t size, const char *format, va_list ap); #endif #endif tinyvisor/vmm/include/core/io.h0000644006644000001440000000413011733245403017016 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef __CORE_IO_H #define __CORE_IO_H #include typedef enum { IOTYPE_INB, IOTYPE_INW, IOTYPE_INL, IOTYPE_OUTB, IOTYPE_OUTW, IOTYPE_OUTL, } iotype_t; typedef int (*iofunc_t) (iotype_t type, ioport_t port, void *data); int do_io_nothing (iotype_t type, ioport_t port, void *data); int do_io_pass (iotype_t type, ioport_t port, void *data); iofunc_t set_iofunc (ioport_t port, iofunc_t func); void iotype_to_size_wr(iotype_t type, ioport_t *size, bool *wr); #endif tinyvisor/vmm/include/core/linkage.h0000644006644000001440000000324511733227577020043 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_LINKAGE #define __CORE_LINKAGE #define asmlinkage __attribute__ ((regparm (0))) #endif tinyvisor/vmm/include/core/acpi.h0000644006644000001440000000434711733245403017335 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_ACPI_H #define __CORE_ACPI_H #include #define ACPI_SYSTEM_MEMORY 0 #define ACPI_SYSTEM_IO 1 #define ACPI_PCI_CONFIGURATION_SPACE 2 #define ACPI_EMBEDDED_CONTROLLER 3 struct acpi_desc_header { u8 signature[4]; u32 length; u8 revision; u8 checksum; u8 oemid[6]; u8 oem_table_id[8]; u8 oem_revision[4]; u8 creator_id[4]; u8 creator_revision[4]; } __attribute__ ((packed)); struct acpi_generic_address { u8 space_id; u8 bit_width; u8 bit_offset; u8 access_size; u64 address; } __attribute__ ((packed)); typedef void (acpi_parser_t)(void *table, u32 length); void acpi_register_parser(char *signature, acpi_parser_t *func); #endif /* __CORE_ACPI_H */ tinyvisor/vmm/include/core/sleep.h0000644006644000001440000000324312167264643017534 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _CORE_SLEEP_H #define _CORE_SLEEP_H #include void usleep (u32 usec); #endif tinyvisor/vmm/include/core/string.h0000644006644000001440000000730211733245403017721 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef __CORE_STRING_H #define __CORE_STRING_H #include #define USE_BUILTIN_STRING #ifdef USE_BUILTIN_STRING # define memset(addr, val, len) memset_builtin (addr, val, len) # define memcpy(dest, src, len) memcpy_builtin (dest, src, len) # define strcmp(s1, s2) strcmp_builtin (s1, s2) # define memcmp(p1, p2, len) memcmp_builtin (p1, p2, len) # define strlen(p) strlen_builtin (p) #else /* USE_BUILTIN_STRING */ # define memset(addr, val, len) memset_slow (addr, val, len) # define memcpy(dest, src, len) memcpy_slow (dest, src, len) # define strcmp(s1, s2) strcmp_slow (s1, s2) # define memcmp(p1, p2, len) memcmp_slow (p1, p2, len) # define strlen(p) strlen_slow (p) #endif /* USE_BUILTIN_STRING */ #ifdef USE_BUILTIN_STRING static inline void * memset_builtin (void *addr, int val, int len) { return __builtin_memset (addr, val, len); } static inline void * memcpy_builtin (void *dest, const void *src, int len) { return __builtin_memcpy (dest, src, len); } static inline int strcmp_builtin (const char *s1, const char *s2) { return __builtin_strcmp (s1, s2); } static inline int memcmp_builtin (const void *p1, const void *p2, int len) { return __builtin_memcmp (p1, p2, len); } static inline int strlen_builtin (const char *p) { return __builtin_strlen (p); } #else /* USE_BUILTIN_STRING */ static inline void * memset_slow (void *addr, int val, int len) { char *p; p = addr; while (len--) *p++ = val; return addr; } static inline void * memcpy_slow (void *dest, const void *src, int len) { char *p, *q; p = dest; q = src; while (len-- > 0) *p++ = *q++; return dest; } static inline int strcmp_slow (const char *s1, const char *s2) { int r, c1, c2; do { c1 = *s1++; c2 = *s2++; r = c1 - c2; } while (!r && c1); return r; } static inline int memcmp_slow (const void *p1, const void *p2, int len) { int r, i; char *q1, *q2; q1 = p1; q2 = p2; for (r = 0, i = 0; !r && i < len; i++) r = *q1++ - *q2++; return r; } static inline int strlen_slow (const char *p) { int len = 0; while (*p++) len++; return len; } #endif /* USE_BUILTIN_STRING */ #endif tinyvisor/vmm/include/core/thread.h0000644006644000001440000000407411733245403017665 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef __CORE_THREAD_H #define __CORE_THREAD_H #include #include typedef u8 tid_t; tid_t thread_gettid (void); void schedule (void); tid_t thread_new (void (*func) (void *), void *arg, int stacksize); tid_t thread_new_bind(void (*func) (void *), void *arg, int stacksize, cpu_id_t cpu_id); void thread_exit (void); void thread_wakeup (tid_t tid); void thread_will_stop (void); #define VMM_STACKSIZE (4096 * 8) #endif tinyvisor/vmm/include/core/spinlock.h0000644006644000001440000001107412011463046020231 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef __CORE_SPINLOCK_H #define __CORE_SPINLOCK_H #include #include #ifdef SPINLOCK_DEBUG #include #endif typedef u8 spinlock_t; typedef u32 rw_spinlock_t; #define SPINLOCK_INITIALIZER ((spinlock_t)0) #ifdef SPINLOCK_DEBUG #define spinlock_debug1(a) spinlock_debug2(a) #define spinlock_debug2(a) #a #define spinlock_lock(l) spinlock_lock_debug (l, \ "spinlock_lock failed." \ " file " __FILE__ \ " line " spinlock_debug1 (__LINE__)) #endif /* SPINLOCK_DEBUG */ #ifdef SPINLOCK_DEBUG static inline void spinlock_lock_debug(spinlock_t *lock, char *msg) #else static inline void spinlock_lock(spinlock_t *lock) #endif { spinlock_t old; #ifdef SPINLOCK_DEBUG u32 count = 0; #endif for (;;) { disable_interrupt(); __asm__ volatile ( " xchg %1, %0 \n" /* exchange old and *lock */ #ifdef __x86_64__ : "=r" (old), /* output 0 */ #else : "=abcd" (old), /* output 0 */ #endif "=m" (*lock) /* output 1 */ : "0" ((u8)1) /* input 0 */ ); if (old == 0) { return; } enable_interrupt(); do { #ifdef SPINLOCK_DEBUG if (count++ == 0xffffffff) { panic("%s", msg); } #endif __asm__ volatile ( " pause \n" ); } while (*(volatile spinlock_t *)lock == old); } } static inline void spinlock_unlock(spinlock_t *l) { u8 dummy; __asm__ volatile ("xchg %1, %0 \n" #ifdef __x86_64__ : "=r" (dummy) #else : "=abcd" (dummy) #endif , "=m" (*l) : "0" ((u8)0)); enable_interrupt(); } static inline void spinlock_init (spinlock_t *l) { *l = SPINLOCK_INITIALIZER; } static inline void rw_spinlock_lock_sh (rw_spinlock_t *l) { __asm__ volatile (" lock addl %2, %0 \n" /* increment *l */ " jns 1f \n" /* if positive, succeeded */ "2: \n" " pause \n" /* spin loop hint */ " cmpl %1, %0 \n" /* test a sign */ " js 2b \n" /* if negative, do spin loop */ "1: \n" : "=m" (*l) : "ri" ((rw_spinlock_t)0) , "ri" ((rw_spinlock_t)1) : "cc"); } static inline void rw_spinlock_unlock_sh (rw_spinlock_t *l) { __asm__ volatile ("lock subl %1, %0" : "=m" (*l) : "ri" ((rw_spinlock_t)1) : "cc"); } static inline void rw_spinlock_lock_ex (rw_spinlock_t *l) { __asm__ volatile (" lock cmpxchgl %2, %0 \n" /* if *l==0, *l=0x80000000 */ " je 1f \n" /* and succeeded */ "2: \n" " xor %1, %1 \n" /* clear %eax */ " pause \n" /* spin loop hint */ " lock cmpxchgl %2, %0 \n" /* if *l==0, *l=0x80000000 */ " jne 2b \n" /* else do spin loop */ "1: \n" : "=m" (*l) : "a" (0) , "r" (0x80000000) : "cc"); } static inline void rw_spinlock_unlock_ex (rw_spinlock_t *l) { __asm__ volatile ("lock andl %1,%0" : "=m" (*l) : "ri" ((rw_spinlock_t)0x7FFFFFFF) : "cc"); } static inline void rw_spinlock_init (rw_spinlock_t *l) { *l = 0; } #endif tinyvisor/vmm/include/core/cpu.h0000644006644000001440000000364211733245403017205 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef __CORE_CPU_H #define __CORE_CPU_H #include #define MAX_CPU_ID 0xfffffffe typedef u32 cpu_id_t; typedef u32 apic_id_t; typedef u8 vector_t; cpu_id_t get_cpu_id (void); bool cpu_is_bsp(void); void cpu_relax (void); void enable_interrupt(void); void disable_interrupt(void); #endif tinyvisor/vmm/include/core/mmio.h0000644006644000001440000000403511733245403017354 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef __CORE_MMIO_H #define __CORE_MMIO_H #include typedef int (mmio_handler_t) (void *data, phys_t gphys, bool wr, void *buf, uint len, u32 flags); void *mmio_register (phys_t gphys, uint len, mmio_handler_t *handler, void *data); void mmio_unregister (void *handle); void *mmio_memcpy(void *dest, const void *src, int len); mmio_handler_t mmio_do_nothing; mmio_handler_t mmio_pass; #endif tinyvisor/vmm/include/core/mm.h0000644006644000001440000001035611733245403017027 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef __CORE_MM_H #define __CORE_MM_H #include #include #define MAPMEM_HPHYS 0x10000 #define MAPMEM_GPHYS 0x20000 #define MAPMEM_WRITE 0x40000 #define MAPMEM_CACHE_MASK 0x7 #define MAPMEM_WB 0x0 /* Write back (default) */ #define MAPMEM_UC 0x1 #define MAPMEM_WUC 0x2 /* Week UC */ #define MAPMEM_WC 0x3 #define MAPMEM_WT 0x4 #define MAPMEM_WP 0x5 #define MAPMEM_VALID_FLAG 0x00070007 #define MEM_TYPE_AVAILABLE 0x00000001 #define MEM_TYPE_RESERVED 0x00000002 #define MEM_TYPE_ACPI_RECLAIM 0x00000003 #define MEM_TYPE_ACPI_NVS 0x00000004 #define GMM_NO_MAPPING 0xFFFFFFFFFFFFFFFFLL #define PAGE_SHIFT 12 #define PAGE_MASK (((u64)-1) << PAGE_SHIFT) #define PAGE_SIZE (1 << PAGE_SHIFT) vmmerr_t alloc_pages (void **virt, u64 *phys, int n); vmmerr_t alloc_page (void **virt, u64 *phys); void free_page (void *virt); void free_page_phys (phys_t phys); void *alloc (size_t len); void free (void *virt); virt_t phys_to_virt (phys_t phys); /* accessing memory */ void unmapmem (void *virt, uint len); void *mapmem (u32 flags, u64 physaddr, uint len); void *mapmem_hphys (phys_t physaddr, uint len, u32 flags); void *mapmem_gphys (phys_t physaddr, uint len, u32 flags); /* accessing host physical memory */ void read_hphys_b (phys_t phys, void *data, u32 attr); void write_hphys_b (phys_t phys, u32 data, u32 attr); void read_hphys_w (phys_t phys, void *data, u32 attr); void write_hphys_w (phys_t phys, u32 data, u32 attr); void read_hphys_l (phys_t phys, void *data, u32 attr); void write_hphys_l (phys_t phys, u32 data, u32 attr); void read_hphys_q (phys_t phys, void *data, u32 attr); void write_hphys_q (phys_t phys, u64 data, u32 attr); bool cmpxchg_hphys_l (phys_t phys, u32 *olddata, u32 data, u32 attr); bool cmpxchg_hphys_q (phys_t phys, u64 *olddata, u64 data, u32 attr); /* accessing guest physical memory */ void read_gphys_b (phys_t phys, void *data, u32 flags); void write_gphys_b (phys_t phys, u32 data, u32 flags); void read_gphys_w (phys_t phys, void *data, u32 flags); void write_gphys_w (phys_t phys, u32 data, u32 flags); void read_gphys_l (phys_t phys, void *data, u32 flags); void write_gphys_l (phys_t phys, u32 data, u32 flags); void read_gphys_q (phys_t phys, void *data, u32 flags); void write_gphys_q (phys_t phys, u64 data, u32 flags); bool cmpxchg_gphys_l (phys_t phys, u32 *olddata, u32 data, u32 flags); bool cmpxchg_gphys_q (phys_t phys, u64 *olddata, u64 data, u32 flags); int get_phys_mem_map(int index, phys_t *base, phys_t *len, u32 *type); int get_phys_mem_map_count(void); struct resource *mm_next_mem_map(struct resource *resource); u32 vmm_start_inf(); u32 vmm_term_inf(); #endif tinyvisor/vmm/include/core/timer.h0000644006644000001440000000400011733227577017537 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_TIMER_H #define __CORE_TIMER_H #include #include void *timer_new (void (*callback) (void *handle, void *data), void *data); void timer_set (void *handle, u64 interval_usec); void timer_free (void *handle); static inline u64 elapse_time_ms(u64 start) { const u64 max = (~0ULL / 1024) + 1; u64 now; now = get_cpu_time() / 1024; return (now >= start) ? (now - start) : (max - start + now); } #endif tinyvisor/vmm/include/core/vmmerr.h0000644006644000001440000000464311753454341017735 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef __CORE_VMMERR_H #define __CORE_VMMERR_H typedef enum { VMMERR_SUCCESS = 0, VMMERR_GUESTSEG_LOAD_FAILED, VMMERR_GUESTSEG_NOT_PRESENT, VMMERR_INVALID_GUESTSEG, VMMERR_PAGE_NOT_PRESENT, VMMERR_PAGE_NOT_ACCESSIBLE, /* 5 */ VMMERR_PAGE_NOT_EXECUTABLE, VMMERR_PAGE_BAD_RESERVED_BIT, VMMERR_PREFIX_TOO_LONG, VMMERR_UNIMPLEMENTED_OPCODE, VMMERR_UNSUPPORTED_OPCODE, /* 10 */ VMMERR_EXCEPTION_UD, VMMERR_AVOID_COMPILER_WARNING, VMMERR_SW, VMMERR_NOMEM, VMMERR_MSR_FAULT, /* 15 */ VMMERR_NOTEXIST, /* 0x10 */ VMMERR_INVAL, VMMERR_BUSY, VMMERR_RANGE, VMMERR_BUFSIZE, /* 20 */ VMMERR_NODEV, VMMERR_NOSUP, VMMERR_NOT_CONTIGUOUS } vmmerr_t; #define RET_IF_ERR(func) do { \ vmmerr_t err; \ err = (func); \ if (err) \ return err; \ } while (0) #define RIE RET_IF_ERR #endif /* __CORE_VMMERR_H */ tinyvisor/vmm/include/core/assert.h0000644006644000001440000000353711733227577017736 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_ASSERT_H #define __CORE_ASSERT_H #ifdef ENABLE_ASSERT #define ASSERT(x) if (!(x)) \ assertion_failed (#x, __FUNCTION__, __FILE__, __LINE__) void assertion_failed (char *x, const char *funcname, char *filename, int linenum); #else #define ASSERT(x) #endif #endif tinyvisor/vmm/include/core/vm.h0000644006644000001440000000374612007746256017054 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_VM_H #define __CORE_VM_H #define VM_NAME_BUF_SIZE 9 #include typedef off_t drvdata_hdl_t; unsigned int vm_get_vcpu_count(); char *vm_get_name(); u32 vm_get_id(void); /* * This function must called from "drivern" init funcs. */ drvdata_hdl_t vm_alloc_driver_data(size_t); void *vm_get_driver_data(drvdata_hdl_t handle); apic_id_t vm_vbsp_apic_id(void); void vm_iommu_enabled(void); #endif /* __CORE_VM_H */ tinyvisor/vmm/include/core/param.h0000644006644000001440000000425111733245403017513 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_PARAM_H #define __CORE_PARAM_H #include #include vmmerr_t param_get_str(const char *name, int number, char *buf, size_t len); vmmerr_t param_get_u8(const char *name, int number, u8 *value); vmmerr_t param_get_u16(const char *name, int number, u16 *value); vmmerr_t param_get_u32(const char *name, int number, u32 *value); vmmerr_t param_get_u64(const char *name, int number, u64 *value); vmmerr_t param_get_u64_range(const char *name, int number, u64 *value1, u64 *value2); vmmerr_t param_get_bdf(const char *name, int number, u8 *bus, u8 *dev, u8 *func); #endif /* __CORE_PARAM_H */ tinyvisor/vmm/include/core/initfunc.h0000644006644000001440000000503012167264643020237 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef __CORE_INITFUNC_H #define __CORE_INITFUNC_H #define INITFUNC(id, func) struct initfunc_data __initfunc_##func \ __attribute__ ((__section__ (".initfunc"), aligned (1))) = { id, func } #define RM_INIT(func) INITFUNC ("driver0", func) #define BUS_INIT(func) INITFUNC ("driver1", func) #define DRIVER_INIT(func) INITFUNC ("driver2", func) #define RM_PASSVM(func) INITFUNC ("passvm4", func) #define BUS_PASSVM(func) INITFUNC ("passvm5", func) #define DRIVER_PASSVM(func) INITFUNC ("passvm6", func) #define BUS_START(func) INITFUNC ("start0", func) #define DRIVER_START(func) INITFUNC ("start1", func) #define BUS_RESETVM(func) INITFUNC ("resetvm0", func) #ifdef __x86_64__ struct initfunc_data { char id[8]; void (*func) (void); } __attribute__ ((packed)); #else struct initfunc_data { char id[8]; void (*func) (void); void *padding; } __attribute__ ((packed)); #endif void call_initfunc (char *id); #endif tinyvisor/vmm/include/core/stdarg.h0000644006644000001440000000347611733227577017723 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_STDARG_H #define __CORE_STDARG_H #define va_start(PTR, LASTARG) __builtin_va_start (PTR, LASTARG) #define va_end(PTR) __builtin_va_end (PTR) #define va_arg(PTR, TYPE) __builtin_va_arg (PTR, TYPE) #define va_list __builtin_va_list #endif tinyvisor/vmm/include/core/arith.h0000644006644000001440000000352511733227577017541 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_ARITH_H #define __CORE_ARITH_H #include #include asmlinkage void mpumul_64_64 (u64 m1, u64 m2, u64 ans[2]); asmlinkage u32 mpudiv_128_32 (u64 d1[2], u32 d2, u64 quotient[2]); asmlinkage u16 ipchecksum (void *buf, u32 len); #endif tinyvisor/vmm/include/core/types.h0000644006644000001440000000477111733245403017566 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef __CORE_TYPES_H #define __CORE_TYPES_H #define NULL ((void *)0) typedef signed char i8; typedef signed short int i16; typedef signed int i32; typedef signed long long int i64; typedef unsigned char u8; typedef unsigned short int u16; typedef unsigned int u32; typedef unsigned long long int u64; typedef volatile unsigned char vu8; typedef volatile unsigned short int vu16; typedef volatile unsigned int vu32; typedef volatile unsigned long long int vu64; typedef unsigned int uint; typedef unsigned long int ulong; typedef ulong virt_t; typedef u32 phys32_t; typedef u64 phys_t; typedef u64 size_t; typedef u64 off_t; typedef u16 ioport_t; typedef enum { false = 0, true = 1, } bool; union mem { u8 byte; u16 word; u32 dword; u64 qword; }; typedef union { u8 byte; u16 word; u32 dword; u64 qword; u8 bytes[8]; u16 words[4]; u32 dwords[2]; } core_mem_t; #endif tinyvisor/vmm/include/core/rm.h0000644006644000001440000000533511733245403017035 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_RM_H #define __CORE_RM_H #include #include #include #define RESOURCE_TYPE_INVALID 0x0 #define RESOURCE_TYPE_MEM 0x1 #define RESOURCE_TYPE_MMIO 0x2 #define RESOURCE_TYPE_IO 0x3 struct resource { LIST2_DEFINE_HEAD(struct resource, children); LIST2_DEFINE(struct resource, sibling); struct resource *parent; phys_t start; phys_t end; u32 type; u32 data; char *name; }; #define RM_RESOURCE_NEXT(parent, resouece)\ LIST2_NEXT((parent)->children, sibling, (resouece)); struct resource *rm_find_resource(struct resource *parent, phys_t addrress); void rm_init_resource(struct resource *resource, phys_t start, phys_t end, u32 type, u32 data, char *name); vmmerr_t rm_insert_resource(struct resource *parent, struct resource *new); vmmerr_t rm_alloc_avail_resource(struct resource *parent, struct resource *new, phys_t start, phys_t end, phys_t align, u32 type, u32 data, char *name); vmmerr_t rm_alloc_resource(struct resource *parent, struct resource *new, size_t size, phys_t align, u32 type, u32 data, char *name); void rm_dump_resources(struct resource *resource); #endif /* __CORE_RM_H */ tinyvisor/vmm/include/core/extint.h0000644006644000001440000000354412140554234017730 0ustar yuichi_xyusers/* * Copyright (c) 2010-2012 Yuichi Watanabe * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of Yuichi Watanabe nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef __CORE_EXTINT_H #define __CORE_EXTINT_H #include void extint_pend_apic_int(vector_t vector); void extint_pend_8259a_int(vector_t vector); void extint_reset_8259a(void); void extint_reset_apic(void); void extint_send_apic_int(vector_t vector, apic_id_t dest); #endif /* __CORE_EXTINT_H */ tinyvisor/vmm/include/core/time.h0000644006644000001440000000407011733245403017350 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef __CORE_TIME_H #define __CORE_TIME_H #include u64 get_cpu_time (void); bool time_initialized (void); static inline bool time_before (u64 a, u64 b) { return ((i64)(a - b) < 0); } static inline bool time_after (u64 a, u64 b) { return time_before (b, a); } static inline bool time_after_eq (u64 a, u64 b) { return ((i64)(a - b) >= 0); } static inline bool time_before_eq (u64 a, u64 b) { return time_before_eq (b, a); } #endif tinyvisor/vmm/include/limits.h0000644006644000001440000000326511733227577017004 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #define UCHAR_MAX 255u #define USHRT_MAX 65535u #define UINT_MAX 4294967295u #define ULLONG_MAX 18446744073709551615ULL tinyvisor/vmm/include/stdint.h0000644006644000001440000000313011733227577016777 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ typedef long int intptr_t; tinyvisor/vmm/include/stdlib.h0000644006644000001440000000316111733227577016757 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #define EXIT_FAILURE 1 #define EXIT_SUCCESS 0 tinyvisor/vmm/include/common/0000755006644000001440000000000012206363325016600 5ustar yuichi_xyuserstinyvisor/vmm/include/common/list.h0000644006644000001440000003311312071526062017724 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _LIST_H_ #define _LIST_H_ /* * Simple list implementation */ struct list { void *next; }; #define LIST_DEFINE(listname) struct list listname #define LIST_DEFINE_HEAD(listname) struct list listname##_head = { NULL } #define LIST_EXTERN_HEAD(listname) extern struct list listname##_head #define LIST_INSERT(listname, new) \ { \ new.listname.next = listname##_head.next; \ listname##_head.next = new; \ } #define LIST_APPEND(listname, new) \ { \ typeof(new) p = listname##_head.next; \ if (p != NULL) { \ while (p->listname.next != NULL) \ p = p->listname.next; \ p->listname.next = new; \ } else \ listname##_head.next = new; \ new->listname.next = NULL; \ } #define LIST_FOREACH(listname, p) for (p = listname##_head.next; p != NULL; p = p->listname.next) #define LIST_NEXT(listname, cur) \ ((cur) ? (cur)->listname.next : listname##_head.next) #define LIST_HEAD(listname) listname##_head.next /* * 1st list implementation * * usage: * struct foo { * LIST1_DEFINE (struct foo); * int bar; * }; * LIST1_DEFINE_HEAD (struct foo, list1_foo); * func () { * struct foo f[3], *p; * LIST1_HEAD_INIT (list1_foo); * LIST1_PUSH (list1_foo, &f[0]); * LIST1_PUSH (list1_foo, &f[1]); * p = LIST1_POP (list1_foo); * LIST1_DEL (list1_foo, &f[0]); * } */ #define LIST1_NAME list #define LIST1_DEFINE(type) LIST2_DEFINE(type, LIST1_NAME) #define LIST1_DEFINE_HEAD(type, name) LIST2_DEFINE_HEAD(type, name) #define LIST1_DEFINE_HEAD_INIT(type, name) \ LIST2_DEFINE_HEAD_INIT(type, name) #define LIST1_HEAD_INIT(head) LIST2_HEAD_INIT(head) #define LIST1_ADD(head, data) LIST2_ADD(head, LIST1_NAME, data) #define LIST1_INSERT(head, nextd, data) LIST2_INSERT(head, LIST1_NAME, nextd, data) #define LIST1_PUSH(head, data) LIST2_PUSH(head, LIST1_NAME, data) #define LIST1_DEL(head, data) LIST2_DEL(head, LIST1_NAME, data) #define LIST1_POP(head) LIST2_POP(head, LIST1_NAME) #define LIST1_FOREACH(head, var) LIST2_FOREACH(head, LIST1_NAME, var) #define LIST1_FOREACH_DELETABLE(head, var, varn) \ LIST2_FOREACH_DELETABLE(head, LIST1_NAME, var, varn) #define LIST1_NEXT(head, cur) LIST2_NEXT(head, LIST1_NAME, cur) #define LIST1_PREV(head, cur) LIST2_PREV(head, LIST1_NAME, cur) /* * 2nd list implementation * * usage: * struct foo { * LIST2_DEFINE (struct foo, mona); * LIST2_DEFINE (struct foo, giko); * int bar; * }; * LIST2_DEFINE_HEAD (struct foo, list_foo_mona); * LIST2_DEFINE_HEAD (struct foo, list_foo_giko); * func () { * struct foo f[3], *p; * LIST2_HEAD_INIT (list_foo_mona); * LIST2_HEAD_INIT (list_foo_giko); * LIST2_PUSH (list_foo_mona, mona, &f[0]); * LIST2_PUSH (list_foo_mona, mona, &f[1]); * LIST2_PUSH (list_foo_giko, giko, &f[0]); * p = LIST2_POP (list_foo_mona, mona); * LIST2_DEL (list_foo_giko, giko, &f[0]); * } */ #define LIST2_DEFINE(type, name) \ struct {type *next, *prev; } name #define LIST2_DEFINE_HEAD(type, headname) \ struct {type *top, *tail; } headname #define LIST2_DEFINE_HEAD_INIT(type, name) \ struct {type *top, *tail; } name = {NULL, NULL} #define LIST2_HEAD_INIT(head) \ (head).top = (head).tail = NULL #define LIST2_ADD(head, name, data) \ do { \ (data)->name.next = NULL; \ (data)->name.prev = (head).tail; \ if ((head).tail != NULL) { \ (head).tail->name.next = (data); \ } \ (head).tail = (data); \ if ((head).top == NULL) { \ (head).top = (data); \ } \ } while (0) #define LIST2_INSERT(head, name, nextd, data) \ do { \ (data)->name.next = (nextd); \ (data)->name.prev = (nextd)->name.prev; \ if ((nextd)->name.prev == NULL) { \ (head).top = (data); \ } else { \ (nextd)->name.prev->name.next \ = (data); \ } \ (nextd)->name.prev = (data); \ } while (0) #define LIST2_PUSH(head, name, data) \ do { \ (data)->name.next = (head).top; \ (data)->name.prev = NULL; \ if ((head).top != NULL) { \ (head).top->name.prev = (data); \ } \ (head).top = (data); \ if ((head).tail == NULL) { \ (head).tail = (data); \ } \ } while (0) #define LIST2_DEL(head, name, data) \ list2_delete((((data)->name.prev) ? \ &((data)->name.prev->name.next) : \ &((head).top)), \ (data)->name.next, \ (((data)->name.next) ? \ &((data)->name.next->name.prev) : \ &((head).tail)), \ (data)->name.prev, \ (data)) #define LIST2_POP(head, name) \ (head.top ? \ LIST2_DEL(head, name, head.top) : NULL) #define LIST2_FOREACH(head, name, var) \ for (var = (head).top; var; var = var->name.next) #define LIST2_FOREACH_DELETABLE(head, name, var, varn) \ for (var = (head).top; var && ((varn = var->name.next), 1); \ var = varn) #define LIST2_NEXT(head, name, cur) \ ((cur) ? (cur)->name.next : (head).top) #define LIST2_PREV(head, name, cur) \ ((cur) ? (cur)->name.prev : (head).tail) static inline void * list2_delete (void *p_next_of_prev, void *next, void *p_prev_of_next, void *prev, void *data) { *(unsigned long *)p_next_of_prev = (unsigned long)next; *(unsigned long *)p_prev_of_next = (unsigned long)prev; return data; } /* list for continuous array every element of a list is in one array usage: struct foo { LIST3_DEFINE (struct foo, mona, signed char); LIST3_DEFINE_BIT (struct foo, giko, signed int, 4); int bar; }; LIST3_DEFINE_HEAD (list_foo_mona, struct foo, mona); LIST3_DEFINE_HEAD (list_foo_giko, struct foo, giko); func () { struct foo f[3], *p; LIST3_HEAD_INIT (list_foo_mona, mona); LIST3_HEAD_INIT (list_foo_giko, giko); LIST3_PUSH (list_foo_mona, mona, &f[0]); LIST3_PUSH (list_foo_mona, mona, &f[1]); LIST3_PUSH (list_foo_giko, giko, &f[0]); p = LIST3_POP (list_foo_mona, mona); LIST3_DEL (list_foo_giko, giko, &f[0]); } */ #define LIST3_DEFINE(type, sx, inttype) \ inttype sx##prev, sx##next #define LIST3_DEFINE_BIT(type, sx, inttype, nbits) \ inttype sx##prev : nbits, sx##next : nbits #define LIST3_DEFINE_HEAD(name, type, sx) \ struct { type *prev, *next; } name #define LIST3_DEFINE_HEAD_INIT(name, type, sx) \ struct { type *prev, *next; } name = { NULL, NULL } #define LIST3_HEAD_INIT(name, sx) name.prev = name.next = NULL #define LIST3_ADD(head, sx, data) ( \ ((data)->sx##next = 0), \ (/* if */ (head).prev ? ( \ ((data)->sx##prev = (head).prev - (data)), \ ((head).prev->sx##next = -(data)->sx##prev), \ ((head).prev = (data)) \ ) : (/* else */ \ ((data)->sx##prev = 0), \ ((head).prev = (head).next = (data)) \ ))) #define LIST3_INSERT(head, sx, nextd, data) \ (/* if */ (nextd) ? ( \ ((data)->sx##next = (nextd) - (data)), \ (/* if */ (nextd)->sx##prev ? ( \ ((data)->sx##prev = \ (data)->sx##next + (nextd)->sx##prev), \ ((nextd)->sx##prev = -(data)->sx##next), \ (((data) + (data)->sx##prev)->sx##next = \ -(data)->sx##prev), \ (data) \ ) : (/* else */ \ ((data)->sx##prev = 0), \ ((nextd)->sx##prev = -(data)->sx##next), \ ((head).next = (data)) \ )) \ ) : (/* else */ \ LIST3_ADD (head, sx, (data)) \ )) #define LIST3_PUSH(head, sx, data) \ LIST3_INSERT (head, sx, (head).next, (data)) #define LIST3_DEL(head, sx, data) ({ \ void *RET = (data); \ ((data)->sx##prev ? (data)->sx##next ? ( /* prev && next */ \ (((data) + (data)->sx##prev)->sx##next += (data)->sx##next), \ (((data) + (data)->sx##next)->sx##prev += (data)->sx##prev), \ RET \ ) : ( /* prev && !next */ \ ((head).prev = ((data) + (data)->sx##prev)), \ ((head).prev->sx##next = 0), \ RET \ ) : (data)->sx##next ? ( /* !prev && next */ \ ((head).next = ((data) + (data)->sx##next)), \ ((head).next->sx##prev = 0), \ RET \ ) : ( /* !prev && !next */ \ ((head).prev = (head).next = NULL), \ RET \ )); \ }) #define LIST3_POP(head, sx) \ ((head).next ? LIST3_DEL (head, sx, (head).next) : NULL) #define LIST3_FOREACH(head, sx, var) \ for (var = (head).next; var; var = var->sx##next ? \ var + var->sx##next : NULL) #define LIST3_FOREACH_DELETABLE(head, sx, var, varn) \ for (var = (head).next; var && ((varn = var->sx##next ? \ (var + var->sx##next) : NULL), 1); \ var = varn) /* #define LIST1_DEFINE(type) type **pnext, *next */ /* #define LIST1_DEFINE_HEAD(type, name) struct { type **pnext, *next; } name */ /* #define LIST1_DEFINE_HEAD_INIT(type, name) \ */ /* struct { type **pnext, *next; } name = { &name.next, NULL } */ /* #define LIST1_HEAD_INIT(name) *(name.pnext = &name.next) = NULL */ /* #define _LIST1_NEXTPNEXT(head, data) \ */ /* ((data)->next ? &(data)->next->pnext : &(head).pnext) */ /* #define LIST1_ADD(head, data) \ */ /* list1_insert ((head).pnext, (data), &(data)->pnext, &(data)->next, \ */ /* NULL, &(head).pnext) */ /* #define LIST1_PUSH(head, data) \ */ /* list1_insert (&(head).next, (data), &(data)->pnext, &(data)->next, \ */ /* (head).next, _LIST1_NEXTPNEXT (head, &head)) */ /* #define LIST1_DEL(head, data) \ */ /* list1_delete ((data)->pnext, (data)->next, \ */ /* _LIST1_NEXTPNEXT (head, data), (data)) */ /* #define LIST1_POP(head) \ */ /* ((head).next ? LIST1_DEL (head, (head).next) : NULL) */ /* #define LIST1_FOREACH(head, var) \ */ /* for (var = (head).next; var; var = var->next) */ /* #define LIST1_INSERT(head, nextd, data) \ */ /* ((nextd) ? list1_insert ((nextd)->pnext, (data), &(data)->pnext, \ */ /* &(data)->next, (nextd), &(nextd)->pnext) \ */ /* : LIST1_ADD ((head), (data))) */ /* #define LIST1_NEXT(head, cur) \ */ /* ((cur) ? (cur)->next : (head).next) */ /* #define LIST2_DEFINE(type, sx) type **sx##pnext, *sx##next */ /* #define LIST2_DEFINE_HEAD(name, type) \ */ /* struct { type **pnext, *next; } name */ /* #define LIST2_DEFINE_HEAD_INIT(name, type) \ */ /* struct { type **pnext, *next; } name = { &name.next, NULL } */ /* #define LIST2_HEAD_INIT(name) *(name.pnext = &name.next) = NULL */ /* #define _LIST2_NEXTPNEXT(head, sx, data) \ */ /* ((data)->sx##next ? &(data)->sx##next->sx##pnext : &(head).pnext) */ /* #define _LIST2_NEXTPNEXT2(head, sx) \ */ /* ((head).next ? &(head).next->sx##pnext : &(head).pnext) */ /* #define LIST2_ADD(head, sx, data) \ */ /* list1_insert ((head).pnext, (data), &(data)->sx##pnext, \ */ /* &(data)->sx##next, NULL, &(head).pnext) */ /* #define LIST2_PUSH(head, sx, data) \ */ /* list1_insert (&(head).next, (data), &(data)->sx##pnext, \ */ /* &(data)->sx##next, (head).next, \ */ /* _LIST2_NEXTPNEXT2 (head, sx)) */ /* #define LIST2_DEL(head, sx, data) \ */ /* list1_delete ((data)->sx##pnext, (data)->sx##next, \ */ /* _LIST2_NEXTPNEXT (head, sx, data), (data)) */ /* #define LIST2_POP(head, sx) \ */ /* ((head).next ? LIST2_DEL (head, sx, (head).next) : NULL) */ /* #define LIST2_FOREACH(head, sx, var) \ */ /* for (var = (head).next; var; var = var->sx##next) */ /* #define LIST2_FOREACH_DELETABLE(head, sx, var, varn) \ */ /* for (var = (head).next; var && ((varn = var->sx##next), 1); \ */ /* var = varn) */ /* #define LIST2_INSERT(head, sx, nextd, data) \ */ /* ((nextd) ? list1_insert ((nextd)->sx##pnext, (data), \ */ /* &(data)->sx##pnext, &(data)->sx##next, \ */ /* (nextd), &(nextd)->sx##pnext) \ */ /* : LIST2_ADD (head, sx, (data))) */ /* #define LIST2_NEXT(head, sx, cur) \ */ /* ((cur) ? (cur)->sx##next : (head).next) */ /* /\* p{p_pn,p_n} -> n{n_pn,n_n} *\/ */ /* /\* p{p_pn,p_n} -> d{d_pn,d_n} -> n{n_pn,n_n} *\/ */ /* static inline void */ /* list1_insert (void *p_n, void *d, void *d_pn, void *d_n, void *n, */ /* void *n_pn) */ /* { */ /* *(unsigned long *)p_n = (unsigned long)d; */ /* *(unsigned long *)d_pn = (unsigned long)p_n; */ /* *(unsigned long *)d_n = (unsigned long)n; */ /* *(unsigned long *)n_pn = (unsigned long)d_n; */ /* } */ /* /\* p{p_pn,p_n=*d_pn} -> d{d_pn,d_n} -> n=d_n{n_pn=&d_n,n_n} *\/ */ /* /\* p{p_pn,p_n=n} -> n{n_pn=&p_n,n_n} *\/ */ /* static inline void * */ /* list1_delete (void *p_n, void *n, void *n_pn, void *d) */ /* { */ /* *(unsigned long *)p_n = (unsigned long)n; */ /* *(unsigned long *)n_pn = (unsigned long)p_n; */ /* return d; */ /* } */ #endif tinyvisor/vmm/include/common/common.h0000644006644000001440000000401411753454341020245 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #ifndef _COMMON_H #define _COMMON_H #define offsetof(s,m) (size_t)&(((s *)0)->m) #define lengthof(s) (size_t)sizeof(s)/sizeof(s[0]) #define ROUND_UP(value, align) \ (((value) + (align) - 1) & ~((align - 1))) #define ROUND_DOWN(value, align) \ ((value) & ~((align) - 1)) #define MAX(val1, val2) \ ((val1) > (val2) ? (val1) : (val2)) #define MIN(val1, val2) \ ((val1) < (val2) ? (val1) : (val2)) #endif tinyvisor/vmm/include/common/types.h0000644006644000001440000000320011733227577020124 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _TYPES_H #define _TYPES_H #include #endif tinyvisor/vmm/include/common/arraylist.h0000644006644000001440000000523711733227577021006 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #ifndef _ARRAYLIST_H_ #define _ARRAYLIST_H_ #define ARRAYLIST_DEFAULT_NUM 128 #define ARRAYLIST_DEFINE(listname) #define ARRAYLIST_DEFINE_HEAD_NUM(listname, maxnum) int listname##_num = 0; int listname##_max = maxnum; void *listname##_array[maxnum] = {NULL}; #define ARRAYLIST_DEFINE_HEAD(listname) ARRAYLIST_DEFINE_HEAD_NUM(listname, ARRAYLIST_DEFAULT_NUM) #define ARRAYLIST_APPEND(listname, new) \ { \ if (listname##_num >= listname##_max) \ panic("too many arraylist items\n"); \ listname##_array[listname##_num++] = new; \ } #define ARRAYLIST_REMOVE_INDEX(listname, index) \ { \ int __i; \ for (__i = index; __i < listname##_num; __i++) \ listname##_array[__i] = listname##_array[__i+1]; \ listname##_num--; \ } #define ARRAYLIST_REMOVE(listname, old) \ { \ int __i; \ for (__i = 0; __i < listname##_num; __i++) \ if (listname##_array[i] == old) \ ARRAYLIST_REMOVE_INDEX(listname, __i); \ } #define ARRAYLIST_FOREACH(listname, p, i) \ for (i = 0, p = listname##_array[0]; i < listname##_num; i++, p = listname##_array[i]) #endif tinyvisor/vmm/Makefile.master0000644006644000001440000000112111733245403016612 0ustar yuichi_xyusersCONFIG = $(TOPDIR)/.config include $(CONFIG) BITS-0 = 32 BITS-1 = 64 MAKE = make CC = gcc LD = ld INCLUDE = $(TOPDIR)/include HEADERS = $(shell find $(INCLUDE) -name '*.h') CFLAGS = -m$(BITS-$(CONFIG_64)) -O2 -g -Wall -Werror \ -mno-red-zone -ffreestanding -nostdinc -fno-stack-protector \ -mno-sse -fno-omit-frame-pointer -I$(INCLUDE) LINTFLAGS = -nolib -booltype bool -boolfalse false -booltrue true -sysunrecog -temptrans -I$(INCLUDE) LDFLG-0 = -melf_i386 LDFLG-1 = -melf_x86_64 LDFLAGS = $(LDFLG-$(CONFIG_64)) -g -nostdlib # --build-id=none LDFLAGS2 = -T $(LDS) --cref -Map $(MAP) tinyvisor/vmm/config.sh0000755006644000001440000000122711733537734015506 0ustar yuichi_xyusers#!/bin/sh set -- LANG=C while read line; do name="${line%%#*}" value="${name#*=}" name="${name%%=*}" name="${name#CONFIG_}" help="${line#*#}" set -- "$@" "$name" "$help" "$value" done < .config exec 3>&1 ret="`whiptail --checklist \"VMM Configuration\" 22 75 16 -- \"$@\" 2>&1 1>&3 3>&-`" || exit 1 exec 3>&- set -- $ret mv .config .config.bak || exit 1 while read line; do name="${line%%#*}" value="${name#*=}" name="${name%%=*}" name="${name#CONFIG_}" help="${line#*#}" value=0 for i; do case "$i" in \""$name"\") value=1 esac done echo "CONFIG_$name=$value#$help" done < .config.bak > .config tinyvisor/vmm/vmm.lds0000644006644000001440000000106311733245403015170 0ustar yuichi_xyusersENTRY(entry) virt = 0x40100000; phys = 0x00100000; PHDRS { hdrs PT_PHDR PHDRS AT (phys); all PT_LOAD; } SECTIONS { . = virt; head = .; . = virt + SIZEOF_HEADERS; .text : AT (phys + (code - head)) { code = .; *(.entry) *(.text) codeend = .; } :all .data : AT (phys + (data - head)) { data = .; *(.data) . = ALIGN (8); __initfunc_start = .; *(.initfunc) __initfunc_end = .; /* } .bss : AT (phys + (bss - head)) { */ bss = .; *(.bss) *(COMMON) } end = .; /DISCARD/ : { *(.gomi) } } tinyvisor/Makefile0000644006644000001440000000064011753454341014533 0ustar yuichi_xyusers.PHONY : all clean sloc lint config all: make -C vmm make -C bootloader make -C cmd make -C bios config: make -C vmm config biosconfig: make -C bios menuconfig clean: make -C vmm clean make -C bootloader clean make -C cmd clean make -C bios clean lint: make -C vmm lint make -C bootloader lint make -C cmd lint # Count source lines of code # http://www.dwheeler.com/sloccount sloc : sloccount . tinyvisor/cmd/0000755006644000001440000000000012206363326013632 5ustar yuichi_xyuserstinyvisor/cmd/Makefile0000644006644000001440000000047511733245403015277 0ustar yuichi_xyusersOUT_BINS = dbgsh .PHONY: all cleanlint all: $(OUT_BINS) dgbsh: dbgsh.o clean: rm -f $(OUT_BINS) *.o *~ lint: splint $(LINTFLAGS) *.c check-syntax: gcc -fsyntax-only $(CPPFLAGS) $(CFLAGS) $(CHK_SOURCES) # splint $(LINTFLAGS) $(CHK_SOURCES) HEADERS = CFLAGS = -O2 -g -Wall -Werror LINTFLAGS = LDFLAGS = -g tinyvisor/cmd/dbgsh.c0000644006644000001440000000522211733245403015065 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #include #include #ifdef __MINGW32__ #include #define NOECHO() #define GETCHAR() getch () #define PUTCHAR(c) putch (c) #define ECHO() #else #define NOECHO() system ("stty -echo -icanon") #define GETCHAR() getchar () #define PUTCHAR(c) putchar (c), fflush (stdout) #define ECHO() system ("stty echo icanon") #endif static int vmcall_dbgsh (int c) { int r, n; asm volatile ("push (%%ebx); push 4(%%ebx); lea 8(%%esp),%%esp; vmcall" : "=a" (n) : "a" (0), "b" ("dbgsh")); if (!n) return -1; asm volatile ("vmcall" : "=a" (r) : "a" (n), "b" (c)); return r; } void e (void) { ECHO (); } int main (int argc, char **argv) { int s, r; FILE *fp; if (argc >= 2) { fp = fopen (argv[1], "w"); } else { fp = NULL; } if (vmcall_dbgsh (-1) == -1) { fprintf(stderr, "Failed to call dbgsh vmmcall.\n"); return 1; } atexit (e); NOECHO (); s = -1; for (;;) { r = vmcall_dbgsh (s); s = -1; if (r == 0) { s = GETCHAR (); } else if (r > 0) { if (fp) { fprintf (fp, "%c", r); fflush (fp); } PUTCHAR (r); s = 0; } } return 0; } tinyvisor/install_to_usb.sh0000755006644000001440000001401312140426470016443 0ustar yuichi_xyusers#!/usr/bin/env bash : <<. /* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ . printhelp(){ echo "usage: $0 [-f] [-l lba1] [-i lba2] [-c cmdline] device [loader] [vmm] [module1]" echo " $0 -s [-l lba1] device" echo ' -f first time (do not check existing data)' echo ' -l lba1 a lba where a boot record is installed (default 0; MBR)' echo ' -i lba2 a lba where a image is installed (default 1)' echo ' -c cmdline boot parameters to vmm' echo ' -s show the installing status' echo ' device write to device (ex. /dev/sda)' echo ' loader a path to bootloader (default: bootloader/bootloader)' echo ' vmm a path to vmm.elf (default: vmm/vmm/vmm.elf)' echo ' module1 a path to guest bios (default: bios/out/bios.bin)' } show(){ if [ ! -e "$device" ]; then echo "$device not found." return 1; fi length=`dd if=$device bs=1 skip="$((lba1 * 512 + 4))" count=4 2> /dev/null | od -t d8 | cut -d ' ' -f 2- -s` lba2=`dd if=$device bs=1 skip="$((lba1 * 512 + 8))" count=8 2> /dev/null | od -t d8 | cut -d ' ' -f 2- -s` cmdlineoff=`dd if=$device bs=1 skip="$((lba1 * 512 + 16))" count=4 2> /dev/null | od -t d8 | cut -d ' ' -f 2- -s` moduleoff=`dd if=$device bs=1 skip="$((lba1 * 512 + 20))" count=4 2> /dev/null | od -t d8 | cut -d ' ' -f 2- -s` if dd if="$device" skip="$lba2" count=1 2>/dev/null | od | grep -q '^0000000 042577 043114' then true else echo "VMM not found." return 1 fi vmm_size=$cmdlineoff; if [ $vmm_size -le 0 ]; then vmm_size=$moduleoff; fi if [ $vmm_size -le 0 ]; then vmm_size=$length; fi echo "lba2: $((lba2))" echo "vmm: off 0 size $(($vmm_size))" if [ $cmdlineoff -le 0 ]; then echo "cmdline: (none)" else cmdline_size=$moduleoff if [ $cmdline_size -le 0 ]; then cmdline_size=$length fi cmdline_size=$(($cmdline_size - $cmdlineoff)); echo -n "cmdline: off $((cmdlineoff)) size $(($cmdline_size)) (" dd if=$device bs=1 skip=$((lba2 * 512 + $cmdlineoff)) count=$cmdline_size 2> /dev/null echo ")" fi if [ $moduleoff -le 0 ]; then echo "module1: (none)" else module_size=$(($length - $moduleoff)); echo "module1: off $(($moduleoff)) size $(($module_size))" fi return 0; } printbin(){ cnt=$1 x=$(($2)) while test $cnt -gt 0 do a=$(($x%256)) x=$(($x/256)) printf \\`printf %o $a` cnt=$(($cnt-1)) done } generatembr(){ length=$1 cmdlineoff=$2 moduleoff=$3 dd if="$loader" bs=1 count=4 2> /dev/null # 0- 4 bytes printbin 4 $length # 4- 4 bytes printbin 8 "$lba2" # 8- 8 bytes printbin 4 $cmdlineoff # 16- 4 bytes printbin 4 $moduleoff # 20- 4 bytes dd if="$loader" bs=1 skip=24 count=416 2> /dev/null # 24- 416 bytes dd if="$device" bs=1 skip="$((lba1 * 512 + 440))" count=70 2> /dev/null # 440- 70 bytes dd if="$loader" bs=1 skip=510 count=2 2> /dev/null # 510- 2 bytes } first=0 device= lba1=0 lba2=1 loader=bootloader/bootloader vmm=vmm/vmm.elf cmdline= module1=bios/out/bios.bin arg=. show=0 while test $# -gt 0 do case "$1" in -f) first=1;; -s) show=1;; -l) shift; lba1=$1;; -i) shift; lba2=$1;; -c) shift; cmdline=$1;; -*) echo "unrecognized option \`$1'" >&2 exit 1;; *) case $arg in .) device="$1";; ..) loader="$1";; ...) vmm="$1";; ....) module1="$1";; .....) echo "extra operand \`$1'" >&2 exit 1;; esac arg=.$arg;; esac shift done case $arg in .) printhelp exit 1;; esac case $show in 1) show exit $?; esac date if [ ! -e "$device" ]; then echo "$device not found." exit 1 fi case $first in 0) if dd if="$device" skip="$lba2" count=1 2> /dev/null | od | grep -q '^0000000 042577 043114' then echo "found ELF header." >&2 else echo "ELF header not found. use -f option to install." >&2 exit 1 fi;; esac size0=`cat "$vmm" | wc -c` cmdlinesize=0 size1=0 cmdlineoff=0 off1=0 total=$size0 if [ -n "$cmdline" ]; then cmdlineoff=$total cmdlinesize=`echo -n "$cmdline" | wc -c` cmdlinesize=$(($cmdlinesize + 1)) total=$(($total + $cmdlinesize)) echo "cmdline: $cmdline" fi if [ -n "$module1" ]; then off1=$total size1=`cat "$module1" | wc -c` total=$(($total + $size1)) fi echo "Writing to lba $lba1" generatembr $total $cmdlineoff $off1 | dd of="$device" seek="$lba1" conv=notrunc 2> /dev/null echo "Writing to lba $lba2" ( cat "$vmm" if [ -n "$cmdline" ]; then echo -n $cmdline; echo -n -e '\000'; # octal value fi if [ -n "$module1" ]; then cat "$module1" fi ) | dd of="$device" seek="$lba2" conv=notrunc 2> /dev/null tinyvisor/bios/0000755006644000001440000000000012206363327014024 5ustar yuichi_xyuserstinyvisor/bios/tools/0000755006644000001440000000000012206363326015163 5ustar yuichi_xyuserstinyvisor/bios/tools/checkstack.py0000755006644000001440000001725012172661303017646 0ustar yuichi_xyusers#!/usr/bin/env python # Script that tries to find how much stack space each function in an # object is using. # # Copyright (C) 2008 Kevin O'Connor # # This file may be distributed under the terms of the GNU GPLv3 license. # Usage: # objdump -m i386 -M i8086 -M suffix -d out/rom16.o | tools/checkstack.py import sys import re # Functions that change stacks STACKHOP = ['stack_hop', 'stack_hop_back'] # List of functions we can assume are never called. #IGNORE = ['panic', '__dprintf'] IGNORE = ['panic'] OUTPUTDESC = """ #funcname1[preamble_stack_usage,max_usage_with_callers]: # insn_addr:called_function [usage_at_call_point+caller_preamble,total_usage] # #funcname2[p,m,max_usage_to_yield_point]: # insn_addr:called_function [u+c,t,usage_to_yield_point] """ # Find out maximum stack usage for a function def calcmaxstack(funcs, funcaddr): info = funcs[funcaddr] # Find max of all nested calls. maxusage = info[1] maxyieldusage = doesyield = 0 if info[3] is not None: maxyieldusage = info[3] doesyield = 1 info[2] = maxusage info[4] = info[3] seenbefore = {} totcalls = 0 for insnaddr, calladdr, usage in info[6]: callinfo = funcs.get(calladdr) if callinfo is None: continue if callinfo[2] is None: calcmaxstack(funcs, calladdr) if callinfo[0] not in seenbefore: seenbefore[callinfo[0]] = 1 totcalls += 1 + callinfo[5] funcnameroot = callinfo[0].split('.')[0] if funcnameroot in IGNORE: # This called function is ignored - don't contribute it to # the max stack. continue if funcnameroot in STACKHOP: if usage > maxusage: maxusage = usage if callinfo[4] is not None: doesyield = 1 if usage > maxyieldusage: maxyieldusage = usage continue totusage = usage + callinfo[2] if totusage > maxusage: maxusage = totusage if callinfo[4] is not None: doesyield = 1 totyieldusage = usage + callinfo[4] if totyieldusage > maxyieldusage: maxyieldusage = totyieldusage info[2] = maxusage if doesyield: info[4] = maxyieldusage info[5] = totcalls # Try to arrange output so that functions that call each other are # near each other. def orderfuncs(funcaddrs, availfuncs): l = [(availfuncs[funcaddr][5], availfuncs[funcaddr][0], funcaddr) for funcaddr in funcaddrs if funcaddr in availfuncs] l.sort() l.reverse() out = [] while l: count, name, funcaddr = l.pop(0) if funcaddr not in availfuncs: continue calladdrs = [calls[1] for calls in availfuncs[funcaddr][6]] del availfuncs[funcaddr] out = out + orderfuncs(calladdrs, availfuncs) + [funcaddr] return out # Update function info with a found "yield" point. def noteYield(info, stackusage): prevyield = info[3] if prevyield is None or prevyield < stackusage: info[3] = stackusage # Update function info with a found "call" point. def noteCall(info, subfuncs, insnaddr, calladdr, stackusage): if (calladdr, stackusage) in subfuncs: # Already noted a nearly identical call - ignore this one. return info[6].append((insnaddr, calladdr, stackusage)) subfuncs[(calladdr, stackusage)] = 1 hex_s = r'[0-9a-f]+' re_func = re.compile(r'^(?P' + hex_s + r') <(?P.*)>:$') re_asm = re.compile( r'^[ ]*(?P' + hex_s + r'):\t.*\t(addr32 )?(?P.+?)[ ]*((?P' + hex_s + r') <(?P.*)>)?$') re_usestack = re.compile( r'^(push[f]?[lw])|(sub.* [$](?P0x' + hex_s + r'),%esp)$') def calc(): # funcs[funcaddr] = [funcname, basicstackusage, maxstackusage # , yieldusage, maxyieldusage, totalcalls # , [(insnaddr, calladdr, stackusage), ...]] funcs = {-1: ['', 0, 0, None, None, 0, []]} cur = None atstart = 0 stackusage = 0 # Parse input lines for line in sys.stdin.readlines(): m = re_func.match(line) if m is not None: # Found function funcaddr = int(m.group('funcaddr'), 16) funcs[funcaddr] = cur = [m.group('func'), 0, None, None, None, 0, []] stackusage = 0 atstart = 1 subfuncs = {} continue m = re_asm.match(line) if m is not None: insn = m.group('insn') im = re_usestack.match(insn) if im is not None: if insn.startswith('pushl') or insn.startswith('pushfl'): stackusage += 4 continue elif insn.startswith('pushw') or insn.startswith('pushfw'): stackusage += 2 continue stackusage += int(im.group('num'), 16) if atstart: if '%esp' in insn or insn.startswith('leal'): # Still part of initial header continue cur[1] = stackusage atstart = 0 insnaddr = m.group('insnaddr') calladdr = m.group('calladdr') if calladdr is None: if insn.startswith('lcallw'): noteCall(cur, subfuncs, insnaddr, -1, stackusage + 4) noteYield(cur, stackusage + 4) elif insn.startswith('int'): noteCall(cur, subfuncs, insnaddr, -1, stackusage + 6) noteYield(cur, stackusage + 6) elif insn.startswith('sti'): noteYield(cur, stackusage) else: # misc instruction continue else: # Jump or call insn calladdr = int(calladdr, 16) ref = m.group('ref') if '+' in ref: # Inter-function jump. pass elif insn.startswith('j'): # Tail call noteCall(cur, subfuncs, insnaddr, calladdr, 0) elif insn.startswith('calll'): noteCall(cur, subfuncs, insnaddr, calladdr, stackusage + 4) else: print "unknown call", ref noteCall(cur, subfuncs, insnaddr, calladdr, stackusage) # Reset stack usage to preamble usage stackusage = cur[1] #print "other", repr(line) # Calculate maxstackusage for funcaddr, info in funcs.items(): if info[2] is not None: continue calcmaxstack(funcs, funcaddr) # Sort functions for output funcaddrs = orderfuncs(funcs.keys(), funcs.copy()) # Show all functions print OUTPUTDESC for funcaddr in funcaddrs: name, basicusage, maxusage, yieldusage, maxyieldusage, count, calls = \ funcs[funcaddr] if maxusage == 0 and maxyieldusage is None: continue yieldstr = "" if maxyieldusage is not None: yieldstr = ",%d" % maxyieldusage print "\n%s[%d,%d%s]:" % (name, basicusage, maxusage, yieldstr) for insnaddr, calladdr, stackusage in calls: callinfo = funcs.get(calladdr, ("", 0, 0, 0, None)) yieldstr = "" if callinfo[4] is not None: yieldstr = ",%d" % (stackusage + callinfo[4]) print " %04s:%-40s [%d+%d,%d%s]" % ( insnaddr, callinfo[0], stackusage, callinfo[1] , stackusage+callinfo[2], yieldstr) def main(): calc() if __name__ == '__main__': main() tinyvisor/bios/tools/checkrom.py0000755006644000001440000000550312172661303017334 0ustar yuichi_xyusers#!/usr/bin/env python # Script to check a bios image and report info on it. # # Copyright (C) 2008 Kevin O'Connor # # This file may be distributed under the terms of the GNU GPLv3 license. import sys import layoutrom def subst(data, offset, new): return data[:offset] + new + data[offset + len(new):] def checksum(data, start, size, csum): sumbyte = 0 while size: sumbyte = sumbyte + ord(data[start + size - 1]) size = size - 1 sumbyte = (0x100 - sumbyte) & 0xff return subst(data, start+csum, chr(sumbyte)) def main(): # Get args objinfo, rawfile, outfile = sys.argv[1:] # Read in symbols objinfofile = open(objinfo, 'rb') symbols = layoutrom.parseObjDump(objinfofile, 'in')[1] # Read in raw file f = open(rawfile, 'rb') rawdata = f.read() f.close() datasize = len(rawdata) finalsize = 64*1024 if datasize > 64*1024: finalsize = 128*1024 if datasize > 128*1024: finalsize = 256*1024 # Sanity checks start = symbols['code32flat_start'].offset end = symbols['code32flat_end'].offset expend = layoutrom.BUILD_BIOS_ADDR + layoutrom.BUILD_BIOS_SIZE if end != expend: print "Error! Code does not end at 0x%x (got 0x%x)" % ( expend, end) sys.exit(1) if datasize > finalsize: print "Error! Code is too big (0x%x vs 0x%x)" % ( datasize, finalsize) sys.exit(1) expdatasize = end - start if datasize != expdatasize: print "Error! Unknown extra data (0x%x vs 0x%x)" % ( datasize, expdatasize) sys.exit(1) # Fix up CSM Compatibility16 table if 'csm_compat_table' in symbols and 'entry_csm' in symbols: # Field offsets within EFI_COMPATIBILITY16_TABLE ENTRY_FIELD_OFS = 14 # Compatibility16CallOffset (UINT16) SIZE_FIELD_OFS = 5 # TableLength (UINT8) CSUM_FIELD_OFS = 4 # TableChecksum (UINT8) tableofs = symbols['csm_compat_table'].offset - symbols['code32flat_start'].offset entry_addr = symbols['entry_csm'].offset - layoutrom.BUILD_BIOS_ADDR byte1 = chr(entry_addr & 0xff) byte2 = chr(entry_addr >> 8) rawdata = subst(rawdata, tableofs+ENTRY_FIELD_OFS, byte1+byte2) tablesize = ord(rawdata[tableofs+SIZE_FIELD_OFS]) rawdata = checksum(rawdata, tableofs, tablesize, CSUM_FIELD_OFS) # Print statistics runtimesize = end - symbols['code32init_end'].offset print "Total size: %d Fixed: %d Free: %d (used %.1f%% of %dKiB rom)" % ( datasize, runtimesize, finalsize - datasize , (datasize / float(finalsize)) * 100.0 , finalsize / 1024) # Write final file f = open(outfile, 'wb') f.write(("\0" * (finalsize - datasize)) + rawdata) f.close() if __name__ == '__main__': main() tinyvisor/bios/tools/transdump.py0000755006644000001440000000231011733257065017557 0ustar yuichi_xyusers#!/usr/bin/env python # This script is useful for taking the output of memdump() and # converting it back into binary output. This can be useful, for # example, when one wants to push that data into other tools like # objdump or hexdump. # # (C) Copyright 2010 Kevin O'Connor # # This file may be distributed under the terms of the GNU GPLv3 license. import sys import struct def unhex(str): return int(str, 16) def parseMem(filehdl): mem = [] for line in filehdl: parts = line.split(':') if len(parts) < 2: continue try: vaddr = unhex(parts[0]) parts = parts[1].split() mem.extend([unhex(v) for v in parts]) except ValueError: continue return mem def printUsage(): sys.stderr.write("Usage:\n %s \n" % (sys.argv[0],)) sys.exit(1) def main(): if len(sys.argv) != 2: printUsage() filename = sys.argv[1] if filename == '-': filehdl = sys.stdin else: filehdl = open(filename, 'r') mem = parseMem(filehdl) for i in mem: sys.stdout.write(struct.pack(" # # This file may be distributed under the terms of the GNU GPLv3 license. # Usage: # tools/readserial.py /dev/ttyUSB0 115200 import sys import time import select import optparse # Reset time counter after this much idle time. RESTARTINTERVAL = 60 # Number of bits in a transmitted byte - 8N1 is 1 start bit + 8 data # bits + 1 stop bit. BITSPERBYTE = 10 def calibrateserialwrite(outfile, byteadjust): # Build 4000 bytes of dummy data. data = "0123456789" * 4 + "012345678" + "\n" data = data * 80 while 1: st = time.time() outfile.write(data) outfile.flush() et = time.time() sys.stdout.write( "Wrote %d - %.1fus per char (theory states %.1fus)\n" % ( len(data), (et-st) / len(data) * 1000000, byteadjust * 1000000)) sys.stdout.flush() time.sleep(3) def calibrateserialread(infile, byteadjust): starttime = lasttime = 0 totalchars = 0 while 1: select.select([infile], [], []) d = infile.read(4096) curtime = time.time() if curtime - lasttime > 1.0: if starttime and totalchars: sys.stdout.write( "Calibrating on %d bytes - %.1fus per char" " (theory states %.1fus)\n" % ( totalchars, float(lasttime - starttime) * 1000000 / totalchars, byteadjust * 1000000)) totalchars = 0 starttime = curtime else: totalchars += len(d) lasttime = curtime def readserial(infile, logfile, byteadjust): lasttime = 0 while 1: # Read data try: res = select.select([infile, sys.stdin], [], []) except KeyboardInterrupt: sys.stdout.write("\n") break if sys.stdin in res[0]: # Got keyboard input - force reset on next serial input sys.stdin.read(1) lasttime = 0 if len(res[0]) == 1: continue d = infile.read(4096) if not d: break datatime = time.time() datatime -= len(d) * byteadjust # Reset start time if no data for some time if datatime - lasttime > RESTARTINTERVAL: starttime = datatime charcount = 0 isnewline = 1 msg = "\n\n======= %s (adjust=%.1fus)\n" % ( time.asctime(time.localtime(datatime)), byteadjust * 1000000) sys.stdout.write(msg) logfile.write(msg) lasttime = datatime # Translate unprintable chars; add timestamps out = "" for c in d: if isnewline: delta = datatime - starttime - (charcount * byteadjust) out += "%06.3f: " % delta isnewline = 0 oc = ord(c) charcount += 1 datatime += byteadjust if oc == 0x0d: continue if oc == 0x00: out += "<00>\n" isnewline = 1 continue if oc == 0x0a: out += "\n" isnewline = 1 continue if oc < 0x20 or oc >= 0x7f and oc != 0x09: out += "<%02x>" % oc continue out += c sys.stdout.write(out) sys.stdout.flush() logfile.write(out) logfile.flush() def main(): usage = "%prog [options] [ []]" opts = optparse.OptionParser(usage) opts.add_option("-f", "--file", action="store_false", dest="serial", default=True, help="read from file instead of serialdevice") opts.add_option("-n", "--no-adjust", action="store_false", dest="adjustbaud", default=True, help="don't adjust times by serial rate") opts.add_option("-c", "--calibrate-read", action="store_true", dest="calibrate_read", default=False, help="read from serial port to calibrate it") opts.add_option("-C", "--calibrate-write", action="store_true", dest="calibrate_write", default=False, help="write to serial port to calibrate it") opts.add_option("-t", "--time", type="float", dest="time", default=None, help="time to write one byte on serial port (in us)") options, args = opts.parse_args() serialport = 0 baud = 115200 if len(args) > 2: opts.error("Too many arguments") if len(args) > 0: serialport = args[0] if len(args) > 1: baud = int(args[1]) byteadjust = float(BITSPERBYTE) / baud if options.time is not None: byteadjust = options.time / 1000000.0 if not options.adjustbaud: byteadjust = 0.0 if options.serial: # Read from serial port try: import serial except ImportError: print """ Unable to find pyserial package ( http://pyserial.sourceforge.net/ ). On Linux machines try: yum install pyserial Or: apt-get install python-serial """ sys.exit(1) ser = serial.Serial(serialport, baud, timeout=0) else: # Read from a file ser = open(serialport, 'rb') import fcntl import os fcntl.fcntl(ser, fcntl.F_SETFL , fcntl.fcntl(ser, fcntl.F_GETFL) | os.O_NONBLOCK) if options.calibrate_read: calibrateserialread(ser, byteadjust) return if options.calibrate_write: calibrateserialwrite(ser, byteadjust) return logname = time.strftime("seriallog-%Y%m%d_%H%M%S.log") f = open(logname, 'wb') readserial(ser, f, byteadjust) if __name__ == '__main__': main() tinyvisor/bios/tools/acpi_extract_preprocess.py0000755006644000001440000000247011733257065022464 0ustar yuichi_xyusers#!/usr/bin/python # Copyright (C) 2011 Red Hat, Inc., Michael S. Tsirkin # # This file may be distributed under the terms of the GNU GPLv3 license. # Read a preprocessed ASL listing and put each ACPI_EXTRACT # directive in a comment, to make iasl skip it. # We also put each directive on a new line, the machinery # in tools/acpi_extract.py requires this. import re; import sys; import fileinput; def die(diag): sys.stderr.write("Error: %s\n" % (diag)) sys.exit(1) # Note: () around pattern make split return matched string as part of list psplit = re.compile(r''' ( \b # At word boundary ACPI_EXTRACT_\w+ # directive \s+ # some whitespace \w+ # array name )''', re.VERBOSE); lineno = 0 for line in fileinput.input(): # line number and debug string to output in case of errors lineno = lineno + 1 debug = "input line %d: %s" % (lineno, line.rstrip()) s = psplit.split(line); # The way split works, each odd item is the matching ACPI_EXTRACT directive. # Put each in a comment, and on a line by itself. for i in range(len(s)): if (i % 2): sys.stdout.write("\n/* %s */\n" % s[i]) else: sys.stdout.write(s[i]) tinyvisor/bios/tools/vgafixup.py0000644006644000001440000000236312172661303017370 0ustar yuichi_xyusers#!/usr/bin/env python # Work around x86emu bugs by replacing problematic instructions. # # Copyright (C) 2012 Kevin O'Connor # # This file may be distributed under the terms of the GNU GPLv3 license. # The x86emu code widely used in Linux distributions when running Xorg # in vesamode is known to have issues with "retl", "leavel", "entryl", # and some variants of "calll". This code modifies those instructions # (ret and leave) that are known to be generated by gcc to avoid # triggering the x86emu bugs. # It is also known that the Windows vgabios emulator has issues with # addressing negative offsets to the %esp register. That has been # worked around by not using the gcc parameter "-fomit-frame-pointer" # when compiling. import sys def main(): infilename, outfilename = sys.argv[1:] infile = open(infilename, 'rb') out = [] for line in infile: sline = line.strip() if sline == 'ret': out.append('retw $2\n') elif sline == 'leave': out.append('movl %ebp, %esp ; popl %ebp\n') else: out.append(line) infile.close() outfile = open(outfilename, 'wb') outfile.write(''.join(out)) outfile.close() if __name__ == '__main__': main() tinyvisor/bios/tools/layoutrom.py0000755006644000001440000006224512172661303017602 0ustar yuichi_xyusers#!/usr/bin/env python # Script to analyze code and arrange ld sections. # # Copyright (C) 2008-2010 Kevin O'Connor # # This file may be distributed under the terms of the GNU GPLv3 license. import sys # LD script headers/trailers COMMONHEADER = """ /* DO NOT EDIT! This is an autogenerated file. See tools/layoutrom.py. */ OUTPUT_FORMAT("elf32-i386") OUTPUT_ARCH("i386") SECTIONS { """ COMMONTRAILER = """ /* Discard regular data sections to force a link error if * code attempts to access data not marked with VAR16 (or other * appropriate macro) */ /DISCARD/ : { *(.text*) *(.data*) *(.bss*) *(.rodata*) *(COMMON) *(.discard*) *(.eh_frame) *(.note*) } } """ ###################################################################### # Determine section locations ###################################################################### # Align 'pos' to 'alignbytes' offset def alignpos(pos, alignbytes): mask = alignbytes - 1 return (pos + mask) & ~mask # Determine the final addresses for a list of sections that end at an # address. def setSectionsStart(sections, endaddr, minalign=1, segoffset=0): totspace = 0 for section in sections: if section.align > minalign: minalign = section.align totspace = alignpos(totspace, section.align) + section.size startaddr = (endaddr - totspace) / minalign * minalign curaddr = startaddr for section in sections: curaddr = alignpos(curaddr, section.align) section.finalloc = curaddr section.finalsegloc = curaddr - segoffset curaddr += section.size return startaddr, minalign # The 16bit code can't exceed 64K of space. BUILD_BIOS_ADDR = 0xf0000 BUILD_BIOS_SIZE = 0x10000 BUILD_ROM_START = 0xc0000 # Space to reserve in f-segment for dynamic allocations BUILD_MIN_BIOSTABLE = 2048 # Layout the 16bit code. This ensures sections with fixed offset # requirements are placed in the correct location. It also places the # 16bit code as high as possible in the f-segment. def fitSections(sections, fillsections): # fixedsections = [(addr, section), ...] fixedsections = [] for section in sections: if section.name.startswith('.fixedaddr.'): addr = int(section.name[11:], 16) section.finalloc = addr + BUILD_BIOS_ADDR section.finalsegloc = addr fixedsections.append((addr, section)) if section.align != 1: print "Error: Fixed section %s has non-zero alignment (%d)" % ( section.name, section.align) sys.exit(1) fixedsections.sort() firstfixed = fixedsections[0][0] # Find freespace in fixed address area # fixedAddr = [(freespace, section), ...] fixedAddr = [] for i in range(len(fixedsections)): fixedsectioninfo = fixedsections[i] addr, section = fixedsectioninfo if i == len(fixedsections) - 1: nextaddr = BUILD_BIOS_SIZE else: nextaddr = fixedsections[i+1][0] avail = nextaddr - addr - section.size fixedAddr.append((avail, section)) fixedAddr.sort() # Attempt to fit other sections into fixed area canrelocate = [(section.size, section.align, section.name, section) for section in fillsections] canrelocate.sort() canrelocate = [section for size, align, name, section in canrelocate] totalused = 0 for freespace, fixedsection in fixedAddr: addpos = fixedsection.finalsegloc + fixedsection.size totalused += fixedsection.size nextfixedaddr = addpos + freespace # print "Filling section %x uses %d, next=%x, available=%d" % ( # fixedsection.finalloc, fixedsection.size, nextfixedaddr, freespace) while 1: canfit = None for fitsection in canrelocate: if addpos + fitsection.size > nextfixedaddr: # Can't fit and nothing else will fit. break fitnextaddr = alignpos(addpos, fitsection.align) + fitsection.size # print "Test %s - %x vs %x" % ( # fitsection.name, fitnextaddr, nextfixedaddr) if fitnextaddr > nextfixedaddr: # This item can't fit. continue canfit = (fitnextaddr, fitsection) if canfit is None: break # Found a section that can fit. fitnextaddr, fitsection = canfit canrelocate.remove(fitsection) fitsection.finalloc = addpos + BUILD_BIOS_ADDR fitsection.finalsegloc = addpos addpos = fitnextaddr totalused += fitsection.size # print " Adding %s (size %d align %d) pos=%x avail=%d" % ( # fitsection[2], fitsection[0], fitsection[1] # , fitnextaddr, nextfixedaddr - fitnextaddr) # Report stats total = BUILD_BIOS_SIZE-firstfixed slack = total - totalused print ("Fixed space: 0x%x-0x%x total: %d slack: %d" " Percent slack: %.1f%%" % ( firstfixed, BUILD_BIOS_SIZE, total, slack, (float(slack) / total) * 100.0)) return firstfixed + BUILD_BIOS_ADDR # Return the subset of sections with a given category def getSectionsCategory(sections, category): return [section for section in sections if section.category == category] # Return the subset of sections with a given name prefix def getSectionsPrefix(sections, prefix): return [section for section in sections if section.name.startswith(prefix)] # The sections (and associated information) to be placed in output rom class LayoutInfo: genreloc = None sections16 = sec16_start = sec16_align = None sections32seg = sec32seg_start = sec32seg_align = None sections32flat = sec32flat_start = sec32flat_align = None sections32init = sec32init_start = sec32init_align = None sections32low = sec32low_start = sec32low_align = None sections32fseg = sec32fseg_start = sec32fseg_align = None zonefseg_start = zonefseg_end = None zonelow_base = final_sec32low_start = None exportsyms = varlowsyms = None # Determine final memory addresses for sections def doLayout(sections): li = LayoutInfo() # Determine 16bit positions li.sections16 = getSectionsCategory(sections, '16') textsections = getSectionsPrefix(li.sections16, '.text.') rodatasections = ( getSectionsPrefix(li.sections16, '.rodata.str1.1') + getSectionsPrefix(li.sections16, '.rodata.__func__.') + getSectionsPrefix(li.sections16, '.rodata.__PRETTY_FUNCTION__.')) datasections = getSectionsPrefix(li.sections16, '.data16.') fixedsections = getSectionsPrefix(li.sections16, '.fixedaddr.') firstfixed = fitSections(fixedsections, textsections) remsections = [s for s in textsections+rodatasections+datasections if s.finalloc is None] li.sec16_start, li.sec16_align = setSectionsStart( remsections, firstfixed, segoffset=BUILD_BIOS_ADDR) # Determine 32seg positions li.sections32seg = getSectionsCategory(sections, '32seg') textsections = getSectionsPrefix(li.sections32seg, '.text.') rodatasections = ( getSectionsPrefix(li.sections32seg, '.rodata.str1.1') + getSectionsPrefix(li.sections32seg, '.rodata.__func__.') + getSectionsPrefix(li.sections32seg, '.rodata.__PRETTY_FUNCTION__.')) datasections = getSectionsPrefix(li.sections32seg, '.data32seg.') li.sec32seg_start, li.sec32seg_align = setSectionsStart( textsections + rodatasections + datasections, li.sec16_start , segoffset=BUILD_BIOS_ADDR) # Determine "fseg memory" data positions li.sections32fseg = getSectionsCategory(sections, '32fseg') li.sec32fseg_start, li.sec32fseg_align = setSectionsStart( li.sections32fseg, li.sec32seg_start, 16 , segoffset=BUILD_BIOS_ADDR) # Determine 32flat runtime positions li.sections32flat = getSectionsCategory(sections, '32flat') textsections = getSectionsPrefix(li.sections32flat, '.text.') rodatasections = getSectionsPrefix(li.sections32flat, '.rodata') datasections = getSectionsPrefix(li.sections32flat, '.data.') bsssections = getSectionsPrefix(li.sections32flat, '.bss.') li.sec32flat_start, li.sec32flat_align = setSectionsStart( textsections + rodatasections + datasections + bsssections , li.sec32fseg_start, 16) li.zonefseg_end = li.sec32flat_start li.zonefseg_start = BUILD_BIOS_ADDR if li.zonefseg_start + BUILD_MIN_BIOSTABLE > li.zonefseg_end: # Not enough ZoneFSeg space - force a minimum space. li.zonefseg_end = li.sec32fseg_start li.zonefseg_start = li.zonefseg_end - BUILD_MIN_BIOSTABLE li.sec32flat_start, li.sec32flat_align = setSectionsStart( textsections + rodatasections + datasections + bsssections , li.zonefseg_start, 16) # Determine 32flat init positions li.sections32init = getSectionsCategory(sections, '32init') textsections = getSectionsPrefix(li.sections32init, '.text.') rodatasections = getSectionsPrefix(li.sections32init, '.rodata') datasections = getSectionsPrefix(li.sections32init, '.data.') bsssections = getSectionsPrefix(li.sections32init, '.bss.') li.sec32init_start, li.sec32init_align = setSectionsStart( textsections + rodatasections + datasections + bsssections , li.sec32flat_start, 16) # Determine "low memory" data positions li.sections32low = getSectionsCategory(sections, '32low') sec32low_end = li.sec32init_start final_sec32low_end = min(BUILD_BIOS_ADDR, li.sec32flat_start) relocdelta = final_sec32low_end - sec32low_end zonelow_base = final_sec32low_end - 64*1024 li.zonelow_base = max(BUILD_ROM_START, alignpos(zonelow_base, 2*1024)) li.sec32low_start, li.sec32low_align = setSectionsStart( li.sections32low, sec32low_end, 16 , segoffset=li.zonelow_base - relocdelta) li.final_sec32low_start = li.sec32low_start + relocdelta # Print statistics size16 = BUILD_BIOS_ADDR + BUILD_BIOS_SIZE - li.sec16_start size32seg = li.sec16_start - li.sec32seg_start size32fseg = li.sec32seg_start - li.sec32fseg_start size32flat = li.sec32fseg_start - li.sec32flat_start size32init = li.sec32flat_start - li.sec32init_start sizelow = sec32low_end - li.sec32low_start print "16bit size: %d" % size16 print "32bit segmented size: %d" % size32seg print "32bit flat size: %d" % size32flat print "32bit flat init size: %d" % size32init print "Lowmem size: %d" % sizelow print "f-segment var size: %d" % size32fseg return li ###################################################################### # Linker script output ###################################################################### # Write LD script includes for the given cross references def outXRefs(sections, useseg=0, exportsyms=[], forcedelta=0): xrefs = dict([(symbol.name, symbol) for symbol in exportsyms]) out = "" for section in sections: for reloc in section.relocs: symbol = reloc.symbol if (symbol.section is not None and (symbol.section.fileid != section.fileid or symbol.name != reloc.symbolname)): xrefs[reloc.symbolname] = symbol for symbolname, symbol in xrefs.items(): loc = symbol.section.finalloc if useseg: loc = symbol.section.finalsegloc out += "%s = 0x%x ;\n" % (symbolname, loc + forcedelta + symbol.offset) return out # Write LD script includes for the given sections using relative offsets def outRelSections(sections, startsym, useseg=0): sections = [(section.finalloc, section) for section in sections if section.finalloc is not None] sections.sort() out = "" for addr, section in sections: loc = section.finalloc if useseg: loc = section.finalsegloc out += ". = ( 0x%x - %s ) ;\n" % (loc, startsym) if section.name == '.rodata.str1.1': out += "_rodata = . ;\n" out += "*(%s)\n" % (section.name,) return out # Build linker script output for a list of relocations. def strRelocs(outname, outrel, relocs): relocs.sort() return (" %s_start = ABSOLUTE(.) ;\n" % (outname,) + "".join(["LONG(0x%x - %s)\n" % (pos, outrel) for pos in relocs]) + " %s_end = ABSOLUTE(.) ;\n" % (outname,)) # Find all relocations in the given sections with the given attributes def getRelocs(sections, type=None, category=None, notcategory=None): out = [] for section in sections: for reloc in section.relocs: if reloc.symbol.section is None: continue destcategory = reloc.symbol.section.category if ((type is None or reloc.type == type) and (category is None or destcategory == category) and (notcategory is None or destcategory != notcategory)): out.append(section.finalloc + reloc.offset) return out # Return the start address and minimum alignment for a set of sections def getSectionsStart(sections, defaddr=0): return min([section.finalloc for section in sections if section.finalloc is not None] or [defaddr]) # Output the linker scripts for all required sections. def writeLinkerScripts(li, out16, out32seg, out32flat): # Write 16bit linker script out = outXRefs(li.sections16, useseg=1) + """ zonelow_base = 0x%x ; _zonelow_seg = 0x%x ; code16_start = 0x%x ; .text16 code16_start : { %s } """ % (li.zonelow_base, li.zonelow_base / 16, li.sec16_start - BUILD_BIOS_ADDR, outRelSections(li.sections16, 'code16_start', useseg=1)) outfile = open(out16, 'wb') outfile.write(COMMONHEADER + out + COMMONTRAILER) outfile.close() # Write 32seg linker script out = outXRefs(li.sections32seg, useseg=1) + """ code32seg_start = 0x%x ; .text32seg code32seg_start : { %s } """ % (li.sec32seg_start - BUILD_BIOS_ADDR, outRelSections(li.sections32seg, 'code32seg_start', useseg=1)) outfile = open(out32seg, 'wb') outfile.write(COMMONHEADER + out + COMMONTRAILER) outfile.close() # Write 32flat linker script sections32all = (li.sections32flat + li.sections32init + li.sections32fseg) sec32all_start = li.sec32low_start relocstr = "" if li.genreloc: # Generate relocations absrelocs = getRelocs( li.sections32init, type='R_386_32', category='32init') relrelocs = getRelocs( li.sections32init, type='R_386_PC32', notcategory='32init') initrelocs = getRelocs( li.sections32flat + li.sections32low + li.sections16 + li.sections32seg + li.sections32fseg, category='32init') relocstr = (strRelocs("_reloc_abs", "code32init_start", absrelocs) + strRelocs("_reloc_rel", "code32init_start", relrelocs) + strRelocs("_reloc_init", "code32flat_start", initrelocs)) numrelocs = len(absrelocs + relrelocs + initrelocs) sec32all_start -= numrelocs * 4 out = outXRefs(li.sections32low, exportsyms=li.varlowsyms , forcedelta=li.final_sec32low_start-li.sec32low_start) out += outXRefs(sections32all, exportsyms=li.exportsyms) + """ _reloc_min_align = 0x%x ; zonefseg_start = 0x%x ; zonefseg_end = 0x%x ; zonelow_base = 0x%x ; final_varlow_start = 0x%x ; code32flat_start = 0x%x ; .text code32flat_start : { %s varlow_start = ABSOLUTE(.) ; %s varlow_end = ABSOLUTE(.) ; code32init_start = ABSOLUTE(.) ; %s code32init_end = ABSOLUTE(.) ; %s %s . = ( 0x%x - code32flat_start ) ; *(.text32seg) . = ( 0x%x - code32flat_start ) ; *(.text16) code32flat_end = ABSOLUTE(.) ; } :text """ % (li.sec32init_align, li.zonefseg_start, li.zonefseg_end, li.zonelow_base, li.final_sec32low_start, sec32all_start, relocstr, outRelSections(li.sections32low, 'code32flat_start'), outRelSections(li.sections32init, 'code32flat_start'), outRelSections(li.sections32flat, 'code32flat_start'), outRelSections(li.sections32fseg, 'code32flat_start'), li.sec32seg_start, li.sec16_start) out = COMMONHEADER + out + COMMONTRAILER + """ ENTRY(entry_elf) PHDRS { text PT_LOAD AT ( code32flat_start ) ; } """ outfile = open(out32flat, 'wb') outfile.write(out) outfile.close() ###################################################################### # Detection of init code ###################################################################### def markRuntime(section, sections, chain=[]): if (section is None or not section.keep or section.category is not None or '.init.' in section.name or section.fileid != '32flat'): return if '.data.varinit.' in section.name: print "ERROR: %s is VARVERIFY32INIT but used from %s" % ( section.name, chain) sys.exit(1) section.category = '32flat' # Recursively mark all sections this section points to for reloc in section.relocs: markRuntime(reloc.symbol.section, sections, chain + [section.name]) def findInit(sections, genreloc): # Recursively find and mark all "runtime" sections. for section in sections: if ('.data.varlow.' in section.name or '.data.varfseg.' in section.name or '.runtime.' in section.name or '.export.' in section.name): markRuntime(section, sections) for section in sections: if section.category is not None: continue if section.fileid == '32flat' and genreloc: section.category = '32init' else: section.category = section.fileid ###################################################################### # Section garbage collection ###################################################################### CFUNCPREFIX = [('_cfunc16_', 0), ('_cfunc32seg_', 1), ('_cfunc32flat_', 2)] # Find and keep the section associated with a symbol (if available). def keepsymbol(reloc, infos, pos, isxref): symbolname = reloc.symbolname mustbecfunc = 0 for symprefix, needpos in CFUNCPREFIX: if symbolname.startswith(symprefix): if needpos != pos: return -1 symbolname = symbolname[len(symprefix):] mustbecfunc = 1 break symbol = infos[pos][1].get(symbolname) if (symbol is None or symbol.section is None or symbol.section.name.startswith('.discard.')): return -1 isdestcfunc = (symbol.section.name.startswith('.text.') and not symbol.section.name.startswith('.text.asm.')) if ((mustbecfunc and not isdestcfunc) or (not mustbecfunc and isdestcfunc and isxref)): return -1 reloc.symbol = symbol keepsection(symbol.section, infos, pos) return 0 # Note required section, and recursively set all referenced sections # as required. def keepsection(section, infos, pos=0): if section.keep: # Already kept - nothing to do. return section.keep = 1 # Keep all sections that this section points to for reloc in section.relocs: ret = keepsymbol(reloc, infos, pos, 0) if not ret: continue # Not in primary sections - it may be a cross 16/32 reference ret = keepsymbol(reloc, infos, (pos+1)%3, 1) if not ret: continue ret = keepsymbol(reloc, infos, (pos+2)%3, 1) if not ret: continue # Determine which sections are actually referenced and need to be # placed into the output file. def gc(info16, info32seg, info32flat): # infos = ((sections16, symbols16), (sect32seg, sym32seg) # , (sect32flat, sym32flat)) infos = (info16, info32seg, info32flat) # Start by keeping sections that are globally visible. for section in info16[0]: if section.name.startswith('.fixedaddr.') or '.export.' in section.name: keepsection(section, infos) return [section for section in info16[0]+info32seg[0]+info32flat[0] if section.keep] ###################################################################### # Startup and input parsing ###################################################################### class Section: name = size = alignment = fileid = relocs = None finalloc = finalsegloc = category = keep = None class Reloc: offset = type = symbolname = symbol = None class Symbol: name = offset = section = None # Read in output from objdump def parseObjDump(file, fileid): # sections = [section, ...] sections = [] sectionmap = {} # symbols[symbolname] = symbol symbols = {} state = None for line in file.readlines(): line = line.rstrip() if line == 'Sections:': state = 'section' continue if line == 'SYMBOL TABLE:': state = 'symbol' continue if line.startswith('RELOCATION RECORDS FOR ['): sectionname = line[24:-2] if sectionname.startswith('.debug_'): # Skip debugging sections (to reduce parsing time) state = None continue state = 'reloc' relocsection = sectionmap[sectionname] continue if state == 'section': try: idx, name, size, vma, lma, fileoff, align = line.split() if align[:3] != '2**': continue section = Section() section.name = name section.size = int(size, 16) section.align = 2**int(align[3:]) section.fileid = fileid section.relocs = [] sections.append(section) sectionmap[name] = section except ValueError: pass continue if state == 'symbol': try: parts = line[17:].split() if len(parts) == 3: sectionname, size, name = parts elif len(parts) == 4 and parts[2] == '.hidden': sectionname, size, hidden, name = parts else: continue symbol = Symbol() symbol.size = int(size, 16) symbol.offset = int(line[:8], 16) symbol.name = name symbol.section = sectionmap.get(sectionname) symbols[name] = symbol except ValueError: pass continue if state == 'reloc': try: off, type, symbolname = line.split() reloc = Reloc() reloc.offset = int(off, 16) reloc.type = type reloc.symbolname = symbolname reloc.symbol = symbols.get(symbolname) if reloc.symbol is None: # Some binutils (2.20.1) give section name instead # of a symbol - create a dummy symbol. reloc.symbol = symbol = Symbol() symbol.size = 0 symbol.offset = 0 symbol.name = symbolname symbol.section = sectionmap.get(symbolname) symbols[symbolname] = symbol relocsection.relocs.append(reloc) except ValueError: pass return sections, symbols def main(): # Get output name in16, in32seg, in32flat, out16, out32seg, out32flat = sys.argv[1:] # Read in the objdump information infile16 = open(in16, 'rb') infile32seg = open(in32seg, 'rb') infile32flat = open(in32flat, 'rb') # infoX = (sections, symbols) info16 = parseObjDump(infile16, '16') info32seg = parseObjDump(infile32seg, '32seg') info32flat = parseObjDump(infile32flat, '32flat') # Figure out which sections to keep. sections = gc(info16, info32seg, info32flat) # Separate 32bit flat into runtime and init parts genreloc = '_reloc_abs_start' in info32flat[1] findInit(sections, genreloc) # Note "low memory" and "fseg memory" parts for section in getSectionsPrefix(sections, '.data.varlow.'): section.category = '32low' for section in getSectionsPrefix(sections, '.data.varfseg.'): section.category = '32fseg' # Determine the final memory locations of each kept section. li = doLayout(sections) li.genreloc = genreloc # Exported symbols li.exportsyms = [symbol for symbol in info16[1].values() if (symbol.section is not None and '.export.' in symbol.section.name and symbol.name != symbol.section.name)] li.varlowsyms = [symbol for symbol in info32flat[1].values() if (symbol.section is not None and symbol.section.finalloc is not None and '.data.varlow.' in symbol.section.name and symbol.name != symbol.section.name)] # Write out linker script files. writeLinkerScripts(li, out16, out32seg, out32flat) if __name__ == '__main__': main() tinyvisor/bios/tools/checksum.py0000755006644000001440000000053711733257065017355 0ustar yuichi_xyusers#!/usr/bin/env python # Script to report the checksum of a file. # # Copyright (C) 2009 Kevin O'Connor # # This file may be distributed under the terms of the GNU GPLv3 license. import sys def main(): data = sys.stdin.read() ords = map(ord, data) print "sum=%x\n" % sum(ords) if __name__ == '__main__': main() tinyvisor/bios/tools/test-build.sh0000755006644000001440000000641412172661303017601 0ustar yuichi_xyusers#!/bin/sh # Script to test if the build works properly. # Test IASL is installed. $IASL -h > /dev/null 2>&1 if [ $? -ne 0 ]; then echo "The SeaBIOS project requires the 'iasl' package be installed." >&2 echo "Many Linux distributions have this package." >&2 echo "Try: sudo yum install iasl" >&2 echo "Or: sudo apt-get install iasl" >&2 echo "" >&2 echo "Please install iasl and retry." >&2 echo -1 exit 0 fi mkdir -p ${OUT} TMPFILE1=${OUT}/tmp_testcompile1.c TMPFILE1o=${OUT}/tmp_testcompile1.o TMPFILE1_ld=${OUT}/tmp_testcompile1.lds TMPFILE2=${OUT}/tmp_testcompile2.c TMPFILE2o=${OUT}/tmp_testcompile2.o TMPFILE3o=${OUT}/tmp_testcompile3.o # Test if ld's alignment handling is correct. This is a known problem # with the linker that ships with Ubuntu 11.04. cat - > $TMPFILE1 < $TMPFILE1_ld < /dev/null 2>&1 if [ $? -ne 0 ]; then echo "Unable to execute the C compiler ($CC)." >&2 echo "" >&2 echo "Please install a working compiler and retry." >&2 echo -1 exit 0 fi $LD -T $TMPFILE1_ld $TMPFILE1o -o $TMPFILE2o > /dev/null 2>&1 if [ $? -ne 0 ]; then echo "The version of LD on this system ($LD) does not properly handle" >&2 echo "alignments. As a result, this project can not be built." >&2 echo "" >&2 echo "The problem may be the result of this LD bug report:" >&2 echo " http://sourceware.org/bugzilla/show_bug.cgi?id=12726" >&2 echo "" >&2 echo "Please update to a working version of binutils and retry." >&2 echo -1 exit 0 fi # Test for "-fwhole-program". Older versions of gcc (pre v4.1) don't # support the whole-program optimization - detect that. $CC -fwhole-program -S -o /dev/null -xc /dev/null > /dev/null 2>&1 if [ $? -ne 0 ]; then echo " Working around no -fwhole-program" >&2 echo 2 exit 0 fi # Test if "visible" variables and functions are marked global. On # OpenSuse 10.3 "visible" variables declared with "extern" first # aren't marked as global in the resulting assembler. On Ubuntu 7.10 # "visible" functions aren't marked as global in the resulting # assembler. cat - > $TMPFILE1 < /dev/null 2>&1 cat - > $TMPFILE2 < /dev/null 2>&1 $CC -nostdlib -Os $TMPFILE1o $TMPFILE2o -o $TMPFILE3o > /dev/null 2>&1 if [ $? -ne 0 ]; then echo " Working around non-functional -fwhole-program" >&2 echo 2 exit 0 fi echo 0 # Also, the Ubuntu 8.04 compiler has a bug causing corruption when the # "ebp" register is clobberred in an "asm" statement. The code has # been modified to not clobber "ebp" - no test is available yet. rm -f $TMPFILE1 $TMPFILE1o $TMPFILE1_ld $TMPFILE2 $TMPFILE2o $TMPFILE3o tinyvisor/bios/tools/encodeint.py0000755006644000001440000000070011733257065017513 0ustar yuichi_xyusers#!/usr/bin/env python # Encode an integer in little endian format in a file. # # Copyright (C) 2011 Kevin O'Connor # # This file may be distributed under the terms of the GNU GPLv3 license. import sys import struct def main(): filename = sys.argv[1] value = int(sys.argv[2]) outval = struct.pack(' # # This file may be distributed under the terms of the GNU GPLv3 license. import sys def alignpos(pos, alignbytes): mask = alignbytes - 1 return (pos + mask) & ~mask def checksum(data): ords = map(ord, data) return sum(ords) def main(): inname = sys.argv[1] outname = sys.argv[2] # Read data in f = open(inname, 'rb') data = f.read() f.close() count = len(data) # Pad to a 512 byte boundary data += "\0" * (alignpos(count, 512) - count) count = len(data) # Check if a pci header is present pcidata = ord(data[24:25]) + (ord(data[25:26]) << 8) if pcidata != 0: data = data[:pcidata + 16] + chr(count/512) + chr(0) + data[pcidata + 18:] # Fill in size field; clear checksum field data = data[:2] + chr(count/512) + data[3:6] + "\0" + data[7:] # Checksum rom newsum = (256 - checksum(data)) & 0xff data = data[:6] + chr(newsum) + data[7:] # Write new rom f = open(outname, 'wb') f.write(data) f.close() if __name__ == '__main__': main() tinyvisor/bios/tools/buildversion.sh0000755006644000001440000000106612174763154020241 0ustar yuichi_xyusers#!/bin/sh # Script to generate a C file with version information. OUTFILE="$1" VAR16MODE="$2" # Extract version info if [ -d .git ]; then VERSION="`git describe --tags --long --dirty`" elif [ -f .version ]; then VERSION="`cat .version`" else VERSION="?" fi VERSION="${VERSION}-tinyvisor-`date +"%Y%m%d_%H%M%S"`" echo "Version: ${VERSION}" # Build header file if [ "$VAR16MODE" = "VAR16" ]; then cat > ${OUTFILE} < ${OUTFILE} < "$OUTFILE" </{s:->#\(.*\):/* \1 */:; \ s:^->\([^ ]*\) [\$\#]*\([^ ]*\) \(.*\):#define \1 \2 /* \3 */:; \ s:->::; p;}" < "$INFILE" >> "$OUTFILE" cat >> "$OUTFILE" < # # This file may be distributed under the terms of the GNU GPLv3 license. # Process mixed ASL/AML listing (.lst file) produced by iasl -l # Locate and execute ACPI_EXTRACT directives, output offset info # # Documentation of ACPI_EXTRACT_* directive tags: # # These directive tags output offset information from AML for BIOS runtime # table generation. # Each directive is of the form: # ACPI_EXTRACT_ (...) # and causes the extractor to create an array # named with offset, in the generated AML, # of an object of a given type in the following . # # A directive must fit on a single code line. # # Object type in AML is verified, a mismatch causes a build failure. # # Directives and operators currently supported are: # ACPI_EXTRACT_NAME_DWORD_CONST - extract a Dword Const object from Name() # ACPI_EXTRACT_NAME_WORD_CONST - extract a Word Const object from Name() # ACPI_EXTRACT_NAME_BYTE_CONST - extract a Byte Const object from Name() # ACPI_EXTRACT_METHOD_STRING - extract a NameString from Method() # ACPI_EXTRACT_NAME_STRING - extract a NameString from Name() # ACPI_EXTRACT_PROCESSOR_START - start of Processor() block # ACPI_EXTRACT_PROCESSOR_STRING - extract a NameString from Processor() # ACPI_EXTRACT_PROCESSOR_END - offset at last byte of Processor() + 1 # ACPI_EXTRACT_PKG_START - start of Package block # # ACPI_EXTRACT_ALL_CODE - create an array storing the generated AML bytecode # # ACPI_EXTRACT is not allowed anywhere else in code, except in comments. import re; import sys; import fileinput; aml = [] asl = [] output = {} debug = "" class asl_line: line = None lineno = None aml_offset = None def die(diag): sys.stderr.write("Error: %s; %s\n" % (diag, debug)) sys.exit(1) #Store an ASL command, matching AML offset, and input line (for debugging) def add_asl(lineno, line): l = asl_line() l.line = line l.lineno = lineno l.aml_offset = len(aml) asl.append(l) #Store an AML byte sequence #Verify that offset output by iasl matches # of bytes so far def add_aml(offset, line): o = int(offset, 16); # Sanity check: offset must match size of code so far if (o != len(aml)): die("Offset 0x%x != 0x%x" % (o, len(aml))) # Strip any trailing dots and ASCII dump after " line = re.sub(r'\s*\.*\s*".*$',"", line) # Strip traling whitespace line = re.sub(r'\s+$',"", line) # Strip leading whitespace line = re.sub(r'^\s+',"", line) # Split on whitespace code = re.split(r'\s+', line) for c in code: # Require a legal hex number, two digits if (not(re.search(r'^[0-9A-Fa-f][0-9A-Fa-f]$', c))): die("Unexpected octet %s" % c); aml.append(int(c, 16)); # Process aml bytecode array, decoding AML def aml_pkglen_bytes(offset): # PkgLength can be multibyte. Bits 8-7 give the # of extra bytes. pkglenbytes = aml[offset] >> 6; return pkglenbytes + 1 def aml_pkglen(offset): pkgstart = offset pkglenbytes = aml_pkglen_bytes(offset) pkglen = aml[offset] & 0x3F # If multibyte, first nibble only uses bits 0-3 if ((pkglenbytes > 1) and (pkglen & 0x30)): die("PkgLen bytes 0x%x but first nibble 0x%x expected 0x0X" % (pkglen, pkglen)) offset += 1 pkglenbytes -= 1 for i in range(pkglenbytes): pkglen |= aml[offset + i] << (i * 8 + 4) if (len(aml) < pkgstart + pkglen): die("PckgLen 0x%x at offset 0x%x exceeds AML size 0x%x" % (pkglen, offset, len(aml))) return pkglen # Given method offset, find its NameString offset def aml_method_string(offset): #0x14 MethodOp PkgLength NameString MethodFlags TermList if (aml[offset] != 0x14): die( "Method offset 0x%x: expected 0x14 actual 0x%x" % (offset, aml[offset])); offset += 1; pkglenbytes = aml_pkglen_bytes(offset) offset += pkglenbytes; return offset; # Given name offset, find its NameString offset def aml_name_string(offset): #0x08 NameOp NameString DataRef if (aml[offset] != 0x08): die( "Name offset 0x%x: expected 0x08 actual 0x%x" % (offset, aml[offset])); offset += 1 # Block Name Modifier. Skip it. if (aml[offset] == 0x5c or aml[offset] == 0x5e): offset += 1 return offset; # Given data offset, find 8 byte buffer offset def aml_data_buffer8(offset): #0x08 NameOp NameString DataRef expect = [0x11, 0x0B, 0x0A, 0x08] if (aml[offset:offset+4] != expect): die( "Name offset 0x%x: expected %s actual %s" % (offset, aml[offset:offset+4], expect)) return offset + len(expect) # Given data offset, find dword const offset def aml_data_dword_const(offset): #0x08 NameOp NameString DataRef if (aml[offset] != 0x0C): die( "Name offset 0x%x: expected 0x0C actual 0x%x" % (offset, aml[offset])); return offset + 1; # Given data offset, find word const offset def aml_data_word_const(offset): #0x08 NameOp NameString DataRef if (aml[offset] != 0x0B): die( "Name offset 0x%x: expected 0x0B actual 0x%x" % (offset, aml[offset])); return offset + 1; # Given data offset, find byte const offset def aml_data_byte_const(offset): #0x08 NameOp NameString DataRef if (aml[offset] != 0x0A): die( "Name offset 0x%x: expected 0x0A actual 0x%x" % (offset, aml[offset])); return offset + 1; # Find name'd buffer8 def aml_name_buffer8(offset): return aml_data_buffer8(aml_name_string(offset) + 4) # Given name offset, find dword const offset def aml_name_dword_const(offset): return aml_data_dword_const(aml_name_string(offset) + 4) # Given name offset, find word const offset def aml_name_word_const(offset): return aml_data_word_const(aml_name_string(offset) + 4) # Given name offset, find byte const offset def aml_name_byte_const(offset): return aml_data_byte_const(aml_name_string(offset) + 4) def aml_device_start(offset): #0x5B 0x82 DeviceOp PkgLength NameString if ((aml[offset] != 0x5B) or (aml[offset + 1] != 0x82)): die( "Name offset 0x%x: expected 0x5B 0x82 actual 0x%x 0x%x" % (offset, aml[offset], aml[offset + 1])); return offset def aml_device_string(offset): #0x5B 0x82 DeviceOp PkgLength NameString start = aml_device_start(offset) offset += 2 pkglenbytes = aml_pkglen_bytes(offset) offset += pkglenbytes return offset def aml_device_end(offset): start = aml_device_start(offset) offset += 2 pkglenbytes = aml_pkglen_bytes(offset) pkglen = aml_pkglen(offset) return offset + pkglen def aml_processor_start(offset): #0x5B 0x83 ProcessorOp PkgLength NameString ProcID if ((aml[offset] != 0x5B) or (aml[offset + 1] != 0x83)): die( "Name offset 0x%x: expected 0x5B 0x83 actual 0x%x 0x%x" % (offset, aml[offset], aml[offset + 1])); return offset def aml_processor_string(offset): #0x5B 0x83 ProcessorOp PkgLength NameString ProcID start = aml_processor_start(offset) offset += 2 pkglenbytes = aml_pkglen_bytes(offset) offset += pkglenbytes return offset def aml_processor_end(offset): start = aml_processor_start(offset) offset += 2 pkglenbytes = aml_pkglen_bytes(offset) pkglen = aml_pkglen(offset) return offset + pkglen def aml_package_start(offset): offset = aml_name_string(offset) + 4 # 0x12 PkgLength NumElements PackageElementList if (aml[offset] != 0x12): die( "Name offset 0x%x: expected 0x12 actual 0x%x" % (offset, aml[offset])); offset += 1 return offset + aml_pkglen_bytes(offset) + 1 lineno = 0 for line in fileinput.input(): # Strip trailing newline line = line.rstrip(); # line number and debug string to output in case of errors lineno = lineno + 1 debug = "input line %d: %s" % (lineno, line) #ASL listing: space, then line#, then ...., then code pasl = re.compile('^\s+([0-9]+)(:\s\s|\.\.\.\.)\s*') m = pasl.search(line) if (m): add_asl(lineno, pasl.sub("", line)); # AML listing: offset in hex, then ...., then code paml = re.compile('^([0-9A-Fa-f]+)(:\s\s|\.\.\.\.)\s*') m = paml.search(line) if (m): add_aml(m.group(1), paml.sub("", line)) # Now go over code # Track AML offset of a previous non-empty ASL command prev_aml_offset = -1 for i in range(len(asl)): debug = "input line %d: %s" % (asl[i].lineno, asl[i].line) l = asl[i].line # skip if not an extract directive a = len(re.findall(r'ACPI_EXTRACT', l)) if (not a): # If not empty, store AML offset. Will be used for sanity checks # IASL seems to put {}. at random places in the listing. # Ignore any non-words for the purpose of this test. m = re.search(r'\w+', l) if (m): prev_aml_offset = asl[i].aml_offset continue if (a > 1): die("Expected at most one ACPI_EXTRACT per line, actual %d" % a) mext = re.search(r''' ^\s* # leading whitespace /\*\s* # start C comment (ACPI_EXTRACT_\w+) # directive: group(1) \s+ # whitspace separates directive from array name (\w+) # array name: group(2) \s*\*/ # end of C comment \s*$ # trailing whitespace ''', l, re.VERBOSE) if (not mext): die("Stray ACPI_EXTRACT in input") # previous command must have produced some AML, # otherwise we are in a middle of a block if (prev_aml_offset == asl[i].aml_offset): die("ACPI_EXTRACT directive in the middle of a block") directive = mext.group(1) array = mext.group(2) offset = asl[i].aml_offset if (directive == "ACPI_EXTRACT_ALL_CODE"): if array in output: die("%s directive used more than once" % directive) output[array] = aml continue if (directive == "ACPI_EXTRACT_NAME_BUFFER8"): offset = aml_name_buffer8(offset) elif (directive == "ACPI_EXTRACT_NAME_DWORD_CONST"): offset = aml_name_dword_const(offset) elif (directive == "ACPI_EXTRACT_NAME_WORD_CONST"): offset = aml_name_word_const(offset) elif (directive == "ACPI_EXTRACT_NAME_BYTE_CONST"): offset = aml_name_byte_const(offset) elif (directive == "ACPI_EXTRACT_NAME_STRING"): offset = aml_name_string(offset) elif (directive == "ACPI_EXTRACT_METHOD_STRING"): offset = aml_method_string(offset) elif (directive == "ACPI_EXTRACT_DEVICE_START"): offset = aml_device_start(offset) elif (directive == "ACPI_EXTRACT_DEVICE_STRING"): offset = aml_device_string(offset) elif (directive == "ACPI_EXTRACT_DEVICE_END"): offset = aml_device_end(offset) elif (directive == "ACPI_EXTRACT_PROCESSOR_START"): offset = aml_processor_start(offset) elif (directive == "ACPI_EXTRACT_PROCESSOR_STRING"): offset = aml_processor_string(offset) elif (directive == "ACPI_EXTRACT_PROCESSOR_END"): offset = aml_processor_end(offset) elif (directive == "ACPI_EXTRACT_PKG_START"): offset = aml_package_start(offset) else: die("Unsupported directive %s" % directive) if array not in output: output[array] = [] output[array].append(offset) debug = "at end of file" def get_value_type(maxvalue): #Use type large enough to fit the table if (maxvalue >= 0x10000): return "int" elif (maxvalue >= 0x100): return "short" else: return "char" # Pretty print output for array in output.keys(): otype = get_value_type(max(output[array])) odata = [] for value in output[array]: odata.append("0x%x" % value) sys.stdout.write("static unsigned %s %s[] = {\n" % (otype, array)) sys.stdout.write(",\n".join(odata)) sys.stdout.write('\n};\n'); tinyvisor/bios/tools/kconfig/0000755006644000001440000000000012206363326016603 5ustar yuichi_xyuserstinyvisor/bios/tools/kconfig/zconf.gperf0000644006644000001440000000254111733243570020753 0ustar yuichi_xyusers%language=ANSI-C %define hash-function-name kconf_id_hash %define lookup-function-name kconf_id_lookup %define string-pool-name kconf_id_strings %compare-strncmp %enum %pic %struct-type struct kconf_id; static struct kconf_id *kconf_id_lookup(register const char *str, register unsigned int len); %% mainmenu, T_MAINMENU, TF_COMMAND menu, T_MENU, TF_COMMAND endmenu, T_ENDMENU, TF_COMMAND source, T_SOURCE, TF_COMMAND choice, T_CHOICE, TF_COMMAND endchoice, T_ENDCHOICE, TF_COMMAND comment, T_COMMENT, TF_COMMAND config, T_CONFIG, TF_COMMAND menuconfig, T_MENUCONFIG, TF_COMMAND help, T_HELP, TF_COMMAND if, T_IF, TF_COMMAND|TF_PARAM endif, T_ENDIF, TF_COMMAND depends, T_DEPENDS, TF_COMMAND optional, T_OPTIONAL, TF_COMMAND default, T_DEFAULT, TF_COMMAND, S_UNKNOWN prompt, T_PROMPT, TF_COMMAND tristate, T_TYPE, TF_COMMAND, S_TRISTATE def_tristate, T_DEFAULT, TF_COMMAND, S_TRISTATE bool, T_TYPE, TF_COMMAND, S_BOOLEAN boolean, T_TYPE, TF_COMMAND, S_BOOLEAN def_bool, T_DEFAULT, TF_COMMAND, S_BOOLEAN int, T_TYPE, TF_COMMAND, S_INT hex, T_TYPE, TF_COMMAND, S_HEX string, T_TYPE, TF_COMMAND, S_STRING select, T_SELECT, TF_COMMAND range, T_RANGE, TF_COMMAND visible, T_VISIBLE, TF_COMMAND option, T_OPTION, TF_COMMAND on, T_ON, TF_PARAM modules, T_OPT_MODULES, TF_OPTION defconfig_list, T_OPT_DEFCONFIG_LIST,TF_OPTION env, T_OPT_ENV, TF_OPTION %% tinyvisor/bios/tools/kconfig/lex.zconf.c_shipped0000644006644000001440000016215611733243570022406 0ustar yuichi_xyusers #line 3 "scripts/kconfig/lex.zconf.c" #define YY_INT_ALIGNED short int /* A lexical scanner generated by flex */ #define yy_create_buffer zconf_create_buffer #define yy_delete_buffer zconf_delete_buffer #define yy_flex_debug zconf_flex_debug #define yy_init_buffer zconf_init_buffer #define yy_flush_buffer zconf_flush_buffer #define yy_load_buffer_state zconf_load_buffer_state #define yy_switch_to_buffer zconf_switch_to_buffer #define yyin zconfin #define yyleng zconfleng #define yylex zconflex #define yylineno zconflineno #define yyout zconfout #define yyrestart zconfrestart #define yytext zconftext #define yywrap zconfwrap #define yyalloc zconfalloc #define yyrealloc zconfrealloc #define yyfree zconffree #define FLEX_SCANNER #define YY_FLEX_MAJOR_VERSION 2 #define YY_FLEX_MINOR_VERSION 5 #define YY_FLEX_SUBMINOR_VERSION 35 #if YY_FLEX_SUBMINOR_VERSION > 0 #define FLEX_BETA #endif /* First, we deal with platform-specific or compiler-specific issues. */ /* begin standard C headers. */ #include #include #include #include /* end standard C headers. */ /* flex integer type definitions */ #ifndef FLEXINT_H #define FLEXINT_H /* C99 systems have . Non-C99 systems may or may not. */ #if defined (__STDC_VERSION__) && __STDC_VERSION__ >= 199901L /* C99 says to define __STDC_LIMIT_MACROS before including stdint.h, * if you want the limit (max/min) macros for int types. */ #ifndef __STDC_LIMIT_MACROS #define __STDC_LIMIT_MACROS 1 #endif #include typedef int8_t flex_int8_t; typedef uint8_t flex_uint8_t; typedef int16_t flex_int16_t; typedef uint16_t flex_uint16_t; typedef int32_t flex_int32_t; typedef uint32_t flex_uint32_t; #else typedef signed char flex_int8_t; typedef short int flex_int16_t; typedef int flex_int32_t; typedef unsigned char flex_uint8_t; typedef unsigned short int flex_uint16_t; typedef unsigned int flex_uint32_t; /* Limits of integral types. */ #ifndef INT8_MIN #define INT8_MIN (-128) #endif #ifndef INT16_MIN #define INT16_MIN (-32767-1) #endif #ifndef INT32_MIN #define INT32_MIN (-2147483647-1) #endif #ifndef INT8_MAX #define INT8_MAX (127) #endif #ifndef INT16_MAX #define INT16_MAX (32767) #endif #ifndef INT32_MAX #define INT32_MAX (2147483647) #endif #ifndef UINT8_MAX #define UINT8_MAX (255U) #endif #ifndef UINT16_MAX #define UINT16_MAX (65535U) #endif #ifndef UINT32_MAX #define UINT32_MAX (4294967295U) #endif #endif /* ! C99 */ #endif /* ! FLEXINT_H */ #ifdef __cplusplus /* The "const" storage-class-modifier is valid. */ #define YY_USE_CONST #else /* ! __cplusplus */ /* C99 requires __STDC__ to be defined as 1. */ #if defined (__STDC__) #define YY_USE_CONST #endif /* defined (__STDC__) */ #endif /* ! __cplusplus */ #ifdef YY_USE_CONST #define yyconst const #else #define yyconst #endif /* Returned upon end-of-file. */ #define YY_NULL 0 /* Promotes a possibly negative, possibly signed char to an unsigned * integer for use as an array index. If the signed char is negative, * we want to instead treat it as an 8-bit unsigned char, hence the * double cast. */ #define YY_SC_TO_UI(c) ((unsigned int) (unsigned char) c) /* Enter a start condition. This macro really ought to take a parameter, * but we do it the disgusting crufty way forced on us by the ()-less * definition of BEGIN. */ #define BEGIN (yy_start) = 1 + 2 * /* Translate the current start state into a value that can be later handed * to BEGIN to return to the state. The YYSTATE alias is for lex * compatibility. */ #define YY_START (((yy_start) - 1) / 2) #define YYSTATE YY_START /* Action number for EOF rule of a given start state. */ #define YY_STATE_EOF(state) (YY_END_OF_BUFFER + state + 1) /* Special action meaning "start processing a new file". */ #define YY_NEW_FILE zconfrestart(zconfin ) #define YY_END_OF_BUFFER_CHAR 0 /* Size of default input buffer. */ #ifndef YY_BUF_SIZE #ifdef __ia64__ /* On IA-64, the buffer size is 16k, not 8k. * Moreover, YY_BUF_SIZE is 2*YY_READ_BUF_SIZE in the general case. * Ditto for the __ia64__ case accordingly. */ #define YY_BUF_SIZE 32768 #else #define YY_BUF_SIZE 16384 #endif /* __ia64__ */ #endif /* The state buf must be large enough to hold one state per character in the main buffer. */ #define YY_STATE_BUF_SIZE ((YY_BUF_SIZE + 2) * sizeof(yy_state_type)) #ifndef YY_TYPEDEF_YY_BUFFER_STATE #define YY_TYPEDEF_YY_BUFFER_STATE typedef struct yy_buffer_state *YY_BUFFER_STATE; #endif extern int zconfleng; extern FILE *zconfin, *zconfout; #define EOB_ACT_CONTINUE_SCAN 0 #define EOB_ACT_END_OF_FILE 1 #define EOB_ACT_LAST_MATCH 2 #define YY_LESS_LINENO(n) /* Return all but the first "n" matched characters back to the input stream. */ #define yyless(n) \ do \ { \ /* Undo effects of setting up zconftext. */ \ int yyless_macro_arg = (n); \ YY_LESS_LINENO(yyless_macro_arg);\ *yy_cp = (yy_hold_char); \ YY_RESTORE_YY_MORE_OFFSET \ (yy_c_buf_p) = yy_cp = yy_bp + yyless_macro_arg - YY_MORE_ADJ; \ YY_DO_BEFORE_ACTION; /* set up zconftext again */ \ } \ while ( 0 ) #define unput(c) yyunput( c, (yytext_ptr) ) #ifndef YY_TYPEDEF_YY_SIZE_T #define YY_TYPEDEF_YY_SIZE_T typedef size_t yy_size_t; #endif #ifndef YY_STRUCT_YY_BUFFER_STATE #define YY_STRUCT_YY_BUFFER_STATE struct yy_buffer_state { FILE *yy_input_file; char *yy_ch_buf; /* input buffer */ char *yy_buf_pos; /* current position in input buffer */ /* Size of input buffer in bytes, not including room for EOB * characters. */ yy_size_t yy_buf_size; /* Number of characters read into yy_ch_buf, not including EOB * characters. */ int yy_n_chars; /* Whether we "own" the buffer - i.e., we know we created it, * and can realloc() it to grow it, and should free() it to * delete it. */ int yy_is_our_buffer; /* Whether this is an "interactive" input source; if so, and * if we're using stdio for input, then we want to use getc() * instead of fread(), to make sure we stop fetching input after * each newline. */ int yy_is_interactive; /* Whether we're considered to be at the beginning of a line. * If so, '^' rules will be active on the next match, otherwise * not. */ int yy_at_bol; int yy_bs_lineno; /**< The line count. */ int yy_bs_column; /**< The column count. */ /* Whether to try to fill the input buffer when we reach the * end of it. */ int yy_fill_buffer; int yy_buffer_status; #define YY_BUFFER_NEW 0 #define YY_BUFFER_NORMAL 1 /* When an EOF's been seen but there's still some text to process * then we mark the buffer as YY_EOF_PENDING, to indicate that we * shouldn't try reading from the input source any more. We might * still have a bunch of tokens to match, though, because of * possible backing-up. * * When we actually see the EOF, we change the status to "new" * (via zconfrestart()), so that the user can continue scanning by * just pointing zconfin at a new input file. */ #define YY_BUFFER_EOF_PENDING 2 }; #endif /* !YY_STRUCT_YY_BUFFER_STATE */ /* Stack of input buffers. */ static size_t yy_buffer_stack_top = 0; /**< index of top of stack. */ static size_t yy_buffer_stack_max = 0; /**< capacity of stack. */ static YY_BUFFER_STATE * yy_buffer_stack = 0; /**< Stack as an array. */ /* We provide macros for accessing buffer states in case in the * future we want to put the buffer states in a more general * "scanner state". * * Returns the top of the stack, or NULL. */ #define YY_CURRENT_BUFFER ( (yy_buffer_stack) \ ? (yy_buffer_stack)[(yy_buffer_stack_top)] \ : NULL) /* Same as previous macro, but useful when we know that the buffer stack is not * NULL or when we need an lvalue. For internal use only. */ #define YY_CURRENT_BUFFER_LVALUE (yy_buffer_stack)[(yy_buffer_stack_top)] /* yy_hold_char holds the character lost when zconftext is formed. */ static char yy_hold_char; static int yy_n_chars; /* number of characters read into yy_ch_buf */ int zconfleng; /* Points to current character in buffer. */ static char *yy_c_buf_p = (char *) 0; static int yy_init = 0; /* whether we need to initialize */ static int yy_start = 0; /* start state number */ /* Flag which is used to allow zconfwrap()'s to do buffer switches * instead of setting up a fresh zconfin. A bit of a hack ... */ static int yy_did_buffer_switch_on_eof; void zconfrestart (FILE *input_file ); void zconf_switch_to_buffer (YY_BUFFER_STATE new_buffer ); YY_BUFFER_STATE zconf_create_buffer (FILE *file,int size ); void zconf_delete_buffer (YY_BUFFER_STATE b ); void zconf_flush_buffer (YY_BUFFER_STATE b ); void zconfpush_buffer_state (YY_BUFFER_STATE new_buffer ); void zconfpop_buffer_state (void ); static void zconfensure_buffer_stack (void ); static void zconf_load_buffer_state (void ); static void zconf_init_buffer (YY_BUFFER_STATE b,FILE *file ); #define YY_FLUSH_BUFFER zconf_flush_buffer(YY_CURRENT_BUFFER ) YY_BUFFER_STATE zconf_scan_buffer (char *base,yy_size_t size ); YY_BUFFER_STATE zconf_scan_string (yyconst char *yy_str ); YY_BUFFER_STATE zconf_scan_bytes (yyconst char *bytes,int len ); void *zconfalloc (yy_size_t ); void *zconfrealloc (void *,yy_size_t ); void zconffree (void * ); #define yy_new_buffer zconf_create_buffer #define yy_set_interactive(is_interactive) \ { \ if ( ! YY_CURRENT_BUFFER ){ \ zconfensure_buffer_stack (); \ YY_CURRENT_BUFFER_LVALUE = \ zconf_create_buffer(zconfin,YY_BUF_SIZE ); \ } \ YY_CURRENT_BUFFER_LVALUE->yy_is_interactive = is_interactive; \ } #define yy_set_bol(at_bol) \ { \ if ( ! YY_CURRENT_BUFFER ){\ zconfensure_buffer_stack (); \ YY_CURRENT_BUFFER_LVALUE = \ zconf_create_buffer(zconfin,YY_BUF_SIZE ); \ } \ YY_CURRENT_BUFFER_LVALUE->yy_at_bol = at_bol; \ } #define YY_AT_BOL() (YY_CURRENT_BUFFER_LVALUE->yy_at_bol) /* Begin user sect3 */ #define zconfwrap(n) 1 #define YY_SKIP_YYWRAP typedef unsigned char YY_CHAR; FILE *zconfin = (FILE *) 0, *zconfout = (FILE *) 0; typedef int yy_state_type; extern int zconflineno; int zconflineno = 1; extern char *zconftext; #define yytext_ptr zconftext static yyconst flex_int16_t yy_nxt[][17] = { { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0 }, { 11, 12, 13, 14, 12, 12, 15, 12, 12, 12, 12, 12, 12, 12, 12, 12, 12 }, { 11, 12, 13, 14, 12, 12, 15, 12, 12, 12, 12, 12, 12, 12, 12, 12, 12 }, { 11, 16, 16, 17, 16, 16, 16, 16, 16, 16, 16, 16, 16, 18, 16, 16, 16 }, { 11, 16, 16, 17, 16, 16, 16, 16, 16, 16, 16, 16, 16, 18, 16, 16, 16 }, { 11, 19, 20, 21, 19, 19, 19, 19, 19, 19, 19, 19, 19, 19, 19, 19, 19 }, { 11, 19, 20, 21, 19, 19, 19, 19, 19, 19, 19, 19, 19, 19, 19, 19, 19 }, { 11, 22, 22, 23, 22, 24, 22, 22, 24, 22, 22, 22, 22, 22, 22, 25, 22 }, { 11, 22, 22, 23, 22, 24, 22, 22, 24, 22, 22, 22, 22, 22, 22, 25, 22 }, { 11, 26, 26, 27, 28, 29, 30, 31, 29, 32, 33, 34, 35, 35, 36, 37, 38 }, { 11, 26, 26, 27, 28, 29, 30, 31, 29, 32, 33, 34, 35, 35, 36, 37, 38 }, { -11, -11, -11, -11, -11, -11, -11, -11, -11, -11, -11, -11, -11, -11, -11, -11, -11 }, { 11, -12, -12, -12, -12, -12, -12, -12, -12, -12, -12, -12, -12, -12, -12, -12, -12 }, { 11, -13, 39, 40, -13, -13, 41, -13, -13, -13, -13, -13, -13, -13, -13, -13, -13 }, { 11, -14, -14, -14, -14, -14, -14, -14, -14, -14, -14, -14, -14, -14, -14, -14, -14 }, { 11, 42, 42, 43, 42, 42, 42, 42, 42, 42, 42, 42, 42, 42, 42, 42, 42 }, { 11, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16 }, { 11, -17, -17, -17, -17, -17, -17, -17, -17, -17, -17, -17, -17, -17, -17, -17, -17 }, { 11, -18, -18, -18, -18, -18, -18, -18, -18, -18, -18, -18, -18, 44, -18, -18, -18 }, { 11, 45, 45, -19, 45, 45, 45, 45, 45, 45, 45, 45, 45, 45, 45, 45, 45 }, { 11, -20, 46, 47, -20, -20, -20, -20, -20, -20, -20, -20, -20, -20, -20, -20, -20 }, { 11, 48, -21, -21, 48, 48, 48, 48, 48, 48, 48, 48, 48, 48, 48, 48, 48 }, { 11, 49, 49, 50, 49, -22, 49, 49, -22, 49, 49, 49, 49, 49, 49, -22, 49 }, { 11, -23, -23, -23, -23, -23, -23, -23, -23, -23, -23, -23, -23, -23, -23, -23, -23 }, { 11, -24, -24, -24, -24, -24, -24, -24, -24, -24, -24, -24, -24, -24, -24, -24, -24 }, { 11, 51, 51, 52, 51, 51, 51, 51, 51, 51, 51, 51, 51, 51, 51, 51, 51 }, { 11, -26, -26, -26, -26, -26, -26, -26, -26, -26, -26, -26, -26, -26, -26, -26, -26 }, { 11, -27, -27, -27, -27, -27, -27, -27, -27, -27, -27, -27, -27, -27, -27, -27, -27 }, { 11, -28, -28, -28, -28, -28, -28, -28, -28, -28, -28, -28, -28, -28, 53, -28, -28 }, { 11, -29, -29, -29, -29, -29, -29, -29, -29, -29, -29, -29, -29, -29, -29, -29, -29 }, { 11, 54, 54, -30, 54, 54, 54, 54, 54, 54, 54, 54, 54, 54, 54, 54, 54 }, { 11, -31, -31, -31, -31, -31, -31, 55, -31, -31, -31, -31, -31, -31, -31, -31, -31 }, { 11, -32, -32, -32, -32, -32, -32, -32, -32, -32, -32, -32, -32, -32, -32, -32, -32 }, { 11, -33, -33, -33, -33, -33, -33, -33, -33, -33, -33, -33, -33, -33, -33, -33, -33 }, { 11, -34, -34, -34, -34, -34, -34, -34, -34, -34, -34, 56, 57, 57, -34, -34, -34 }, { 11, -35, -35, -35, -35, -35, -35, -35, -35, -35, -35, 57, 57, 57, -35, -35, -35 }, { 11, -36, -36, -36, -36, -36, -36, -36, -36, -36, -36, -36, -36, -36, -36, -36, -36 }, { 11, -37, -37, 58, -37, -37, -37, -37, -37, -37, -37, -37, -37, -37, -37, -37, -37 }, { 11, -38, -38, -38, -38, -38, -38, -38, -38, -38, -38, -38, -38, -38, -38, -38, 59 }, { 11, -39, 39, 40, -39, -39, 41, -39, -39, -39, -39, -39, -39, -39, -39, -39, -39 }, { 11, -40, -40, -40, -40, -40, -40, -40, -40, -40, -40, -40, -40, -40, -40, -40, -40 }, { 11, 42, 42, 43, 42, 42, 42, 42, 42, 42, 42, 42, 42, 42, 42, 42, 42 }, { 11, 42, 42, 43, 42, 42, 42, 42, 42, 42, 42, 42, 42, 42, 42, 42, 42 }, { 11, -43, -43, -43, -43, -43, -43, -43, -43, -43, -43, -43, -43, -43, -43, -43, -43 }, { 11, -44, -44, -44, -44, -44, -44, -44, -44, -44, -44, -44, -44, 44, -44, -44, -44 }, { 11, 45, 45, -45, 45, 45, 45, 45, 45, 45, 45, 45, 45, 45, 45, 45, 45 }, { 11, -46, 46, 47, -46, -46, -46, -46, -46, -46, -46, -46, -46, -46, -46, -46, -46 }, { 11, 48, -47, -47, 48, 48, 48, 48, 48, 48, 48, 48, 48, 48, 48, 48, 48 }, { 11, -48, -48, -48, -48, -48, -48, -48, -48, -48, -48, -48, -48, -48, -48, -48, -48 }, { 11, 49, 49, 50, 49, -49, 49, 49, -49, 49, 49, 49, 49, 49, 49, -49, 49 }, { 11, -50, -50, -50, -50, -50, -50, -50, -50, -50, -50, -50, -50, -50, -50, -50, -50 }, { 11, -51, -51, 52, -51, -51, -51, -51, -51, -51, -51, -51, -51, -51, -51, -51, -51 }, { 11, -52, -52, -52, -52, -52, -52, -52, -52, -52, -52, -52, -52, -52, -52, -52, -52 }, { 11, -53, -53, -53, -53, -53, -53, -53, -53, -53, -53, -53, -53, -53, -53, -53, -53 }, { 11, 54, 54, -54, 54, 54, 54, 54, 54, 54, 54, 54, 54, 54, 54, 54, 54 }, { 11, -55, -55, -55, -55, -55, -55, -55, -55, -55, -55, -55, -55, -55, -55, -55, -55 }, { 11, -56, -56, -56, -56, -56, -56, -56, -56, -56, -56, 60, 57, 57, -56, -56, -56 }, { 11, -57, -57, -57, -57, -57, -57, -57, -57, -57, -57, 57, 57, 57, -57, -57, -57 }, { 11, -58, -58, -58, -58, -58, -58, -58, -58, -58, -58, -58, -58, -58, -58, -58, -58 }, { 11, -59, -59, -59, -59, -59, -59, -59, -59, -59, -59, -59, -59, -59, -59, -59, -59 }, { 11, -60, -60, -60, -60, -60, -60, -60, -60, -60, -60, 57, 57, 57, -60, -60, -60 }, } ; static yy_state_type yy_get_previous_state (void ); static yy_state_type yy_try_NUL_trans (yy_state_type current_state ); static int yy_get_next_buffer (void ); static void yy_fatal_error (yyconst char msg[] ); /* Done after the current pattern has been matched and before the * corresponding action - sets up zconftext. */ #define YY_DO_BEFORE_ACTION \ (yytext_ptr) = yy_bp; \ zconfleng = (size_t) (yy_cp - yy_bp); \ (yy_hold_char) = *yy_cp; \ *yy_cp = '\0'; \ (yy_c_buf_p) = yy_cp; #define YY_NUM_RULES 33 #define YY_END_OF_BUFFER 34 /* This struct is not used in this scanner, but its presence is necessary. */ struct yy_trans_info { flex_int32_t yy_verify; flex_int32_t yy_nxt; }; static yyconst flex_int16_t yy_accept[61] = { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 34, 5, 4, 2, 3, 7, 8, 6, 32, 29, 31, 24, 28, 27, 26, 22, 17, 13, 16, 20, 22, 11, 12, 19, 19, 14, 22, 22, 4, 2, 3, 3, 1, 6, 32, 29, 31, 30, 24, 23, 26, 25, 15, 20, 9, 19, 19, 21, 10, 18 } ; static yyconst flex_int32_t yy_ec[256] = { 0, 1, 1, 1, 1, 1, 1, 1, 1, 2, 3, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 2, 4, 5, 6, 1, 1, 7, 8, 9, 10, 1, 1, 1, 11, 12, 12, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 1, 1, 1, 14, 1, 1, 1, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 1, 15, 1, 1, 13, 1, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 13, 1, 16, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1 } ; extern int zconf_flex_debug; int zconf_flex_debug = 0; /* The intent behind this definition is that it'll catch * any uses of REJECT which flex missed. */ #define REJECT reject_used_but_not_detected #define yymore() yymore_used_but_not_detected #define YY_MORE_ADJ 0 #define YY_RESTORE_YY_MORE_OFFSET char *zconftext; #define YY_NO_INPUT 1 /* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ #include #include #include #include #include #define LKC_DIRECT_LINK #include "lkc.h" #define START_STRSIZE 16 static struct { struct file *file; int lineno; } current_pos; static char *text; static int text_size, text_asize; struct buffer { struct buffer *parent; YY_BUFFER_STATE state; }; struct buffer *current_buf; static int last_ts, first_ts; static void zconf_endhelp(void); static void zconf_endfile(void); static void new_string(void) { text = malloc(START_STRSIZE); text_asize = START_STRSIZE; text_size = 0; *text = 0; } static void append_string(const char *str, int size) { int new_size = text_size + size + 1; if (new_size > text_asize) { new_size += START_STRSIZE - 1; new_size &= -START_STRSIZE; text = realloc(text, new_size); text_asize = new_size; } memcpy(text + text_size, str, size); text_size += size; text[text_size] = 0; } static void alloc_string(const char *str, int size) { text = malloc(size + 1); memcpy(text, str, size); text[size] = 0; } #define INITIAL 0 #define COMMAND 1 #define HELP 2 #define STRING 3 #define PARAM 4 #ifndef YY_NO_UNISTD_H /* Special case for "unistd.h", since it is non-ANSI. We include it way * down here because we want the user's section 1 to have been scanned first. * The user has a chance to override it with an option. */ #include #endif #ifndef YY_EXTRA_TYPE #define YY_EXTRA_TYPE void * #endif static int yy_init_globals (void ); /* Accessor methods to globals. These are made visible to non-reentrant scanners for convenience. */ int zconflex_destroy (void ); int zconfget_debug (void ); void zconfset_debug (int debug_flag ); YY_EXTRA_TYPE zconfget_extra (void ); void zconfset_extra (YY_EXTRA_TYPE user_defined ); FILE *zconfget_in (void ); void zconfset_in (FILE * in_str ); FILE *zconfget_out (void ); void zconfset_out (FILE * out_str ); int zconfget_leng (void ); char *zconfget_text (void ); int zconfget_lineno (void ); void zconfset_lineno (int line_number ); /* Macros after this point can all be overridden by user definitions in * section 1. */ #ifndef YY_SKIP_YYWRAP #ifdef __cplusplus extern "C" int zconfwrap (void ); #else extern int zconfwrap (void ); #endif #endif static void yyunput (int c,char *buf_ptr ); #ifndef yytext_ptr static void yy_flex_strncpy (char *,yyconst char *,int ); #endif #ifdef YY_NEED_STRLEN static int yy_flex_strlen (yyconst char * ); #endif #ifndef YY_NO_INPUT #ifdef __cplusplus static int yyinput (void ); #else static int input (void ); #endif #endif /* Amount of stuff to slurp up with each read. */ #ifndef YY_READ_BUF_SIZE #ifdef __ia64__ /* On IA-64, the buffer size is 16k, not 8k */ #define YY_READ_BUF_SIZE 16384 #else #define YY_READ_BUF_SIZE 8192 #endif /* __ia64__ */ #endif /* Copy whatever the last rule matched to the standard output. */ #ifndef ECHO /* This used to be an fputs(), but since the string might contain NUL's, * we now use fwrite(). */ #define ECHO do { if (fwrite( zconftext, zconfleng, 1, zconfout )) {} } while (0) #endif /* Gets input and stuffs it into "buf". number of characters read, or YY_NULL, * is returned in "result". */ #ifndef YY_INPUT #define YY_INPUT(buf,result,max_size) \ errno=0; \ while ( (result = read( fileno(zconfin), (char *) buf, max_size )) < 0 ) \ { \ if( errno != EINTR) \ { \ YY_FATAL_ERROR( "input in flex scanner failed" ); \ break; \ } \ errno=0; \ clearerr(zconfin); \ }\ \ #endif /* No semi-colon after return; correct usage is to write "yyterminate();" - * we don't want an extra ';' after the "return" because that will cause * some compilers to complain about unreachable statements. */ #ifndef yyterminate #define yyterminate() return YY_NULL #endif /* Number of entries by which start-condition stack grows. */ #ifndef YY_START_STACK_INCR #define YY_START_STACK_INCR 25 #endif /* Report a fatal error. */ #ifndef YY_FATAL_ERROR #define YY_FATAL_ERROR(msg) yy_fatal_error( msg ) #endif /* end tables serialization structures and prototypes */ /* Default declaration of generated scanner - a define so the user can * easily add parameters. */ #ifndef YY_DECL #define YY_DECL_IS_OURS 1 extern int zconflex (void); #define YY_DECL int zconflex (void) #endif /* !YY_DECL */ /* Code executed at the beginning of each rule, after zconftext and zconfleng * have been set up. */ #ifndef YY_USER_ACTION #define YY_USER_ACTION #endif /* Code executed at the end of each rule. */ #ifndef YY_BREAK #define YY_BREAK break; #endif #define YY_RULE_SETUP \ YY_USER_ACTION /** The main scanner function which does all the work. */ YY_DECL { register yy_state_type yy_current_state; register char *yy_cp, *yy_bp; register int yy_act; int str = 0; int ts, i; if ( !(yy_init) ) { (yy_init) = 1; #ifdef YY_USER_INIT YY_USER_INIT; #endif if ( ! (yy_start) ) (yy_start) = 1; /* first start state */ if ( ! zconfin ) zconfin = stdin; if ( ! zconfout ) zconfout = stdout; if ( ! YY_CURRENT_BUFFER ) { zconfensure_buffer_stack (); YY_CURRENT_BUFFER_LVALUE = zconf_create_buffer(zconfin,YY_BUF_SIZE ); } zconf_load_buffer_state( ); } while ( 1 ) /* loops until end-of-file is reached */ { yy_cp = (yy_c_buf_p); /* Support of zconftext. */ *yy_cp = (yy_hold_char); /* yy_bp points to the position in yy_ch_buf of the start of * the current run. */ yy_bp = yy_cp; yy_current_state = (yy_start); yy_match: while ( (yy_current_state = yy_nxt[yy_current_state][ yy_ec[YY_SC_TO_UI(*yy_cp)] ]) > 0 ) ++yy_cp; yy_current_state = -yy_current_state; yy_find_action: yy_act = yy_accept[yy_current_state]; YY_DO_BEFORE_ACTION; do_action: /* This label is used only to access EOF actions. */ switch ( yy_act ) { /* beginning of action switch */ case 1: /* rule 1 can match eol */ case 2: /* rule 2 can match eol */ YY_RULE_SETUP { current_file->lineno++; return T_EOL; } YY_BREAK case 3: YY_RULE_SETUP YY_BREAK case 4: YY_RULE_SETUP { BEGIN(COMMAND); } YY_BREAK case 5: YY_RULE_SETUP { unput(zconftext[0]); BEGIN(COMMAND); } YY_BREAK case 6: YY_RULE_SETUP { struct kconf_id *id = kconf_id_lookup(zconftext, zconfleng); BEGIN(PARAM); current_pos.file = current_file; current_pos.lineno = current_file->lineno; if (id && id->flags & TF_COMMAND) { zconflval.id = id; return id->token; } alloc_string(zconftext, zconfleng); zconflval.string = text; return T_WORD; } YY_BREAK case 7: YY_RULE_SETUP YY_BREAK case 8: /* rule 8 can match eol */ YY_RULE_SETUP { BEGIN(INITIAL); current_file->lineno++; return T_EOL; } YY_BREAK case 9: YY_RULE_SETUP return T_AND; YY_BREAK case 10: YY_RULE_SETUP return T_OR; YY_BREAK case 11: YY_RULE_SETUP return T_OPEN_PAREN; YY_BREAK case 12: YY_RULE_SETUP return T_CLOSE_PAREN; YY_BREAK case 13: YY_RULE_SETUP return T_NOT; YY_BREAK case 14: YY_RULE_SETUP return T_EQUAL; YY_BREAK case 15: YY_RULE_SETUP return T_UNEQUAL; YY_BREAK case 16: YY_RULE_SETUP { str = zconftext[0]; new_string(); BEGIN(STRING); } YY_BREAK case 17: /* rule 17 can match eol */ YY_RULE_SETUP BEGIN(INITIAL); current_file->lineno++; return T_EOL; YY_BREAK case 18: YY_RULE_SETUP /* ignore */ YY_BREAK case 19: YY_RULE_SETUP { struct kconf_id *id = kconf_id_lookup(zconftext, zconfleng); if (id && id->flags & TF_PARAM) { zconflval.id = id; return id->token; } alloc_string(zconftext, zconfleng); zconflval.string = text; return T_WORD; } YY_BREAK case 20: YY_RULE_SETUP /* comment */ YY_BREAK case 21: /* rule 21 can match eol */ YY_RULE_SETUP current_file->lineno++; YY_BREAK case 22: YY_RULE_SETUP YY_BREAK case YY_STATE_EOF(PARAM): { BEGIN(INITIAL); } YY_BREAK case 23: /* rule 23 can match eol */ *yy_cp = (yy_hold_char); /* undo effects of setting up zconftext */ (yy_c_buf_p) = yy_cp -= 1; YY_DO_BEFORE_ACTION; /* set up zconftext again */ YY_RULE_SETUP { append_string(zconftext, zconfleng); zconflval.string = text; return T_WORD_QUOTE; } YY_BREAK case 24: YY_RULE_SETUP { append_string(zconftext, zconfleng); } YY_BREAK case 25: /* rule 25 can match eol */ *yy_cp = (yy_hold_char); /* undo effects of setting up zconftext */ (yy_c_buf_p) = yy_cp -= 1; YY_DO_BEFORE_ACTION; /* set up zconftext again */ YY_RULE_SETUP { append_string(zconftext + 1, zconfleng - 1); zconflval.string = text; return T_WORD_QUOTE; } YY_BREAK case 26: YY_RULE_SETUP { append_string(zconftext + 1, zconfleng - 1); } YY_BREAK case 27: YY_RULE_SETUP { if (str == zconftext[0]) { BEGIN(PARAM); zconflval.string = text; return T_WORD_QUOTE; } else append_string(zconftext, 1); } YY_BREAK case 28: /* rule 28 can match eol */ YY_RULE_SETUP { printf("%s:%d:warning: multi-line strings not supported\n", zconf_curname(), zconf_lineno()); current_file->lineno++; BEGIN(INITIAL); return T_EOL; } YY_BREAK case YY_STATE_EOF(STRING): { BEGIN(INITIAL); } YY_BREAK case 29: YY_RULE_SETUP { ts = 0; for (i = 0; i < zconfleng; i++) { if (zconftext[i] == '\t') ts = (ts & ~7) + 8; else ts++; } last_ts = ts; if (first_ts) { if (ts < first_ts) { zconf_endhelp(); return T_HELPTEXT; } ts -= first_ts; while (ts > 8) { append_string(" ", 8); ts -= 8; } append_string(" ", ts); } } YY_BREAK case 30: /* rule 30 can match eol */ *yy_cp = (yy_hold_char); /* undo effects of setting up zconftext */ (yy_c_buf_p) = yy_cp -= 1; YY_DO_BEFORE_ACTION; /* set up zconftext again */ YY_RULE_SETUP { current_file->lineno++; zconf_endhelp(); return T_HELPTEXT; } YY_BREAK case 31: /* rule 31 can match eol */ YY_RULE_SETUP { current_file->lineno++; append_string("\n", 1); } YY_BREAK case 32: YY_RULE_SETUP { while (zconfleng) { if ((zconftext[zconfleng-1] != ' ') && (zconftext[zconfleng-1] != '\t')) break; zconfleng--; } append_string(zconftext, zconfleng); if (!first_ts) first_ts = last_ts; } YY_BREAK case YY_STATE_EOF(HELP): { zconf_endhelp(); return T_HELPTEXT; } YY_BREAK case YY_STATE_EOF(INITIAL): case YY_STATE_EOF(COMMAND): { if (current_file) { zconf_endfile(); return T_EOL; } fclose(zconfin); yyterminate(); } YY_BREAK case 33: YY_RULE_SETUP YY_FATAL_ERROR( "flex scanner jammed" ); YY_BREAK case YY_END_OF_BUFFER: { /* Amount of text matched not including the EOB char. */ int yy_amount_of_matched_text = (int) (yy_cp - (yytext_ptr)) - 1; /* Undo the effects of YY_DO_BEFORE_ACTION. */ *yy_cp = (yy_hold_char); YY_RESTORE_YY_MORE_OFFSET if ( YY_CURRENT_BUFFER_LVALUE->yy_buffer_status == YY_BUFFER_NEW ) { /* We're scanning a new file or input source. It's * possible that this happened because the user * just pointed zconfin at a new source and called * zconflex(). If so, then we have to assure * consistency between YY_CURRENT_BUFFER and our * globals. Here is the right place to do so, because * this is the first action (other than possibly a * back-up) that will match for the new input source. */ (yy_n_chars) = YY_CURRENT_BUFFER_LVALUE->yy_n_chars; YY_CURRENT_BUFFER_LVALUE->yy_input_file = zconfin; YY_CURRENT_BUFFER_LVALUE->yy_buffer_status = YY_BUFFER_NORMAL; } /* Note that here we test for yy_c_buf_p "<=" to the position * of the first EOB in the buffer, since yy_c_buf_p will * already have been incremented past the NUL character * (since all states make transitions on EOB to the * end-of-buffer state). Contrast this with the test * in input(). */ if ( (yy_c_buf_p) <= &YY_CURRENT_BUFFER_LVALUE->yy_ch_buf[(yy_n_chars)] ) { /* This was really a NUL. */ yy_state_type yy_next_state; (yy_c_buf_p) = (yytext_ptr) + yy_amount_of_matched_text; yy_current_state = yy_get_previous_state( ); /* Okay, we're now positioned to make the NUL * transition. We couldn't have * yy_get_previous_state() go ahead and do it * for us because it doesn't know how to deal * with the possibility of jamming (and we don't * want to build jamming into it because then it * will run more slowly). */ yy_next_state = yy_try_NUL_trans( yy_current_state ); yy_bp = (yytext_ptr) + YY_MORE_ADJ; if ( yy_next_state ) { /* Consume the NUL. */ yy_cp = ++(yy_c_buf_p); yy_current_state = yy_next_state; goto yy_match; } else { yy_cp = (yy_c_buf_p); goto yy_find_action; } } else switch ( yy_get_next_buffer( ) ) { case EOB_ACT_END_OF_FILE: { (yy_did_buffer_switch_on_eof) = 0; if ( zconfwrap( ) ) { /* Note: because we've taken care in * yy_get_next_buffer() to have set up * zconftext, we can now set up * yy_c_buf_p so that if some total * hoser (like flex itself) wants to * call the scanner after we return the * YY_NULL, it'll still work - another * YY_NULL will get returned. */ (yy_c_buf_p) = (yytext_ptr) + YY_MORE_ADJ; yy_act = YY_STATE_EOF(YY_START); goto do_action; } else { if ( ! (yy_did_buffer_switch_on_eof) ) YY_NEW_FILE; } break; } case EOB_ACT_CONTINUE_SCAN: (yy_c_buf_p) = (yytext_ptr) + yy_amount_of_matched_text; yy_current_state = yy_get_previous_state( ); yy_cp = (yy_c_buf_p); yy_bp = (yytext_ptr) + YY_MORE_ADJ; goto yy_match; case EOB_ACT_LAST_MATCH: (yy_c_buf_p) = &YY_CURRENT_BUFFER_LVALUE->yy_ch_buf[(yy_n_chars)]; yy_current_state = yy_get_previous_state( ); yy_cp = (yy_c_buf_p); yy_bp = (yytext_ptr) + YY_MORE_ADJ; goto yy_find_action; } break; } default: YY_FATAL_ERROR( "fatal flex scanner internal error--no action found" ); } /* end of action switch */ } /* end of scanning one token */ } /* end of zconflex */ /* yy_get_next_buffer - try to read in a new buffer * * Returns a code representing an action: * EOB_ACT_LAST_MATCH - * EOB_ACT_CONTINUE_SCAN - continue scanning from current position * EOB_ACT_END_OF_FILE - end of file */ static int yy_get_next_buffer (void) { register char *dest = YY_CURRENT_BUFFER_LVALUE->yy_ch_buf; register char *source = (yytext_ptr); register int number_to_move, i; int ret_val; if ( (yy_c_buf_p) > &YY_CURRENT_BUFFER_LVALUE->yy_ch_buf[(yy_n_chars) + 1] ) YY_FATAL_ERROR( "fatal flex scanner internal error--end of buffer missed" ); if ( YY_CURRENT_BUFFER_LVALUE->yy_fill_buffer == 0 ) { /* Don't try to fill the buffer, so this is an EOF. */ if ( (yy_c_buf_p) - (yytext_ptr) - YY_MORE_ADJ == 1 ) { /* We matched a single character, the EOB, so * treat this as a final EOF. */ return EOB_ACT_END_OF_FILE; } else { /* We matched some text prior to the EOB, first * process it. */ return EOB_ACT_LAST_MATCH; } } /* Try to read more data. */ /* First move last chars to start of buffer. */ number_to_move = (int) ((yy_c_buf_p) - (yytext_ptr)) - 1; for ( i = 0; i < number_to_move; ++i ) *(dest++) = *(source++); if ( YY_CURRENT_BUFFER_LVALUE->yy_buffer_status == YY_BUFFER_EOF_PENDING ) /* don't do the read, it's not guaranteed to return an EOF, * just force an EOF */ YY_CURRENT_BUFFER_LVALUE->yy_n_chars = (yy_n_chars) = 0; else { int num_to_read = YY_CURRENT_BUFFER_LVALUE->yy_buf_size - number_to_move - 1; while ( num_to_read <= 0 ) { /* Not enough room in the buffer - grow it. */ /* just a shorter name for the current buffer */ YY_BUFFER_STATE b = YY_CURRENT_BUFFER; int yy_c_buf_p_offset = (int) ((yy_c_buf_p) - b->yy_ch_buf); if ( b->yy_is_our_buffer ) { int new_size = b->yy_buf_size * 2; if ( new_size <= 0 ) b->yy_buf_size += b->yy_buf_size / 8; else b->yy_buf_size *= 2; b->yy_ch_buf = (char *) /* Include room in for 2 EOB chars. */ zconfrealloc((void *) b->yy_ch_buf,b->yy_buf_size + 2 ); } else /* Can't grow it, we don't own it. */ b->yy_ch_buf = 0; if ( ! b->yy_ch_buf ) YY_FATAL_ERROR( "fatal error - scanner input buffer overflow" ); (yy_c_buf_p) = &b->yy_ch_buf[yy_c_buf_p_offset]; num_to_read = YY_CURRENT_BUFFER_LVALUE->yy_buf_size - number_to_move - 1; } if ( num_to_read > YY_READ_BUF_SIZE ) num_to_read = YY_READ_BUF_SIZE; /* Read in more data. */ YY_INPUT( (&YY_CURRENT_BUFFER_LVALUE->yy_ch_buf[number_to_move]), (yy_n_chars), (size_t) num_to_read ); YY_CURRENT_BUFFER_LVALUE->yy_n_chars = (yy_n_chars); } if ( (yy_n_chars) == 0 ) { if ( number_to_move == YY_MORE_ADJ ) { ret_val = EOB_ACT_END_OF_FILE; zconfrestart(zconfin ); } else { ret_val = EOB_ACT_LAST_MATCH; YY_CURRENT_BUFFER_LVALUE->yy_buffer_status = YY_BUFFER_EOF_PENDING; } } else ret_val = EOB_ACT_CONTINUE_SCAN; if ((yy_size_t) ((yy_n_chars) + number_to_move) > YY_CURRENT_BUFFER_LVALUE->yy_buf_size) { /* Extend the array by 50%, plus the number we really need. */ yy_size_t new_size = (yy_n_chars) + number_to_move + ((yy_n_chars) >> 1); YY_CURRENT_BUFFER_LVALUE->yy_ch_buf = (char *) zconfrealloc((void *) YY_CURRENT_BUFFER_LVALUE->yy_ch_buf,new_size ); if ( ! YY_CURRENT_BUFFER_LVALUE->yy_ch_buf ) YY_FATAL_ERROR( "out of dynamic memory in yy_get_next_buffer()" ); } (yy_n_chars) += number_to_move; YY_CURRENT_BUFFER_LVALUE->yy_ch_buf[(yy_n_chars)] = YY_END_OF_BUFFER_CHAR; YY_CURRENT_BUFFER_LVALUE->yy_ch_buf[(yy_n_chars) + 1] = YY_END_OF_BUFFER_CHAR; (yytext_ptr) = &YY_CURRENT_BUFFER_LVALUE->yy_ch_buf[0]; return ret_val; } /* yy_get_previous_state - get the state just before the EOB char was reached */ static yy_state_type yy_get_previous_state (void) { register yy_state_type yy_current_state; register char *yy_cp; yy_current_state = (yy_start); for ( yy_cp = (yytext_ptr) + YY_MORE_ADJ; yy_cp < (yy_c_buf_p); ++yy_cp ) { yy_current_state = yy_nxt[yy_current_state][(*yy_cp ? yy_ec[YY_SC_TO_UI(*yy_cp)] : 1)]; } return yy_current_state; } /* yy_try_NUL_trans - try to make a transition on the NUL character * * synopsis * next_state = yy_try_NUL_trans( current_state ); */ static yy_state_type yy_try_NUL_trans (yy_state_type yy_current_state ) { register int yy_is_jam; yy_current_state = yy_nxt[yy_current_state][1]; yy_is_jam = (yy_current_state <= 0); return yy_is_jam ? 0 : yy_current_state; } static void yyunput (int c, register char * yy_bp ) { register char *yy_cp; yy_cp = (yy_c_buf_p); /* undo effects of setting up zconftext */ *yy_cp = (yy_hold_char); if ( yy_cp < YY_CURRENT_BUFFER_LVALUE->yy_ch_buf + 2 ) { /* need to shift things up to make room */ /* +2 for EOB chars. */ register int number_to_move = (yy_n_chars) + 2; register char *dest = &YY_CURRENT_BUFFER_LVALUE->yy_ch_buf[ YY_CURRENT_BUFFER_LVALUE->yy_buf_size + 2]; register char *source = &YY_CURRENT_BUFFER_LVALUE->yy_ch_buf[number_to_move]; while ( source > YY_CURRENT_BUFFER_LVALUE->yy_ch_buf ) *--dest = *--source; yy_cp += (int) (dest - source); yy_bp += (int) (dest - source); YY_CURRENT_BUFFER_LVALUE->yy_n_chars = (yy_n_chars) = YY_CURRENT_BUFFER_LVALUE->yy_buf_size; if ( yy_cp < YY_CURRENT_BUFFER_LVALUE->yy_ch_buf + 2 ) YY_FATAL_ERROR( "flex scanner push-back overflow" ); } *--yy_cp = (char) c; (yytext_ptr) = yy_bp; (yy_hold_char) = *yy_cp; (yy_c_buf_p) = yy_cp; } #ifndef YY_NO_INPUT #ifdef __cplusplus static int yyinput (void) #else static int input (void) #endif { int c; *(yy_c_buf_p) = (yy_hold_char); if ( *(yy_c_buf_p) == YY_END_OF_BUFFER_CHAR ) { /* yy_c_buf_p now points to the character we want to return. * If this occurs *before* the EOB characters, then it's a * valid NUL; if not, then we've hit the end of the buffer. */ if ( (yy_c_buf_p) < &YY_CURRENT_BUFFER_LVALUE->yy_ch_buf[(yy_n_chars)] ) /* This was really a NUL. */ *(yy_c_buf_p) = '\0'; else { /* need more input */ int offset = (yy_c_buf_p) - (yytext_ptr); ++(yy_c_buf_p); switch ( yy_get_next_buffer( ) ) { case EOB_ACT_LAST_MATCH: /* This happens because yy_g_n_b() * sees that we've accumulated a * token and flags that we need to * try matching the token before * proceeding. But for input(), * there's no matching to consider. * So convert the EOB_ACT_LAST_MATCH * to EOB_ACT_END_OF_FILE. */ /* Reset buffer status. */ zconfrestart(zconfin ); /*FALLTHROUGH*/ case EOB_ACT_END_OF_FILE: { if ( zconfwrap( ) ) return EOF; if ( ! (yy_did_buffer_switch_on_eof) ) YY_NEW_FILE; #ifdef __cplusplus return yyinput(); #else return input(); #endif } case EOB_ACT_CONTINUE_SCAN: (yy_c_buf_p) = (yytext_ptr) + offset; break; } } } c = *(unsigned char *) (yy_c_buf_p); /* cast for 8-bit char's */ *(yy_c_buf_p) = '\0'; /* preserve zconftext */ (yy_hold_char) = *++(yy_c_buf_p); return c; } #endif /* ifndef YY_NO_INPUT */ /** Immediately switch to a different input stream. * @param input_file A readable stream. * * @note This function does not reset the start condition to @c INITIAL . */ void zconfrestart (FILE * input_file ) { if ( ! YY_CURRENT_BUFFER ){ zconfensure_buffer_stack (); YY_CURRENT_BUFFER_LVALUE = zconf_create_buffer(zconfin,YY_BUF_SIZE ); } zconf_init_buffer(YY_CURRENT_BUFFER,input_file ); zconf_load_buffer_state( ); } /** Switch to a different input buffer. * @param new_buffer The new input buffer. * */ void zconf_switch_to_buffer (YY_BUFFER_STATE new_buffer ) { /* TODO. We should be able to replace this entire function body * with * zconfpop_buffer_state(); * zconfpush_buffer_state(new_buffer); */ zconfensure_buffer_stack (); if ( YY_CURRENT_BUFFER == new_buffer ) return; if ( YY_CURRENT_BUFFER ) { /* Flush out information for old buffer. */ *(yy_c_buf_p) = (yy_hold_char); YY_CURRENT_BUFFER_LVALUE->yy_buf_pos = (yy_c_buf_p); YY_CURRENT_BUFFER_LVALUE->yy_n_chars = (yy_n_chars); } YY_CURRENT_BUFFER_LVALUE = new_buffer; zconf_load_buffer_state( ); /* We don't actually know whether we did this switch during * EOF (zconfwrap()) processing, but the only time this flag * is looked at is after zconfwrap() is called, so it's safe * to go ahead and always set it. */ (yy_did_buffer_switch_on_eof) = 1; } static void zconf_load_buffer_state (void) { (yy_n_chars) = YY_CURRENT_BUFFER_LVALUE->yy_n_chars; (yytext_ptr) = (yy_c_buf_p) = YY_CURRENT_BUFFER_LVALUE->yy_buf_pos; zconfin = YY_CURRENT_BUFFER_LVALUE->yy_input_file; (yy_hold_char) = *(yy_c_buf_p); } /** Allocate and initialize an input buffer state. * @param file A readable stream. * @param size The character buffer size in bytes. When in doubt, use @c YY_BUF_SIZE. * * @return the allocated buffer state. */ YY_BUFFER_STATE zconf_create_buffer (FILE * file, int size ) { YY_BUFFER_STATE b; b = (YY_BUFFER_STATE) zconfalloc(sizeof( struct yy_buffer_state ) ); if ( ! b ) YY_FATAL_ERROR( "out of dynamic memory in zconf_create_buffer()" ); b->yy_buf_size = size; /* yy_ch_buf has to be 2 characters longer than the size given because * we need to put in 2 end-of-buffer characters. */ b->yy_ch_buf = (char *) zconfalloc(b->yy_buf_size + 2 ); if ( ! b->yy_ch_buf ) YY_FATAL_ERROR( "out of dynamic memory in zconf_create_buffer()" ); b->yy_is_our_buffer = 1; zconf_init_buffer(b,file ); return b; } /** Destroy the buffer. * @param b a buffer created with zconf_create_buffer() * */ void zconf_delete_buffer (YY_BUFFER_STATE b ) { if ( ! b ) return; if ( b == YY_CURRENT_BUFFER ) /* Not sure if we should pop here. */ YY_CURRENT_BUFFER_LVALUE = (YY_BUFFER_STATE) 0; if ( b->yy_is_our_buffer ) zconffree((void *) b->yy_ch_buf ); zconffree((void *) b ); } /* Initializes or reinitializes a buffer. * This function is sometimes called more than once on the same buffer, * such as during a zconfrestart() or at EOF. */ static void zconf_init_buffer (YY_BUFFER_STATE b, FILE * file ) { int oerrno = errno; zconf_flush_buffer(b ); b->yy_input_file = file; b->yy_fill_buffer = 1; /* If b is the current buffer, then zconf_init_buffer was _probably_ * called from zconfrestart() or through yy_get_next_buffer. * In that case, we don't want to reset the lineno or column. */ if (b != YY_CURRENT_BUFFER){ b->yy_bs_lineno = 1; b->yy_bs_column = 0; } b->yy_is_interactive = 0; errno = oerrno; } /** Discard all buffered characters. On the next scan, YY_INPUT will be called. * @param b the buffer state to be flushed, usually @c YY_CURRENT_BUFFER. * */ void zconf_flush_buffer (YY_BUFFER_STATE b ) { if ( ! b ) return; b->yy_n_chars = 0; /* We always need two end-of-buffer characters. The first causes * a transition to the end-of-buffer state. The second causes * a jam in that state. */ b->yy_ch_buf[0] = YY_END_OF_BUFFER_CHAR; b->yy_ch_buf[1] = YY_END_OF_BUFFER_CHAR; b->yy_buf_pos = &b->yy_ch_buf[0]; b->yy_at_bol = 1; b->yy_buffer_status = YY_BUFFER_NEW; if ( b == YY_CURRENT_BUFFER ) zconf_load_buffer_state( ); } /** Pushes the new state onto the stack. The new state becomes * the current state. This function will allocate the stack * if necessary. * @param new_buffer The new state. * */ void zconfpush_buffer_state (YY_BUFFER_STATE new_buffer ) { if (new_buffer == NULL) return; zconfensure_buffer_stack(); /* This block is copied from zconf_switch_to_buffer. */ if ( YY_CURRENT_BUFFER ) { /* Flush out information for old buffer. */ *(yy_c_buf_p) = (yy_hold_char); YY_CURRENT_BUFFER_LVALUE->yy_buf_pos = (yy_c_buf_p); YY_CURRENT_BUFFER_LVALUE->yy_n_chars = (yy_n_chars); } /* Only push if top exists. Otherwise, replace top. */ if (YY_CURRENT_BUFFER) (yy_buffer_stack_top)++; YY_CURRENT_BUFFER_LVALUE = new_buffer; /* copied from zconf_switch_to_buffer. */ zconf_load_buffer_state( ); (yy_did_buffer_switch_on_eof) = 1; } /** Removes and deletes the top of the stack, if present. * The next element becomes the new top. * */ void zconfpop_buffer_state (void) { if (!YY_CURRENT_BUFFER) return; zconf_delete_buffer(YY_CURRENT_BUFFER ); YY_CURRENT_BUFFER_LVALUE = NULL; if ((yy_buffer_stack_top) > 0) --(yy_buffer_stack_top); if (YY_CURRENT_BUFFER) { zconf_load_buffer_state( ); (yy_did_buffer_switch_on_eof) = 1; } } /* Allocates the stack if it does not exist. * Guarantees space for at least one push. */ static void zconfensure_buffer_stack (void) { int num_to_alloc; if (!(yy_buffer_stack)) { /* First allocation is just for 2 elements, since we don't know if this * scanner will even need a stack. We use 2 instead of 1 to avoid an * immediate realloc on the next call. */ num_to_alloc = 1; (yy_buffer_stack) = (struct yy_buffer_state**)zconfalloc (num_to_alloc * sizeof(struct yy_buffer_state*) ); if ( ! (yy_buffer_stack) ) YY_FATAL_ERROR( "out of dynamic memory in zconfensure_buffer_stack()" ); memset((yy_buffer_stack), 0, num_to_alloc * sizeof(struct yy_buffer_state*)); (yy_buffer_stack_max) = num_to_alloc; (yy_buffer_stack_top) = 0; return; } if ((yy_buffer_stack_top) >= ((yy_buffer_stack_max)) - 1){ /* Increase the buffer to prepare for a possible push. */ int grow_size = 8 /* arbitrary grow size */; num_to_alloc = (yy_buffer_stack_max) + grow_size; (yy_buffer_stack) = (struct yy_buffer_state**)zconfrealloc ((yy_buffer_stack), num_to_alloc * sizeof(struct yy_buffer_state*) ); if ( ! (yy_buffer_stack) ) YY_FATAL_ERROR( "out of dynamic memory in zconfensure_buffer_stack()" ); /* zero only the new slots.*/ memset((yy_buffer_stack) + (yy_buffer_stack_max), 0, grow_size * sizeof(struct yy_buffer_state*)); (yy_buffer_stack_max) = num_to_alloc; } } /** Setup the input buffer state to scan directly from a user-specified character buffer. * @param base the character buffer * @param size the size in bytes of the character buffer * * @return the newly allocated buffer state object. */ YY_BUFFER_STATE zconf_scan_buffer (char * base, yy_size_t size ) { YY_BUFFER_STATE b; if ( size < 2 || base[size-2] != YY_END_OF_BUFFER_CHAR || base[size-1] != YY_END_OF_BUFFER_CHAR ) /* They forgot to leave room for the EOB's. */ return 0; b = (YY_BUFFER_STATE) zconfalloc(sizeof( struct yy_buffer_state ) ); if ( ! b ) YY_FATAL_ERROR( "out of dynamic memory in zconf_scan_buffer()" ); b->yy_buf_size = size - 2; /* "- 2" to take care of EOB's */ b->yy_buf_pos = b->yy_ch_buf = base; b->yy_is_our_buffer = 0; b->yy_input_file = 0; b->yy_n_chars = b->yy_buf_size; b->yy_is_interactive = 0; b->yy_at_bol = 1; b->yy_fill_buffer = 0; b->yy_buffer_status = YY_BUFFER_NEW; zconf_switch_to_buffer(b ); return b; } /** Setup the input buffer state to scan a string. The next call to zconflex() will * scan from a @e copy of @a str. * @param yystr a NUL-terminated string to scan * * @return the newly allocated buffer state object. * @note If you want to scan bytes that may contain NUL values, then use * zconf_scan_bytes() instead. */ YY_BUFFER_STATE zconf_scan_string (yyconst char * yystr ) { return zconf_scan_bytes(yystr,strlen(yystr) ); } /** Setup the input buffer state to scan the given bytes. The next call to zconflex() will * scan from a @e copy of @a bytes. * @param yybytes the byte buffer to scan * @param _yybytes_len the number of bytes in the buffer pointed to by @a bytes. * * @return the newly allocated buffer state object. */ YY_BUFFER_STATE zconf_scan_bytes (yyconst char * yybytes, int _yybytes_len ) { YY_BUFFER_STATE b; char *buf; yy_size_t n; int i; /* Get memory for full buffer, including space for trailing EOB's. */ n = _yybytes_len + 2; buf = (char *) zconfalloc(n ); if ( ! buf ) YY_FATAL_ERROR( "out of dynamic memory in zconf_scan_bytes()" ); for ( i = 0; i < _yybytes_len; ++i ) buf[i] = yybytes[i]; buf[_yybytes_len] = buf[_yybytes_len+1] = YY_END_OF_BUFFER_CHAR; b = zconf_scan_buffer(buf,n ); if ( ! b ) YY_FATAL_ERROR( "bad buffer in zconf_scan_bytes()" ); /* It's okay to grow etc. this buffer, and we should throw it * away when we're done. */ b->yy_is_our_buffer = 1; return b; } #ifndef YY_EXIT_FAILURE #define YY_EXIT_FAILURE 2 #endif static void yy_fatal_error (yyconst char* msg ) { (void) fprintf( stderr, "%s\n", msg ); exit( YY_EXIT_FAILURE ); } /* Redefine yyless() so it works in section 3 code. */ #undef yyless #define yyless(n) \ do \ { \ /* Undo effects of setting up zconftext. */ \ int yyless_macro_arg = (n); \ YY_LESS_LINENO(yyless_macro_arg);\ zconftext[zconfleng] = (yy_hold_char); \ (yy_c_buf_p) = zconftext + yyless_macro_arg; \ (yy_hold_char) = *(yy_c_buf_p); \ *(yy_c_buf_p) = '\0'; \ zconfleng = yyless_macro_arg; \ } \ while ( 0 ) /* Accessor methods (get/set functions) to struct members. */ /** Get the current line number. * */ int zconfget_lineno (void) { return zconflineno; } /** Get the input stream. * */ FILE *zconfget_in (void) { return zconfin; } /** Get the output stream. * */ FILE *zconfget_out (void) { return zconfout; } /** Get the length of the current token. * */ int zconfget_leng (void) { return zconfleng; } /** Get the current token. * */ char *zconfget_text (void) { return zconftext; } /** Set the current line number. * @param line_number * */ void zconfset_lineno (int line_number ) { zconflineno = line_number; } /** Set the input stream. This does not discard the current * input buffer. * @param in_str A readable stream. * * @see zconf_switch_to_buffer */ void zconfset_in (FILE * in_str ) { zconfin = in_str ; } void zconfset_out (FILE * out_str ) { zconfout = out_str ; } int zconfget_debug (void) { return zconf_flex_debug; } void zconfset_debug (int bdebug ) { zconf_flex_debug = bdebug ; } static int yy_init_globals (void) { /* Initialization is the same as for the non-reentrant scanner. * This function is called from zconflex_destroy(), so don't allocate here. */ (yy_buffer_stack) = 0; (yy_buffer_stack_top) = 0; (yy_buffer_stack_max) = 0; (yy_c_buf_p) = (char *) 0; (yy_init) = 0; (yy_start) = 0; /* Defined in main.c */ #ifdef YY_STDINIT zconfin = stdin; zconfout = stdout; #else zconfin = (FILE *) 0; zconfout = (FILE *) 0; #endif /* For future reference: Set errno on error, since we are called by * zconflex_init() */ return 0; } /* zconflex_destroy is for both reentrant and non-reentrant scanners. */ int zconflex_destroy (void) { /* Pop the buffer stack, destroying each element. */ while(YY_CURRENT_BUFFER){ zconf_delete_buffer(YY_CURRENT_BUFFER ); YY_CURRENT_BUFFER_LVALUE = NULL; zconfpop_buffer_state(); } /* Destroy the stack itself. */ zconffree((yy_buffer_stack) ); (yy_buffer_stack) = NULL; /* Reset the globals. This is important in a non-reentrant scanner so the next time * zconflex() is called, initialization will occur. */ yy_init_globals( ); return 0; } /* * Internal utility routines. */ #ifndef yytext_ptr static void yy_flex_strncpy (char* s1, yyconst char * s2, int n ) { register int i; for ( i = 0; i < n; ++i ) s1[i] = s2[i]; } #endif #ifdef YY_NEED_STRLEN static int yy_flex_strlen (yyconst char * s ) { register int n; for ( n = 0; s[n]; ++n ) ; return n; } #endif void *zconfalloc (yy_size_t size ) { return (void *) malloc( size ); } void *zconfrealloc (void * ptr, yy_size_t size ) { /* The cast to (char *) in the following accommodates both * implementations that use char* generic pointers, and those * that use void* generic pointers. It works with the latter * because both ANSI C and C++ allow castless assignment from * any pointer type to void*, and deal with argument conversions * as though doing an assignment. */ return (void *) realloc( (char *) ptr, size ); } void zconffree (void * ptr ) { free( (char *) ptr ); /* see zconfrealloc() for (char *) cast */ } #define YYTABLES_NAME "yytables" void zconf_starthelp(void) { new_string(); last_ts = first_ts = 0; BEGIN(HELP); } static void zconf_endhelp(void) { zconflval.string = text; BEGIN(INITIAL); } /* * Try to open specified file with following names: * ./name * $(srctree)/name * The latter is used when srctree is separate from objtree * when compiling the kernel. * Return NULL if file is not found. */ FILE *zconf_fopen(const char *name) { char *env, fullname[PATH_MAX+1]; FILE *f; f = fopen(name, "r"); if (!f && name != NULL && name[0] != '/') { env = getenv(SRCTREE); if (env) { sprintf(fullname, "%s/%s", env, name); f = fopen(fullname, "r"); } } return f; } void zconf_initscan(const char *name) { zconfin = zconf_fopen(name); if (!zconfin) { printf("can't find file %s\n", name); exit(1); } current_buf = malloc(sizeof(*current_buf)); memset(current_buf, 0, sizeof(*current_buf)); current_file = file_lookup(name); current_file->lineno = 1; current_file->flags = FILE_BUSY; } void zconf_nextfile(const char *name) { struct file *file = file_lookup(name); struct buffer *buf = malloc(sizeof(*buf)); memset(buf, 0, sizeof(*buf)); current_buf->state = YY_CURRENT_BUFFER; zconfin = zconf_fopen(file->name); if (!zconfin) { printf("%s:%d: can't open file \"%s\"\n", zconf_curname(), zconf_lineno(), file->name); exit(1); } zconf_switch_to_buffer(zconf_create_buffer(zconfin,YY_BUF_SIZE)); buf->parent = current_buf; current_buf = buf; if (file->flags & FILE_BUSY) { printf("%s:%d: do not source '%s' from itself\n", zconf_curname(), zconf_lineno(), name); exit(1); } if (file->flags & FILE_SCANNED) { printf("%s:%d: file '%s' is already sourced from '%s'\n", zconf_curname(), zconf_lineno(), name, file->parent->name); exit(1); } file->flags |= FILE_BUSY; file->lineno = 1; file->parent = current_file; current_file = file; } static void zconf_endfile(void) { struct buffer *parent; current_file->flags |= FILE_SCANNED; current_file->flags &= ~FILE_BUSY; current_file = current_file->parent; parent = current_buf->parent; if (parent) { fclose(zconfin); zconf_delete_buffer(YY_CURRENT_BUFFER); zconf_switch_to_buffer(parent->state); } free(current_buf); current_buf = parent; } int zconf_lineno(void) { return current_pos.lineno; } const char *zconf_curname(void) { return current_pos.file ? current_pos.file->name : ""; } tinyvisor/bios/tools/kconfig/lkc.h0000644006644000001440000001130711733243570017531 0ustar yuichi_xyusers/* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ #ifndef LKC_H #define LKC_H #include "expr.h" #ifndef KBUILD_NO_NLS # include #else static inline const char *gettext(const char *txt) { return txt; } static inline void textdomain(const char *domainname) {} static inline void bindtextdomain(const char *name, const char *dir) {} static inline char *bind_textdomain_codeset(const char *dn, char *c) { return c; } #endif #ifdef __cplusplus extern "C" { #endif #ifdef LKC_DIRECT_LINK #define P(name,type,arg) extern type name arg #else #include "lkc_defs.h" #define P(name,type,arg) extern type (*name ## _p) arg #endif #include "lkc_proto.h" #undef P #define SRCTREE "srctree" #ifndef PACKAGE #define PACKAGE "linux" #endif #define LOCALEDIR "/usr/share/locale" #define _(text) gettext(text) #define N_(text) (text) #ifndef CONFIG_ #define CONFIG_ "CONFIG_" #endif #define TF_COMMAND 0x0001 #define TF_PARAM 0x0002 #define TF_OPTION 0x0004 enum conf_def_mode { def_default, def_yes, def_mod, def_no, def_random }; #define T_OPT_MODULES 1 #define T_OPT_DEFCONFIG_LIST 2 #define T_OPT_ENV 3 struct kconf_id { int name; int token; unsigned int flags; enum symbol_type stype; }; #ifdef YYDEBUG extern int zconfdebug; #endif int zconfparse(void); void zconfdump(FILE *out); void zconf_starthelp(void); FILE *zconf_fopen(const char *name); void zconf_initscan(const char *name); void zconf_nextfile(const char *name); int zconf_lineno(void); const char *zconf_curname(void); /* conf.c */ void xfgets(char *str, int size, FILE *in); /* confdata.c */ const char *conf_get_configname(void); const char *conf_get_autoconfig_name(void); char *conf_get_default_confname(void); void sym_set_change_count(int count); void sym_add_change_count(int count); void conf_set_all_new_symbols(enum conf_def_mode mode); /* confdata.c and expr.c */ static inline void xfwrite(const void *str, size_t len, size_t count, FILE *out) { if (fwrite(str, len, count, out) < count) fprintf(stderr, "\nError in writing or end of file.\n"); } /* kconfig_load.c */ void kconfig_load(void); /* menu.c */ void _menu_init(void); void menu_warn(struct menu *menu, const char *fmt, ...); struct menu *menu_add_menu(void); void menu_end_menu(void); void menu_add_entry(struct symbol *sym); void menu_end_entry(void); void menu_add_dep(struct expr *dep); void menu_add_visibility(struct expr *dep); struct property *menu_add_prop(enum prop_type type, char *prompt, struct expr *expr, struct expr *dep); struct property *menu_add_prompt(enum prop_type type, char *prompt, struct expr *dep); void menu_add_expr(enum prop_type type, struct expr *expr, struct expr *dep); void menu_add_symbol(enum prop_type type, struct symbol *sym, struct expr *dep); void menu_add_option(int token, char *arg); void menu_finalize(struct menu *parent); void menu_set_type(int type); /* util.c */ struct file *file_lookup(const char *name); int file_write_dep(const char *name); struct gstr { size_t len; char *s; /* * when max_width is not zero long lines in string s (if any) get * wrapped not to exceed the max_width value */ int max_width; }; struct gstr str_new(void); struct gstr str_assign(const char *s); void str_free(struct gstr *gs); void str_append(struct gstr *gs, const char *s); void str_printf(struct gstr *gs, const char *fmt, ...); const char *str_get(struct gstr *gs); /* symbol.c */ extern struct expr *sym_env_list; void sym_init(void); void sym_clear_all_valid(void); void sym_set_all_changed(void); void sym_set_changed(struct symbol *sym); struct symbol *sym_choice_default(struct symbol *sym); const char *sym_get_string_default(struct symbol *sym); struct symbol *sym_check_deps(struct symbol *sym); struct property *prop_alloc(enum prop_type type, struct symbol *sym); struct symbol *prop_get_symbol(struct property *prop); struct property *sym_get_env_prop(struct symbol *sym); static inline tristate sym_get_tristate_value(struct symbol *sym) { return sym->curr.tri; } static inline struct symbol *sym_get_choice_value(struct symbol *sym) { return (struct symbol *)sym->curr.val; } static inline bool sym_set_choice_value(struct symbol *ch, struct symbol *chval) { return sym_set_tristate_value(chval, yes); } static inline bool sym_is_choice(struct symbol *sym) { return sym->flags & SYMBOL_CHOICE ? true : false; } static inline bool sym_is_choice_value(struct symbol *sym) { return sym->flags & SYMBOL_CHOICEVAL ? true : false; } static inline bool sym_is_optional(struct symbol *sym) { return sym->flags & SYMBOL_OPTIONAL ? true : false; } static inline bool sym_has_value(struct symbol *sym) { return sym->flags & SYMBOL_DEF_USER ? true : false; } #ifdef __cplusplus } #endif #endif /* LKC_H */ tinyvisor/bios/tools/kconfig/confdata.c0000644006644000001440000005443511733243570020543 0ustar yuichi_xyusers/* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ #include #include #include #include #include #include #include #include #include #define LKC_DIRECT_LINK #include "lkc.h" static void conf_warning(const char *fmt, ...) __attribute__ ((format (printf, 1, 2))); static void conf_message(const char *fmt, ...) __attribute__ ((format (printf, 1, 2))); static const char *conf_filename; static int conf_lineno, conf_warnings, conf_unsaved; const char conf_defname[] = "arch/$ARCH/defconfig"; static void conf_warning(const char *fmt, ...) { va_list ap; va_start(ap, fmt); fprintf(stderr, "%s:%d:warning: ", conf_filename, conf_lineno); vfprintf(stderr, fmt, ap); fprintf(stderr, "\n"); va_end(ap); conf_warnings++; } static void conf_default_message_callback(const char *fmt, va_list ap) { printf("#\n# "); vprintf(fmt, ap); printf("\n#\n"); } static void (*conf_message_callback) (const char *fmt, va_list ap) = conf_default_message_callback; void conf_set_message_callback(void (*fn) (const char *fmt, va_list ap)) { conf_message_callback = fn; } static void conf_message(const char *fmt, ...) { va_list ap; va_start(ap, fmt); if (conf_message_callback) conf_message_callback(fmt, ap); } const char *conf_get_configname(void) { char *name = getenv("KCONFIG_CONFIG"); return name ? name : ".config"; } const char *conf_get_autoconfig_name(void) { char *name = getenv("KCONFIG_AUTOCONFIG"); return name ? name : "include/config/auto.conf"; } static char *conf_expand_value(const char *in) { struct symbol *sym; const char *src; static char res_value[SYMBOL_MAXLENGTH]; char *dst, name[SYMBOL_MAXLENGTH]; res_value[0] = 0; dst = name; while ((src = strchr(in, '$'))) { strncat(res_value, in, src - in); src++; dst = name; while (isalnum(*src) || *src == '_') *dst++ = *src++; *dst = 0; sym = sym_lookup(name, 0); sym_calc_value(sym); strcat(res_value, sym_get_string_value(sym)); in = src; } strcat(res_value, in); return res_value; } char *conf_get_default_confname(void) { struct stat buf; static char fullname[PATH_MAX+1]; char *env, *name; name = conf_expand_value(conf_defname); env = getenv(SRCTREE); if (env) { sprintf(fullname, "%s/%s", env, name); if (!stat(fullname, &buf)) return fullname; } return name; } static int conf_set_sym_val(struct symbol *sym, int def, int def_flags, char *p) { char *p2; switch (sym->type) { case S_TRISTATE: if (p[0] == 'm') { sym->def[def].tri = mod; sym->flags |= def_flags; break; } case S_BOOLEAN: if (p[0] == 'y') { sym->def[def].tri = yes; sym->flags |= def_flags; break; } if (p[0] == 'n') { sym->def[def].tri = no; sym->flags |= def_flags; break; } conf_warning("symbol value '%s' invalid for %s", p, sym->name); break; case S_OTHER: if (*p != '"') { for (p2 = p; *p2 && !isspace(*p2); p2++) ; sym->type = S_STRING; goto done; } case S_STRING: if (*p++ != '"') break; for (p2 = p; (p2 = strpbrk(p2, "\"\\")); p2++) { if (*p2 == '"') { *p2 = 0; break; } memmove(p2, p2 + 1, strlen(p2)); } if (!p2) { conf_warning("invalid string found"); return 1; } case S_INT: case S_HEX: done: if (sym_string_valid(sym, p)) { sym->def[def].val = strdup(p); sym->flags |= def_flags; } else { conf_warning("symbol value '%s' invalid for %s", p, sym->name); return 1; } break; default: ; } return 0; } int conf_read_simple(const char *name, int def) { FILE *in = NULL; char line[1024]; char *p, *p2; struct symbol *sym; int i, def_flags; if (name) { in = zconf_fopen(name); } else { struct property *prop; name = conf_get_configname(); in = zconf_fopen(name); if (in) goto load; sym_add_change_count(1); if (!sym_defconfig_list) { if (modules_sym) sym_calc_value(modules_sym); return 1; } for_all_defaults(sym_defconfig_list, prop) { if (expr_calc_value(prop->visible.expr) == no || prop->expr->type != E_SYMBOL) continue; name = conf_expand_value(prop->expr->left.sym->name); in = zconf_fopen(name); if (in) { conf_message(_("using defaults found in %s"), name); goto load; } } } if (!in) return 1; load: conf_filename = name; conf_lineno = 0; conf_warnings = 0; conf_unsaved = 0; def_flags = SYMBOL_DEF << def; for_all_symbols(i, sym) { sym->flags |= SYMBOL_CHANGED; sym->flags &= ~(def_flags|SYMBOL_VALID); if (sym_is_choice(sym)) sym->flags |= def_flags; switch (sym->type) { case S_INT: case S_HEX: case S_STRING: if (sym->def[def].val) free(sym->def[def].val); default: sym->def[def].val = NULL; sym->def[def].tri = no; } } while (fgets(line, sizeof(line), in)) { conf_lineno++; sym = NULL; if (line[0] == '#') { if (memcmp(line + 2, CONFIG_, strlen(CONFIG_))) continue; p = strchr(line + 2 + strlen(CONFIG_), ' '); if (!p) continue; *p++ = 0; if (strncmp(p, "is not set", 10)) continue; if (def == S_DEF_USER) { sym = sym_find(line + 2 + strlen(CONFIG_)); if (!sym) { sym_add_change_count(1); goto setsym; } } else { sym = sym_lookup(line + 2 + strlen(CONFIG_), 0); if (sym->type == S_UNKNOWN) sym->type = S_BOOLEAN; } if (sym->flags & def_flags) { conf_warning("override: reassigning to symbol %s", sym->name); } switch (sym->type) { case S_BOOLEAN: case S_TRISTATE: sym->def[def].tri = no; sym->flags |= def_flags; break; default: ; } } else if (memcmp(line, CONFIG_, strlen(CONFIG_)) == 0) { p = strchr(line + strlen(CONFIG_), '='); if (!p) continue; *p++ = 0; p2 = strchr(p, '\n'); if (p2) { *p2-- = 0; if (*p2 == '\r') *p2 = 0; } if (def == S_DEF_USER) { sym = sym_find(line + strlen(CONFIG_)); if (!sym) { sym_add_change_count(1); goto setsym; } } else { sym = sym_lookup(line + strlen(CONFIG_), 0); if (sym->type == S_UNKNOWN) sym->type = S_OTHER; } if (sym->flags & def_flags) { conf_warning("override: reassigning to symbol %s", sym->name); } if (conf_set_sym_val(sym, def, def_flags, p)) continue; } else { if (line[0] != '\r' && line[0] != '\n') conf_warning("unexpected data"); continue; } setsym: if (sym && sym_is_choice_value(sym)) { struct symbol *cs = prop_get_symbol(sym_get_choice_prop(sym)); switch (sym->def[def].tri) { case no: break; case mod: if (cs->def[def].tri == yes) { conf_warning("%s creates inconsistent choice state", sym->name); cs->flags &= ~def_flags; } break; case yes: if (cs->def[def].tri != no) conf_warning("override: %s changes choice state", sym->name); cs->def[def].val = sym; break; } cs->def[def].tri = EXPR_OR(cs->def[def].tri, sym->def[def].tri); } } fclose(in); if (modules_sym) sym_calc_value(modules_sym); return 0; } int conf_read(const char *name) { struct symbol *sym, *choice_sym; struct property *prop; struct expr *e; int i, flags; sym_set_change_count(0); if (conf_read_simple(name, S_DEF_USER)) return 1; for_all_symbols(i, sym) { sym_calc_value(sym); if (sym_is_choice(sym) || (sym->flags & SYMBOL_AUTO)) goto sym_ok; if (sym_has_value(sym) && (sym->flags & SYMBOL_WRITE)) { /* check that calculated value agrees with saved value */ switch (sym->type) { case S_BOOLEAN: case S_TRISTATE: if (sym->def[S_DEF_USER].tri != sym_get_tristate_value(sym)) break; if (!sym_is_choice(sym)) goto sym_ok; default: if (!strcmp(sym->curr.val, sym->def[S_DEF_USER].val)) goto sym_ok; break; } } else if (!sym_has_value(sym) && !(sym->flags & SYMBOL_WRITE)) /* no previous value and not saved */ goto sym_ok; conf_unsaved++; /* maybe print value in verbose mode... */ sym_ok: if (!sym_is_choice(sym)) continue; /* The choice symbol only has a set value (and thus is not new) * if all its visible childs have values. */ prop = sym_get_choice_prop(sym); flags = sym->flags; expr_list_for_each_sym(prop->expr, e, choice_sym) if (choice_sym->visible != no) flags &= choice_sym->flags; sym->flags &= flags | ~SYMBOL_DEF_USER; } for_all_symbols(i, sym) { if (sym_has_value(sym) && !sym_is_choice_value(sym)) { /* Reset values of generates values, so they'll appear * as new, if they should become visible, but that * doesn't quite work if the Kconfig and the saved * configuration disagree. */ if (sym->visible == no && !conf_unsaved) sym->flags &= ~SYMBOL_DEF_USER; switch (sym->type) { case S_STRING: case S_INT: case S_HEX: /* Reset a string value if it's out of range */ if (sym_string_within_range(sym, sym->def[S_DEF_USER].val)) break; sym->flags &= ~(SYMBOL_VALID|SYMBOL_DEF_USER); conf_unsaved++; break; default: break; } } } sym_add_change_count(conf_warnings || conf_unsaved); return 0; } /* Write a S_STRING */ static void conf_write_string(bool headerfile, const char *name, const char *str, FILE *out) { int l; if (headerfile) fprintf(out, "#define %s%s \"", CONFIG_, name); else fprintf(out, "%s%s=\"", CONFIG_, name); while (1) { l = strcspn(str, "\"\\"); if (l) { xfwrite(str, l, 1, out); str += l; } if (!*str) break; fprintf(out, "\\%c", *str++); } fputs("\"\n", out); } static void conf_write_symbol(struct symbol *sym, FILE *out, bool write_no) { const char *str; switch (sym->type) { case S_BOOLEAN: case S_TRISTATE: switch (sym_get_tristate_value(sym)) { case no: if (write_no) fprintf(out, "# %s%s is not set\n", CONFIG_, sym->name); break; case mod: fprintf(out, "%s%s=m\n", CONFIG_, sym->name); break; case yes: fprintf(out, "%s%s=y\n", CONFIG_, sym->name); break; } break; case S_STRING: conf_write_string(false, sym->name, sym_get_string_value(sym), out); break; case S_HEX: case S_INT: str = sym_get_string_value(sym); fprintf(out, "%s%s=%s\n", CONFIG_, sym->name, str); break; case S_OTHER: case S_UNKNOWN: break; } } /* * Write out a minimal config. * All values that has default values are skipped as this is redundant. */ int conf_write_defconfig(const char *filename) { struct symbol *sym; struct menu *menu; FILE *out; out = fopen(filename, "w"); if (!out) return 1; sym_clear_all_valid(); /* Traverse all menus to find all relevant symbols */ menu = rootmenu.list; while (menu != NULL) { sym = menu->sym; if (sym == NULL) { if (!menu_is_visible(menu)) goto next_menu; } else if (!sym_is_choice(sym)) { sym_calc_value(sym); if (!(sym->flags & SYMBOL_WRITE)) goto next_menu; sym->flags &= ~SYMBOL_WRITE; /* If we cannot change the symbol - skip */ if (!sym_is_changable(sym)) goto next_menu; /* If symbol equals to default value - skip */ if (strcmp(sym_get_string_value(sym), sym_get_string_default(sym)) == 0) goto next_menu; /* * If symbol is a choice value and equals to the * default for a choice - skip. * But only if value is bool and equal to "y" and * choice is not "optional". * (If choice is "optional" then all values can be "n") */ if (sym_is_choice_value(sym)) { struct symbol *cs; struct symbol *ds; cs = prop_get_symbol(sym_get_choice_prop(sym)); ds = sym_choice_default(cs); if (!sym_is_optional(cs) && sym == ds) { if ((sym->type == S_BOOLEAN) && sym_get_tristate_value(sym) == yes) goto next_menu; } } conf_write_symbol(sym, out, true); } next_menu: if (menu->list != NULL) { menu = menu->list; } else if (menu->next != NULL) { menu = menu->next; } else { while ((menu = menu->parent)) { if (menu->next != NULL) { menu = menu->next; break; } } } } fclose(out); return 0; } int conf_write(const char *name) { FILE *out; struct symbol *sym; struct menu *menu; const char *basename; const char *str; char dirname[PATH_MAX+1], tmpname[PATH_MAX+1], newname[PATH_MAX+1]; time_t now; int use_timestamp = 1; char *env; dirname[0] = 0; if (name && name[0]) { struct stat st; char *slash; if (!stat(name, &st) && S_ISDIR(st.st_mode)) { strcpy(dirname, name); strcat(dirname, "/"); basename = conf_get_configname(); } else if ((slash = strrchr(name, '/'))) { int size = slash - name + 1; memcpy(dirname, name, size); dirname[size] = 0; if (slash[1]) basename = slash + 1; else basename = conf_get_configname(); } else basename = name; } else basename = conf_get_configname(); sprintf(newname, "%s%s", dirname, basename); env = getenv("KCONFIG_OVERWRITECONFIG"); if (!env || !*env) { sprintf(tmpname, "%s.tmpconfig.%d", dirname, (int)getpid()); out = fopen(tmpname, "w"); } else { *tmpname = 0; out = fopen(newname, "w"); } if (!out) return 1; time(&now); env = getenv("KCONFIG_NOTIMESTAMP"); if (env && *env) use_timestamp = 0; fprintf(out, _("#\n" "# Automatically generated make config: don't edit\n" "# %s\n" "%s%s" "#\n"), rootmenu.prompt->text, use_timestamp ? "# " : "", use_timestamp ? ctime(&now) : ""); if (!conf_get_changed()) sym_clear_all_valid(); menu = rootmenu.list; while (menu) { sym = menu->sym; if (!sym) { if (!menu_is_visible(menu)) goto next; str = menu_get_prompt(menu); fprintf(out, "\n" "#\n" "# %s\n" "#\n", str); } else if (!(sym->flags & SYMBOL_CHOICE)) { sym_calc_value(sym); if (!(sym->flags & SYMBOL_WRITE)) goto next; sym->flags &= ~SYMBOL_WRITE; /* Write config symbol to file */ conf_write_symbol(sym, out, true); } next: if (menu->list) { menu = menu->list; continue; } if (menu->next) menu = menu->next; else while ((menu = menu->parent)) { if (menu->next) { menu = menu->next; break; } } } fclose(out); if (*tmpname) { strcat(dirname, basename); strcat(dirname, ".old"); rename(newname, dirname); if (rename(tmpname, newname)) return 1; } conf_message(_("configuration written to %s"), newname); sym_set_change_count(0); return 0; } static int conf_split_config(void) { const char *name; char path[PATH_MAX+1]; char *s, *d, c; struct symbol *sym; struct stat sb; int res, i, fd; name = conf_get_autoconfig_name(); conf_read_simple(name, S_DEF_AUTO); if (chdir("include/config")) return 1; res = 0; for_all_symbols(i, sym) { sym_calc_value(sym); if ((sym->flags & SYMBOL_AUTO) || !sym->name) continue; if (sym->flags & SYMBOL_WRITE) { if (sym->flags & SYMBOL_DEF_AUTO) { /* * symbol has old and new value, * so compare them... */ switch (sym->type) { case S_BOOLEAN: case S_TRISTATE: if (sym_get_tristate_value(sym) == sym->def[S_DEF_AUTO].tri) continue; break; case S_STRING: case S_HEX: case S_INT: if (!strcmp(sym_get_string_value(sym), sym->def[S_DEF_AUTO].val)) continue; break; default: break; } } else { /* * If there is no old value, only 'no' (unset) * is allowed as new value. */ switch (sym->type) { case S_BOOLEAN: case S_TRISTATE: if (sym_get_tristate_value(sym) == no) continue; break; default: break; } } } else if (!(sym->flags & SYMBOL_DEF_AUTO)) /* There is neither an old nor a new value. */ continue; /* else * There is an old value, but no new value ('no' (unset) * isn't saved in auto.conf, so the old value is always * different from 'no'). */ /* Replace all '_' and append ".h" */ s = sym->name; d = path; while ((c = *s++)) { c = tolower(c); *d++ = (c == '_') ? '/' : c; } strcpy(d, ".h"); /* Assume directory path already exists. */ fd = open(path, O_WRONLY | O_CREAT | O_TRUNC, 0644); if (fd == -1) { if (errno != ENOENT) { res = 1; break; } /* * Create directory components, * unless they exist already. */ d = path; while ((d = strchr(d, '/'))) { *d = 0; if (stat(path, &sb) && mkdir(path, 0755)) { res = 1; goto out; } *d++ = '/'; } /* Try it again. */ fd = open(path, O_WRONLY | O_CREAT | O_TRUNC, 0644); if (fd == -1) { res = 1; break; } } close(fd); } out: if (chdir("../..")) return 1; return res; } int conf_write_autoconf(void) { struct symbol *sym; const char *str; const char *name; FILE *out, *tristate, *out_h; time_t now; int i; sym_clear_all_valid(); file_write_dep("include/config/auto.conf.cmd"); if (conf_split_config()) return 1; out = fopen(".tmpconfig", "w"); if (!out) return 1; tristate = fopen(".tmpconfig_tristate", "w"); if (!tristate) { fclose(out); return 1; } out_h = fopen(".tmpconfig.h", "w"); if (!out_h) { fclose(out); fclose(tristate); return 1; } time(&now); fprintf(out, "#\n" "# Automatically generated make config: don't edit\n" "# %s\n" "# %s" "#\n", rootmenu.prompt->text, ctime(&now)); fprintf(tristate, "#\n" "# Automatically generated - do not edit\n" "\n"); fprintf(out_h, "/*\n" " * Automatically generated C config: don't edit\n" " * %s\n" " * %s" " */\n", rootmenu.prompt->text, ctime(&now)); for_all_symbols(i, sym) { sym_calc_value(sym); if (!sym->name) continue; if (!(sym->flags & SYMBOL_WRITE)) { if (sym->type == S_BOOLEAN || sym->type == S_HEX || sym->type == S_INT) fprintf(out_h, "#define %s%s 0\n", CONFIG_, sym->name); continue; } /* write symbol to config file */ conf_write_symbol(sym, out, false); /* update autoconf and tristate files */ switch (sym->type) { case S_BOOLEAN: case S_TRISTATE: switch (sym_get_tristate_value(sym)) { case no: fprintf(out_h, "#define %s%s 0\n", CONFIG_, sym->name); break; case mod: fprintf(tristate, "%s%s=M\n", CONFIG_, sym->name); fprintf(out_h, "#define %s%s_MODULE 1\n", CONFIG_, sym->name); break; case yes: if (sym->type == S_TRISTATE) fprintf(tristate,"%s%s=Y\n", CONFIG_, sym->name); fprintf(out_h, "#define %s%s 1\n", CONFIG_, sym->name); break; } break; case S_STRING: conf_write_string(true, sym->name, sym_get_string_value(sym), out_h); break; case S_HEX: str = sym_get_string_value(sym); if (str[0] != '0' || (str[1] != 'x' && str[1] != 'X')) { fprintf(out_h, "#define %s%s 0x%s\n", CONFIG_, sym->name, str); break; } case S_INT: str = sym_get_string_value(sym); fprintf(out_h, "#define %s%s %s\n", CONFIG_, sym->name, str); break; default: break; } } fclose(out); fclose(tristate); fclose(out_h); name = getenv("KCONFIG_AUTOHEADER"); if (!name) name = "include/generated/autoconf.h"; if (rename(".tmpconfig.h", name)) return 1; name = getenv("KCONFIG_TRISTATE"); if (!name) name = "include/config/tristate.conf"; if (rename(".tmpconfig_tristate", name)) return 1; name = conf_get_autoconfig_name(); /* * This must be the last step, kbuild has a dependency on auto.conf * and this marks the successful completion of the previous steps. */ if (rename(".tmpconfig", name)) return 1; return 0; } static int sym_change_count; static void (*conf_changed_callback)(void); void sym_set_change_count(int count) { int _sym_change_count = sym_change_count; sym_change_count = count; if (conf_changed_callback && (bool)_sym_change_count != (bool)count) conf_changed_callback(); } void sym_add_change_count(int count) { sym_set_change_count(count + sym_change_count); } bool conf_get_changed(void) { return sym_change_count; } void conf_set_changed_callback(void (*fn)(void)) { conf_changed_callback = fn; } static void randomize_choice_values(struct symbol *csym) { struct property *prop; struct symbol *sym; struct expr *e; int cnt, def; /* * If choice is mod then we may have more items selected * and if no then no-one. * In both cases stop. */ if (csym->curr.tri != yes) return; prop = sym_get_choice_prop(csym); /* count entries in choice block */ cnt = 0; expr_list_for_each_sym(prop->expr, e, sym) cnt++; /* * find a random value and set it to yes, * set the rest to no so we have only one set */ def = (rand() % cnt); cnt = 0; expr_list_for_each_sym(prop->expr, e, sym) { if (def == cnt++) { sym->def[S_DEF_USER].tri = yes; csym->def[S_DEF_USER].val = sym; } else { sym->def[S_DEF_USER].tri = no; } } csym->flags |= SYMBOL_DEF_USER; /* clear VALID to get value calculated */ csym->flags &= ~(SYMBOL_VALID); } static void set_all_choice_values(struct symbol *csym) { struct property *prop; struct symbol *sym; struct expr *e; prop = sym_get_choice_prop(csym); /* * Set all non-assinged choice values to no */ expr_list_for_each_sym(prop->expr, e, sym) { if (!sym_has_value(sym)) sym->def[S_DEF_USER].tri = no; } csym->flags |= SYMBOL_DEF_USER; /* clear VALID to get value calculated */ csym->flags &= ~(SYMBOL_VALID); } void conf_set_all_new_symbols(enum conf_def_mode mode) { struct symbol *sym, *csym; int i, cnt; for_all_symbols(i, sym) { if (sym_has_value(sym)) continue; switch (sym_get_type(sym)) { case S_BOOLEAN: case S_TRISTATE: switch (mode) { case def_yes: sym->def[S_DEF_USER].tri = yes; break; case def_mod: sym->def[S_DEF_USER].tri = mod; break; case def_no: sym->def[S_DEF_USER].tri = no; break; case def_random: cnt = sym_get_type(sym) == S_TRISTATE ? 3 : 2; sym->def[S_DEF_USER].tri = (tristate)(rand() % cnt); break; default: continue; } if (!(sym_is_choice(sym) && mode == def_random)) sym->flags |= SYMBOL_DEF_USER; break; default: break; } } sym_clear_all_valid(); /* * We have different type of choice blocks. * If curr.tri equals to mod then we can select several * choice symbols in one block. * In this case we do nothing. * If curr.tri equals yes then only one symbol can be * selected in a choice block and we set it to yes, * and the rest to no. */ for_all_symbols(i, csym) { if (sym_has_value(csym) || !sym_is_choice(csym)) continue; sym_calc_value(csym); if (mode == def_random) randomize_choice_values(csym); else set_all_choice_values(csym); } } tinyvisor/bios/tools/kconfig/Makefile0000644006644000001440000003005111733243570020244 0ustar yuichi_xyusers# =========================================================================== # Kernel configuration targets # These targets are used from top-level makefile PHONY += oldconfig xconfig gconfig menuconfig config silentoldconfig update-po-config \ localmodconfig localyesconfig ifdef KBUILD_KCONFIG Kconfig := $(KBUILD_KCONFIG) else Kconfig := Kconfig endif xconfig: $(obj)/qconf $< $(Kconfig) gconfig: $(obj)/gconf $< $(Kconfig) menuconfig: $(obj)/mconf $< $(Kconfig) config: $(obj)/conf $< --oldaskconfig $(Kconfig) nconfig: $(obj)/nconf $< $(Kconfig) oldconfig: $(obj)/conf $< --$@ $(Kconfig) silentoldconfig: $(obj)/conf @echo " Build Kconfig config file" $(Q)mkdir -p include/generated $(Q)$< --$@ $(Kconfig) # if no path is given, then use src directory to find file ifdef LSMOD LSMOD_F := $(LSMOD) ifeq ($(findstring /,$(LSMOD)),) LSMOD_F := $(objtree)/$(LSMOD) endif endif localmodconfig: $(obj)/streamline_config.pl $(obj)/conf $(Q)mkdir -p include/generated $(Q)perl $< $(srctree) $(Kconfig) $(LSMOD_F) > .tmp.config $(Q)if [ -f .config ]; then \ cmp -s .tmp.config .config || \ (mv -f .config .config.old.1; \ mv -f .tmp.config .config; \ $(obj)/conf --silentoldconfig $(Kconfig); \ mv -f .config.old.1 .config.old) \ else \ mv -f .tmp.config .config; \ $(obj)/conf --silentoldconfig $(Kconfig); \ fi $(Q)rm -f .tmp.config localyesconfig: $(obj)/streamline_config.pl $(obj)/conf $(Q)mkdir -p include/generated $(Q)perl $< $(srctree) $(Kconfig) $(LSMOD_F) > .tmp.config $(Q)sed -i s/=m/=y/ .tmp.config $(Q)if [ -f .config ]; then \ cmp -s .tmp.config .config || \ (mv -f .config .config.old.1; \ mv -f .tmp.config .config; \ $(obj)/conf --silentoldconfig $(Kconfig); \ mv -f .config.old.1 .config.old) \ else \ mv -f .tmp.config .config; \ $(obj)/conf --silentoldconfig $(Kconfig); \ fi $(Q)rm -f .tmp.config # Create new linux.pot file # Adjust charset to UTF-8 in .po file to accept UTF-8 in Kconfig files # The symlink is used to repair a deficiency in arch/um update-po-config: $(obj)/kxgettext $(obj)/gconf.glade.h $(Q)echo " GEN config" $(Q)xgettext --default-domain=linux \ --add-comments --keyword=_ --keyword=N_ \ --from-code=UTF-8 \ --files-from=tools/kconfig/POTFILES.in \ --output $(obj)/config.pot $(Q)sed -i s/CHARSET/UTF-8/ $(obj)/config.pot $(Q)ln -fs Kconfig.i386 arch/um/Kconfig.arch $(Q)(for i in `ls arch/*/Kconfig`; \ do \ echo " GEN $$i"; \ $(obj)/kxgettext $$i \ >> $(obj)/config.pot; \ done ) $(Q)msguniq --sort-by-file --to-code=UTF-8 $(obj)/config.pot \ --output $(obj)/linux.pot $(Q)rm -f arch/um/Kconfig.arch $(Q)rm -f $(obj)/config.pot PHONY += allnoconfig allyesconfig allmodconfig alldefconfig randconfig allnoconfig allyesconfig allmodconfig alldefconfig randconfig: $(obj)/conf $< --$@ $(Kconfig) PHONY += listnewconfig oldnoconfig savedefconfig defconfig listnewconfig oldnoconfig: $(obj)/conf $< --$@ $(Kconfig) savedefconfig: $(obj)/conf $< --$@=defconfig $(Kconfig) defconfig: $(obj)/conf @echo " Build default config" $(Q)$< --defconfig=/dev/null $(Kconfig) # Help text used by make help help: @echo ' config - Update current config utilising a line-oriented program' @echo ' nconfig - Update current config utilising a ncurses menu based program' @echo ' menuconfig - Update current config utilising a menu based program' @echo ' xconfig - Update current config utilising a QT based front-end' @echo ' gconfig - Update current config utilising a GTK based front-end' @echo ' oldconfig - Update current config utilising a provided .config as base' @echo ' localmodconfig - Update current config disabling modules not loaded' @echo ' localyesconfig - Update current config converting local mods to core' @echo ' silentoldconfig - Same as oldconfig, but quietly, additionally update deps' @echo ' defconfig - New config with default from ARCH supplied defconfig' @echo ' savedefconfig - Save current config as ./defconfig (minimal config)' @echo ' allnoconfig - New config where all options are answered with no' @echo ' allyesconfig - New config where all options are accepted with yes' @echo ' allmodconfig - New config selecting modules when possible' @echo ' alldefconfig - New config with all symbols set to default' @echo ' randconfig - New config with random answer to all options' @echo ' listnewconfig - List new options' @echo ' oldnoconfig - Same as silentoldconfig but set new symbols to n (unset)' # lxdialog stuff check-lxdialog := $(srctree)/$(src)/lxdialog/check-lxdialog.sh # Use recursively expanded variables so we do not call gcc unless # we really need to do so. (Do not call gcc as part of make mrproper) HOST_EXTRACFLAGS += $(shell $(CONFIG_SHELL) $(check-lxdialog) -ccflags) \ -DLOCALE # =========================================================================== # Shared Makefile for the various kconfig executables: # conf: Used for defconfig, oldconfig and related targets # nconf: Used for the nconfig target. # Utilizes ncurses # mconf: Used for the menuconfig target # Utilizes the lxdialog package # qconf: Used for the xconfig target # Based on QT which needs to be installed to compile it # gconf: Used for the gconfig target # Based on GTK which needs to be installed to compile it # object files used by all kconfig flavours lxdialog := lxdialog/checklist.o lxdialog/util.o lxdialog/inputbox.o lxdialog += lxdialog/textbox.o lxdialog/yesno.o lxdialog/menubox.o conf-objs := conf.o zconf.tab.o mconf-objs := mconf.o zconf.tab.o $(lxdialog) nconf-objs := nconf.o zconf.tab.o nconf.gui.o kxgettext-objs := kxgettext.o zconf.tab.o hostprogs-y := conf qconf gconf kxgettext ifeq ($(MAKECMDGOALS),nconfig) hostprogs-y += nconf endif ifeq ($(MAKECMDGOALS),menuconfig) hostprogs-y += mconf endif ifeq ($(MAKECMDGOALS),xconfig) qconf-target := 1 endif ifeq ($(MAKECMDGOALS),gconfig) gconf-target := 1 endif ifeq ($(qconf-target),1) qconf-cxxobjs := qconf.o qconf-objs := kconfig_load.o zconf.tab.o endif ifeq ($(gconf-target),1) gconf-objs := gconf.o kconfig_load.o zconf.tab.o endif clean-files := lkc_defs.h qconf.moc .tmp_qtcheck \ .tmp_gtkcheck zconf.tab.c lex.zconf.c zconf.hash.c gconf.glade.h clean-files += mconf qconf gconf nconf clean-files += config.pot linux.pot # Check that we have the required ncurses stuff installed for lxdialog (menuconfig) PHONY += $(obj)/dochecklxdialog $(addprefix $(obj)/,$(lxdialog)): $(obj)/dochecklxdialog $(obj)/dochecklxdialog: $(Q)$(CONFIG_SHELL) $(check-lxdialog) -check $(HOSTCC) $(HOST_EXTRACFLAGS) $(HOSTLOADLIBES_mconf) always := dochecklxdialog # Add environment specific flags HOST_EXTRACFLAGS += $(shell $(CONFIG_SHELL) $(srctree)/$(src)/check.sh $(HOSTCC) $(HOSTCFLAGS)) # generated files seem to need this to find local include files HOSTCFLAGS_lex.zconf.o := -I$(src) HOSTCFLAGS_zconf.tab.o := -I$(src) HOSTLOADLIBES_qconf = $(KC_QT_LIBS) -ldl HOSTCXXFLAGS_qconf.o = $(KC_QT_CFLAGS) -D LKC_DIRECT_LINK HOSTLOADLIBES_gconf = `pkg-config --libs gtk+-2.0 gmodule-2.0 libglade-2.0` -ldl HOSTCFLAGS_gconf.o = `pkg-config --cflags gtk+-2.0 gmodule-2.0 libglade-2.0` \ -D LKC_DIRECT_LINK HOSTLOADLIBES_mconf = $(shell $(CONFIG_SHELL) $(check-lxdialog) -ldflags $(HOSTCC)) HOSTLOADLIBES_nconf = -lmenu -lpanel -lncurses $(obj)/qconf.o: $(obj)/.tmp_qtcheck ifeq ($(qconf-target),1) $(obj)/.tmp_qtcheck: $(src)/Makefile -include $(obj)/.tmp_qtcheck # QT needs some extra effort... $(obj)/.tmp_qtcheck: @set -e; echo " CHECK qt"; dir=""; pkg=""; \ if ! pkg-config --exists QtCore 2> /dev/null; then \ echo "* Unable to find the QT4 tool qmake. Trying to use QT3"; \ pkg-config --exists qt 2> /dev/null && pkg=qt; \ pkg-config --exists qt-mt 2> /dev/null && pkg=qt-mt; \ if [ -n "$$pkg" ]; then \ cflags="\$$(shell pkg-config $$pkg --cflags)"; \ libs="\$$(shell pkg-config $$pkg --libs)"; \ moc="\$$(shell pkg-config $$pkg --variable=prefix)/bin/moc"; \ dir="$$(pkg-config $$pkg --variable=prefix)"; \ else \ for d in $$QTDIR /usr/share/qt* /usr/lib/qt*; do \ if [ -f $$d/include/qconfig.h ]; then dir=$$d; break; fi; \ done; \ if [ -z "$$dir" ]; then \ echo "*"; \ echo "* Unable to find any QT installation. Please make sure that"; \ echo "* the QT4 or QT3 development package is correctly installed and"; \ echo "* either qmake can be found or install pkg-config or set"; \ echo "* the QTDIR environment variable to the correct location."; \ echo "*"; \ false; \ fi; \ libpath=$$dir/lib; lib=qt; osdir=""; \ $(HOSTCXX) -print-multi-os-directory > /dev/null 2>&1 && \ osdir=x$$($(HOSTCXX) -print-multi-os-directory); \ test -d $$libpath/$$osdir && libpath=$$libpath/$$osdir; \ test -f $$libpath/libqt-mt.so && lib=qt-mt; \ cflags="-I$$dir/include"; \ libs="-L$$libpath -Wl,-rpath,$$libpath -l$$lib"; \ moc="$$dir/bin/moc"; \ fi; \ if [ ! -x $$dir/bin/moc -a -x /usr/bin/moc ]; then \ echo "*"; \ echo "* Unable to find $$dir/bin/moc, using /usr/bin/moc instead."; \ echo "*"; \ moc="/usr/bin/moc"; \ fi; \ else \ cflags="\$$(shell pkg-config QtCore QtGui Qt3Support --cflags)"; \ libs="\$$(shell pkg-config QtCore QtGui Qt3Support --libs)"; \ binpath="\$$(shell pkg-config QtCore --variable=prefix)"; \ moc="$$binpath/bin/moc"; \ fi; \ echo "KC_QT_CFLAGS=$$cflags" > $@; \ echo "KC_QT_LIBS=$$libs" >> $@; \ echo "KC_QT_MOC=$$moc" >> $@ endif $(obj)/gconf.o: $(obj)/.tmp_gtkcheck ifeq ($(gconf-target),1) -include $(obj)/.tmp_gtkcheck # GTK needs some extra effort, too... $(obj)/.tmp_gtkcheck: @if `pkg-config --exists gtk+-2.0 gmodule-2.0 libglade-2.0`; then \ if `pkg-config --atleast-version=2.0.0 gtk+-2.0`; then \ touch $@; \ else \ echo "*"; \ echo "* GTK+ is present but version >= 2.0.0 is required."; \ echo "*"; \ false; \ fi \ else \ echo "*"; \ echo "* Unable to find the GTK+ installation. Please make sure that"; \ echo "* the GTK+ 2.0 development package is correctly installed..."; \ echo "* You need gtk+-2.0, glib-2.0 and libglade-2.0."; \ echo "*"; \ false; \ fi endif $(obj)/zconf.tab.o: $(obj)/lex.zconf.c $(obj)/zconf.hash.c $(obj)/kconfig_load.o: $(obj)/lkc_defs.h $(obj)/qconf.o: $(obj)/qconf.moc $(obj)/lkc_defs.h $(obj)/gconf.o: $(obj)/lkc_defs.h $(obj)/%.moc: $(src)/%.h $(KC_QT_MOC) -i $< -o $@ $(obj)/lkc_defs.h: $(src)/lkc_proto.h sed < $< > $@ 's/P(\([^,]*\),.*/#define \1 (\*\1_p)/' # Extract gconf menu items for I18N support $(obj)/gconf.glade.h: $(obj)/gconf.glade intltool-extract --type=gettext/glade $(obj)/gconf.glade ### # The following requires flex/bison/gperf # By default we use the _shipped versions, uncomment the following line if # you are modifying the flex/bison src. # LKC_GENPARSER := 1 ifdef LKC_GENPARSER $(obj)/zconf.tab.c: $(src)/zconf.y $(obj)/lex.zconf.c: $(src)/zconf.l $(obj)/zconf.hash.c: $(src)/zconf.gperf %.tab.c: %.y bison -l -b $* -p $(notdir $*) $< cp $@ $@_shipped lex.%.c: %.l flex -L -P$(notdir $*) -o$@ $< cp $@ $@_shipped %.hash.c: %.gperf gperf < $< > $@ cp $@ $@_shipped endif VPATH := $(srctree) $(obj)/%:: $(src)/%_shipped $(Q)cat $< > $@ host-cobjs := $(sort $(foreach m,$(hostprogs-y),$($(m)-objs))) host-cobjs := $(addprefix $(obj)/,$(host-cobjs)) hostprogs-y := $(addprefix $(obj)/,$(hostprogs-y)) $(host-cobjs) : $(obj)/%.o : $(src)/%.c $(Q)$(HOSTCC) -I$(obj) -I$(srctree)/$(src) $(HOSTCFLAGS) $(HOSTCFLAGS_$(@F)) $(HOST_EXTRACFLAGS) -c -o $@ $< $(hostprogs-y) : $(obj)/% : $(host-cobjs) $(Q)$(HOSTCC) $(HOSTLDFLAGS) -o $@ $(addprefix $(obj)/,$($(@F)-objs)) $(HOST_LOADLIBES) $(HOSTLOADLIBES_$(@F)) tinyvisor/bios/tools/kconfig/qconf.cc0000644006644000001440000012665311733243570020237 0ustar yuichi_xyusers/* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ #include #if QT_VERSION < 0x040000 #include #include #include #include #include #include #include #include #include #else #include #include #include #include #include #include #include #include #include #endif #include #include #include #include #include #include #include #include #include #include #include #include #include #include "lkc.h" #include "qconf.h" #include "qconf.moc" #include "images.c" #ifdef _ # undef _ # define _ qgettext #endif static QApplication *configApp; static ConfigSettings *configSettings; Q3Action *ConfigMainWindow::saveAction; static inline QString qgettext(const char* str) { return QString::fromLocal8Bit(gettext(str)); } static inline QString qgettext(const QString& str) { return QString::fromLocal8Bit(gettext(str.latin1())); } /** * Reads a list of integer values from the application settings. */ Q3ValueList ConfigSettings::readSizes(const QString& key, bool *ok) { Q3ValueList result; QStringList entryList = readListEntry(key, ok); QStringList::Iterator it; for (it = entryList.begin(); it != entryList.end(); ++it) result.push_back((*it).toInt()); return result; } /** * Writes a list of integer values to the application settings. */ bool ConfigSettings::writeSizes(const QString& key, const Q3ValueList& value) { QStringList stringList; Q3ValueList::ConstIterator it; for (it = value.begin(); it != value.end(); ++it) stringList.push_back(QString::number(*it)); return writeEntry(key, stringList); } /* * set the new data * TODO check the value */ void ConfigItem::okRename(int col) { Parent::okRename(col); sym_set_string_value(menu->sym, text(dataColIdx).latin1()); listView()->updateList(this); } /* * update the displayed of a menu entry */ void ConfigItem::updateMenu(void) { ConfigList* list; struct symbol* sym; struct property *prop; QString prompt; int type; tristate expr; list = listView(); if (goParent) { setPixmap(promptColIdx, list->menuBackPix); prompt = ".."; goto set_prompt; } sym = menu->sym; prop = menu->prompt; prompt = _(menu_get_prompt(menu)); if (prop) switch (prop->type) { case P_MENU: if (list->mode == singleMode || list->mode == symbolMode) { /* a menuconfig entry is displayed differently * depending whether it's at the view root or a child. */ if (sym && list->rootEntry == menu) break; setPixmap(promptColIdx, list->menuPix); } else { if (sym) break; setPixmap(promptColIdx, 0); } goto set_prompt; case P_COMMENT: setPixmap(promptColIdx, 0); goto set_prompt; default: ; } if (!sym) goto set_prompt; setText(nameColIdx, QString::fromLocal8Bit(sym->name)); type = sym_get_type(sym); switch (type) { case S_BOOLEAN: case S_TRISTATE: char ch; if (!sym_is_changable(sym) && list->optMode == normalOpt) { setPixmap(promptColIdx, 0); setText(noColIdx, QString::null); setText(modColIdx, QString::null); setText(yesColIdx, QString::null); break; } expr = sym_get_tristate_value(sym); switch (expr) { case yes: if (sym_is_choice_value(sym) && type == S_BOOLEAN) setPixmap(promptColIdx, list->choiceYesPix); else setPixmap(promptColIdx, list->symbolYesPix); setText(yesColIdx, "Y"); ch = 'Y'; break; case mod: setPixmap(promptColIdx, list->symbolModPix); setText(modColIdx, "M"); ch = 'M'; break; default: if (sym_is_choice_value(sym) && type == S_BOOLEAN) setPixmap(promptColIdx, list->choiceNoPix); else setPixmap(promptColIdx, list->symbolNoPix); setText(noColIdx, "N"); ch = 'N'; break; } if (expr != no) setText(noColIdx, sym_tristate_within_range(sym, no) ? "_" : 0); if (expr != mod) setText(modColIdx, sym_tristate_within_range(sym, mod) ? "_" : 0); if (expr != yes) setText(yesColIdx, sym_tristate_within_range(sym, yes) ? "_" : 0); setText(dataColIdx, QChar(ch)); break; case S_INT: case S_HEX: case S_STRING: const char* data; data = sym_get_string_value(sym); int i = list->mapIdx(dataColIdx); if (i >= 0) setRenameEnabled(i, TRUE); setText(dataColIdx, data); if (type == S_STRING) prompt = QString("%1: %2").arg(prompt).arg(data); else prompt = QString("(%2) %1").arg(prompt).arg(data); break; } if (!sym_has_value(sym) && visible) prompt += _(" (NEW)"); set_prompt: setText(promptColIdx, prompt); } void ConfigItem::testUpdateMenu(bool v) { ConfigItem* i; visible = v; if (!menu) return; sym_calc_value(menu->sym); if (menu->flags & MENU_CHANGED) { /* the menu entry changed, so update all list items */ menu->flags &= ~MENU_CHANGED; for (i = (ConfigItem*)menu->data; i; i = i->nextItem) i->updateMenu(); } else if (listView()->updateAll) updateMenu(); } void ConfigItem::paintCell(QPainter* p, const QColorGroup& cg, int column, int width, int align) { ConfigList* list = listView(); if (visible) { if (isSelected() && !list->hasFocus() && list->mode == menuMode) Parent::paintCell(p, list->inactivedColorGroup, column, width, align); else Parent::paintCell(p, cg, column, width, align); } else Parent::paintCell(p, list->disabledColorGroup, column, width, align); } /* * construct a menu entry */ void ConfigItem::init(void) { if (menu) { ConfigList* list = listView(); nextItem = (ConfigItem*)menu->data; menu->data = this; if (list->mode != fullMode) setOpen(TRUE); sym_calc_value(menu->sym); } updateMenu(); } /* * destruct a menu entry */ ConfigItem::~ConfigItem(void) { if (menu) { ConfigItem** ip = (ConfigItem**)&menu->data; for (; *ip; ip = &(*ip)->nextItem) { if (*ip == this) { *ip = nextItem; break; } } } } ConfigLineEdit::ConfigLineEdit(ConfigView* parent) : Parent(parent) { connect(this, SIGNAL(lostFocus()), SLOT(hide())); } void ConfigLineEdit::show(ConfigItem* i) { item = i; if (sym_get_string_value(item->menu->sym)) setText(QString::fromLocal8Bit(sym_get_string_value(item->menu->sym))); else setText(QString::null); Parent::show(); setFocus(); } void ConfigLineEdit::keyPressEvent(QKeyEvent* e) { switch (e->key()) { case Qt::Key_Escape: break; case Qt::Key_Return: case Qt::Key_Enter: sym_set_string_value(item->menu->sym, text().latin1()); parent()->updateList(item); break; default: Parent::keyPressEvent(e); return; } e->accept(); parent()->list->setFocus(); hide(); } ConfigList::ConfigList(ConfigView* p, const char *name) : Parent(p, name), updateAll(false), symbolYesPix(xpm_symbol_yes), symbolModPix(xpm_symbol_mod), symbolNoPix(xpm_symbol_no), choiceYesPix(xpm_choice_yes), choiceNoPix(xpm_choice_no), menuPix(xpm_menu), menuInvPix(xpm_menu_inv), menuBackPix(xpm_menuback), voidPix(xpm_void), showName(false), showRange(false), showData(false), optMode(normalOpt), rootEntry(0), headerPopup(0) { int i; setSorting(-1); setRootIsDecorated(TRUE); disabledColorGroup = palette().active(); disabledColorGroup.setColor(QColorGroup::Text, palette().disabled().text()); inactivedColorGroup = palette().active(); inactivedColorGroup.setColor(QColorGroup::Highlight, palette().disabled().highlight()); connect(this, SIGNAL(selectionChanged(void)), SLOT(updateSelection(void))); if (name) { configSettings->beginGroup(name); showName = configSettings->readBoolEntry("/showName", false); showRange = configSettings->readBoolEntry("/showRange", false); showData = configSettings->readBoolEntry("/showData", false); optMode = (enum optionMode)configSettings->readNumEntry("/optionMode", false); configSettings->endGroup(); connect(configApp, SIGNAL(aboutToQuit()), SLOT(saveSettings())); } for (i = 0; i < colNr; i++) colMap[i] = colRevMap[i] = -1; addColumn(promptColIdx, _("Option")); reinit(); } bool ConfigList::menuSkip(struct menu *menu) { if (optMode == normalOpt && menu_is_visible(menu)) return false; if (optMode == promptOpt && menu_has_prompt(menu)) return false; if (optMode == allOpt) return false; return true; } void ConfigList::reinit(void) { removeColumn(dataColIdx); removeColumn(yesColIdx); removeColumn(modColIdx); removeColumn(noColIdx); removeColumn(nameColIdx); if (showName) addColumn(nameColIdx, _("Name")); if (showRange) { addColumn(noColIdx, "N"); addColumn(modColIdx, "M"); addColumn(yesColIdx, "Y"); } if (showData) addColumn(dataColIdx, _("Value")); updateListAll(); } void ConfigList::saveSettings(void) { if (name()) { configSettings->beginGroup(name()); configSettings->writeEntry("/showName", showName); configSettings->writeEntry("/showRange", showRange); configSettings->writeEntry("/showData", showData); configSettings->writeEntry("/optionMode", (int)optMode); configSettings->endGroup(); } } ConfigItem* ConfigList::findConfigItem(struct menu *menu) { ConfigItem* item = (ConfigItem*)menu->data; for (; item; item = item->nextItem) { if (this == item->listView()) break; } return item; } void ConfigList::updateSelection(void) { struct menu *menu; enum prop_type type; ConfigItem* item = (ConfigItem*)selectedItem(); if (!item) return; menu = item->menu; emit menuChanged(menu); if (!menu) return; type = menu->prompt ? menu->prompt->type : P_UNKNOWN; if (mode == menuMode && type == P_MENU) emit menuSelected(menu); } void ConfigList::updateList(ConfigItem* item) { ConfigItem* last = 0; if (!rootEntry) { if (mode != listMode) goto update; Q3ListViewItemIterator it(this); ConfigItem* item; for (; it.current(); ++it) { item = (ConfigItem*)it.current(); if (!item->menu) continue; item->testUpdateMenu(menu_is_visible(item->menu)); } return; } if (rootEntry != &rootmenu && (mode == singleMode || (mode == symbolMode && rootEntry->parent != &rootmenu))) { item = firstChild(); if (!item) item = new ConfigItem(this, 0, true); last = item; } if ((mode == singleMode || (mode == symbolMode && !(rootEntry->flags & MENU_ROOT))) && rootEntry->sym && rootEntry->prompt) { item = last ? last->nextSibling() : firstChild(); if (!item) item = new ConfigItem(this, last, rootEntry, true); else item->testUpdateMenu(true); updateMenuList(item, rootEntry); triggerUpdate(); return; } update: updateMenuList(this, rootEntry); triggerUpdate(); } void ConfigList::setValue(ConfigItem* item, tristate val) { struct symbol* sym; int type; tristate oldval; sym = item->menu ? item->menu->sym : 0; if (!sym) return; type = sym_get_type(sym); switch (type) { case S_BOOLEAN: case S_TRISTATE: oldval = sym_get_tristate_value(sym); if (!sym_set_tristate_value(sym, val)) return; if (oldval == no && item->menu->list) item->setOpen(TRUE); parent()->updateList(item); break; } } void ConfigList::changeValue(ConfigItem* item) { struct symbol* sym; struct menu* menu; int type, oldexpr, newexpr; menu = item->menu; if (!menu) return; sym = menu->sym; if (!sym) { if (item->menu->list) item->setOpen(!item->isOpen()); return; } type = sym_get_type(sym); switch (type) { case S_BOOLEAN: case S_TRISTATE: oldexpr = sym_get_tristate_value(sym); newexpr = sym_toggle_tristate_value(sym); if (item->menu->list) { if (oldexpr == newexpr) item->setOpen(!item->isOpen()); else if (oldexpr == no) item->setOpen(TRUE); } if (oldexpr != newexpr) parent()->updateList(item); break; case S_INT: case S_HEX: case S_STRING: if (colMap[dataColIdx] >= 0) item->startRename(colMap[dataColIdx]); else parent()->lineEdit->show(item); break; } } void ConfigList::setRootMenu(struct menu *menu) { enum prop_type type; if (rootEntry == menu) return; type = menu && menu->prompt ? menu->prompt->type : P_UNKNOWN; if (type != P_MENU) return; updateMenuList(this, 0); rootEntry = menu; updateListAll(); setSelected(currentItem(), hasFocus()); ensureItemVisible(currentItem()); } void ConfigList::setParentMenu(void) { ConfigItem* item; struct menu *oldroot; oldroot = rootEntry; if (rootEntry == &rootmenu) return; setRootMenu(menu_get_parent_menu(rootEntry->parent)); Q3ListViewItemIterator it(this); for (; (item = (ConfigItem*)it.current()); it++) { if (item->menu == oldroot) { setCurrentItem(item); ensureItemVisible(item); break; } } } /* * update all the children of a menu entry * removes/adds the entries from the parent widget as necessary * * parent: either the menu list widget or a menu entry widget * menu: entry to be updated */ template void ConfigList::updateMenuList(P* parent, struct menu* menu) { struct menu* child; ConfigItem* item; ConfigItem* last; bool visible; enum prop_type type; if (!menu) { while ((item = parent->firstChild())) delete item; return; } last = parent->firstChild(); if (last && !last->goParent) last = 0; for (child = menu->list; child; child = child->next) { item = last ? last->nextSibling() : parent->firstChild(); type = child->prompt ? child->prompt->type : P_UNKNOWN; switch (mode) { case menuMode: if (!(child->flags & MENU_ROOT)) goto hide; break; case symbolMode: if (child->flags & MENU_ROOT) goto hide; break; default: break; } visible = menu_is_visible(child); if (!menuSkip(child)) { if (!child->sym && !child->list && !child->prompt) continue; if (!item || item->menu != child) item = new ConfigItem(parent, last, child, visible); else item->testUpdateMenu(visible); if (mode == fullMode || mode == menuMode || type != P_MENU) updateMenuList(item, child); else updateMenuList(item, 0); last = item; continue; } hide: if (item && item->menu == child) { last = parent->firstChild(); if (last == item) last = 0; else while (last->nextSibling() != item) last = last->nextSibling(); delete item; } } } void ConfigList::keyPressEvent(QKeyEvent* ev) { Q3ListViewItem* i = currentItem(); ConfigItem* item; struct menu *menu; enum prop_type type; if (ev->key() == Qt::Key_Escape && mode != fullMode && mode != listMode) { emit parentSelected(); ev->accept(); return; } if (!i) { Parent::keyPressEvent(ev); return; } item = (ConfigItem*)i; switch (ev->key()) { case Qt::Key_Return: case Qt::Key_Enter: if (item->goParent) { emit parentSelected(); break; } menu = item->menu; if (!menu) break; type = menu->prompt ? menu->prompt->type : P_UNKNOWN; if (type == P_MENU && rootEntry != menu && mode != fullMode && mode != menuMode) { emit menuSelected(menu); break; } case Qt::Key_Space: changeValue(item); break; case Qt::Key_N: setValue(item, no); break; case Qt::Key_M: setValue(item, mod); break; case Qt::Key_Y: setValue(item, yes); break; default: Parent::keyPressEvent(ev); return; } ev->accept(); } void ConfigList::contentsMousePressEvent(QMouseEvent* e) { //QPoint p(contentsToViewport(e->pos())); //printf("contentsMousePressEvent: %d,%d\n", p.x(), p.y()); Parent::contentsMousePressEvent(e); } void ConfigList::contentsMouseReleaseEvent(QMouseEvent* e) { QPoint p(contentsToViewport(e->pos())); ConfigItem* item = (ConfigItem*)itemAt(p); struct menu *menu; enum prop_type ptype; const QPixmap* pm; int idx, x; if (!item) goto skip; menu = item->menu; x = header()->offset() + p.x(); idx = colRevMap[header()->sectionAt(x)]; switch (idx) { case promptColIdx: pm = item->pixmap(promptColIdx); if (pm) { int off = header()->sectionPos(0) + itemMargin() + treeStepSize() * (item->depth() + (rootIsDecorated() ? 1 : 0)); if (x >= off && x < off + pm->width()) { if (item->goParent) { emit parentSelected(); break; } else if (!menu) break; ptype = menu->prompt ? menu->prompt->type : P_UNKNOWN; if (ptype == P_MENU && rootEntry != menu && mode != fullMode && mode != menuMode) emit menuSelected(menu); else changeValue(item); } } break; case noColIdx: setValue(item, no); break; case modColIdx: setValue(item, mod); break; case yesColIdx: setValue(item, yes); break; case dataColIdx: changeValue(item); break; } skip: //printf("contentsMouseReleaseEvent: %d,%d\n", p.x(), p.y()); Parent::contentsMouseReleaseEvent(e); } void ConfigList::contentsMouseMoveEvent(QMouseEvent* e) { //QPoint p(contentsToViewport(e->pos())); //printf("contentsMouseMoveEvent: %d,%d\n", p.x(), p.y()); Parent::contentsMouseMoveEvent(e); } void ConfigList::contentsMouseDoubleClickEvent(QMouseEvent* e) { QPoint p(contentsToViewport(e->pos())); ConfigItem* item = (ConfigItem*)itemAt(p); struct menu *menu; enum prop_type ptype; if (!item) goto skip; if (item->goParent) { emit parentSelected(); goto skip; } menu = item->menu; if (!menu) goto skip; ptype = menu->prompt ? menu->prompt->type : P_UNKNOWN; if (ptype == P_MENU && (mode == singleMode || mode == symbolMode)) emit menuSelected(menu); else if (menu->sym) changeValue(item); skip: //printf("contentsMouseDoubleClickEvent: %d,%d\n", p.x(), p.y()); Parent::contentsMouseDoubleClickEvent(e); } void ConfigList::focusInEvent(QFocusEvent *e) { struct menu *menu = NULL; Parent::focusInEvent(e); ConfigItem* item = (ConfigItem *)currentItem(); if (item) { setSelected(item, TRUE); menu = item->menu; } emit gotFocus(menu); } void ConfigList::contextMenuEvent(QContextMenuEvent *e) { if (e->y() <= header()->geometry().bottom()) { if (!headerPopup) { Q3Action *action; headerPopup = new Q3PopupMenu(this); action = new Q3Action(NULL, _("Show Name"), 0, this); action->setToggleAction(TRUE); connect(action, SIGNAL(toggled(bool)), parent(), SLOT(setShowName(bool))); connect(parent(), SIGNAL(showNameChanged(bool)), action, SLOT(setOn(bool))); action->setOn(showName); action->addTo(headerPopup); action = new Q3Action(NULL, _("Show Range"), 0, this); action->setToggleAction(TRUE); connect(action, SIGNAL(toggled(bool)), parent(), SLOT(setShowRange(bool))); connect(parent(), SIGNAL(showRangeChanged(bool)), action, SLOT(setOn(bool))); action->setOn(showRange); action->addTo(headerPopup); action = new Q3Action(NULL, _("Show Data"), 0, this); action->setToggleAction(TRUE); connect(action, SIGNAL(toggled(bool)), parent(), SLOT(setShowData(bool))); connect(parent(), SIGNAL(showDataChanged(bool)), action, SLOT(setOn(bool))); action->setOn(showData); action->addTo(headerPopup); } headerPopup->exec(e->globalPos()); e->accept(); } else e->ignore(); } ConfigView*ConfigView::viewList; QAction *ConfigView::showNormalAction; QAction *ConfigView::showAllAction; QAction *ConfigView::showPromptAction; ConfigView::ConfigView(QWidget* parent, const char *name) : Parent(parent, name) { list = new ConfigList(this, name); lineEdit = new ConfigLineEdit(this); lineEdit->hide(); this->nextView = viewList; viewList = this; } ConfigView::~ConfigView(void) { ConfigView** vp; for (vp = &viewList; *vp; vp = &(*vp)->nextView) { if (*vp == this) { *vp = nextView; break; } } } void ConfigView::setOptionMode(QAction *act) { if (act == showNormalAction) list->optMode = normalOpt; else if (act == showAllAction) list->optMode = allOpt; else list->optMode = promptOpt; list->updateListAll(); } void ConfigView::setShowName(bool b) { if (list->showName != b) { list->showName = b; list->reinit(); emit showNameChanged(b); } } void ConfigView::setShowRange(bool b) { if (list->showRange != b) { list->showRange = b; list->reinit(); emit showRangeChanged(b); } } void ConfigView::setShowData(bool b) { if (list->showData != b) { list->showData = b; list->reinit(); emit showDataChanged(b); } } void ConfigList::setAllOpen(bool open) { Q3ListViewItemIterator it(this); for (; it.current(); it++) it.current()->setOpen(open); } void ConfigView::updateList(ConfigItem* item) { ConfigView* v; for (v = viewList; v; v = v->nextView) v->list->updateList(item); } void ConfigView::updateListAll(void) { ConfigView* v; for (v = viewList; v; v = v->nextView) v->list->updateListAll(); } ConfigInfoView::ConfigInfoView(QWidget* parent, const char *name) : Parent(parent, name), sym(0), _menu(0) { if (name) { configSettings->beginGroup(name); _showDebug = configSettings->readBoolEntry("/showDebug", false); configSettings->endGroup(); connect(configApp, SIGNAL(aboutToQuit()), SLOT(saveSettings())); } } void ConfigInfoView::saveSettings(void) { if (name()) { configSettings->beginGroup(name()); configSettings->writeEntry("/showDebug", showDebug()); configSettings->endGroup(); } } void ConfigInfoView::setShowDebug(bool b) { if (_showDebug != b) { _showDebug = b; if (_menu) menuInfo(); else if (sym) symbolInfo(); emit showDebugChanged(b); } } void ConfigInfoView::setInfo(struct menu *m) { if (_menu == m) return; _menu = m; sym = NULL; if (!_menu) clear(); else menuInfo(); } void ConfigInfoView::symbolInfo(void) { QString str; str += "Symbol: "; str += print_filter(sym->name); str += "

value: "; str += print_filter(sym_get_string_value(sym)); str += "
visibility: "; str += sym->visible == yes ? "y" : sym->visible == mod ? "m" : "n"; str += "
"; str += debug_info(sym); setText(str); } void ConfigInfoView::menuInfo(void) { struct symbol* sym; QString head, debug, help; sym = _menu->sym; if (sym) { if (_menu->prompt) { head += ""; head += print_filter(_(_menu->prompt->text)); head += ""; if (sym->name) { head += " ("; if (showDebug()) head += QString().sprintf("", sym); head += print_filter(sym->name); if (showDebug()) head += ""; head += ")"; } } else if (sym->name) { head += ""; if (showDebug()) head += QString().sprintf("", sym); head += print_filter(sym->name); if (showDebug()) head += ""; head += ""; } head += "

"; if (showDebug()) debug = debug_info(sym); struct gstr help_gstr = str_new(); menu_get_ext_help(_menu, &help_gstr); help = print_filter(str_get(&help_gstr)); str_free(&help_gstr); } else if (_menu->prompt) { head += ""; head += print_filter(_(_menu->prompt->text)); head += "

"; if (showDebug()) { if (_menu->prompt->visible.expr) { debug += "  dep: "; expr_print(_menu->prompt->visible.expr, expr_print_help, &debug, E_NONE); debug += "

"; } } } if (showDebug()) debug += QString().sprintf("defined at %s:%d

", _menu->file->name, _menu->lineno); setText(head + debug + help); } QString ConfigInfoView::debug_info(struct symbol *sym) { QString debug; debug += "type: "; debug += print_filter(sym_type_name(sym->type)); if (sym_is_choice(sym)) debug += " (choice)"; debug += "
"; if (sym->rev_dep.expr) { debug += "reverse dep: "; expr_print(sym->rev_dep.expr, expr_print_help, &debug, E_NONE); debug += "
"; } for (struct property *prop = sym->prop; prop; prop = prop->next) { switch (prop->type) { case P_PROMPT: case P_MENU: debug += QString().sprintf("prompt: ", prop->menu); debug += print_filter(_(prop->text)); debug += "
"; break; case P_DEFAULT: case P_SELECT: case P_RANGE: case P_ENV: debug += prop_get_type_name(prop->type); debug += ": "; expr_print(prop->expr, expr_print_help, &debug, E_NONE); debug += "
"; break; case P_CHOICE: if (sym_is_choice(sym)) { debug += "choice: "; expr_print(prop->expr, expr_print_help, &debug, E_NONE); debug += "
"; } break; default: debug += "unknown property: "; debug += prop_get_type_name(prop->type); debug += "
"; } if (prop->visible.expr) { debug += "    dep: "; expr_print(prop->visible.expr, expr_print_help, &debug, E_NONE); debug += "
"; } } debug += "
"; return debug; } QString ConfigInfoView::print_filter(const QString &str) { QRegExp re("[<>&\"\\n]"); QString res = str; for (int i = 0; (i = res.find(re, i)) >= 0;) { switch (res[i].latin1()) { case '<': res.replace(i, 1, "<"); i += 4; break; case '>': res.replace(i, 1, ">"); i += 4; break; case '&': res.replace(i, 1, "&"); i += 5; break; case '"': res.replace(i, 1, """); i += 6; break; case '\n': res.replace(i, 1, "
"); i += 4; break; } } return res; } void ConfigInfoView::expr_print_help(void *data, struct symbol *sym, const char *str) { QString* text = reinterpret_cast(data); QString str2 = print_filter(str); if (sym && sym->name && !(sym->flags & SYMBOL_CONST)) { *text += QString().sprintf("", sym); *text += str2; *text += ""; } else *text += str2; } Q3PopupMenu* ConfigInfoView::createPopupMenu(const QPoint& pos) { Q3PopupMenu* popup = Parent::createPopupMenu(pos); Q3Action* action = new Q3Action(NULL, _("Show Debug Info"), 0, popup); action->setToggleAction(TRUE); connect(action, SIGNAL(toggled(bool)), SLOT(setShowDebug(bool))); connect(this, SIGNAL(showDebugChanged(bool)), action, SLOT(setOn(bool))); action->setOn(showDebug()); popup->insertSeparator(); action->addTo(popup); return popup; } void ConfigInfoView::contentsContextMenuEvent(QContextMenuEvent *e) { Parent::contentsContextMenuEvent(e); } ConfigSearchWindow::ConfigSearchWindow(ConfigMainWindow* parent, const char *name) : Parent(parent, name), result(NULL) { setCaption("Search Config"); QVBoxLayout* layout1 = new QVBoxLayout(this, 11, 6); QHBoxLayout* layout2 = new QHBoxLayout(0, 0, 6); layout2->addWidget(new QLabel(_("Find:"), this)); editField = new QLineEdit(this); connect(editField, SIGNAL(returnPressed()), SLOT(search())); layout2->addWidget(editField); searchButton = new QPushButton(_("Search"), this); searchButton->setAutoDefault(FALSE); connect(searchButton, SIGNAL(clicked()), SLOT(search())); layout2->addWidget(searchButton); layout1->addLayout(layout2); split = new QSplitter(this); split->setOrientation(Qt::Vertical); list = new ConfigView(split, name); list->list->mode = listMode; info = new ConfigInfoView(split, name); connect(list->list, SIGNAL(menuChanged(struct menu *)), info, SLOT(setInfo(struct menu *))); connect(list->list, SIGNAL(menuChanged(struct menu *)), parent, SLOT(setMenuLink(struct menu *))); layout1->addWidget(split); if (name) { int x, y, width, height; bool ok; configSettings->beginGroup(name); width = configSettings->readNumEntry("/window width", parent->width() / 2); height = configSettings->readNumEntry("/window height", parent->height() / 2); resize(width, height); x = configSettings->readNumEntry("/window x", 0, &ok); if (ok) y = configSettings->readNumEntry("/window y", 0, &ok); if (ok) move(x, y); Q3ValueList sizes = configSettings->readSizes("/split", &ok); if (ok) split->setSizes(sizes); configSettings->endGroup(); connect(configApp, SIGNAL(aboutToQuit()), SLOT(saveSettings())); } } void ConfigSearchWindow::saveSettings(void) { if (name()) { configSettings->beginGroup(name()); configSettings->writeEntry("/window x", pos().x()); configSettings->writeEntry("/window y", pos().y()); configSettings->writeEntry("/window width", size().width()); configSettings->writeEntry("/window height", size().height()); configSettings->writeSizes("/split", split->sizes()); configSettings->endGroup(); } } void ConfigSearchWindow::search(void) { struct symbol **p; struct property *prop; ConfigItem *lastItem = NULL; free(result); list->list->clear(); info->clear(); result = sym_re_search(editField->text().latin1()); if (!result) return; for (p = result; *p; p++) { for_all_prompts((*p), prop) lastItem = new ConfigItem(list->list, lastItem, prop->menu, menu_is_visible(prop->menu)); } } /* * Construct the complete config widget */ ConfigMainWindow::ConfigMainWindow(void) : searchWindow(0) { QMenuBar* menu; bool ok; int x, y, width, height; char title[256]; QDesktopWidget *d = configApp->desktop(); snprintf(title, sizeof(title), "%s%s", rootmenu.prompt->text, #if QT_VERSION < 0x040000 " (Qt3)" #else "" #endif ); setCaption(title); width = configSettings->readNumEntry("/window width", d->width() - 64); height = configSettings->readNumEntry("/window height", d->height() - 64); resize(width, height); x = configSettings->readNumEntry("/window x", 0, &ok); if (ok) y = configSettings->readNumEntry("/window y", 0, &ok); if (ok) move(x, y); split1 = new QSplitter(this); split1->setOrientation(Qt::Horizontal); setCentralWidget(split1); menuView = new ConfigView(split1, "menu"); menuList = menuView->list; split2 = new QSplitter(split1); split2->setOrientation(Qt::Vertical); // create config tree configView = new ConfigView(split2, "config"); configList = configView->list; helpText = new ConfigInfoView(split2, "help"); helpText->setTextFormat(Qt::RichText); setTabOrder(configList, helpText); configList->setFocus(); menu = menuBar(); toolBar = new Q3ToolBar("Tools", this); backAction = new Q3Action("Back", QPixmap(xpm_back), _("Back"), 0, this); connect(backAction, SIGNAL(activated()), SLOT(goBack())); backAction->setEnabled(FALSE); Q3Action *quitAction = new Q3Action("Quit", _("&Quit"), Qt::CTRL + Qt::Key_Q, this); connect(quitAction, SIGNAL(activated()), SLOT(close())); Q3Action *loadAction = new Q3Action("Load", QPixmap(xpm_load), _("&Load"), Qt::CTRL + Qt::Key_L, this); connect(loadAction, SIGNAL(activated()), SLOT(loadConfig())); saveAction = new Q3Action("Save", QPixmap(xpm_save), _("&Save"), Qt::CTRL + Qt::Key_S, this); connect(saveAction, SIGNAL(activated()), SLOT(saveConfig())); conf_set_changed_callback(conf_changed); // Set saveAction's initial state conf_changed(); Q3Action *saveAsAction = new Q3Action("Save As...", _("Save &As..."), 0, this); connect(saveAsAction, SIGNAL(activated()), SLOT(saveConfigAs())); Q3Action *searchAction = new Q3Action("Find", _("&Find"), Qt::CTRL + Qt::Key_F, this); connect(searchAction, SIGNAL(activated()), SLOT(searchConfig())); Q3Action *singleViewAction = new Q3Action("Single View", QPixmap(xpm_single_view), _("Single View"), 0, this); connect(singleViewAction, SIGNAL(activated()), SLOT(showSingleView())); Q3Action *splitViewAction = new Q3Action("Split View", QPixmap(xpm_split_view), _("Split View"), 0, this); connect(splitViewAction, SIGNAL(activated()), SLOT(showSplitView())); Q3Action *fullViewAction = new Q3Action("Full View", QPixmap(xpm_tree_view), _("Full View"), 0, this); connect(fullViewAction, SIGNAL(activated()), SLOT(showFullView())); Q3Action *showNameAction = new Q3Action(NULL, _("Show Name"), 0, this); showNameAction->setToggleAction(TRUE); connect(showNameAction, SIGNAL(toggled(bool)), configView, SLOT(setShowName(bool))); connect(configView, SIGNAL(showNameChanged(bool)), showNameAction, SLOT(setOn(bool))); showNameAction->setOn(configView->showName()); Q3Action *showRangeAction = new Q3Action(NULL, _("Show Range"), 0, this); showRangeAction->setToggleAction(TRUE); connect(showRangeAction, SIGNAL(toggled(bool)), configView, SLOT(setShowRange(bool))); connect(configView, SIGNAL(showRangeChanged(bool)), showRangeAction, SLOT(setOn(bool))); showRangeAction->setOn(configList->showRange); Q3Action *showDataAction = new Q3Action(NULL, _("Show Data"), 0, this); showDataAction->setToggleAction(TRUE); connect(showDataAction, SIGNAL(toggled(bool)), configView, SLOT(setShowData(bool))); connect(configView, SIGNAL(showDataChanged(bool)), showDataAction, SLOT(setOn(bool))); showDataAction->setOn(configList->showData); QActionGroup *optGroup = new QActionGroup(this); optGroup->setExclusive(TRUE); connect(optGroup, SIGNAL(selected(QAction *)), configView, SLOT(setOptionMode(QAction *))); connect(optGroup, SIGNAL(selected(QAction *)), menuView, SLOT(setOptionMode(QAction *))); #if QT_VERSION >= 0x040000 configView->showNormalAction = new QAction(_("Show Normal Options"), optGroup); configView->showAllAction = new QAction(_("Show All Options"), optGroup); configView->showPromptAction = new QAction(_("Show Prompt Options"), optGroup); #else configView->showNormalAction = new QAction(_("Show Normal Options"), 0, optGroup); configView->showAllAction = new QAction(_("Show All Options"), 0, optGroup); configView->showPromptAction = new QAction(_("Show Prompt Options"), 0, optGroup); #endif configView->showNormalAction->setToggleAction(TRUE); configView->showNormalAction->setOn(configList->optMode == normalOpt); configView->showAllAction->setToggleAction(TRUE); configView->showAllAction->setOn(configList->optMode == allOpt); configView->showPromptAction->setToggleAction(TRUE); configView->showPromptAction->setOn(configList->optMode == promptOpt); Q3Action *showDebugAction = new Q3Action(NULL, _("Show Debug Info"), 0, this); showDebugAction->setToggleAction(TRUE); connect(showDebugAction, SIGNAL(toggled(bool)), helpText, SLOT(setShowDebug(bool))); connect(helpText, SIGNAL(showDebugChanged(bool)), showDebugAction, SLOT(setOn(bool))); showDebugAction->setOn(helpText->showDebug()); Q3Action *showIntroAction = new Q3Action(NULL, _("Introduction"), 0, this); connect(showIntroAction, SIGNAL(activated()), SLOT(showIntro())); Q3Action *showAboutAction = new Q3Action(NULL, _("About"), 0, this); connect(showAboutAction, SIGNAL(activated()), SLOT(showAbout())); // init tool bar backAction->addTo(toolBar); toolBar->addSeparator(); loadAction->addTo(toolBar); saveAction->addTo(toolBar); toolBar->addSeparator(); singleViewAction->addTo(toolBar); splitViewAction->addTo(toolBar); fullViewAction->addTo(toolBar); // create config menu Q3PopupMenu* config = new Q3PopupMenu(this); menu->insertItem(_("&File"), config); loadAction->addTo(config); saveAction->addTo(config); saveAsAction->addTo(config); config->insertSeparator(); quitAction->addTo(config); // create edit menu Q3PopupMenu* editMenu = new Q3PopupMenu(this); menu->insertItem(_("&Edit"), editMenu); searchAction->addTo(editMenu); // create options menu Q3PopupMenu* optionMenu = new Q3PopupMenu(this); menu->insertItem(_("&Option"), optionMenu); showNameAction->addTo(optionMenu); showRangeAction->addTo(optionMenu); showDataAction->addTo(optionMenu); optionMenu->insertSeparator(); optGroup->addTo(optionMenu); optionMenu->insertSeparator(); // create help menu Q3PopupMenu* helpMenu = new Q3PopupMenu(this); menu->insertSeparator(); menu->insertItem(_("&Help"), helpMenu); showIntroAction->addTo(helpMenu); showAboutAction->addTo(helpMenu); connect(configList, SIGNAL(menuChanged(struct menu *)), helpText, SLOT(setInfo(struct menu *))); connect(configList, SIGNAL(menuSelected(struct menu *)), SLOT(changeMenu(struct menu *))); connect(configList, SIGNAL(parentSelected()), SLOT(goBack())); connect(menuList, SIGNAL(menuChanged(struct menu *)), helpText, SLOT(setInfo(struct menu *))); connect(menuList, SIGNAL(menuSelected(struct menu *)), SLOT(changeMenu(struct menu *))); connect(configList, SIGNAL(gotFocus(struct menu *)), helpText, SLOT(setInfo(struct menu *))); connect(menuList, SIGNAL(gotFocus(struct menu *)), helpText, SLOT(setInfo(struct menu *))); connect(menuList, SIGNAL(gotFocus(struct menu *)), SLOT(listFocusChanged(void))); connect(helpText, SIGNAL(menuSelected(struct menu *)), SLOT(setMenuLink(struct menu *))); QString listMode = configSettings->readEntry("/listMode", "symbol"); if (listMode == "single") showSingleView(); else if (listMode == "full") showFullView(); else /*if (listMode == "split")*/ showSplitView(); // UI setup done, restore splitter positions Q3ValueList sizes = configSettings->readSizes("/split1", &ok); if (ok) split1->setSizes(sizes); sizes = configSettings->readSizes("/split2", &ok); if (ok) split2->setSizes(sizes); } void ConfigMainWindow::loadConfig(void) { QString s = Q3FileDialog::getOpenFileName(conf_get_configname(), NULL, this); if (s.isNull()) return; if (conf_read(QFile::encodeName(s))) QMessageBox::information(this, "qconf", _("Unable to load configuration!")); ConfigView::updateListAll(); } void ConfigMainWindow::saveConfig(void) { if (conf_write(NULL)) QMessageBox::information(this, "qconf", _("Unable to save configuration!")); } void ConfigMainWindow::saveConfigAs(void) { QString s = Q3FileDialog::getSaveFileName(conf_get_configname(), NULL, this); if (s.isNull()) return; if (conf_write(QFile::encodeName(s))) QMessageBox::information(this, "qconf", _("Unable to save configuration!")); } void ConfigMainWindow::searchConfig(void) { if (!searchWindow) searchWindow = new ConfigSearchWindow(this, "search"); searchWindow->show(); } void ConfigMainWindow::changeMenu(struct menu *menu) { configList->setRootMenu(menu); if (configList->rootEntry->parent == &rootmenu) backAction->setEnabled(FALSE); else backAction->setEnabled(TRUE); } void ConfigMainWindow::setMenuLink(struct menu *menu) { struct menu *parent; ConfigList* list = NULL; ConfigItem* item; if (configList->menuSkip(menu)) return; switch (configList->mode) { case singleMode: list = configList; parent = menu_get_parent_menu(menu); if (!parent) return; list->setRootMenu(parent); break; case symbolMode: if (menu->flags & MENU_ROOT) { configList->setRootMenu(menu); configList->clearSelection(); list = menuList; } else { list = configList; parent = menu_get_parent_menu(menu->parent); if (!parent) return; item = menuList->findConfigItem(parent); if (item) { menuList->setSelected(item, TRUE); menuList->ensureItemVisible(item); } list->setRootMenu(parent); } break; case fullMode: list = configList; break; default: break; } if (list) { item = list->findConfigItem(menu); if (item) { list->setSelected(item, TRUE); list->ensureItemVisible(item); list->setFocus(); } } } void ConfigMainWindow::listFocusChanged(void) { if (menuList->mode == menuMode) configList->clearSelection(); } void ConfigMainWindow::goBack(void) { ConfigItem* item; configList->setParentMenu(); if (configList->rootEntry == &rootmenu) backAction->setEnabled(FALSE); item = (ConfigItem*)menuList->selectedItem(); while (item) { if (item->menu == configList->rootEntry) { menuList->setSelected(item, TRUE); break; } item = (ConfigItem*)item->parent(); } } void ConfigMainWindow::showSingleView(void) { menuView->hide(); menuList->setRootMenu(0); configList->mode = singleMode; if (configList->rootEntry == &rootmenu) configList->updateListAll(); else configList->setRootMenu(&rootmenu); configList->setAllOpen(TRUE); configList->setFocus(); } void ConfigMainWindow::showSplitView(void) { configList->mode = symbolMode; if (configList->rootEntry == &rootmenu) configList->updateListAll(); else configList->setRootMenu(&rootmenu); configList->setAllOpen(TRUE); configApp->processEvents(); menuList->mode = menuMode; menuList->setRootMenu(&rootmenu); menuList->setAllOpen(TRUE); menuView->show(); menuList->setFocus(); } void ConfigMainWindow::showFullView(void) { menuView->hide(); menuList->setRootMenu(0); configList->mode = fullMode; if (configList->rootEntry == &rootmenu) configList->updateListAll(); else configList->setRootMenu(&rootmenu); configList->setAllOpen(FALSE); configList->setFocus(); } /* * ask for saving configuration before quitting * TODO ask only when something changed */ void ConfigMainWindow::closeEvent(QCloseEvent* e) { if (!conf_get_changed()) { e->accept(); return; } QMessageBox mb("qconf", _("Save configuration?"), QMessageBox::Warning, QMessageBox::Yes | QMessageBox::Default, QMessageBox::No, QMessageBox::Cancel | QMessageBox::Escape); mb.setButtonText(QMessageBox::Yes, _("&Save Changes")); mb.setButtonText(QMessageBox::No, _("&Discard Changes")); mb.setButtonText(QMessageBox::Cancel, _("Cancel Exit")); switch (mb.exec()) { case QMessageBox::Yes: conf_write(NULL); case QMessageBox::No: e->accept(); break; case QMessageBox::Cancel: e->ignore(); break; } } void ConfigMainWindow::showIntro(void) { static const QString str = _("Welcome to the qconf graphical configuration tool.\n\n" "For each option, a blank box indicates the feature is disabled, a check\n" "indicates it is enabled, and a dot indicates that it is to be compiled\n" "as a module. Clicking on the box will cycle through the three states.\n\n" "If you do not see an option (e.g., a device driver) that you believe\n" "should be present, try turning on Show All Options under the Options menu.\n" "Although there is no cross reference yet to help you figure out what other\n" "options must be enabled to support the option you are interested in, you can\n" "still view the help of a grayed-out option.\n\n" "Toggling Show Debug Info under the Options menu will show the dependencies,\n" "which you can then match by examining other options.\n\n"); QMessageBox::information(this, "qconf", str); } void ConfigMainWindow::showAbout(void) { static const QString str = _("qconf is Copyright (C) 2002 Roman Zippel .\n\n" "Bug reports and feature request can also be entered at http://bugzilla.kernel.org/\n"); QMessageBox::information(this, "qconf", str); } void ConfigMainWindow::saveSettings(void) { configSettings->writeEntry("/window x", pos().x()); configSettings->writeEntry("/window y", pos().y()); configSettings->writeEntry("/window width", size().width()); configSettings->writeEntry("/window height", size().height()); QString entry; switch(configList->mode) { case singleMode : entry = "single"; break; case symbolMode : entry = "split"; break; case fullMode : entry = "full"; break; default: break; } configSettings->writeEntry("/listMode", entry); configSettings->writeSizes("/split1", split1->sizes()); configSettings->writeSizes("/split2", split2->sizes()); } void ConfigMainWindow::conf_changed(void) { if (saveAction) saveAction->setEnabled(conf_get_changed()); } void fixup_rootmenu(struct menu *menu) { struct menu *child; static int menu_cnt = 0; menu->flags |= MENU_ROOT; for (child = menu->list; child; child = child->next) { if (child->prompt && child->prompt->type == P_MENU) { menu_cnt++; fixup_rootmenu(child); menu_cnt--; } else if (!menu_cnt) fixup_rootmenu(child); } } static const char *progname; static void usage(void) { printf(_("%s \n"), progname); exit(0); } int main(int ac, char** av) { ConfigMainWindow* v; const char *name; bindtextdomain(PACKAGE, LOCALEDIR); textdomain(PACKAGE); #ifndef LKC_DIRECT_LINK kconfig_load(); #endif progname = av[0]; configApp = new QApplication(ac, av); if (ac > 1 && av[1][0] == '-') { switch (av[1][1]) { case 'h': case '?': usage(); } name = av[2]; } else name = av[1]; if (!name) usage(); conf_parse(name); fixup_rootmenu(&rootmenu); conf_read(NULL); //zconfdump(stdout); configSettings = new ConfigSettings(); configSettings->beginGroup("/kconfig/qconf"); v = new ConfigMainWindow(); //zconfdump(stdout); configApp->setMainWidget(v); configApp->connect(configApp, SIGNAL(lastWindowClosed()), SLOT(quit())); configApp->connect(configApp, SIGNAL(aboutToQuit()), v, SLOT(saveSettings())); v->show(); configApp->exec(); configSettings->endGroup(); delete configSettings; return 0; } tinyvisor/bios/tools/kconfig/zconf.hash.c_shipped0000644006644000001440000002416011733243570022531 0ustar yuichi_xyusers/* ANSI-C code produced by gperf version 3.0.3 */ /* Command-line: gperf */ /* Computed positions: -k'1,3' */ #if !((' ' == 32) && ('!' == 33) && ('"' == 34) && ('#' == 35) \ && ('%' == 37) && ('&' == 38) && ('\'' == 39) && ('(' == 40) \ && (')' == 41) && ('*' == 42) && ('+' == 43) && (',' == 44) \ && ('-' == 45) && ('.' == 46) && ('/' == 47) && ('0' == 48) \ && ('1' == 49) && ('2' == 50) && ('3' == 51) && ('4' == 52) \ && ('5' == 53) && ('6' == 54) && ('7' == 55) && ('8' == 56) \ && ('9' == 57) && (':' == 58) && (';' == 59) && ('<' == 60) \ && ('=' == 61) && ('>' == 62) && ('?' == 63) && ('A' == 65) \ && ('B' == 66) && ('C' == 67) && ('D' == 68) && ('E' == 69) \ && ('F' == 70) && ('G' == 71) && ('H' == 72) && ('I' == 73) \ && ('J' == 74) && ('K' == 75) && ('L' == 76) && ('M' == 77) \ && ('N' == 78) && ('O' == 79) && ('P' == 80) && ('Q' == 81) \ && ('R' == 82) && ('S' == 83) && ('T' == 84) && ('U' == 85) \ && ('V' == 86) && ('W' == 87) && ('X' == 88) && ('Y' == 89) \ && ('Z' == 90) && ('[' == 91) && ('\\' == 92) && (']' == 93) \ && ('^' == 94) && ('_' == 95) && ('a' == 97) && ('b' == 98) \ && ('c' == 99) && ('d' == 100) && ('e' == 101) && ('f' == 102) \ && ('g' == 103) && ('h' == 104) && ('i' == 105) && ('j' == 106) \ && ('k' == 107) && ('l' == 108) && ('m' == 109) && ('n' == 110) \ && ('o' == 111) && ('p' == 112) && ('q' == 113) && ('r' == 114) \ && ('s' == 115) && ('t' == 116) && ('u' == 117) && ('v' == 118) \ && ('w' == 119) && ('x' == 120) && ('y' == 121) && ('z' == 122) \ && ('{' == 123) && ('|' == 124) && ('}' == 125) && ('~' == 126)) /* The character set is not based on ISO-646. */ #error "gperf generated tables don't work with this execution character set. Please report a bug to ." #endif struct kconf_id; static struct kconf_id *kconf_id_lookup(register const char *str, register unsigned int len); /* maximum key range = 50, duplicates = 0 */ #ifdef __GNUC__ __inline #else #ifdef __cplusplus inline #endif #endif static unsigned int kconf_id_hash (register const char *str, register unsigned int len) { static unsigned char asso_values[] = { 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 40, 5, 0, 0, 5, 52, 0, 20, 52, 52, 10, 20, 5, 0, 35, 52, 0, 30, 0, 15, 0, 52, 15, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52, 52 }; register int hval = len; switch (hval) { default: hval += asso_values[(unsigned char)str[2]]; /*FALLTHROUGH*/ case 2: case 1: hval += asso_values[(unsigned char)str[0]]; break; } return hval; } struct kconf_id_strings_t { char kconf_id_strings_str2[sizeof("on")]; char kconf_id_strings_str3[sizeof("env")]; char kconf_id_strings_str5[sizeof("endif")]; char kconf_id_strings_str6[sizeof("option")]; char kconf_id_strings_str7[sizeof("endmenu")]; char kconf_id_strings_str8[sizeof("optional")]; char kconf_id_strings_str9[sizeof("endchoice")]; char kconf_id_strings_str10[sizeof("range")]; char kconf_id_strings_str11[sizeof("choice")]; char kconf_id_strings_str12[sizeof("default")]; char kconf_id_strings_str13[sizeof("def_bool")]; char kconf_id_strings_str14[sizeof("help")]; char kconf_id_strings_str16[sizeof("config")]; char kconf_id_strings_str17[sizeof("def_tristate")]; char kconf_id_strings_str18[sizeof("hex")]; char kconf_id_strings_str19[sizeof("defconfig_list")]; char kconf_id_strings_str22[sizeof("if")]; char kconf_id_strings_str23[sizeof("int")]; char kconf_id_strings_str27[sizeof("modules")]; char kconf_id_strings_str28[sizeof("tristate")]; char kconf_id_strings_str29[sizeof("menu")]; char kconf_id_strings_str32[sizeof("comment")]; char kconf_id_strings_str35[sizeof("menuconfig")]; char kconf_id_strings_str36[sizeof("string")]; char kconf_id_strings_str37[sizeof("visible")]; char kconf_id_strings_str41[sizeof("prompt")]; char kconf_id_strings_str42[sizeof("depends")]; char kconf_id_strings_str44[sizeof("bool")]; char kconf_id_strings_str46[sizeof("select")]; char kconf_id_strings_str47[sizeof("boolean")]; char kconf_id_strings_str48[sizeof("mainmenu")]; char kconf_id_strings_str51[sizeof("source")]; }; static struct kconf_id_strings_t kconf_id_strings_contents = { "on", "env", "endif", "option", "endmenu", "optional", "endchoice", "range", "choice", "default", "def_bool", "help", "config", "def_tristate", "hex", "defconfig_list", "if", "int", "modules", "tristate", "menu", "comment", "menuconfig", "string", "visible", "prompt", "depends", "bool", "select", "boolean", "mainmenu", "source" }; #define kconf_id_strings ((const char *) &kconf_id_strings_contents) #ifdef __GNUC__ __inline #ifdef __GNUC_STDC_INLINE__ __attribute__ ((__gnu_inline__)) #endif #endif struct kconf_id * kconf_id_lookup (register const char *str, register unsigned int len) { enum { TOTAL_KEYWORDS = 32, MIN_WORD_LENGTH = 2, MAX_WORD_LENGTH = 14, MIN_HASH_VALUE = 2, MAX_HASH_VALUE = 51 }; static struct kconf_id wordlist[] = { {-1}, {-1}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str2, T_ON, TF_PARAM}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str3, T_OPT_ENV, TF_OPTION}, {-1}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str5, T_ENDIF, TF_COMMAND}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str6, T_OPTION, TF_COMMAND}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str7, T_ENDMENU, TF_COMMAND}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str8, T_OPTIONAL, TF_COMMAND}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str9, T_ENDCHOICE, TF_COMMAND}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str10, T_RANGE, TF_COMMAND}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str11, T_CHOICE, TF_COMMAND}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str12, T_DEFAULT, TF_COMMAND, S_UNKNOWN}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str13, T_DEFAULT, TF_COMMAND, S_BOOLEAN}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str14, T_HELP, TF_COMMAND}, {-1}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str16, T_CONFIG, TF_COMMAND}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str17, T_DEFAULT, TF_COMMAND, S_TRISTATE}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str18, T_TYPE, TF_COMMAND, S_HEX}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str19, T_OPT_DEFCONFIG_LIST,TF_OPTION}, {-1}, {-1}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str22, T_IF, TF_COMMAND|TF_PARAM}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str23, T_TYPE, TF_COMMAND, S_INT}, {-1}, {-1}, {-1}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str27, T_OPT_MODULES, TF_OPTION}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str28, T_TYPE, TF_COMMAND, S_TRISTATE}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str29, T_MENU, TF_COMMAND}, {-1}, {-1}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str32, T_COMMENT, TF_COMMAND}, {-1}, {-1}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str35, T_MENUCONFIG, TF_COMMAND}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str36, T_TYPE, TF_COMMAND, S_STRING}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str37, T_VISIBLE, TF_COMMAND}, {-1}, {-1}, {-1}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str41, T_PROMPT, TF_COMMAND}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str42, T_DEPENDS, TF_COMMAND}, {-1}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str44, T_TYPE, TF_COMMAND, S_BOOLEAN}, {-1}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str46, T_SELECT, TF_COMMAND}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str47, T_TYPE, TF_COMMAND, S_BOOLEAN}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str48, T_MAINMENU, TF_COMMAND}, {-1}, {-1}, {(int)(long)&((struct kconf_id_strings_t *)0)->kconf_id_strings_str51, T_SOURCE, TF_COMMAND} }; if (len <= MAX_WORD_LENGTH && len >= MIN_WORD_LENGTH) { register int key = kconf_id_hash (str, len); if (key <= MAX_HASH_VALUE && key >= 0) { register int o = wordlist[key].name; if (o >= 0) { register const char *s = o + kconf_id_strings; if (*str == *s && !strncmp (str + 1, s + 1, len - 1) && s[len] == '\0') return &wordlist[key]; } } } return 0; } tinyvisor/bios/tools/kconfig/nconf.c0000644006644000001440000011536311733243570020065 0ustar yuichi_xyusers/* * Copyright (C) 2008 Nir Tzachar #define LKC_DIRECT_LINK #include "lkc.h" #include "nconf.h" #include static const char nconf_readme[] = N_( "Overview\n" "--------\n" "This interface let you select features and parameters for the build.\n" "Features can either be built-in, modularized, or ignored. Parameters\n" "must be entered in as decimal or hexadecimal numbers or text.\n" "\n" "Menu items beginning with following braces represent features that\n" " [ ] can be built in or removed\n" " < > can be built in, modularized or removed\n" " { } can be built in or modularized (selected by other feature)\n" " - - are selected by other feature,\n" " XXX cannot be selected. Use Symbol Info to find out why,\n" "while *, M or whitespace inside braces means to build in, build as\n" "a module or to exclude the feature respectively.\n" "\n" "To change any of these features, highlight it with the cursor\n" "keys and press to build it in, to make it a module or\n" " to removed it. You may also press the to cycle\n" "through the available options (ie. Y->N->M->Y).\n" "\n" "Some additional keyboard hints:\n" "\n" "Menus\n" "----------\n" "o Use the Up/Down arrow keys (cursor keys) to highlight the item\n" " you wish to change use or . Goto submenu by \n" " pressing of . Use or to go back.\n" " Submenus are designated by \"--->\".\n" "\n" " Searching: pressing '/' triggers interactive search mode.\n" " nconfig performs a case insensitive search for the string\n" " in the menu prompts (no regex support).\n" " Pressing the up/down keys highlights the previous/next\n" " matching item. Backspace removes one character from the\n" " match string. Pressing either '/' again or ESC exits\n" " search mode. All other keys behave normally.\n" "\n" " You may also use the and keys to scroll\n" " unseen options into view.\n" "\n" "o To exit a menu use the just press or .\n" "\n" "o To get help with an item, press \n" " Shortcut: Press or .\n" "\n" "\n" "Radiolists (Choice lists)\n" "-----------\n" "o Use the cursor keys to select the option you wish to set and press\n" " or the .\n" "\n" " Shortcut: Press the first letter of the option you wish to set then\n" " press or .\n" "\n" "o To see available help for the item, press \n" " Shortcut: Press or .\n" "\n" "\n" "Data Entry\n" "-----------\n" "o Enter the requested information and press \n" " If you are entering hexadecimal values, it is not necessary to\n" " add the '0x' prefix to the entry.\n" "\n" "o For help, press .\n" "\n" "\n" "Text Box (Help Window)\n" "--------\n" "o Use the cursor keys to scroll up/down/left/right. The VI editor\n" " keys h,j,k,l function here as do for those\n" " who are familiar with less and lynx.\n" "\n" "o Press , , , or to exit.\n" "\n" "\n" "Alternate Configuration Files\n" "-----------------------------\n" "nconfig supports the use of alternate configuration files for\n" "those who, for various reasons, find it necessary to switch\n" "between different configurations.\n" "\n" "At the end of the main menu you will find two options. One is\n" "for saving the current configuration to a file of your choosing.\n" "The other option is for loading a previously saved alternate\n" "configuration.\n" "\n" "Even if you don't use alternate configuration files, but you\n" "find during a nconfig session that you have completely messed\n" "up your settings, you may use the \"Load Alternate...\" option to\n" "restore your previously saved settings from \".config\" without\n" "restarting nconfig.\n" "\n" "Other information\n" "-----------------\n" "If you use nconfig in an XTERM window make sure you have your\n" "$TERM variable set to point to a xterm definition which supports color.\n" "Otherwise, nconfig will look rather bad. nconfig will not\n" "display correctly in a RXVT window because rxvt displays only one\n" "intensity of color, bright.\n" "\n" "nconfig will display larger menus on screens or xterms which are\n" "set to display more than the standard 25 row by 80 column geometry.\n" "In order for this to work, the \"stty size\" command must be able to\n" "display the screen's current row and column geometry. I STRONGLY\n" "RECOMMEND that you make sure you do NOT have the shell variables\n" "LINES and COLUMNS exported into your environment. Some distributions\n" "export those variables via /etc/profile. Some ncurses programs can\n" "become confused when those variables (LINES & COLUMNS) don't reflect\n" "the true screen size.\n" "\n" "Optional personality available\n" "------------------------------\n" "If you prefer to have all of the options listed in a single menu, rather\n" "than the default multimenu hierarchy, run the nconfig with NCONFIG_MODE\n" "environment variable set to single_menu. Example:\n" "\n" "make NCONFIG_MODE=single_menu nconfig\n" "\n" " will then unroll the appropriate category, or enfold it if it\n" "is already unrolled.\n" "\n" "Note that this mode can eventually be a little more CPU expensive\n" "(especially with a larger number of unrolled categories) than the\n" "default mode.\n" "\n"), menu_no_f_instructions[] = N_( " You do not have function keys support. Please follow the\n" " following instructions:\n" " Arrow keys navigate the menu.\n" " or selects submenus --->.\n" " Capital Letters are hotkeys.\n" " Pressing includes, excludes, modularizes features.\n" " Pressing SpaceBar toggles between the above options.\n" " Press or to go back one menu,\n" " or for Help, for Search.\n" " <1> is interchangeable with , <2> with , etc.\n" " Legend: [*] built-in [ ] excluded module < > module capable.\n" " always leaves the current window.\n"), menu_instructions[] = N_( " Arrow keys navigate the menu.\n" " or selects submenus --->.\n" " Capital Letters are hotkeys.\n" " Pressing includes, excludes, modularizes features.\n" " Pressing SpaceBar toggles between the above options\n" " Press , or to go back one menu,\n" " , or for Help, for Search.\n" " <1> is interchangeable with , <2> with , etc.\n" " Legend: [*] built-in [ ] excluded module < > module capable.\n" " always leaves the current window\n"), radiolist_instructions[] = N_( " Use the arrow keys to navigate this window or\n" " press the hotkey of the item you wish to select\n" " followed by the .\n" " Press , or for additional information about this option.\n"), inputbox_instructions_int[] = N_( "Please enter a decimal value.\n" "Fractions will not be accepted.\n" "Press to accept, to cancel."), inputbox_instructions_hex[] = N_( "Please enter a hexadecimal value.\n" "Press to accept, to cancel."), inputbox_instructions_string[] = N_( "Please enter a string value.\n" "Press to accept, to cancel."), setmod_text[] = N_( "This feature depends on another which\n" "has been configured as a module.\n" "As a result, this feature will be built as a module."), nohelp_text[] = N_( "There is no help available for this option.\n"), load_config_text[] = N_( "Enter the name of the configuration file you wish to load.\n" "Accept the name shown to restore the configuration you\n" "last retrieved. Leave blank to abort."), load_config_help[] = N_( "\n" "For various reasons, one may wish to keep several different\n" "configurations available on a single machine.\n" "\n" "If you have saved a previous configuration in a file other than the\n" "default one, entering its name here will allow you to modify that\n" "configuration.\n" "\n" "If you are uncertain, then you have probably never used alternate\n" "configuration files. You should therefor leave this blank to abort.\n"), save_config_text[] = N_( "Enter a filename to which this configuration should be saved\n" "as an alternate. Leave blank to abort."), save_config_help[] = N_( "\n" "For various reasons, one may wish to keep different configurations\n" "available on a single machine.\n" "\n" "Entering a file name here will allow you to later retrieve, modify\n" "and use the current configuration as an alternate to whatever\n" "configuration options you have selected at that time.\n" "\n" "If you are uncertain what all this means then you should probably\n" "leave this blank.\n"), search_help[] = N_( "\n" "Search for symbols and display their relations. Regular expressions\n" "are allowed.\n" "Example: search for \"^FOO\"\n" "Result:\n" "-----------------------------------------------------------------\n" "Symbol: FOO [ = m]\n" "Prompt: Foo bus is used to drive the bar HW\n" "Defined at drivers/pci/Kconfig:47\n" "Depends on: X86_LOCAL_APIC && X86_IO_APIC || IA64\n" "Location:\n" " -> Bus options (PCI, PCMCIA, EISA, MCA, ISA)\n" " -> PCI support (PCI [ = y])\n" " -> PCI access mode ( [ = y])\n" "Selects: LIBCRC32\n" "Selected by: BAR\n" "-----------------------------------------------------------------\n" "o The line 'Prompt:' shows the text used in the menu structure for\n" " this symbol\n" "o The 'Defined at' line tell at what file / line number the symbol\n" " is defined\n" "o The 'Depends on:' line tell what symbols needs to be defined for\n" " this symbol to be visible in the menu (selectable)\n" "o The 'Location:' lines tell where in the menu structure this symbol\n" " is located\n" " A location followed by a [ = y] indicate that this is a selectable\n" " menu item - and current value is displayed inside brackets.\n" "o The 'Selects:' line tell what symbol will be automatically\n" " selected if this symbol is selected (y or m)\n" "o The 'Selected by' line tell what symbol has selected this symbol\n" "\n" "Only relevant lines are shown.\n" "\n\n" "Search examples:\n" "Examples: USB => find all symbols containing USB\n" " ^USB => find all symbols starting with USB\n" " USB$ => find all symbols ending with USB\n" "\n"); struct mitem { char str[256]; char tag; void *usrptr; int is_visible; }; #define MAX_MENU_ITEMS 4096 static int show_all_items; static int indent; static struct menu *current_menu; static int child_count; static int single_menu_mode; /* the window in which all information appears */ static WINDOW *main_window; /* the largest size of the menu window */ static int mwin_max_lines; static int mwin_max_cols; /* the window in which we show option buttons */ static MENU *curses_menu; static ITEM *curses_menu_items[MAX_MENU_ITEMS]; static struct mitem k_menu_items[MAX_MENU_ITEMS]; static int items_num; static int global_exit; /* the currently selected button */ const char *current_instructions = menu_instructions; static void conf(struct menu *menu); static void conf_choice(struct menu *menu); static void conf_string(struct menu *menu); static void conf_load(void); static void conf_save(void); static void show_help(struct menu *menu); static int do_exit(void); static void setup_windows(void); static void search_conf(void); typedef void (*function_key_handler_t)(int *key, struct menu *menu); static void handle_f1(int *key, struct menu *current_item); static void handle_f2(int *key, struct menu *current_item); static void handle_f3(int *key, struct menu *current_item); static void handle_f4(int *key, struct menu *current_item); static void handle_f5(int *key, struct menu *current_item); static void handle_f6(int *key, struct menu *current_item); static void handle_f7(int *key, struct menu *current_item); static void handle_f8(int *key, struct menu *current_item); static void handle_f9(int *key, struct menu *current_item); struct function_keys { const char *key_str; const char *func; function_key key; function_key_handler_t handler; }; static const int function_keys_num = 9; struct function_keys function_keys[] = { { .key_str = "F1", .func = "Help", .key = F_HELP, .handler = handle_f1, }, { .key_str = "F2", .func = "Sym Info", .key = F_SYMBOL, .handler = handle_f2, }, { .key_str = "F3", .func = "Insts", .key = F_INSTS, .handler = handle_f3, }, { .key_str = "F4", .func = "Config", .key = F_CONF, .handler = handle_f4, }, { .key_str = "F5", .func = "Back", .key = F_BACK, .handler = handle_f5, }, { .key_str = "F6", .func = "Save", .key = F_SAVE, .handler = handle_f6, }, { .key_str = "F7", .func = "Load", .key = F_LOAD, .handler = handle_f7, }, { .key_str = "F8", .func = "Sym Search", .key = F_SEARCH, .handler = handle_f8, }, { .key_str = "F9", .func = "Exit", .key = F_EXIT, .handler = handle_f9, }, }; static void print_function_line(void) { int i; int offset = 1; const int skip = 1; for (i = 0; i < function_keys_num; i++) { wattrset(main_window, attributes[FUNCTION_HIGHLIGHT]); mvwprintw(main_window, LINES-3, offset, "%s", function_keys[i].key_str); wattrset(main_window, attributes[FUNCTION_TEXT]); offset += strlen(function_keys[i].key_str); mvwprintw(main_window, LINES-3, offset, "%s", function_keys[i].func); offset += strlen(function_keys[i].func) + skip; } wattrset(main_window, attributes[NORMAL]); } /* help */ static void handle_f1(int *key, struct menu *current_item) { show_scroll_win(main_window, _("README"), _(nconf_readme)); return; } /* symbole help */ static void handle_f2(int *key, struct menu *current_item) { show_help(current_item); return; } /* instructions */ static void handle_f3(int *key, struct menu *current_item) { show_scroll_win(main_window, _("Instructions"), _(current_instructions)); return; } /* config */ static void handle_f4(int *key, struct menu *current_item) { int res = btn_dialog(main_window, _("Show all symbols?"), 2, " ", ""); if (res == 0) show_all_items = 1; else if (res == 1) show_all_items = 0; return; } /* back */ static void handle_f5(int *key, struct menu *current_item) { *key = KEY_LEFT; return; } /* save */ static void handle_f6(int *key, struct menu *current_item) { conf_save(); return; } /* load */ static void handle_f7(int *key, struct menu *current_item) { conf_load(); return; } /* search */ static void handle_f8(int *key, struct menu *current_item) { search_conf(); return; } /* exit */ static void handle_f9(int *key, struct menu *current_item) { do_exit(); return; } /* return != 0 to indicate the key was handles */ static int process_special_keys(int *key, struct menu *menu) { int i; if (*key == KEY_RESIZE) { setup_windows(); return 1; } for (i = 0; i < function_keys_num; i++) { if (*key == KEY_F(function_keys[i].key) || *key == '0' + function_keys[i].key){ function_keys[i].handler(key, menu); return 1; } } return 0; } static void clean_items(void) { int i; for (i = 0; curses_menu_items[i]; i++) free_item(curses_menu_items[i]); bzero(curses_menu_items, sizeof(curses_menu_items)); bzero(k_menu_items, sizeof(k_menu_items)); items_num = 0; } typedef enum {MATCH_TINKER_PATTERN_UP, MATCH_TINKER_PATTERN_DOWN, FIND_NEXT_MATCH_DOWN, FIND_NEXT_MATCH_UP} match_f; /* return the index of the matched item, or -1 if no such item exists */ static int get_mext_match(const char *match_str, match_f flag) { int match_start = item_index(current_item(curses_menu)); int index; if (flag == FIND_NEXT_MATCH_DOWN) ++match_start; else if (flag == FIND_NEXT_MATCH_UP) --match_start; index = match_start; index = (index + items_num) % items_num; while (true) { char *str = k_menu_items[index].str; if (strcasestr(str, match_str) != 0) return index; if (flag == FIND_NEXT_MATCH_UP || flag == MATCH_TINKER_PATTERN_UP) --index; else ++index; index = (index + items_num) % items_num; if (index == match_start) return -1; } } /* Make a new item. */ static void item_make(struct menu *menu, char tag, const char *fmt, ...) { va_list ap; if (items_num > MAX_MENU_ITEMS-1) return; bzero(&k_menu_items[items_num], sizeof(k_menu_items[0])); k_menu_items[items_num].tag = tag; k_menu_items[items_num].usrptr = menu; if (menu != NULL) k_menu_items[items_num].is_visible = menu_is_visible(menu); else k_menu_items[items_num].is_visible = 1; va_start(ap, fmt); vsnprintf(k_menu_items[items_num].str, sizeof(k_menu_items[items_num].str), fmt, ap); va_end(ap); if (!k_menu_items[items_num].is_visible) memcpy(k_menu_items[items_num].str, "XXX", 3); curses_menu_items[items_num] = new_item( k_menu_items[items_num].str, k_menu_items[items_num].str); set_item_userptr(curses_menu_items[items_num], &k_menu_items[items_num]); /* if (!k_menu_items[items_num].is_visible) item_opts_off(curses_menu_items[items_num], O_SELECTABLE); */ items_num++; curses_menu_items[items_num] = NULL; } /* very hackish. adds a string to the last item added */ static void item_add_str(const char *fmt, ...) { va_list ap; int index = items_num-1; char new_str[256]; char tmp_str[256]; if (index < 0) return; va_start(ap, fmt); vsnprintf(new_str, sizeof(new_str), fmt, ap); va_end(ap); snprintf(tmp_str, sizeof(tmp_str), "%s%s", k_menu_items[index].str, new_str); strncpy(k_menu_items[index].str, tmp_str, sizeof(k_menu_items[index].str)); free_item(curses_menu_items[index]); curses_menu_items[index] = new_item( k_menu_items[index].str, k_menu_items[index].str); set_item_userptr(curses_menu_items[index], &k_menu_items[index]); } /* get the tag of the currently selected item */ static char item_tag(void) { ITEM *cur; struct mitem *mcur; cur = current_item(curses_menu); if (cur == NULL) return 0; mcur = (struct mitem *) item_userptr(cur); return mcur->tag; } static int curses_item_index(void) { return item_index(current_item(curses_menu)); } static void *item_data(void) { ITEM *cur; struct mitem *mcur; cur = current_item(curses_menu); if (!cur) return NULL; mcur = (struct mitem *) item_userptr(cur); return mcur->usrptr; } static int item_is_tag(char tag) { return item_tag() == tag; } static char filename[PATH_MAX+1]; static char menu_backtitle[PATH_MAX+128]; static const char *set_config_filename(const char *config_filename) { int size; size = snprintf(menu_backtitle, sizeof(menu_backtitle), "%s - %s", config_filename, rootmenu.prompt->text); if (size >= sizeof(menu_backtitle)) menu_backtitle[sizeof(menu_backtitle)-1] = '\0'; size = snprintf(filename, sizeof(filename), "%s", config_filename); if (size >= sizeof(filename)) filename[sizeof(filename)-1] = '\0'; return menu_backtitle; } /* return = 0 means we are successful. * -1 means go on doing what you were doing */ static int do_exit(void) { int res; if (!conf_get_changed()) { global_exit = 1; return 0; } res = btn_dialog(main_window, _("Do you wish to save your new configuration?\n" " to cancel and resume nconfig."), 2, " ", ""); if (res == KEY_EXIT) { global_exit = 0; return -1; } /* if we got here, the user really wants to exit */ switch (res) { case 0: res = conf_write(filename); if (res) btn_dialog( main_window, _("Error during writing of configuration.\n" "Your configuration changes were NOT saved."), 1, ""); break; default: btn_dialog( main_window, _("Your configuration changes were NOT saved."), 1, ""); break; } global_exit = 1; return 0; } static void search_conf(void) { struct symbol **sym_arr; struct gstr res; char dialog_input_result[100]; char *dialog_input; int dres; again: dres = dialog_inputbox(main_window, _("Search Configuration Parameter"), _("Enter " CONFIG_ " (sub)string to search for " "(with or without \"" CONFIG_ "\")"), "", dialog_input_result, 99); switch (dres) { case 0: break; case 1: show_scroll_win(main_window, _("Search Configuration"), search_help); goto again; default: return; } /* strip the prefix if necessary */ dialog_input = dialog_input_result; if (strncasecmp(dialog_input_result, CONFIG_, strlen(CONFIG_)) == 0) dialog_input += strlen(CONFIG_); sym_arr = sym_re_search(dialog_input); res = get_relations_str(sym_arr); free(sym_arr); show_scroll_win(main_window, _("Search Results"), str_get(&res)); str_free(&res); } static void build_conf(struct menu *menu) { struct symbol *sym; struct property *prop; struct menu *child; int type, tmp, doint = 2; tristate val; char ch; if (!menu || (!show_all_items && !menu_is_visible(menu))) return; sym = menu->sym; prop = menu->prompt; if (!sym) { if (prop && menu != current_menu) { const char *prompt = menu_get_prompt(menu); enum prop_type ptype; ptype = menu->prompt ? menu->prompt->type : P_UNKNOWN; switch (ptype) { case P_MENU: child_count++; prompt = _(prompt); if (single_menu_mode) { item_make(menu, 'm', "%s%*c%s", menu->data ? "-->" : "++>", indent + 1, ' ', prompt); } else item_make(menu, 'm', " %*c%s --->", indent + 1, ' ', prompt); if (single_menu_mode && menu->data) goto conf_childs; return; case P_COMMENT: if (prompt) { child_count++; item_make(menu, ':', " %*c*** %s ***", indent + 1, ' ', _(prompt)); } break; default: if (prompt) { child_count++; item_make(menu, ':', "---%*c%s", indent + 1, ' ', _(prompt)); } } } else doint = 0; goto conf_childs; } type = sym_get_type(sym); if (sym_is_choice(sym)) { struct symbol *def_sym = sym_get_choice_value(sym); struct menu *def_menu = NULL; child_count++; for (child = menu->list; child; child = child->next) { if (menu_is_visible(child) && child->sym == def_sym) def_menu = child; } val = sym_get_tristate_value(sym); if (sym_is_changable(sym)) { switch (type) { case S_BOOLEAN: item_make(menu, 't', "[%c]", val == no ? ' ' : '*'); break; case S_TRISTATE: switch (val) { case yes: ch = '*'; break; case mod: ch = 'M'; break; default: ch = ' '; break; } item_make(menu, 't', "<%c>", ch); break; } } else { item_make(menu, def_menu ? 't' : ':', " "); } item_add_str("%*c%s", indent + 1, ' ', _(menu_get_prompt(menu))); if (val == yes) { if (def_menu) { item_add_str(" (%s)", _(menu_get_prompt(def_menu))); item_add_str(" --->"); if (def_menu->list) { indent += 2; build_conf(def_menu); indent -= 2; } } return; } } else { if (menu == current_menu) { item_make(menu, ':', "---%*c%s", indent + 1, ' ', _(menu_get_prompt(menu))); goto conf_childs; } child_count++; val = sym_get_tristate_value(sym); if (sym_is_choice_value(sym) && val == yes) { item_make(menu, ':', " "); } else { switch (type) { case S_BOOLEAN: if (sym_is_changable(sym)) item_make(menu, 't', "[%c]", val == no ? ' ' : '*'); else item_make(menu, 't', "-%c-", val == no ? ' ' : '*'); break; case S_TRISTATE: switch (val) { case yes: ch = '*'; break; case mod: ch = 'M'; break; default: ch = ' '; break; } if (sym_is_changable(sym)) { if (sym->rev_dep.tri == mod) item_make(menu, 't', "{%c}", ch); else item_make(menu, 't', "<%c>", ch); } else item_make(menu, 't', "-%c-", ch); break; default: tmp = 2 + strlen(sym_get_string_value(sym)); item_make(menu, 's', " (%s)", sym_get_string_value(sym)); tmp = indent - tmp + 4; if (tmp < 0) tmp = 0; item_add_str("%*c%s%s", tmp, ' ', _(menu_get_prompt(menu)), (sym_has_value(sym) || !sym_is_changable(sym)) ? "" : _(" (NEW)")); goto conf_childs; } } item_add_str("%*c%s%s", indent + 1, ' ', _(menu_get_prompt(menu)), (sym_has_value(sym) || !sym_is_changable(sym)) ? "" : _(" (NEW)")); if (menu->prompt && menu->prompt->type == P_MENU) { item_add_str(" --->"); return; } } conf_childs: indent += doint; for (child = menu->list; child; child = child->next) build_conf(child); indent -= doint; } static void reset_menu(void) { unpost_menu(curses_menu); clean_items(); } /* adjust the menu to show this item. * prefer not to scroll the menu if possible*/ static void center_item(int selected_index, int *last_top_row) { int toprow; set_top_row(curses_menu, *last_top_row); toprow = top_row(curses_menu); if (selected_index < toprow || selected_index >= toprow+mwin_max_lines) { toprow = max(selected_index-mwin_max_lines/2, 0); if (toprow >= item_count(curses_menu)-mwin_max_lines) toprow = item_count(curses_menu)-mwin_max_lines; set_top_row(curses_menu, toprow); } set_current_item(curses_menu, curses_menu_items[selected_index]); *last_top_row = toprow; post_menu(curses_menu); refresh_all_windows(main_window); } /* this function assumes reset_menu has been called before */ static void show_menu(const char *prompt, const char *instructions, int selected_index, int *last_top_row) { int maxx, maxy; WINDOW *menu_window; current_instructions = instructions; clear(); wattrset(main_window, attributes[NORMAL]); print_in_middle(stdscr, 1, 0, COLS, menu_backtitle, attributes[MAIN_HEADING]); wattrset(main_window, attributes[MAIN_MENU_BOX]); box(main_window, 0, 0); wattrset(main_window, attributes[MAIN_MENU_HEADING]); mvwprintw(main_window, 0, 3, " %s ", prompt); wattrset(main_window, attributes[NORMAL]); set_menu_items(curses_menu, curses_menu_items); /* position the menu at the middle of the screen */ scale_menu(curses_menu, &maxy, &maxx); maxx = min(maxx, mwin_max_cols-2); maxy = mwin_max_lines; menu_window = derwin(main_window, maxy, maxx, 2, (mwin_max_cols-maxx)/2); keypad(menu_window, TRUE); set_menu_win(curses_menu, menu_window); set_menu_sub(curses_menu, menu_window); /* must reassert this after changing items, otherwise returns to a * default of 16 */ set_menu_format(curses_menu, maxy, 1); center_item(selected_index, last_top_row); set_menu_format(curses_menu, maxy, 1); print_function_line(); /* Post the menu */ post_menu(curses_menu); refresh_all_windows(main_window); } static void adj_match_dir(match_f *match_direction) { if (*match_direction == FIND_NEXT_MATCH_DOWN) *match_direction = MATCH_TINKER_PATTERN_DOWN; else if (*match_direction == FIND_NEXT_MATCH_UP) *match_direction = MATCH_TINKER_PATTERN_UP; /* else, do no change.. */ } struct match_state { int in_search; match_f match_direction; char pattern[256]; }; /* Return 0 means I have handled the key. In such a case, ans should hold the * item to center, or -1 otherwise. * Else return -1 . */ static int do_match(int key, struct match_state *state, int *ans) { char c = (char) key; int terminate_search = 0; *ans = -1; if (key == '/' || (state->in_search && key == 27)) { move(0, 0); refresh(); clrtoeol(); state->in_search = 1-state->in_search; bzero(state->pattern, sizeof(state->pattern)); state->match_direction = MATCH_TINKER_PATTERN_DOWN; return 0; } else if (!state->in_search) return 1; if (isalnum(c) || isgraph(c) || c == ' ') { state->pattern[strlen(state->pattern)] = c; state->pattern[strlen(state->pattern)] = '\0'; adj_match_dir(&state->match_direction); *ans = get_mext_match(state->pattern, state->match_direction); } else if (key == KEY_DOWN) { state->match_direction = FIND_NEXT_MATCH_DOWN; *ans = get_mext_match(state->pattern, state->match_direction); } else if (key == KEY_UP) { state->match_direction = FIND_NEXT_MATCH_UP; *ans = get_mext_match(state->pattern, state->match_direction); } else if (key == KEY_BACKSPACE || key == 127) { state->pattern[strlen(state->pattern)-1] = '\0'; adj_match_dir(&state->match_direction); } else terminate_search = 1; if (terminate_search) { state->in_search = 0; bzero(state->pattern, sizeof(state->pattern)); move(0, 0); refresh(); clrtoeol(); return -1; } return 0; } static void conf(struct menu *menu) { struct menu *submenu = 0; const char *prompt = menu_get_prompt(menu); struct symbol *sym; struct menu *active_menu = NULL; int res; int current_index = 0; int last_top_row = 0; struct match_state match_state = { .in_search = 0, .match_direction = MATCH_TINKER_PATTERN_DOWN, .pattern = "", }; while (!global_exit) { reset_menu(); current_menu = menu; build_conf(menu); if (!child_count) break; show_menu(prompt ? _(prompt) : _("Main Menu"), _(menu_instructions), current_index, &last_top_row); keypad((menu_win(curses_menu)), TRUE); while (!global_exit) { if (match_state.in_search) { mvprintw(0, 0, "searching: %s", match_state.pattern); clrtoeol(); } refresh_all_windows(main_window); res = wgetch(menu_win(curses_menu)); if (!res) break; if (do_match(res, &match_state, ¤t_index) == 0) { if (current_index != -1) center_item(current_index, &last_top_row); continue; } if (process_special_keys(&res, (struct menu *) item_data())) break; switch (res) { case KEY_DOWN: menu_driver(curses_menu, REQ_DOWN_ITEM); break; case KEY_UP: menu_driver(curses_menu, REQ_UP_ITEM); break; case KEY_NPAGE: menu_driver(curses_menu, REQ_SCR_DPAGE); break; case KEY_PPAGE: menu_driver(curses_menu, REQ_SCR_UPAGE); break; case KEY_HOME: menu_driver(curses_menu, REQ_FIRST_ITEM); break; case KEY_END: menu_driver(curses_menu, REQ_LAST_ITEM); break; case 'h': case '?': show_help((struct menu *) item_data()); break; } if (res == 10 || res == 27 || res == 32 || res == 'n' || res == 'y' || res == KEY_LEFT || res == KEY_RIGHT || res == 'm') break; refresh_all_windows(main_window); } refresh_all_windows(main_window); /* if ESC or left*/ if (res == 27 || (menu != &rootmenu && res == KEY_LEFT)) break; /* remember location in the menu */ last_top_row = top_row(curses_menu); current_index = curses_item_index(); if (!item_tag()) continue; submenu = (struct menu *) item_data(); active_menu = (struct menu *)item_data(); if (!submenu || !menu_is_visible(submenu)) continue; if (submenu) sym = submenu->sym; else sym = NULL; switch (res) { case ' ': if (item_is_tag('t')) sym_toggle_tristate_value(sym); else if (item_is_tag('m')) conf(submenu); break; case KEY_RIGHT: case 10: /* ENTER WAS PRESSED */ switch (item_tag()) { case 'm': if (single_menu_mode) submenu->data = (void *) (long) !submenu->data; else conf(submenu); break; case 't': if (sym_is_choice(sym) && sym_get_tristate_value(sym) == yes) conf_choice(submenu); else if (submenu->prompt && submenu->prompt->type == P_MENU) conf(submenu); else if (res == 10) sym_toggle_tristate_value(sym); break; case 's': conf_string(submenu); break; } break; case 'y': if (item_is_tag('t')) { if (sym_set_tristate_value(sym, yes)) break; if (sym_set_tristate_value(sym, mod)) btn_dialog(main_window, setmod_text, 0); } break; case 'n': if (item_is_tag('t')) sym_set_tristate_value(sym, no); break; case 'm': if (item_is_tag('t')) sym_set_tristate_value(sym, mod); break; } } } static void conf_message_callback(const char *fmt, va_list ap) { char buf[1024]; vsnprintf(buf, sizeof(buf), fmt, ap); btn_dialog(main_window, buf, 1, ""); } static void show_help(struct menu *menu) { struct gstr help = str_new(); if (menu && menu->sym && menu_has_help(menu)) { if (menu->sym->name) { str_printf(&help, "%s%s:\n\n", CONFIG_, menu->sym->name); str_append(&help, _(menu_get_help(menu))); str_append(&help, "\n"); get_symbol_str(&help, menu->sym); } else { str_append(&help, _(menu_get_help(menu))); } } else { str_append(&help, nohelp_text); } show_scroll_win(main_window, _(menu_get_prompt(menu)), str_get(&help)); str_free(&help); } static void conf_choice(struct menu *menu) { const char *prompt = _(menu_get_prompt(menu)); struct menu *child = 0; struct symbol *active; int selected_index = 0; int last_top_row = 0; int res, i = 0; struct match_state match_state = { .in_search = 0, .match_direction = MATCH_TINKER_PATTERN_DOWN, .pattern = "", }; active = sym_get_choice_value(menu->sym); /* this is mostly duplicated from the conf() function. */ while (!global_exit) { reset_menu(); for (i = 0, child = menu->list; child; child = child->next) { if (!show_all_items && !menu_is_visible(child)) continue; if (child->sym == sym_get_choice_value(menu->sym)) item_make(child, ':', " %s", _(menu_get_prompt(child))); else if (child->sym) item_make(child, ':', " %s", _(menu_get_prompt(child))); else item_make(child, ':', "*** %s ***", _(menu_get_prompt(child))); if (child->sym == active){ last_top_row = top_row(curses_menu); selected_index = i; } i++; } show_menu(prompt ? _(prompt) : _("Choice Menu"), _(radiolist_instructions), selected_index, &last_top_row); while (!global_exit) { if (match_state.in_search) { mvprintw(0, 0, "searching: %s", match_state.pattern); clrtoeol(); } refresh_all_windows(main_window); res = wgetch(menu_win(curses_menu)); if (!res) break; if (do_match(res, &match_state, &selected_index) == 0) { if (selected_index != -1) center_item(selected_index, &last_top_row); continue; } if (process_special_keys( &res, (struct menu *) item_data())) break; switch (res) { case KEY_DOWN: menu_driver(curses_menu, REQ_DOWN_ITEM); break; case KEY_UP: menu_driver(curses_menu, REQ_UP_ITEM); break; case KEY_NPAGE: menu_driver(curses_menu, REQ_SCR_DPAGE); break; case KEY_PPAGE: menu_driver(curses_menu, REQ_SCR_UPAGE); break; case KEY_HOME: menu_driver(curses_menu, REQ_FIRST_ITEM); break; case KEY_END: menu_driver(curses_menu, REQ_LAST_ITEM); break; case 'h': case '?': show_help((struct menu *) item_data()); break; } if (res == 10 || res == 27 || res == ' ' || res == KEY_LEFT){ break; } refresh_all_windows(main_window); } /* if ESC or left */ if (res == 27 || res == KEY_LEFT) break; child = item_data(); if (!child || !menu_is_visible(child) || !child->sym) continue; switch (res) { case ' ': case 10: case KEY_RIGHT: sym_set_tristate_value(child->sym, yes); return; case 'h': case '?': show_help(child); active = child->sym; break; case KEY_EXIT: return; } } } static void conf_string(struct menu *menu) { const char *prompt = menu_get_prompt(menu); char dialog_input_result[256]; while (1) { int res; const char *heading; switch (sym_get_type(menu->sym)) { case S_INT: heading = _(inputbox_instructions_int); break; case S_HEX: heading = _(inputbox_instructions_hex); break; case S_STRING: heading = _(inputbox_instructions_string); break; default: heading = _("Internal nconf error!"); } res = dialog_inputbox(main_window, prompt ? _(prompt) : _("Main Menu"), heading, sym_get_string_value(menu->sym), dialog_input_result, sizeof(dialog_input_result)); switch (res) { case 0: if (sym_set_string_value(menu->sym, dialog_input_result)) return; btn_dialog(main_window, _("You have made an invalid entry."), 0); break; case 1: show_help(menu); break; case KEY_EXIT: return; } } } static void conf_load(void) { char dialog_input_result[256]; while (1) { int res; res = dialog_inputbox(main_window, NULL, load_config_text, filename, dialog_input_result, sizeof(dialog_input_result)); switch (res) { case 0: if (!dialog_input_result[0]) return; if (!conf_read(dialog_input_result)) { set_config_filename(dialog_input_result); sym_set_change_count(1); return; } btn_dialog(main_window, _("File does not exist!"), 0); break; case 1: show_scroll_win(main_window, _("Load Alternate Configuration"), load_config_help); break; case KEY_EXIT: return; } } } static void conf_save(void) { char dialog_input_result[256]; while (1) { int res; res = dialog_inputbox(main_window, NULL, save_config_text, filename, dialog_input_result, sizeof(dialog_input_result)); switch (res) { case 0: if (!dialog_input_result[0]) return; res = conf_write(dialog_input_result); if (!res) { set_config_filename(dialog_input_result); return; } btn_dialog(main_window, _("Can't create file! " "Probably a nonexistent directory."), 1, ""); break; case 1: show_scroll_win(main_window, _("Save Alternate Configuration"), save_config_help); break; case KEY_EXIT: return; } } } void setup_windows(void) { if (main_window != NULL) delwin(main_window); /* set up the menu and menu window */ main_window = newwin(LINES-2, COLS-2, 2, 1); keypad(main_window, TRUE); mwin_max_lines = LINES-7; mwin_max_cols = COLS-6; /* panels order is from bottom to top */ new_panel(main_window); } int main(int ac, char **av) { char *mode; setlocale(LC_ALL, ""); bindtextdomain(PACKAGE, LOCALEDIR); textdomain(PACKAGE); conf_parse(av[1]); conf_read(NULL); mode = getenv("NCONFIG_MODE"); if (mode) { if (!strcasecmp(mode, "single_menu")) single_menu_mode = 1; } /* Initialize curses */ initscr(); /* set color theme */ set_colors(); cbreak(); noecho(); keypad(stdscr, TRUE); curs_set(0); if (COLS < 75 || LINES < 20) { endwin(); printf("Your terminal should have at " "least 20 lines and 75 columns\n"); return 1; } notimeout(stdscr, FALSE); ESCDELAY = 1; /* set btns menu */ curses_menu = new_menu(curses_menu_items); menu_opts_off(curses_menu, O_SHOWDESC); menu_opts_on(curses_menu, O_SHOWMATCH); menu_opts_on(curses_menu, O_ONEVALUE); menu_opts_on(curses_menu, O_NONCYCLIC); menu_opts_on(curses_menu, O_IGNORECASE); set_menu_mark(curses_menu, " "); set_menu_fore(curses_menu, attributes[MAIN_MENU_FORE]); set_menu_back(curses_menu, attributes[MAIN_MENU_BACK]); set_menu_grey(curses_menu, attributes[MAIN_MENU_GREY]); set_config_filename(conf_get_configname()); setup_windows(); /* check for KEY_FUNC(1) */ if (has_key(KEY_F(1)) == FALSE) { show_scroll_win(main_window, _("Instructions"), _(menu_no_f_instructions)); } conf_set_message_callback(conf_message_callback); /* do the work */ while (!global_exit) { conf(&rootmenu); if (!global_exit && do_exit() == 0) break; } /* ok, we are done */ unpost_menu(curses_menu); free_menu(curses_menu); delwin(main_window); clear(); refresh(); endwin(); return 0; } tinyvisor/bios/tools/kconfig/util.c0000644006644000001440000000543411733243570017734 0ustar yuichi_xyusers/* * Copyright (C) 2002-2005 Roman Zippel * Copyright (C) 2002-2005 Sam Ravnborg * * Released under the terms of the GNU GPL v2.0. */ #include #include "lkc.h" /* file already present in list? If not add it */ struct file *file_lookup(const char *name) { struct file *file; const char *file_name = sym_expand_string_value(name); for (file = file_list; file; file = file->next) { if (!strcmp(name, file->name)) { free((void *)file_name); return file; } } file = malloc(sizeof(*file)); memset(file, 0, sizeof(*file)); file->name = file_name; file->next = file_list; file_list = file; return file; } /* write a dependency file as used by kbuild to track dependencies */ int file_write_dep(const char *name) { struct symbol *sym, *env_sym; struct expr *e; struct file *file; FILE *out; if (!name) name = ".kconfig.d"; out = fopen("..config.tmp", "w"); if (!out) return 1; fprintf(out, "deps_config := \\\n"); for (file = file_list; file; file = file->next) { if (file->next) fprintf(out, "\t%s \\\n", file->name); else fprintf(out, "\t%s\n", file->name); } fprintf(out, "\n%s: \\\n" "\t$(deps_config)\n\n", conf_get_autoconfig_name()); expr_list_for_each_sym(sym_env_list, e, sym) { struct property *prop; const char *value; prop = sym_get_env_prop(sym); env_sym = prop_get_symbol(prop); if (!env_sym) continue; value = getenv(env_sym->name); if (!value) value = ""; fprintf(out, "ifneq \"$(%s)\" \"%s\"\n", env_sym->name, value); fprintf(out, "%s: FORCE\n", conf_get_autoconfig_name()); fprintf(out, "endif\n"); } fprintf(out, "\n$(deps_config): ;\n"); fclose(out); rename("..config.tmp", name); return 0; } /* Allocate initial growable string */ struct gstr str_new(void) { struct gstr gs; gs.s = malloc(sizeof(char) * 64); gs.len = 64; gs.max_width = 0; strcpy(gs.s, "\0"); return gs; } /* Allocate and assign growable string */ struct gstr str_assign(const char *s) { struct gstr gs; gs.s = strdup(s); gs.len = strlen(s) + 1; gs.max_width = 0; return gs; } /* Free storage for growable string */ void str_free(struct gstr *gs) { if (gs->s) free(gs->s); gs->s = NULL; gs->len = 0; } /* Append to growable string */ void str_append(struct gstr *gs, const char *s) { size_t l; if (s) { l = strlen(gs->s) + strlen(s) + 1; if (l > gs->len) { gs->s = realloc(gs->s, l); gs->len = l; } strcat(gs->s, s); } } /* Append printf formatted string to growable string */ void str_printf(struct gstr *gs, const char *fmt, ...) { va_list ap; char s[10000]; /* big enough... */ va_start(ap, fmt); vsnprintf(s, sizeof(s), fmt, ap); str_append(gs, s); va_end(ap); } /* Retrieve value of growable string */ const char *str_get(struct gstr *gs) { return gs->s; } tinyvisor/bios/tools/kconfig/zconf.tab.c_shipped0000644006644000001440000021427111733243570022360 0ustar yuichi_xyusers /* A Bison parser, made by GNU Bison 2.4.1. */ /* Skeleton implementation for Bison's Yacc-like parsers in C Copyright (C) 1984, 1989, 1990, 2000, 2001, 2002, 2003, 2004, 2005, 2006 Free Software Foundation, Inc. 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, either version 3 of the License, or (at your option) any later version. 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. You should have received a copy of the GNU General Public License along with this program. If not, see . */ /* As a special exception, you may create a larger work that contains part or all of the Bison parser skeleton and distribute that work under terms of your choice, so long as that work isn't itself a parser generator using the skeleton or a modified version thereof as a parser skeleton. Alternatively, if you modify or redistribute the parser skeleton itself, you may (at your option) remove this special exception, which will cause the skeleton and the resulting Bison output files to be licensed under the GNU General Public License without this special exception. This special exception was added by the Free Software Foundation in version 2.2 of Bison. */ /* C LALR(1) parser skeleton written by Richard Stallman, by simplifying the original so-called "semantic" parser. */ /* All symbols defined below should begin with yy or YY, to avoid infringing on user name space. This should be done even for local variables, as they might otherwise be expanded by user macros. There are some unavoidable exceptions within include files to define necessary library symbols; they are noted "INFRINGES ON USER NAME SPACE" below. */ /* Identify Bison output. */ #define YYBISON 1 /* Bison version. */ #define YYBISON_VERSION "2.4.1" /* Skeleton name. */ #define YYSKELETON_NAME "yacc.c" /* Pure parsers. */ #define YYPURE 0 /* Push parsers. */ #define YYPUSH 0 /* Pull parsers. */ #define YYPULL 1 /* Using locations. */ #define YYLSP_NEEDED 0 /* Substitute the variable and function names. */ #define yyparse zconfparse #define yylex zconflex #define yyerror zconferror #define yylval zconflval #define yychar zconfchar #define yydebug zconfdebug #define yynerrs zconfnerrs /* Copy the first part of user declarations. */ /* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ #include #include #include #include #include #include #define LKC_DIRECT_LINK #include "lkc.h" #define printd(mask, fmt...) if (cdebug & (mask)) printf(fmt) #define PRINTD 0x0001 #define DEBUG_PARSE 0x0002 int cdebug = PRINTD; extern int zconflex(void); static void zconfprint(const char *err, ...); static void zconf_error(const char *err, ...); static void zconferror(const char *err); static bool zconf_endtoken(struct kconf_id *id, int starttoken, int endtoken); struct symbol *symbol_hash[SYMBOL_HASHSIZE]; static struct menu *current_menu, *current_entry; #define YYDEBUG 0 #if YYDEBUG #define YYERROR_VERBOSE #endif /* Enabling traces. */ #ifndef YYDEBUG # define YYDEBUG 0 #endif /* Enabling verbose error messages. */ #ifdef YYERROR_VERBOSE # undef YYERROR_VERBOSE # define YYERROR_VERBOSE 1 #else # define YYERROR_VERBOSE 0 #endif /* Enabling the token table. */ #ifndef YYTOKEN_TABLE # define YYTOKEN_TABLE 0 #endif /* Tokens. */ #ifndef YYTOKENTYPE # define YYTOKENTYPE /* Put the tokens into the symbol table, so that GDB and other debuggers know about them. */ enum yytokentype { T_MAINMENU = 258, T_MENU = 259, T_ENDMENU = 260, T_SOURCE = 261, T_CHOICE = 262, T_ENDCHOICE = 263, T_COMMENT = 264, T_CONFIG = 265, T_MENUCONFIG = 266, T_HELP = 267, T_HELPTEXT = 268, T_IF = 269, T_ENDIF = 270, T_DEPENDS = 271, T_OPTIONAL = 272, T_PROMPT = 273, T_TYPE = 274, T_DEFAULT = 275, T_SELECT = 276, T_RANGE = 277, T_VISIBLE = 278, T_OPTION = 279, T_ON = 280, T_WORD = 281, T_WORD_QUOTE = 282, T_UNEQUAL = 283, T_CLOSE_PAREN = 284, T_OPEN_PAREN = 285, T_EOL = 286, T_OR = 287, T_AND = 288, T_EQUAL = 289, T_NOT = 290 }; #endif #if ! defined YYSTYPE && ! defined YYSTYPE_IS_DECLARED typedef union YYSTYPE { char *string; struct file *file; struct symbol *symbol; struct expr *expr; struct menu *menu; struct kconf_id *id; } YYSTYPE; # define YYSTYPE_IS_TRIVIAL 1 # define yystype YYSTYPE /* obsolescent; will be withdrawn */ # define YYSTYPE_IS_DECLARED 1 #endif /* Copy the second part of user declarations. */ /* Include zconf.hash.c here so it can see the token constants. */ #include "zconf.hash.c" #ifdef short # undef short #endif #ifdef YYTYPE_UINT8 typedef YYTYPE_UINT8 yytype_uint8; #else typedef unsigned char yytype_uint8; #endif #ifdef YYTYPE_INT8 typedef YYTYPE_INT8 yytype_int8; #elif (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) typedef signed char yytype_int8; #else typedef short int yytype_int8; #endif #ifdef YYTYPE_UINT16 typedef YYTYPE_UINT16 yytype_uint16; #else typedef unsigned short int yytype_uint16; #endif #ifdef YYTYPE_INT16 typedef YYTYPE_INT16 yytype_int16; #else typedef short int yytype_int16; #endif #ifndef YYSIZE_T # ifdef __SIZE_TYPE__ # define YYSIZE_T __SIZE_TYPE__ # elif defined size_t # define YYSIZE_T size_t # elif ! defined YYSIZE_T && (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) # include /* INFRINGES ON USER NAME SPACE */ # define YYSIZE_T size_t # else # define YYSIZE_T unsigned int # endif #endif #define YYSIZE_MAXIMUM ((YYSIZE_T) -1) #ifndef YY_ # if YYENABLE_NLS # if ENABLE_NLS # include /* INFRINGES ON USER NAME SPACE */ # define YY_(msgid) dgettext ("bison-runtime", msgid) # endif # endif # ifndef YY_ # define YY_(msgid) msgid # endif #endif /* Suppress unused-variable warnings by "using" E. */ #if ! defined lint || defined __GNUC__ # define YYUSE(e) ((void) (e)) #else # define YYUSE(e) /* empty */ #endif /* Identity function, used to suppress warnings about constant conditions. */ #ifndef lint # define YYID(n) (n) #else #if (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) static int YYID (int yyi) #else static int YYID (yyi) int yyi; #endif { return yyi; } #endif #if ! defined yyoverflow || YYERROR_VERBOSE /* The parser invokes alloca or malloc; define the necessary symbols. */ # ifdef YYSTACK_USE_ALLOCA # if YYSTACK_USE_ALLOCA # ifdef __GNUC__ # define YYSTACK_ALLOC __builtin_alloca # elif defined __BUILTIN_VA_ARG_INCR # include /* INFRINGES ON USER NAME SPACE */ # elif defined _AIX # define YYSTACK_ALLOC __alloca # elif defined _MSC_VER # include /* INFRINGES ON USER NAME SPACE */ # define alloca _alloca # else # define YYSTACK_ALLOC alloca # if ! defined _ALLOCA_H && ! defined _STDLIB_H && (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) # include /* INFRINGES ON USER NAME SPACE */ # ifndef _STDLIB_H # define _STDLIB_H 1 # endif # endif # endif # endif # endif # ifdef YYSTACK_ALLOC /* Pacify GCC's `empty if-body' warning. */ # define YYSTACK_FREE(Ptr) do { /* empty */; } while (YYID (0)) # ifndef YYSTACK_ALLOC_MAXIMUM /* The OS might guarantee only one guard page at the bottom of the stack, and a page size can be as small as 4096 bytes. So we cannot safely invoke alloca (N) if N exceeds 4096. Use a slightly smaller number to allow for a few compiler-allocated temporary stack slots. */ # define YYSTACK_ALLOC_MAXIMUM 4032 /* reasonable circa 2006 */ # endif # else # define YYSTACK_ALLOC YYMALLOC # define YYSTACK_FREE YYFREE # ifndef YYSTACK_ALLOC_MAXIMUM # define YYSTACK_ALLOC_MAXIMUM YYSIZE_MAXIMUM # endif # if (defined __cplusplus && ! defined _STDLIB_H \ && ! ((defined YYMALLOC || defined malloc) \ && (defined YYFREE || defined free))) # include /* INFRINGES ON USER NAME SPACE */ # ifndef _STDLIB_H # define _STDLIB_H 1 # endif # endif # ifndef YYMALLOC # define YYMALLOC malloc # if ! defined malloc && ! defined _STDLIB_H && (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) void *malloc (YYSIZE_T); /* INFRINGES ON USER NAME SPACE */ # endif # endif # ifndef YYFREE # define YYFREE free # if ! defined free && ! defined _STDLIB_H && (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) void free (void *); /* INFRINGES ON USER NAME SPACE */ # endif # endif # endif #endif /* ! defined yyoverflow || YYERROR_VERBOSE */ #if (! defined yyoverflow \ && (! defined __cplusplus \ || (defined YYSTYPE_IS_TRIVIAL && YYSTYPE_IS_TRIVIAL))) /* A type that is properly aligned for any stack member. */ union yyalloc { yytype_int16 yyss_alloc; YYSTYPE yyvs_alloc; }; /* The size of the maximum gap between one aligned stack and the next. */ # define YYSTACK_GAP_MAXIMUM (sizeof (union yyalloc) - 1) /* The size of an array large to enough to hold all stacks, each with N elements. */ # define YYSTACK_BYTES(N) \ ((N) * (sizeof (yytype_int16) + sizeof (YYSTYPE)) \ + YYSTACK_GAP_MAXIMUM) /* Copy COUNT objects from FROM to TO. The source and destination do not overlap. */ # ifndef YYCOPY # if defined __GNUC__ && 1 < __GNUC__ # define YYCOPY(To, From, Count) \ __builtin_memcpy (To, From, (Count) * sizeof (*(From))) # else # define YYCOPY(To, From, Count) \ do \ { \ YYSIZE_T yyi; \ for (yyi = 0; yyi < (Count); yyi++) \ (To)[yyi] = (From)[yyi]; \ } \ while (YYID (0)) # endif # endif /* Relocate STACK from its old location to the new one. The local variables YYSIZE and YYSTACKSIZE give the old and new number of elements in the stack, and YYPTR gives the new location of the stack. Advance YYPTR to a properly aligned location for the next stack. */ # define YYSTACK_RELOCATE(Stack_alloc, Stack) \ do \ { \ YYSIZE_T yynewbytes; \ YYCOPY (&yyptr->Stack_alloc, Stack, yysize); \ Stack = &yyptr->Stack_alloc; \ yynewbytes = yystacksize * sizeof (*Stack) + YYSTACK_GAP_MAXIMUM; \ yyptr += yynewbytes / sizeof (*yyptr); \ } \ while (YYID (0)) #endif /* YYFINAL -- State number of the termination state. */ #define YYFINAL 11 /* YYLAST -- Last index in YYTABLE. */ #define YYLAST 290 /* YYNTOKENS -- Number of terminals. */ #define YYNTOKENS 36 /* YYNNTS -- Number of nonterminals. */ #define YYNNTS 50 /* YYNRULES -- Number of rules. */ #define YYNRULES 118 /* YYNRULES -- Number of states. */ #define YYNSTATES 191 /* YYTRANSLATE(YYLEX) -- Bison symbol number corresponding to YYLEX. */ #define YYUNDEFTOK 2 #define YYMAXUTOK 290 #define YYTRANSLATE(YYX) \ ((unsigned int) (YYX) <= YYMAXUTOK ? yytranslate[YYX] : YYUNDEFTOK) /* YYTRANSLATE[YYLEX] -- Bison symbol number corresponding to YYLEX. */ static const yytype_uint8 yytranslate[] = { 0, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35 }; #if YYDEBUG /* YYPRHS[YYN] -- Index of the first RHS symbol of rule number YYN in YYRHS. */ static const yytype_uint16 yyprhs[] = { 0, 0, 3, 6, 8, 11, 13, 14, 17, 20, 23, 26, 31, 36, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, 60, 62, 64, 66, 68, 72, 75, 79, 82, 86, 89, 90, 93, 96, 99, 102, 105, 108, 112, 117, 122, 127, 133, 137, 138, 142, 143, 146, 150, 153, 155, 159, 160, 163, 166, 169, 172, 175, 180, 184, 187, 192, 193, 196, 200, 202, 206, 207, 210, 213, 216, 220, 224, 228, 230, 234, 235, 238, 241, 244, 248, 252, 255, 258, 261, 262, 265, 268, 271, 276, 277, 280, 283, 286, 287, 290, 292, 294, 297, 300, 303, 305, 308, 309, 312, 314, 318, 322, 326, 329, 333, 337, 339, 341, 342 }; /* YYRHS -- A `-1'-separated list of the rules' RHS. */ static const yytype_int8 yyrhs[] = { 37, 0, -1, 81, 38, -1, 38, -1, 63, 39, -1, 39, -1, -1, 39, 41, -1, 39, 55, -1, 39, 67, -1, 39, 80, -1, 39, 26, 1, 31, -1, 39, 40, 1, 31, -1, 39, 1, 31, -1, 16, -1, 18, -1, 19, -1, 21, -1, 17, -1, 22, -1, 20, -1, 23, -1, 31, -1, 61, -1, 71, -1, 44, -1, 46, -1, 69, -1, 26, 1, 31, -1, 1, 31, -1, 10, 26, 31, -1, 43, 47, -1, 11, 26, 31, -1, 45, 47, -1, -1, 47, 48, -1, 47, 49, -1, 47, 75, -1, 47, 73, -1, 47, 42, -1, 47, 31, -1, 19, 78, 31, -1, 18, 79, 82, 31, -1, 20, 83, 82, 31, -1, 21, 26, 82, 31, -1, 22, 84, 84, 82, 31, -1, 24, 50, 31, -1, -1, 50, 26, 51, -1, -1, 34, 79, -1, 7, 85, 31, -1, 52, 56, -1, 80, -1, 53, 58, 54, -1, -1, 56, 57, -1, 56, 75, -1, 56, 73, -1, 56, 31, -1, 56, 42, -1, 18, 79, 82, 31, -1, 19, 78, 31, -1, 17, 31, -1, 20, 26, 82, 31, -1, -1, 58, 41, -1, 14, 83, 81, -1, 80, -1, 59, 62, 60, -1, -1, 62, 41, -1, 62, 67, -1, 62, 55, -1, 3, 79, 81, -1, 4, 79, 31, -1, 64, 76, 74, -1, 80, -1, 65, 68, 66, -1, -1, 68, 41, -1, 68, 67, -1, 68, 55, -1, 6, 79, 31, -1, 9, 79, 31, -1, 70, 74, -1, 12, 31, -1, 72, 13, -1, -1, 74, 75, -1, 74, 31, -1, 74, 42, -1, 16, 25, 83, 31, -1, -1, 76, 77, -1, 76, 31, -1, 23, 82, -1, -1, 79, 82, -1, 26, -1, 27, -1, 5, 31, -1, 8, 31, -1, 15, 31, -1, 31, -1, 81, 31, -1, -1, 14, 83, -1, 84, -1, 84, 34, 84, -1, 84, 28, 84, -1, 30, 83, 29, -1, 35, 83, -1, 83, 32, 83, -1, 83, 33, 83, -1, 26, -1, 27, -1, -1, 26, -1 }; /* YYRLINE[YYN] -- source line where rule number YYN was defined. */ static const yytype_uint16 yyrline[] = { 0, 108, 108, 108, 110, 110, 112, 114, 115, 116, 117, 118, 119, 123, 127, 127, 127, 127, 127, 127, 127, 127, 131, 132, 133, 134, 135, 136, 140, 141, 147, 155, 161, 169, 179, 181, 182, 183, 184, 185, 186, 189, 197, 203, 213, 219, 225, 228, 230, 241, 242, 247, 256, 261, 269, 272, 274, 275, 276, 277, 278, 281, 287, 298, 304, 314, 316, 321, 329, 337, 340, 342, 343, 344, 349, 356, 363, 368, 376, 379, 381, 382, 383, 386, 394, 401, 408, 414, 421, 423, 424, 425, 428, 436, 438, 439, 442, 449, 451, 456, 457, 460, 461, 462, 466, 467, 470, 471, 474, 475, 476, 477, 478, 479, 480, 483, 484, 487, 488 }; #endif #if YYDEBUG || YYERROR_VERBOSE || YYTOKEN_TABLE /* YYTNAME[SYMBOL-NUM] -- String name of the symbol SYMBOL-NUM. First, the terminals, then, starting at YYNTOKENS, nonterminals. */ static const char *const yytname[] = { "$end", "error", "$undefined", "T_MAINMENU", "T_MENU", "T_ENDMENU", "T_SOURCE", "T_CHOICE", "T_ENDCHOICE", "T_COMMENT", "T_CONFIG", "T_MENUCONFIG", "T_HELP", "T_HELPTEXT", "T_IF", "T_ENDIF", "T_DEPENDS", "T_OPTIONAL", "T_PROMPT", "T_TYPE", "T_DEFAULT", "T_SELECT", "T_RANGE", "T_VISIBLE", "T_OPTION", "T_ON", "T_WORD", "T_WORD_QUOTE", "T_UNEQUAL", "T_CLOSE_PAREN", "T_OPEN_PAREN", "T_EOL", "T_OR", "T_AND", "T_EQUAL", "T_NOT", "$accept", "input", "start", "stmt_list", "option_name", "common_stmt", "option_error", "config_entry_start", "config_stmt", "menuconfig_entry_start", "menuconfig_stmt", "config_option_list", "config_option", "symbol_option", "symbol_option_list", "symbol_option_arg", "choice", "choice_entry", "choice_end", "choice_stmt", "choice_option_list", "choice_option", "choice_block", "if_entry", "if_end", "if_stmt", "if_block", "mainmenu_stmt", "menu", "menu_entry", "menu_end", "menu_stmt", "menu_block", "source_stmt", "comment", "comment_stmt", "help_start", "help", "depends_list", "depends", "visibility_list", "visible", "prompt_stmt_opt", "prompt", "end", "nl", "if_expr", "expr", "symbol", "word_opt", 0 }; #endif # ifdef YYPRINT /* YYTOKNUM[YYLEX-NUM] -- Internal token number corresponding to token YYLEX-NUM. */ static const yytype_uint16 yytoknum[] = { 0, 256, 257, 258, 259, 260, 261, 262, 263, 264, 265, 266, 267, 268, 269, 270, 271, 272, 273, 274, 275, 276, 277, 278, 279, 280, 281, 282, 283, 284, 285, 286, 287, 288, 289, 290 }; # endif /* YYR1[YYN] -- Symbol number of symbol that rule YYN derives. */ static const yytype_uint8 yyr1[] = { 0, 36, 37, 37, 38, 38, 39, 39, 39, 39, 39, 39, 39, 39, 40, 40, 40, 40, 40, 40, 40, 40, 41, 41, 41, 41, 41, 41, 42, 42, 43, 44, 45, 46, 47, 47, 47, 47, 47, 47, 47, 48, 48, 48, 48, 48, 49, 50, 50, 51, 51, 52, 53, 54, 55, 56, 56, 56, 56, 56, 56, 57, 57, 57, 57, 58, 58, 59, 60, 61, 62, 62, 62, 62, 63, 64, 65, 66, 67, 68, 68, 68, 68, 69, 70, 71, 72, 73, 74, 74, 74, 74, 75, 76, 76, 76, 77, 78, 78, 79, 79, 80, 80, 80, 81, 81, 82, 82, 83, 83, 83, 83, 83, 83, 83, 84, 84, 85, 85 }; /* YYR2[YYN] -- Number of symbols composing right hand side of rule YYN. */ static const yytype_uint8 yyr2[] = { 0, 2, 2, 1, 2, 1, 0, 2, 2, 2, 2, 4, 4, 3, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 3, 2, 3, 2, 3, 2, 0, 2, 2, 2, 2, 2, 2, 3, 4, 4, 4, 5, 3, 0, 3, 0, 2, 3, 2, 1, 3, 0, 2, 2, 2, 2, 2, 4, 3, 2, 4, 0, 2, 3, 1, 3, 0, 2, 2, 2, 3, 3, 3, 1, 3, 0, 2, 2, 2, 3, 3, 2, 2, 2, 0, 2, 2, 2, 4, 0, 2, 2, 2, 0, 2, 1, 1, 2, 2, 2, 1, 2, 0, 2, 1, 3, 3, 3, 2, 3, 3, 1, 1, 0, 1 }; /* YYDEFACT[STATE-NAME] -- Default rule to reduce with in state STATE-NUM when YYTABLE doesn't specify something else to do. Zero means the default is an error. */ static const yytype_uint8 yydefact[] = { 6, 0, 104, 0, 3, 0, 6, 6, 99, 100, 0, 1, 0, 0, 0, 0, 117, 0, 0, 0, 0, 0, 0, 14, 18, 15, 16, 20, 17, 19, 21, 0, 22, 0, 7, 34, 25, 34, 26, 55, 65, 8, 70, 23, 93, 79, 9, 27, 88, 24, 10, 0, 105, 2, 74, 13, 0, 101, 0, 118, 0, 102, 0, 0, 0, 115, 116, 0, 0, 0, 108, 103, 0, 0, 0, 0, 0, 0, 0, 88, 0, 0, 75, 83, 51, 84, 30, 32, 0, 112, 0, 0, 67, 0, 0, 11, 12, 0, 0, 0, 0, 97, 0, 0, 0, 47, 0, 40, 39, 35, 36, 0, 38, 37, 0, 0, 97, 0, 59, 60, 56, 58, 57, 66, 54, 53, 71, 73, 69, 72, 68, 106, 95, 0, 94, 80, 82, 78, 81, 77, 90, 91, 89, 111, 113, 114, 110, 109, 29, 86, 0, 106, 0, 106, 106, 106, 0, 0, 0, 87, 63, 106, 0, 106, 0, 96, 0, 0, 41, 98, 0, 0, 106, 49, 46, 28, 0, 62, 0, 107, 92, 42, 43, 44, 0, 0, 48, 61, 64, 45, 50 }; /* YYDEFGOTO[NTERM-NUM]. */ static const yytype_int16 yydefgoto[] = { -1, 3, 4, 5, 33, 34, 108, 35, 36, 37, 38, 74, 109, 110, 157, 186, 39, 40, 124, 41, 76, 120, 77, 42, 128, 43, 78, 6, 44, 45, 137, 46, 80, 47, 48, 49, 111, 112, 81, 113, 79, 134, 152, 153, 50, 7, 165, 69, 70, 60 }; /* YYPACT[STATE-NUM] -- Index in YYTABLE of the portion describing STATE-NUM. */ #define YYPACT_NINF -90 static const yytype_int16 yypact[] = { 4, 42, -90, 96, -90, 111, -90, 15, -90, -90, 75, -90, 82, 42, 104, 42, 110, 107, 42, 115, 125, -4, 121, -90, -90, -90, -90, -90, -90, -90, -90, 162, -90, 163, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, 139, -90, -90, 138, -90, 142, -90, 143, -90, 152, -90, 164, 167, 168, -90, -90, -4, -4, 77, -18, -90, 177, 185, 33, 71, 195, 247, 236, -2, 236, 171, -90, -90, -90, -90, -90, -90, 41, -90, -4, -4, 138, 97, 97, -90, -90, 186, 187, 194, 42, 42, -4, 196, 97, -90, 219, -90, -90, -90, -90, 210, -90, -90, 204, 42, 42, 199, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, 222, -90, 223, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, 215, -90, -90, -90, -90, -90, -4, 222, 228, 222, -5, 222, 97, 35, 229, -90, -90, 222, 232, 222, -4, -90, 135, 233, -90, -90, 234, 235, 222, 240, -90, -90, 237, -90, 239, -13, -90, -90, -90, -90, 244, 42, -90, -90, -90, -90, -90 }; /* YYPGOTO[NTERM-NUM]. */ static const yytype_int16 yypgoto[] = { -90, -90, 269, 271, -90, 23, -70, -90, -90, -90, -90, 243, -90, -90, -90, -90, -90, -90, -90, -48, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, -90, -20, -90, -90, -90, -90, -90, 206, 205, -68, -90, -90, 169, -1, 27, -7, 118, -66, -89, -90 }; /* YYTABLE[YYPACT[STATE-NUM]]. What to do in state STATE-NUM. If positive, shift that token. If negative, reduce the rule which number is the opposite. If zero, do what YYDEFACT says. If YYTABLE_NINF, syntax error. */ #define YYTABLE_NINF -86 static const yytype_int16 yytable[] = { 10, 88, 89, 54, 146, 147, 119, 1, 122, 164, 93, 141, 56, 142, 58, 156, 94, 62, 1, 90, 91, 131, 65, 66, 144, 145, 67, 90, 91, 132, 127, 68, 136, -31, 97, 2, 154, -31, -31, -31, -31, -31, -31, -31, -31, 98, 52, -31, -31, 99, -31, 100, 101, 102, 103, 104, -31, 105, 129, 106, 138, 173, 92, 141, 107, 142, 174, 172, 8, 9, 143, -33, 97, 90, 91, -33, -33, -33, -33, -33, -33, -33, -33, 98, 166, -33, -33, 99, -33, 100, 101, 102, 103, 104, -33, 105, 11, 106, 179, 151, 123, 126, 107, 135, 125, 130, 2, 139, 2, 90, 91, -5, 12, 55, 161, 13, 14, 15, 16, 17, 18, 19, 20, 65, 66, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 57, 59, 31, 61, -4, 12, 63, 32, 13, 14, 15, 16, 17, 18, 19, 20, 64, 71, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 72, 73, 31, 180, 90, 91, 52, 32, -85, 97, 82, 83, -85, -85, -85, -85, -85, -85, -85, -85, 84, 190, -85, -85, 99, -85, -85, -85, -85, -85, -85, -85, 85, 97, 106, 86, 87, -52, -52, 140, -52, -52, -52, -52, 98, 95, -52, -52, 99, 114, 115, 116, 117, 96, 148, 149, 150, 158, 106, 155, 159, 97, 163, 118, -76, -76, -76, -76, -76, -76, -76, -76, 160, 164, -76, -76, 99, 13, 14, 15, 16, 17, 18, 19, 20, 91, 106, 21, 22, 14, 15, 140, 17, 18, 19, 20, 168, 175, 21, 22, 177, 181, 182, 183, 32, 187, 167, 188, 169, 170, 171, 185, 189, 53, 51, 32, 176, 75, 178, 121, 0, 133, 162, 0, 0, 0, 0, 184 }; static const yytype_int16 yycheck[] = { 1, 67, 68, 10, 93, 94, 76, 3, 76, 14, 28, 81, 13, 81, 15, 104, 34, 18, 3, 32, 33, 23, 26, 27, 90, 91, 30, 32, 33, 31, 78, 35, 80, 0, 1, 31, 102, 4, 5, 6, 7, 8, 9, 10, 11, 12, 31, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 78, 26, 80, 26, 69, 133, 31, 133, 31, 156, 26, 27, 29, 0, 1, 32, 33, 4, 5, 6, 7, 8, 9, 10, 11, 12, 150, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 0, 26, 164, 100, 77, 78, 31, 80, 77, 78, 31, 80, 31, 32, 33, 0, 1, 31, 115, 4, 5, 6, 7, 8, 9, 10, 11, 26, 27, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 31, 26, 26, 31, 0, 1, 26, 31, 4, 5, 6, 7, 8, 9, 10, 11, 26, 31, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 1, 1, 26, 31, 32, 33, 31, 31, 0, 1, 31, 31, 4, 5, 6, 7, 8, 9, 10, 11, 31, 185, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 31, 1, 26, 31, 31, 5, 6, 31, 8, 9, 10, 11, 12, 31, 14, 15, 16, 17, 18, 19, 20, 31, 31, 31, 25, 1, 26, 26, 13, 1, 26, 31, 4, 5, 6, 7, 8, 9, 10, 11, 31, 14, 14, 15, 16, 4, 5, 6, 7, 8, 9, 10, 11, 33, 26, 14, 15, 5, 6, 31, 8, 9, 10, 11, 31, 31, 14, 15, 31, 31, 31, 31, 31, 31, 151, 31, 153, 154, 155, 34, 31, 7, 6, 31, 161, 37, 163, 76, -1, 79, 116, -1, -1, -1, -1, 172 }; /* YYSTOS[STATE-NUM] -- The (internal number of the) accessing symbol of state STATE-NUM. */ static const yytype_uint8 yystos[] = { 0, 3, 31, 37, 38, 39, 63, 81, 26, 27, 79, 0, 1, 4, 5, 6, 7, 8, 9, 10, 11, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 26, 31, 40, 41, 43, 44, 45, 46, 52, 53, 55, 59, 61, 64, 65, 67, 69, 70, 71, 80, 39, 31, 38, 81, 31, 79, 31, 79, 26, 85, 31, 79, 26, 26, 26, 27, 30, 35, 83, 84, 31, 1, 1, 47, 47, 56, 58, 62, 76, 68, 74, 31, 31, 31, 31, 31, 31, 83, 83, 32, 33, 81, 28, 34, 31, 31, 1, 12, 16, 18, 19, 20, 21, 22, 24, 26, 31, 42, 48, 49, 72, 73, 75, 17, 18, 19, 20, 31, 42, 57, 73, 75, 41, 54, 80, 41, 55, 60, 67, 80, 23, 31, 74, 77, 41, 55, 66, 67, 80, 31, 42, 75, 29, 83, 83, 84, 84, 31, 31, 25, 79, 78, 79, 83, 26, 84, 50, 1, 13, 31, 79, 78, 26, 14, 82, 83, 82, 31, 82, 82, 82, 84, 26, 31, 31, 82, 31, 82, 83, 31, 31, 31, 31, 82, 34, 51, 31, 31, 31, 79 }; #define yyerrok (yyerrstatus = 0) #define yyclearin (yychar = YYEMPTY) #define YYEMPTY (-2) #define YYEOF 0 #define YYACCEPT goto yyacceptlab #define YYABORT goto yyabortlab #define YYERROR goto yyerrorlab /* Like YYERROR except do call yyerror. This remains here temporarily to ease the transition to the new meaning of YYERROR, for GCC. Once GCC version 2 has supplanted version 1, this can go. */ #define YYFAIL goto yyerrlab #define YYRECOVERING() (!!yyerrstatus) #define YYBACKUP(Token, Value) \ do \ if (yychar == YYEMPTY && yylen == 1) \ { \ yychar = (Token); \ yylval = (Value); \ yytoken = YYTRANSLATE (yychar); \ YYPOPSTACK (1); \ goto yybackup; \ } \ else \ { \ yyerror (YY_("syntax error: cannot back up")); \ YYERROR; \ } \ while (YYID (0)) #define YYTERROR 1 #define YYERRCODE 256 /* YYLLOC_DEFAULT -- Set CURRENT to span from RHS[1] to RHS[N]. If N is 0, then set CURRENT to the empty location which ends the previous symbol: RHS[0] (always defined). */ #define YYRHSLOC(Rhs, K) ((Rhs)[K]) #ifndef YYLLOC_DEFAULT # define YYLLOC_DEFAULT(Current, Rhs, N) \ do \ if (YYID (N)) \ { \ (Current).first_line = YYRHSLOC (Rhs, 1).first_line; \ (Current).first_column = YYRHSLOC (Rhs, 1).first_column; \ (Current).last_line = YYRHSLOC (Rhs, N).last_line; \ (Current).last_column = YYRHSLOC (Rhs, N).last_column; \ } \ else \ { \ (Current).first_line = (Current).last_line = \ YYRHSLOC (Rhs, 0).last_line; \ (Current).first_column = (Current).last_column = \ YYRHSLOC (Rhs, 0).last_column; \ } \ while (YYID (0)) #endif /* YY_LOCATION_PRINT -- Print the location on the stream. This macro was not mandated originally: define only if we know we won't break user code: when these are the locations we know. */ #ifndef YY_LOCATION_PRINT # if YYLTYPE_IS_TRIVIAL # define YY_LOCATION_PRINT(File, Loc) \ fprintf (File, "%d.%d-%d.%d", \ (Loc).first_line, (Loc).first_column, \ (Loc).last_line, (Loc).last_column) # else # define YY_LOCATION_PRINT(File, Loc) ((void) 0) # endif #endif /* YYLEX -- calling `yylex' with the right arguments. */ #ifdef YYLEX_PARAM # define YYLEX yylex (YYLEX_PARAM) #else # define YYLEX yylex () #endif /* Enable debugging if requested. */ #if YYDEBUG # ifndef YYFPRINTF # include /* INFRINGES ON USER NAME SPACE */ # define YYFPRINTF fprintf # endif # define YYDPRINTF(Args) \ do { \ if (yydebug) \ YYFPRINTF Args; \ } while (YYID (0)) # define YY_SYMBOL_PRINT(Title, Type, Value, Location) \ do { \ if (yydebug) \ { \ YYFPRINTF (stderr, "%s ", Title); \ yy_symbol_print (stderr, \ Type, Value); \ YYFPRINTF (stderr, "\n"); \ } \ } while (YYID (0)) /*--------------------------------. | Print this symbol on YYOUTPUT. | `--------------------------------*/ /*ARGSUSED*/ #if (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) static void yy_symbol_value_print (FILE *yyoutput, int yytype, YYSTYPE const * const yyvaluep) #else static void yy_symbol_value_print (yyoutput, yytype, yyvaluep) FILE *yyoutput; int yytype; YYSTYPE const * const yyvaluep; #endif { if (!yyvaluep) return; # ifdef YYPRINT if (yytype < YYNTOKENS) YYPRINT (yyoutput, yytoknum[yytype], *yyvaluep); # else YYUSE (yyoutput); # endif switch (yytype) { default: break; } } /*--------------------------------. | Print this symbol on YYOUTPUT. | `--------------------------------*/ #if (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) static void yy_symbol_print (FILE *yyoutput, int yytype, YYSTYPE const * const yyvaluep) #else static void yy_symbol_print (yyoutput, yytype, yyvaluep) FILE *yyoutput; int yytype; YYSTYPE const * const yyvaluep; #endif { if (yytype < YYNTOKENS) YYFPRINTF (yyoutput, "token %s (", yytname[yytype]); else YYFPRINTF (yyoutput, "nterm %s (", yytname[yytype]); yy_symbol_value_print (yyoutput, yytype, yyvaluep); YYFPRINTF (yyoutput, ")"); } /*------------------------------------------------------------------. | yy_stack_print -- Print the state stack from its BOTTOM up to its | | TOP (included). | `------------------------------------------------------------------*/ #if (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) static void yy_stack_print (yytype_int16 *yybottom, yytype_int16 *yytop) #else static void yy_stack_print (yybottom, yytop) yytype_int16 *yybottom; yytype_int16 *yytop; #endif { YYFPRINTF (stderr, "Stack now"); for (; yybottom <= yytop; yybottom++) { int yybot = *yybottom; YYFPRINTF (stderr, " %d", yybot); } YYFPRINTF (stderr, "\n"); } # define YY_STACK_PRINT(Bottom, Top) \ do { \ if (yydebug) \ yy_stack_print ((Bottom), (Top)); \ } while (YYID (0)) /*------------------------------------------------. | Report that the YYRULE is going to be reduced. | `------------------------------------------------*/ #if (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) static void yy_reduce_print (YYSTYPE *yyvsp, int yyrule) #else static void yy_reduce_print (yyvsp, yyrule) YYSTYPE *yyvsp; int yyrule; #endif { int yynrhs = yyr2[yyrule]; int yyi; unsigned long int yylno = yyrline[yyrule]; YYFPRINTF (stderr, "Reducing stack by rule %d (line %lu):\n", yyrule - 1, yylno); /* The symbols being reduced. */ for (yyi = 0; yyi < yynrhs; yyi++) { YYFPRINTF (stderr, " $%d = ", yyi + 1); yy_symbol_print (stderr, yyrhs[yyprhs[yyrule] + yyi], &(yyvsp[(yyi + 1) - (yynrhs)]) ); YYFPRINTF (stderr, "\n"); } } # define YY_REDUCE_PRINT(Rule) \ do { \ if (yydebug) \ yy_reduce_print (yyvsp, Rule); \ } while (YYID (0)) /* Nonzero means print parse trace. It is left uninitialized so that multiple parsers can coexist. */ int yydebug; #else /* !YYDEBUG */ # define YYDPRINTF(Args) # define YY_SYMBOL_PRINT(Title, Type, Value, Location) # define YY_STACK_PRINT(Bottom, Top) # define YY_REDUCE_PRINT(Rule) #endif /* !YYDEBUG */ /* YYINITDEPTH -- initial size of the parser's stacks. */ #ifndef YYINITDEPTH # define YYINITDEPTH 200 #endif /* YYMAXDEPTH -- maximum size the stacks can grow to (effective only if the built-in stack extension method is used). Do not make this value too large; the results are undefined if YYSTACK_ALLOC_MAXIMUM < YYSTACK_BYTES (YYMAXDEPTH) evaluated with infinite-precision integer arithmetic. */ #ifndef YYMAXDEPTH # define YYMAXDEPTH 10000 #endif #if YYERROR_VERBOSE # ifndef yystrlen # if defined __GLIBC__ && defined _STRING_H # define yystrlen strlen # else /* Return the length of YYSTR. */ #if (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) static YYSIZE_T yystrlen (const char *yystr) #else static YYSIZE_T yystrlen (yystr) const char *yystr; #endif { YYSIZE_T yylen; for (yylen = 0; yystr[yylen]; yylen++) continue; return yylen; } # endif # endif # ifndef yystpcpy # if defined __GLIBC__ && defined _STRING_H && defined _GNU_SOURCE # define yystpcpy stpcpy # else /* Copy YYSRC to YYDEST, returning the address of the terminating '\0' in YYDEST. */ #if (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) static char * yystpcpy (char *yydest, const char *yysrc) #else static char * yystpcpy (yydest, yysrc) char *yydest; const char *yysrc; #endif { char *yyd = yydest; const char *yys = yysrc; while ((*yyd++ = *yys++) != '\0') continue; return yyd - 1; } # endif # endif # ifndef yytnamerr /* Copy to YYRES the contents of YYSTR after stripping away unnecessary quotes and backslashes, so that it's suitable for yyerror. The heuristic is that double-quoting is unnecessary unless the string contains an apostrophe, a comma, or backslash (other than backslash-backslash). YYSTR is taken from yytname. If YYRES is null, do not copy; instead, return the length of what the result would have been. */ static YYSIZE_T yytnamerr (char *yyres, const char *yystr) { if (*yystr == '"') { YYSIZE_T yyn = 0; char const *yyp = yystr; for (;;) switch (*++yyp) { case '\'': case ',': goto do_not_strip_quotes; case '\\': if (*++yyp != '\\') goto do_not_strip_quotes; /* Fall through. */ default: if (yyres) yyres[yyn] = *yyp; yyn++; break; case '"': if (yyres) yyres[yyn] = '\0'; return yyn; } do_not_strip_quotes: ; } if (! yyres) return yystrlen (yystr); return yystpcpy (yyres, yystr) - yyres; } # endif /* Copy into YYRESULT an error message about the unexpected token YYCHAR while in state YYSTATE. Return the number of bytes copied, including the terminating null byte. If YYRESULT is null, do not copy anything; just return the number of bytes that would be copied. As a special case, return 0 if an ordinary "syntax error" message will do. Return YYSIZE_MAXIMUM if overflow occurs during size calculation. */ static YYSIZE_T yysyntax_error (char *yyresult, int yystate, int yychar) { int yyn = yypact[yystate]; if (! (YYPACT_NINF < yyn && yyn <= YYLAST)) return 0; else { int yytype = YYTRANSLATE (yychar); YYSIZE_T yysize0 = yytnamerr (0, yytname[yytype]); YYSIZE_T yysize = yysize0; YYSIZE_T yysize1; int yysize_overflow = 0; enum { YYERROR_VERBOSE_ARGS_MAXIMUM = 5 }; char const *yyarg[YYERROR_VERBOSE_ARGS_MAXIMUM]; int yyx; # if 0 /* This is so xgettext sees the translatable formats that are constructed on the fly. */ YY_("syntax error, unexpected %s"); YY_("syntax error, unexpected %s, expecting %s"); YY_("syntax error, unexpected %s, expecting %s or %s"); YY_("syntax error, unexpected %s, expecting %s or %s or %s"); YY_("syntax error, unexpected %s, expecting %s or %s or %s or %s"); # endif char *yyfmt; char const *yyf; static char const yyunexpected[] = "syntax error, unexpected %s"; static char const yyexpecting[] = ", expecting %s"; static char const yyor[] = " or %s"; char yyformat[sizeof yyunexpected + sizeof yyexpecting - 1 + ((YYERROR_VERBOSE_ARGS_MAXIMUM - 2) * (sizeof yyor - 1))]; char const *yyprefix = yyexpecting; /* Start YYX at -YYN if negative to avoid negative indexes in YYCHECK. */ int yyxbegin = yyn < 0 ? -yyn : 0; /* Stay within bounds of both yycheck and yytname. */ int yychecklim = YYLAST - yyn + 1; int yyxend = yychecklim < YYNTOKENS ? yychecklim : YYNTOKENS; int yycount = 1; yyarg[0] = yytname[yytype]; yyfmt = yystpcpy (yyformat, yyunexpected); for (yyx = yyxbegin; yyx < yyxend; ++yyx) if (yycheck[yyx + yyn] == yyx && yyx != YYTERROR) { if (yycount == YYERROR_VERBOSE_ARGS_MAXIMUM) { yycount = 1; yysize = yysize0; yyformat[sizeof yyunexpected - 1] = '\0'; break; } yyarg[yycount++] = yytname[yyx]; yysize1 = yysize + yytnamerr (0, yytname[yyx]); yysize_overflow |= (yysize1 < yysize); yysize = yysize1; yyfmt = yystpcpy (yyfmt, yyprefix); yyprefix = yyor; } yyf = YY_(yyformat); yysize1 = yysize + yystrlen (yyf); yysize_overflow |= (yysize1 < yysize); yysize = yysize1; if (yysize_overflow) return YYSIZE_MAXIMUM; if (yyresult) { /* Avoid sprintf, as that infringes on the user's name space. Don't have undefined behavior even if the translation produced a string with the wrong number of "%s"s. */ char *yyp = yyresult; int yyi = 0; while ((*yyp = *yyf) != '\0') { if (*yyp == '%' && yyf[1] == 's' && yyi < yycount) { yyp += yytnamerr (yyp, yyarg[yyi++]); yyf += 2; } else { yyp++; yyf++; } } } return yysize; } } #endif /* YYERROR_VERBOSE */ /*-----------------------------------------------. | Release the memory associated to this symbol. | `-----------------------------------------------*/ /*ARGSUSED*/ #if (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) static void yydestruct (const char *yymsg, int yytype, YYSTYPE *yyvaluep) #else static void yydestruct (yymsg, yytype, yyvaluep) const char *yymsg; int yytype; YYSTYPE *yyvaluep; #endif { YYUSE (yyvaluep); if (!yymsg) yymsg = "Deleting"; YY_SYMBOL_PRINT (yymsg, yytype, yyvaluep, yylocationp); switch (yytype) { case 53: /* "choice_entry" */ { fprintf(stderr, "%s:%d: missing end statement for this entry\n", (yyvaluep->menu)->file->name, (yyvaluep->menu)->lineno); if (current_menu == (yyvaluep->menu)) menu_end_menu(); }; break; case 59: /* "if_entry" */ { fprintf(stderr, "%s:%d: missing end statement for this entry\n", (yyvaluep->menu)->file->name, (yyvaluep->menu)->lineno); if (current_menu == (yyvaluep->menu)) menu_end_menu(); }; break; case 65: /* "menu_entry" */ { fprintf(stderr, "%s:%d: missing end statement for this entry\n", (yyvaluep->menu)->file->name, (yyvaluep->menu)->lineno); if (current_menu == (yyvaluep->menu)) menu_end_menu(); }; break; default: break; } } /* Prevent warnings from -Wmissing-prototypes. */ #ifdef YYPARSE_PARAM #if defined __STDC__ || defined __cplusplus int yyparse (void *YYPARSE_PARAM); #else int yyparse (); #endif #else /* ! YYPARSE_PARAM */ #if defined __STDC__ || defined __cplusplus int yyparse (void); #else int yyparse (); #endif #endif /* ! YYPARSE_PARAM */ /* The lookahead symbol. */ int yychar; /* The semantic value of the lookahead symbol. */ YYSTYPE yylval; /* Number of syntax errors so far. */ int yynerrs; /*-------------------------. | yyparse or yypush_parse. | `-------------------------*/ #ifdef YYPARSE_PARAM #if (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) int yyparse (void *YYPARSE_PARAM) #else int yyparse (YYPARSE_PARAM) void *YYPARSE_PARAM; #endif #else /* ! YYPARSE_PARAM */ #if (defined __STDC__ || defined __C99__FUNC__ \ || defined __cplusplus || defined _MSC_VER) int yyparse (void) #else int yyparse () #endif #endif { int yystate; /* Number of tokens to shift before error messages enabled. */ int yyerrstatus; /* The stacks and their tools: `yyss': related to states. `yyvs': related to semantic values. Refer to the stacks thru separate pointers, to allow yyoverflow to reallocate them elsewhere. */ /* The state stack. */ yytype_int16 yyssa[YYINITDEPTH]; yytype_int16 *yyss; yytype_int16 *yyssp; /* The semantic value stack. */ YYSTYPE yyvsa[YYINITDEPTH]; YYSTYPE *yyvs; YYSTYPE *yyvsp; YYSIZE_T yystacksize; int yyn; int yyresult; /* Lookahead token as an internal (translated) token number. */ int yytoken; /* The variables used to return semantic value and location from the action routines. */ YYSTYPE yyval; #if YYERROR_VERBOSE /* Buffer for error messages, and its allocated size. */ char yymsgbuf[128]; char *yymsg = yymsgbuf; YYSIZE_T yymsg_alloc = sizeof yymsgbuf; #endif #define YYPOPSTACK(N) (yyvsp -= (N), yyssp -= (N)) /* The number of symbols on the RHS of the reduced rule. Keep to zero when no symbol should be popped. */ int yylen = 0; yytoken = 0; yyss = yyssa; yyvs = yyvsa; yystacksize = YYINITDEPTH; YYDPRINTF ((stderr, "Starting parse\n")); yystate = 0; yyerrstatus = 0; yynerrs = 0; yychar = YYEMPTY; /* Cause a token to be read. */ /* Initialize stack pointers. Waste one element of value and location stack so that they stay on the same level as the state stack. The wasted elements are never initialized. */ yyssp = yyss; yyvsp = yyvs; goto yysetstate; /*------------------------------------------------------------. | yynewstate -- Push a new state, which is found in yystate. | `------------------------------------------------------------*/ yynewstate: /* In all cases, when you get here, the value and location stacks have just been pushed. So pushing a state here evens the stacks. */ yyssp++; yysetstate: *yyssp = yystate; if (yyss + yystacksize - 1 <= yyssp) { /* Get the current used size of the three stacks, in elements. */ YYSIZE_T yysize = yyssp - yyss + 1; #ifdef yyoverflow { /* Give user a chance to reallocate the stack. Use copies of these so that the &'s don't force the real ones into memory. */ YYSTYPE *yyvs1 = yyvs; yytype_int16 *yyss1 = yyss; /* Each stack pointer address is followed by the size of the data in use in that stack, in bytes. This used to be a conditional around just the two extra args, but that might be undefined if yyoverflow is a macro. */ yyoverflow (YY_("memory exhausted"), &yyss1, yysize * sizeof (*yyssp), &yyvs1, yysize * sizeof (*yyvsp), &yystacksize); yyss = yyss1; yyvs = yyvs1; } #else /* no yyoverflow */ # ifndef YYSTACK_RELOCATE goto yyexhaustedlab; # else /* Extend the stack our own way. */ if (YYMAXDEPTH <= yystacksize) goto yyexhaustedlab; yystacksize *= 2; if (YYMAXDEPTH < yystacksize) yystacksize = YYMAXDEPTH; { yytype_int16 *yyss1 = yyss; union yyalloc *yyptr = (union yyalloc *) YYSTACK_ALLOC (YYSTACK_BYTES (yystacksize)); if (! yyptr) goto yyexhaustedlab; YYSTACK_RELOCATE (yyss_alloc, yyss); YYSTACK_RELOCATE (yyvs_alloc, yyvs); # undef YYSTACK_RELOCATE if (yyss1 != yyssa) YYSTACK_FREE (yyss1); } # endif #endif /* no yyoverflow */ yyssp = yyss + yysize - 1; yyvsp = yyvs + yysize - 1; YYDPRINTF ((stderr, "Stack size increased to %lu\n", (unsigned long int) yystacksize)); if (yyss + yystacksize - 1 <= yyssp) YYABORT; } YYDPRINTF ((stderr, "Entering state %d\n", yystate)); if (yystate == YYFINAL) YYACCEPT; goto yybackup; /*-----------. | yybackup. | `-----------*/ yybackup: /* Do appropriate processing given the current state. Read a lookahead token if we need one and don't already have one. */ /* First try to decide what to do without reference to lookahead token. */ yyn = yypact[yystate]; if (yyn == YYPACT_NINF) goto yydefault; /* Not known => get a lookahead token if don't already have one. */ /* YYCHAR is either YYEMPTY or YYEOF or a valid lookahead symbol. */ if (yychar == YYEMPTY) { YYDPRINTF ((stderr, "Reading a token: ")); yychar = YYLEX; } if (yychar <= YYEOF) { yychar = yytoken = YYEOF; YYDPRINTF ((stderr, "Now at end of input.\n")); } else { yytoken = YYTRANSLATE (yychar); YY_SYMBOL_PRINT ("Next token is", yytoken, &yylval, &yylloc); } /* If the proper action on seeing token YYTOKEN is to reduce or to detect an error, take that action. */ yyn += yytoken; if (yyn < 0 || YYLAST < yyn || yycheck[yyn] != yytoken) goto yydefault; yyn = yytable[yyn]; if (yyn <= 0) { if (yyn == 0 || yyn == YYTABLE_NINF) goto yyerrlab; yyn = -yyn; goto yyreduce; } /* Count tokens shifted since error; after three, turn off error status. */ if (yyerrstatus) yyerrstatus--; /* Shift the lookahead token. */ YY_SYMBOL_PRINT ("Shifting", yytoken, &yylval, &yylloc); /* Discard the shifted token. */ yychar = YYEMPTY; yystate = yyn; *++yyvsp = yylval; goto yynewstate; /*-----------------------------------------------------------. | yydefault -- do the default action for the current state. | `-----------------------------------------------------------*/ yydefault: yyn = yydefact[yystate]; if (yyn == 0) goto yyerrlab; goto yyreduce; /*-----------------------------. | yyreduce -- Do a reduction. | `-----------------------------*/ yyreduce: /* yyn is the number of a rule to reduce with. */ yylen = yyr2[yyn]; /* If YYLEN is nonzero, implement the default value of the action: `$$ = $1'. Otherwise, the following line sets YYVAL to garbage. This behavior is undocumented and Bison users should not rely upon it. Assigning to YYVAL unconditionally makes the parser a bit smaller, and it avoids a GCC warning that YYVAL may be used uninitialized. */ yyval = yyvsp[1-yylen]; YY_REDUCE_PRINT (yyn); switch (yyn) { case 10: { zconf_error("unexpected end statement"); ;} break; case 11: { zconf_error("unknown statement \"%s\"", (yyvsp[(2) - (4)].string)); ;} break; case 12: { zconf_error("unexpected option \"%s\"", kconf_id_strings + (yyvsp[(2) - (4)].id)->name); ;} break; case 13: { zconf_error("invalid statement"); ;} break; case 28: { zconf_error("unknown option \"%s\"", (yyvsp[(1) - (3)].string)); ;} break; case 29: { zconf_error("invalid option"); ;} break; case 30: { struct symbol *sym = sym_lookup((yyvsp[(2) - (3)].string), 0); sym->flags |= SYMBOL_OPTIONAL; menu_add_entry(sym); printd(DEBUG_PARSE, "%s:%d:config %s\n", zconf_curname(), zconf_lineno(), (yyvsp[(2) - (3)].string)); ;} break; case 31: { menu_end_entry(); printd(DEBUG_PARSE, "%s:%d:endconfig\n", zconf_curname(), zconf_lineno()); ;} break; case 32: { struct symbol *sym = sym_lookup((yyvsp[(2) - (3)].string), 0); sym->flags |= SYMBOL_OPTIONAL; menu_add_entry(sym); printd(DEBUG_PARSE, "%s:%d:menuconfig %s\n", zconf_curname(), zconf_lineno(), (yyvsp[(2) - (3)].string)); ;} break; case 33: { if (current_entry->prompt) current_entry->prompt->type = P_MENU; else zconfprint("warning: menuconfig statement without prompt"); menu_end_entry(); printd(DEBUG_PARSE, "%s:%d:endconfig\n", zconf_curname(), zconf_lineno()); ;} break; case 41: { menu_set_type((yyvsp[(1) - (3)].id)->stype); printd(DEBUG_PARSE, "%s:%d:type(%u)\n", zconf_curname(), zconf_lineno(), (yyvsp[(1) - (3)].id)->stype); ;} break; case 42: { menu_add_prompt(P_PROMPT, (yyvsp[(2) - (4)].string), (yyvsp[(3) - (4)].expr)); printd(DEBUG_PARSE, "%s:%d:prompt\n", zconf_curname(), zconf_lineno()); ;} break; case 43: { menu_add_expr(P_DEFAULT, (yyvsp[(2) - (4)].expr), (yyvsp[(3) - (4)].expr)); if ((yyvsp[(1) - (4)].id)->stype != S_UNKNOWN) menu_set_type((yyvsp[(1) - (4)].id)->stype); printd(DEBUG_PARSE, "%s:%d:default(%u)\n", zconf_curname(), zconf_lineno(), (yyvsp[(1) - (4)].id)->stype); ;} break; case 44: { menu_add_symbol(P_SELECT, sym_lookup((yyvsp[(2) - (4)].string), 0), (yyvsp[(3) - (4)].expr)); printd(DEBUG_PARSE, "%s:%d:select\n", zconf_curname(), zconf_lineno()); ;} break; case 45: { menu_add_expr(P_RANGE, expr_alloc_comp(E_RANGE,(yyvsp[(2) - (5)].symbol), (yyvsp[(3) - (5)].symbol)), (yyvsp[(4) - (5)].expr)); printd(DEBUG_PARSE, "%s:%d:range\n", zconf_curname(), zconf_lineno()); ;} break; case 48: { struct kconf_id *id = kconf_id_lookup((yyvsp[(2) - (3)].string), strlen((yyvsp[(2) - (3)].string))); if (id && id->flags & TF_OPTION) menu_add_option(id->token, (yyvsp[(3) - (3)].string)); else zconfprint("warning: ignoring unknown option %s", (yyvsp[(2) - (3)].string)); free((yyvsp[(2) - (3)].string)); ;} break; case 49: { (yyval.string) = NULL; ;} break; case 50: { (yyval.string) = (yyvsp[(2) - (2)].string); ;} break; case 51: { struct symbol *sym = sym_lookup((yyvsp[(2) - (3)].string), SYMBOL_CHOICE); sym->flags |= SYMBOL_AUTO; menu_add_entry(sym); menu_add_expr(P_CHOICE, NULL, NULL); printd(DEBUG_PARSE, "%s:%d:choice\n", zconf_curname(), zconf_lineno()); ;} break; case 52: { (yyval.menu) = menu_add_menu(); ;} break; case 53: { if (zconf_endtoken((yyvsp[(1) - (1)].id), T_CHOICE, T_ENDCHOICE)) { menu_end_menu(); printd(DEBUG_PARSE, "%s:%d:endchoice\n", zconf_curname(), zconf_lineno()); } ;} break; case 61: { menu_add_prompt(P_PROMPT, (yyvsp[(2) - (4)].string), (yyvsp[(3) - (4)].expr)); printd(DEBUG_PARSE, "%s:%d:prompt\n", zconf_curname(), zconf_lineno()); ;} break; case 62: { if ((yyvsp[(1) - (3)].id)->stype == S_BOOLEAN || (yyvsp[(1) - (3)].id)->stype == S_TRISTATE) { menu_set_type((yyvsp[(1) - (3)].id)->stype); printd(DEBUG_PARSE, "%s:%d:type(%u)\n", zconf_curname(), zconf_lineno(), (yyvsp[(1) - (3)].id)->stype); } else YYERROR; ;} break; case 63: { current_entry->sym->flags |= SYMBOL_OPTIONAL; printd(DEBUG_PARSE, "%s:%d:optional\n", zconf_curname(), zconf_lineno()); ;} break; case 64: { if ((yyvsp[(1) - (4)].id)->stype == S_UNKNOWN) { menu_add_symbol(P_DEFAULT, sym_lookup((yyvsp[(2) - (4)].string), 0), (yyvsp[(3) - (4)].expr)); printd(DEBUG_PARSE, "%s:%d:default\n", zconf_curname(), zconf_lineno()); } else YYERROR; ;} break; case 67: { printd(DEBUG_PARSE, "%s:%d:if\n", zconf_curname(), zconf_lineno()); menu_add_entry(NULL); menu_add_dep((yyvsp[(2) - (3)].expr)); (yyval.menu) = menu_add_menu(); ;} break; case 68: { if (zconf_endtoken((yyvsp[(1) - (1)].id), T_IF, T_ENDIF)) { menu_end_menu(); printd(DEBUG_PARSE, "%s:%d:endif\n", zconf_curname(), zconf_lineno()); } ;} break; case 74: { menu_add_prompt(P_MENU, (yyvsp[(2) - (3)].string), NULL); ;} break; case 75: { menu_add_entry(NULL); menu_add_prompt(P_MENU, (yyvsp[(2) - (3)].string), NULL); printd(DEBUG_PARSE, "%s:%d:menu\n", zconf_curname(), zconf_lineno()); ;} break; case 76: { (yyval.menu) = menu_add_menu(); ;} break; case 77: { if (zconf_endtoken((yyvsp[(1) - (1)].id), T_MENU, T_ENDMENU)) { menu_end_menu(); printd(DEBUG_PARSE, "%s:%d:endmenu\n", zconf_curname(), zconf_lineno()); } ;} break; case 83: { printd(DEBUG_PARSE, "%s:%d:source %s\n", zconf_curname(), zconf_lineno(), (yyvsp[(2) - (3)].string)); zconf_nextfile((yyvsp[(2) - (3)].string)); ;} break; case 84: { menu_add_entry(NULL); menu_add_prompt(P_COMMENT, (yyvsp[(2) - (3)].string), NULL); printd(DEBUG_PARSE, "%s:%d:comment\n", zconf_curname(), zconf_lineno()); ;} break; case 85: { menu_end_entry(); ;} break; case 86: { printd(DEBUG_PARSE, "%s:%d:help\n", zconf_curname(), zconf_lineno()); zconf_starthelp(); ;} break; case 87: { current_entry->help = (yyvsp[(2) - (2)].string); ;} break; case 92: { menu_add_dep((yyvsp[(3) - (4)].expr)); printd(DEBUG_PARSE, "%s:%d:depends on\n", zconf_curname(), zconf_lineno()); ;} break; case 96: { menu_add_visibility((yyvsp[(2) - (2)].expr)); ;} break; case 98: { menu_add_prompt(P_PROMPT, (yyvsp[(1) - (2)].string), (yyvsp[(2) - (2)].expr)); ;} break; case 101: { (yyval.id) = (yyvsp[(1) - (2)].id); ;} break; case 102: { (yyval.id) = (yyvsp[(1) - (2)].id); ;} break; case 103: { (yyval.id) = (yyvsp[(1) - (2)].id); ;} break; case 106: { (yyval.expr) = NULL; ;} break; case 107: { (yyval.expr) = (yyvsp[(2) - (2)].expr); ;} break; case 108: { (yyval.expr) = expr_alloc_symbol((yyvsp[(1) - (1)].symbol)); ;} break; case 109: { (yyval.expr) = expr_alloc_comp(E_EQUAL, (yyvsp[(1) - (3)].symbol), (yyvsp[(3) - (3)].symbol)); ;} break; case 110: { (yyval.expr) = expr_alloc_comp(E_UNEQUAL, (yyvsp[(1) - (3)].symbol), (yyvsp[(3) - (3)].symbol)); ;} break; case 111: { (yyval.expr) = (yyvsp[(2) - (3)].expr); ;} break; case 112: { (yyval.expr) = expr_alloc_one(E_NOT, (yyvsp[(2) - (2)].expr)); ;} break; case 113: { (yyval.expr) = expr_alloc_two(E_OR, (yyvsp[(1) - (3)].expr), (yyvsp[(3) - (3)].expr)); ;} break; case 114: { (yyval.expr) = expr_alloc_two(E_AND, (yyvsp[(1) - (3)].expr), (yyvsp[(3) - (3)].expr)); ;} break; case 115: { (yyval.symbol) = sym_lookup((yyvsp[(1) - (1)].string), 0); free((yyvsp[(1) - (1)].string)); ;} break; case 116: { (yyval.symbol) = sym_lookup((yyvsp[(1) - (1)].string), SYMBOL_CONST); free((yyvsp[(1) - (1)].string)); ;} break; case 117: { (yyval.string) = NULL; ;} break; default: break; } YY_SYMBOL_PRINT ("-> $$ =", yyr1[yyn], &yyval, &yyloc); YYPOPSTACK (yylen); yylen = 0; YY_STACK_PRINT (yyss, yyssp); *++yyvsp = yyval; /* Now `shift' the result of the reduction. Determine what state that goes to, based on the state we popped back to and the rule number reduced by. */ yyn = yyr1[yyn]; yystate = yypgoto[yyn - YYNTOKENS] + *yyssp; if (0 <= yystate && yystate <= YYLAST && yycheck[yystate] == *yyssp) yystate = yytable[yystate]; else yystate = yydefgoto[yyn - YYNTOKENS]; goto yynewstate; /*------------------------------------. | yyerrlab -- here on detecting error | `------------------------------------*/ yyerrlab: /* If not already recovering from an error, report this error. */ if (!yyerrstatus) { ++yynerrs; #if ! YYERROR_VERBOSE yyerror (YY_("syntax error")); #else { YYSIZE_T yysize = yysyntax_error (0, yystate, yychar); if (yymsg_alloc < yysize && yymsg_alloc < YYSTACK_ALLOC_MAXIMUM) { YYSIZE_T yyalloc = 2 * yysize; if (! (yysize <= yyalloc && yyalloc <= YYSTACK_ALLOC_MAXIMUM)) yyalloc = YYSTACK_ALLOC_MAXIMUM; if (yymsg != yymsgbuf) YYSTACK_FREE (yymsg); yymsg = (char *) YYSTACK_ALLOC (yyalloc); if (yymsg) yymsg_alloc = yyalloc; else { yymsg = yymsgbuf; yymsg_alloc = sizeof yymsgbuf; } } if (0 < yysize && yysize <= yymsg_alloc) { (void) yysyntax_error (yymsg, yystate, yychar); yyerror (yymsg); } else { yyerror (YY_("syntax error")); if (yysize != 0) goto yyexhaustedlab; } } #endif } if (yyerrstatus == 3) { /* If just tried and failed to reuse lookahead token after an error, discard it. */ if (yychar <= YYEOF) { /* Return failure if at end of input. */ if (yychar == YYEOF) YYABORT; } else { yydestruct ("Error: discarding", yytoken, &yylval); yychar = YYEMPTY; } } /* Else will try to reuse lookahead token after shifting the error token. */ goto yyerrlab1; /*---------------------------------------------------. | yyerrorlab -- error raised explicitly by YYERROR. | `---------------------------------------------------*/ yyerrorlab: /* Pacify compilers like GCC when the user code never invokes YYERROR and the label yyerrorlab therefore never appears in user code. */ if (/*CONSTCOND*/ 0) goto yyerrorlab; /* Do not reclaim the symbols of the rule which action triggered this YYERROR. */ YYPOPSTACK (yylen); yylen = 0; YY_STACK_PRINT (yyss, yyssp); yystate = *yyssp; goto yyerrlab1; /*-------------------------------------------------------------. | yyerrlab1 -- common code for both syntax error and YYERROR. | `-------------------------------------------------------------*/ yyerrlab1: yyerrstatus = 3; /* Each real token shifted decrements this. */ for (;;) { yyn = yypact[yystate]; if (yyn != YYPACT_NINF) { yyn += YYTERROR; if (0 <= yyn && yyn <= YYLAST && yycheck[yyn] == YYTERROR) { yyn = yytable[yyn]; if (0 < yyn) break; } } /* Pop the current state because it cannot handle the error token. */ if (yyssp == yyss) YYABORT; yydestruct ("Error: popping", yystos[yystate], yyvsp); YYPOPSTACK (1); yystate = *yyssp; YY_STACK_PRINT (yyss, yyssp); } *++yyvsp = yylval; /* Shift the error token. */ YY_SYMBOL_PRINT ("Shifting", yystos[yyn], yyvsp, yylsp); yystate = yyn; goto yynewstate; /*-------------------------------------. | yyacceptlab -- YYACCEPT comes here. | `-------------------------------------*/ yyacceptlab: yyresult = 0; goto yyreturn; /*-----------------------------------. | yyabortlab -- YYABORT comes here. | `-----------------------------------*/ yyabortlab: yyresult = 1; goto yyreturn; #if !defined(yyoverflow) || YYERROR_VERBOSE /*-------------------------------------------------. | yyexhaustedlab -- memory exhaustion comes here. | `-------------------------------------------------*/ yyexhaustedlab: yyerror (YY_("memory exhausted")); yyresult = 2; /* Fall through. */ #endif yyreturn: if (yychar != YYEMPTY) yydestruct ("Cleanup: discarding lookahead", yytoken, &yylval); /* Do not reclaim the symbols of the rule which action triggered this YYABORT or YYACCEPT. */ YYPOPSTACK (yylen); YY_STACK_PRINT (yyss, yyssp); while (yyssp != yyss) { yydestruct ("Cleanup: popping", yystos[*yyssp], yyvsp); YYPOPSTACK (1); } #ifndef yyoverflow if (yyss != yyssa) YYSTACK_FREE (yyss); #endif #if YYERROR_VERBOSE if (yymsg != yymsgbuf) YYSTACK_FREE (yymsg); #endif /* Make sure YYID is used. */ return YYID (yyresult); } void conf_parse(const char *name) { struct symbol *sym; int i; zconf_initscan(name); sym_init(); _menu_init(); modules_sym = sym_lookup(NULL, 0); modules_sym->type = S_BOOLEAN; modules_sym->flags |= SYMBOL_AUTO; rootmenu.prompt = menu_add_prompt(P_MENU, "Linux Kernel Configuration", NULL); #if YYDEBUG if (getenv("ZCONF_DEBUG")) zconfdebug = 1; #endif zconfparse(); if (zconfnerrs) exit(1); if (!modules_sym->prop) { struct property *prop; prop = prop_alloc(P_DEFAULT, modules_sym); prop->expr = expr_alloc_symbol(sym_lookup("MODULES", 0)); } rootmenu.prompt->text = _(rootmenu.prompt->text); rootmenu.prompt->text = sym_expand_string_value(rootmenu.prompt->text); menu_finalize(&rootmenu); for_all_symbols(i, sym) { if (sym_check_deps(sym)) zconfnerrs++; } if (zconfnerrs) exit(1); sym_set_change_count(1); } static const char *zconf_tokenname(int token) { switch (token) { case T_MENU: return "menu"; case T_ENDMENU: return "endmenu"; case T_CHOICE: return "choice"; case T_ENDCHOICE: return "endchoice"; case T_IF: return "if"; case T_ENDIF: return "endif"; case T_DEPENDS: return "depends"; case T_VISIBLE: return "visible"; } return ""; } static bool zconf_endtoken(struct kconf_id *id, int starttoken, int endtoken) { if (id->token != endtoken) { zconf_error("unexpected '%s' within %s block", kconf_id_strings + id->name, zconf_tokenname(starttoken)); zconfnerrs++; return false; } if (current_menu->file != current_file) { zconf_error("'%s' in different file than '%s'", kconf_id_strings + id->name, zconf_tokenname(starttoken)); fprintf(stderr, "%s:%d: location of the '%s'\n", current_menu->file->name, current_menu->lineno, zconf_tokenname(starttoken)); zconfnerrs++; return false; } return true; } static void zconfprint(const char *err, ...) { va_list ap; fprintf(stderr, "%s:%d: ", zconf_curname(), zconf_lineno()); va_start(ap, err); vfprintf(stderr, err, ap); va_end(ap); fprintf(stderr, "\n"); } static void zconf_error(const char *err, ...) { va_list ap; zconfnerrs++; fprintf(stderr, "%s:%d: ", zconf_curname(), zconf_lineno()); va_start(ap, err); vfprintf(stderr, err, ap); va_end(ap); fprintf(stderr, "\n"); } static void zconferror(const char *err) { #if YYDEBUG fprintf(stderr, "%s:%d: %s\n", zconf_curname(), zconf_lineno() + 1, err); #endif } static void print_quoted_string(FILE *out, const char *str) { const char *p; int len; putc('"', out); while ((p = strchr(str, '"'))) { len = p - str; if (len) fprintf(out, "%.*s", len, str); fputs("\\\"", out); str = p + 1; } fputs(str, out); putc('"', out); } static void print_symbol(FILE *out, struct menu *menu) { struct symbol *sym = menu->sym; struct property *prop; if (sym_is_choice(sym)) fprintf(out, "\nchoice\n"); else fprintf(out, "\nconfig %s\n", sym->name); switch (sym->type) { case S_BOOLEAN: fputs(" boolean\n", out); break; case S_TRISTATE: fputs(" tristate\n", out); break; case S_STRING: fputs(" string\n", out); break; case S_INT: fputs(" integer\n", out); break; case S_HEX: fputs(" hex\n", out); break; default: fputs(" ???\n", out); break; } for (prop = sym->prop; prop; prop = prop->next) { if (prop->menu != menu) continue; switch (prop->type) { case P_PROMPT: fputs(" prompt ", out); print_quoted_string(out, prop->text); if (!expr_is_yes(prop->visible.expr)) { fputs(" if ", out); expr_fprint(prop->visible.expr, out); } fputc('\n', out); break; case P_DEFAULT: fputs( " default ", out); expr_fprint(prop->expr, out); if (!expr_is_yes(prop->visible.expr)) { fputs(" if ", out); expr_fprint(prop->visible.expr, out); } fputc('\n', out); break; case P_CHOICE: fputs(" #choice value\n", out); break; case P_SELECT: fputs( " select ", out); expr_fprint(prop->expr, out); fputc('\n', out); break; case P_RANGE: fputs( " range ", out); expr_fprint(prop->expr, out); fputc('\n', out); break; case P_MENU: fputs( " menu ", out); print_quoted_string(out, prop->text); fputc('\n', out); break; default: fprintf(out, " unknown prop %d!\n", prop->type); break; } } if (menu->help) { int len = strlen(menu->help); while (menu->help[--len] == '\n') menu->help[len] = 0; fprintf(out, " help\n%s\n", menu->help); } } void zconfdump(FILE *out) { struct property *prop; struct symbol *sym; struct menu *menu; menu = rootmenu.list; while (menu) { if ((sym = menu->sym)) print_symbol(out, menu); else if ((prop = menu->prompt)) { switch (prop->type) { case P_COMMENT: fputs("\ncomment ", out); print_quoted_string(out, prop->text); fputs("\n", out); break; case P_MENU: fputs("\nmenu ", out); print_quoted_string(out, prop->text); fputs("\n", out); break; default: ; } if (!expr_is_yes(prop->visible.expr)) { fputs(" depends ", out); expr_fprint(prop->visible.expr, out); fputc('\n', out); } } if (menu->list) menu = menu->list; else if (menu->next) menu = menu->next; else while ((menu = menu->parent)) { if (menu->prompt && menu->prompt->type == P_MENU) fputs("\nendmenu\n", out); if (menu->next) { menu = menu->next; break; } } } } #include "lex.zconf.c" #include "util.c" #include "confdata.c" #include "expr.c" #include "symbol.c" #include "menu.c" tinyvisor/bios/tools/kconfig/expr.c0000644006644000001440000006520611733243570017740 0ustar yuichi_xyusers/* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ #include #include #include #define LKC_DIRECT_LINK #include "lkc.h" #define DEBUG_EXPR 0 struct expr *expr_alloc_symbol(struct symbol *sym) { struct expr *e = malloc(sizeof(*e)); memset(e, 0, sizeof(*e)); e->type = E_SYMBOL; e->left.sym = sym; return e; } struct expr *expr_alloc_one(enum expr_type type, struct expr *ce) { struct expr *e = malloc(sizeof(*e)); memset(e, 0, sizeof(*e)); e->type = type; e->left.expr = ce; return e; } struct expr *expr_alloc_two(enum expr_type type, struct expr *e1, struct expr *e2) { struct expr *e = malloc(sizeof(*e)); memset(e, 0, sizeof(*e)); e->type = type; e->left.expr = e1; e->right.expr = e2; return e; } struct expr *expr_alloc_comp(enum expr_type type, struct symbol *s1, struct symbol *s2) { struct expr *e = malloc(sizeof(*e)); memset(e, 0, sizeof(*e)); e->type = type; e->left.sym = s1; e->right.sym = s2; return e; } struct expr *expr_alloc_and(struct expr *e1, struct expr *e2) { if (!e1) return e2; return e2 ? expr_alloc_two(E_AND, e1, e2) : e1; } struct expr *expr_alloc_or(struct expr *e1, struct expr *e2) { if (!e1) return e2; return e2 ? expr_alloc_two(E_OR, e1, e2) : e1; } struct expr *expr_copy(const struct expr *org) { struct expr *e; if (!org) return NULL; e = malloc(sizeof(*org)); memcpy(e, org, sizeof(*org)); switch (org->type) { case E_SYMBOL: e->left = org->left; break; case E_NOT: e->left.expr = expr_copy(org->left.expr); break; case E_EQUAL: case E_UNEQUAL: e->left.sym = org->left.sym; e->right.sym = org->right.sym; break; case E_AND: case E_OR: case E_LIST: e->left.expr = expr_copy(org->left.expr); e->right.expr = expr_copy(org->right.expr); break; default: printf("can't copy type %d\n", e->type); free(e); e = NULL; break; } return e; } void expr_free(struct expr *e) { if (!e) return; switch (e->type) { case E_SYMBOL: break; case E_NOT: expr_free(e->left.expr); return; case E_EQUAL: case E_UNEQUAL: break; case E_OR: case E_AND: expr_free(e->left.expr); expr_free(e->right.expr); break; default: printf("how to free type %d?\n", e->type); break; } free(e); } static int trans_count; #define e1 (*ep1) #define e2 (*ep2) static void __expr_eliminate_eq(enum expr_type type, struct expr **ep1, struct expr **ep2) { if (e1->type == type) { __expr_eliminate_eq(type, &e1->left.expr, &e2); __expr_eliminate_eq(type, &e1->right.expr, &e2); return; } if (e2->type == type) { __expr_eliminate_eq(type, &e1, &e2->left.expr); __expr_eliminate_eq(type, &e1, &e2->right.expr); return; } if (e1->type == E_SYMBOL && e2->type == E_SYMBOL && e1->left.sym == e2->left.sym && (e1->left.sym == &symbol_yes || e1->left.sym == &symbol_no)) return; if (!expr_eq(e1, e2)) return; trans_count++; expr_free(e1); expr_free(e2); switch (type) { case E_OR: e1 = expr_alloc_symbol(&symbol_no); e2 = expr_alloc_symbol(&symbol_no); break; case E_AND: e1 = expr_alloc_symbol(&symbol_yes); e2 = expr_alloc_symbol(&symbol_yes); break; default: ; } } void expr_eliminate_eq(struct expr **ep1, struct expr **ep2) { if (!e1 || !e2) return; switch (e1->type) { case E_OR: case E_AND: __expr_eliminate_eq(e1->type, ep1, ep2); default: ; } if (e1->type != e2->type) switch (e2->type) { case E_OR: case E_AND: __expr_eliminate_eq(e2->type, ep1, ep2); default: ; } e1 = expr_eliminate_yn(e1); e2 = expr_eliminate_yn(e2); } #undef e1 #undef e2 int expr_eq(struct expr *e1, struct expr *e2) { int res, old_count; if (e1->type != e2->type) return 0; switch (e1->type) { case E_EQUAL: case E_UNEQUAL: return e1->left.sym == e2->left.sym && e1->right.sym == e2->right.sym; case E_SYMBOL: return e1->left.sym == e2->left.sym; case E_NOT: return expr_eq(e1->left.expr, e2->left.expr); case E_AND: case E_OR: e1 = expr_copy(e1); e2 = expr_copy(e2); old_count = trans_count; expr_eliminate_eq(&e1, &e2); res = (e1->type == E_SYMBOL && e2->type == E_SYMBOL && e1->left.sym == e2->left.sym); expr_free(e1); expr_free(e2); trans_count = old_count; return res; case E_LIST: case E_RANGE: case E_NONE: /* panic */; } if (DEBUG_EXPR) { expr_fprint(e1, stdout); printf(" = "); expr_fprint(e2, stdout); printf(" ?\n"); } return 0; } struct expr *expr_eliminate_yn(struct expr *e) { struct expr *tmp; if (e) switch (e->type) { case E_AND: e->left.expr = expr_eliminate_yn(e->left.expr); e->right.expr = expr_eliminate_yn(e->right.expr); if (e->left.expr->type == E_SYMBOL) { if (e->left.expr->left.sym == &symbol_no) { expr_free(e->left.expr); expr_free(e->right.expr); e->type = E_SYMBOL; e->left.sym = &symbol_no; e->right.expr = NULL; return e; } else if (e->left.expr->left.sym == &symbol_yes) { free(e->left.expr); tmp = e->right.expr; *e = *(e->right.expr); free(tmp); return e; } } if (e->right.expr->type == E_SYMBOL) { if (e->right.expr->left.sym == &symbol_no) { expr_free(e->left.expr); expr_free(e->right.expr); e->type = E_SYMBOL; e->left.sym = &symbol_no; e->right.expr = NULL; return e; } else if (e->right.expr->left.sym == &symbol_yes) { free(e->right.expr); tmp = e->left.expr; *e = *(e->left.expr); free(tmp); return e; } } break; case E_OR: e->left.expr = expr_eliminate_yn(e->left.expr); e->right.expr = expr_eliminate_yn(e->right.expr); if (e->left.expr->type == E_SYMBOL) { if (e->left.expr->left.sym == &symbol_no) { free(e->left.expr); tmp = e->right.expr; *e = *(e->right.expr); free(tmp); return e; } else if (e->left.expr->left.sym == &symbol_yes) { expr_free(e->left.expr); expr_free(e->right.expr); e->type = E_SYMBOL; e->left.sym = &symbol_yes; e->right.expr = NULL; return e; } } if (e->right.expr->type == E_SYMBOL) { if (e->right.expr->left.sym == &symbol_no) { free(e->right.expr); tmp = e->left.expr; *e = *(e->left.expr); free(tmp); return e; } else if (e->right.expr->left.sym == &symbol_yes) { expr_free(e->left.expr); expr_free(e->right.expr); e->type = E_SYMBOL; e->left.sym = &symbol_yes; e->right.expr = NULL; return e; } } break; default: ; } return e; } /* * bool FOO!=n => FOO */ struct expr *expr_trans_bool(struct expr *e) { if (!e) return NULL; switch (e->type) { case E_AND: case E_OR: case E_NOT: e->left.expr = expr_trans_bool(e->left.expr); e->right.expr = expr_trans_bool(e->right.expr); break; case E_UNEQUAL: // FOO!=n -> FOO if (e->left.sym->type == S_TRISTATE) { if (e->right.sym == &symbol_no) { e->type = E_SYMBOL; e->right.sym = NULL; } } break; default: ; } return e; } /* * e1 || e2 -> ? */ static struct expr *expr_join_or(struct expr *e1, struct expr *e2) { struct expr *tmp; struct symbol *sym1, *sym2; if (expr_eq(e1, e2)) return expr_copy(e1); if (e1->type != E_EQUAL && e1->type != E_UNEQUAL && e1->type != E_SYMBOL && e1->type != E_NOT) return NULL; if (e2->type != E_EQUAL && e2->type != E_UNEQUAL && e2->type != E_SYMBOL && e2->type != E_NOT) return NULL; if (e1->type == E_NOT) { tmp = e1->left.expr; if (tmp->type != E_EQUAL && tmp->type != E_UNEQUAL && tmp->type != E_SYMBOL) return NULL; sym1 = tmp->left.sym; } else sym1 = e1->left.sym; if (e2->type == E_NOT) { if (e2->left.expr->type != E_SYMBOL) return NULL; sym2 = e2->left.expr->left.sym; } else sym2 = e2->left.sym; if (sym1 != sym2) return NULL; if (sym1->type != S_BOOLEAN && sym1->type != S_TRISTATE) return NULL; if (sym1->type == S_TRISTATE) { if (e1->type == E_EQUAL && e2->type == E_EQUAL && ((e1->right.sym == &symbol_yes && e2->right.sym == &symbol_mod) || (e1->right.sym == &symbol_mod && e2->right.sym == &symbol_yes))) { // (a='y') || (a='m') -> (a!='n') return expr_alloc_comp(E_UNEQUAL, sym1, &symbol_no); } if (e1->type == E_EQUAL && e2->type == E_EQUAL && ((e1->right.sym == &symbol_yes && e2->right.sym == &symbol_no) || (e1->right.sym == &symbol_no && e2->right.sym == &symbol_yes))) { // (a='y') || (a='n') -> (a!='m') return expr_alloc_comp(E_UNEQUAL, sym1, &symbol_mod); } if (e1->type == E_EQUAL && e2->type == E_EQUAL && ((e1->right.sym == &symbol_mod && e2->right.sym == &symbol_no) || (e1->right.sym == &symbol_no && e2->right.sym == &symbol_mod))) { // (a='m') || (a='n') -> (a!='y') return expr_alloc_comp(E_UNEQUAL, sym1, &symbol_yes); } } if (sym1->type == S_BOOLEAN && sym1 == sym2) { if ((e1->type == E_NOT && e1->left.expr->type == E_SYMBOL && e2->type == E_SYMBOL) || (e2->type == E_NOT && e2->left.expr->type == E_SYMBOL && e1->type == E_SYMBOL)) return expr_alloc_symbol(&symbol_yes); } if (DEBUG_EXPR) { printf("optimize ("); expr_fprint(e1, stdout); printf(") || ("); expr_fprint(e2, stdout); printf(")?\n"); } return NULL; } static struct expr *expr_join_and(struct expr *e1, struct expr *e2) { struct expr *tmp; struct symbol *sym1, *sym2; if (expr_eq(e1, e2)) return expr_copy(e1); if (e1->type != E_EQUAL && e1->type != E_UNEQUAL && e1->type != E_SYMBOL && e1->type != E_NOT) return NULL; if (e2->type != E_EQUAL && e2->type != E_UNEQUAL && e2->type != E_SYMBOL && e2->type != E_NOT) return NULL; if (e1->type == E_NOT) { tmp = e1->left.expr; if (tmp->type != E_EQUAL && tmp->type != E_UNEQUAL && tmp->type != E_SYMBOL) return NULL; sym1 = tmp->left.sym; } else sym1 = e1->left.sym; if (e2->type == E_NOT) { if (e2->left.expr->type != E_SYMBOL) return NULL; sym2 = e2->left.expr->left.sym; } else sym2 = e2->left.sym; if (sym1 != sym2) return NULL; if (sym1->type != S_BOOLEAN && sym1->type != S_TRISTATE) return NULL; if ((e1->type == E_SYMBOL && e2->type == E_EQUAL && e2->right.sym == &symbol_yes) || (e2->type == E_SYMBOL && e1->type == E_EQUAL && e1->right.sym == &symbol_yes)) // (a) && (a='y') -> (a='y') return expr_alloc_comp(E_EQUAL, sym1, &symbol_yes); if ((e1->type == E_SYMBOL && e2->type == E_UNEQUAL && e2->right.sym == &symbol_no) || (e2->type == E_SYMBOL && e1->type == E_UNEQUAL && e1->right.sym == &symbol_no)) // (a) && (a!='n') -> (a) return expr_alloc_symbol(sym1); if ((e1->type == E_SYMBOL && e2->type == E_UNEQUAL && e2->right.sym == &symbol_mod) || (e2->type == E_SYMBOL && e1->type == E_UNEQUAL && e1->right.sym == &symbol_mod)) // (a) && (a!='m') -> (a='y') return expr_alloc_comp(E_EQUAL, sym1, &symbol_yes); if (sym1->type == S_TRISTATE) { if (e1->type == E_EQUAL && e2->type == E_UNEQUAL) { // (a='b') && (a!='c') -> 'b'='c' ? 'n' : a='b' sym2 = e1->right.sym; if ((e2->right.sym->flags & SYMBOL_CONST) && (sym2->flags & SYMBOL_CONST)) return sym2 != e2->right.sym ? expr_alloc_comp(E_EQUAL, sym1, sym2) : expr_alloc_symbol(&symbol_no); } if (e1->type == E_UNEQUAL && e2->type == E_EQUAL) { // (a='b') && (a!='c') -> 'b'='c' ? 'n' : a='b' sym2 = e2->right.sym; if ((e1->right.sym->flags & SYMBOL_CONST) && (sym2->flags & SYMBOL_CONST)) return sym2 != e1->right.sym ? expr_alloc_comp(E_EQUAL, sym1, sym2) : expr_alloc_symbol(&symbol_no); } if (e1->type == E_UNEQUAL && e2->type == E_UNEQUAL && ((e1->right.sym == &symbol_yes && e2->right.sym == &symbol_no) || (e1->right.sym == &symbol_no && e2->right.sym == &symbol_yes))) // (a!='y') && (a!='n') -> (a='m') return expr_alloc_comp(E_EQUAL, sym1, &symbol_mod); if (e1->type == E_UNEQUAL && e2->type == E_UNEQUAL && ((e1->right.sym == &symbol_yes && e2->right.sym == &symbol_mod) || (e1->right.sym == &symbol_mod && e2->right.sym == &symbol_yes))) // (a!='y') && (a!='m') -> (a='n') return expr_alloc_comp(E_EQUAL, sym1, &symbol_no); if (e1->type == E_UNEQUAL && e2->type == E_UNEQUAL && ((e1->right.sym == &symbol_mod && e2->right.sym == &symbol_no) || (e1->right.sym == &symbol_no && e2->right.sym == &symbol_mod))) // (a!='m') && (a!='n') -> (a='m') return expr_alloc_comp(E_EQUAL, sym1, &symbol_yes); if ((e1->type == E_SYMBOL && e2->type == E_EQUAL && e2->right.sym == &symbol_mod) || (e2->type == E_SYMBOL && e1->type == E_EQUAL && e1->right.sym == &symbol_mod) || (e1->type == E_SYMBOL && e2->type == E_UNEQUAL && e2->right.sym == &symbol_yes) || (e2->type == E_SYMBOL && e1->type == E_UNEQUAL && e1->right.sym == &symbol_yes)) return NULL; } if (DEBUG_EXPR) { printf("optimize ("); expr_fprint(e1, stdout); printf(") && ("); expr_fprint(e2, stdout); printf(")?\n"); } return NULL; } static void expr_eliminate_dups1(enum expr_type type, struct expr **ep1, struct expr **ep2) { #define e1 (*ep1) #define e2 (*ep2) struct expr *tmp; if (e1->type == type) { expr_eliminate_dups1(type, &e1->left.expr, &e2); expr_eliminate_dups1(type, &e1->right.expr, &e2); return; } if (e2->type == type) { expr_eliminate_dups1(type, &e1, &e2->left.expr); expr_eliminate_dups1(type, &e1, &e2->right.expr); return; } if (e1 == e2) return; switch (e1->type) { case E_OR: case E_AND: expr_eliminate_dups1(e1->type, &e1, &e1); default: ; } switch (type) { case E_OR: tmp = expr_join_or(e1, e2); if (tmp) { expr_free(e1); expr_free(e2); e1 = expr_alloc_symbol(&symbol_no); e2 = tmp; trans_count++; } break; case E_AND: tmp = expr_join_and(e1, e2); if (tmp) { expr_free(e1); expr_free(e2); e1 = expr_alloc_symbol(&symbol_yes); e2 = tmp; trans_count++; } break; default: ; } #undef e1 #undef e2 } static void expr_eliminate_dups2(enum expr_type type, struct expr **ep1, struct expr **ep2) { #define e1 (*ep1) #define e2 (*ep2) struct expr *tmp, *tmp1, *tmp2; if (e1->type == type) { expr_eliminate_dups2(type, &e1->left.expr, &e2); expr_eliminate_dups2(type, &e1->right.expr, &e2); return; } if (e2->type == type) { expr_eliminate_dups2(type, &e1, &e2->left.expr); expr_eliminate_dups2(type, &e1, &e2->right.expr); } if (e1 == e2) return; switch (e1->type) { case E_OR: expr_eliminate_dups2(e1->type, &e1, &e1); // (FOO || BAR) && (!FOO && !BAR) -> n tmp1 = expr_transform(expr_alloc_one(E_NOT, expr_copy(e1))); tmp2 = expr_copy(e2); tmp = expr_extract_eq_and(&tmp1, &tmp2); if (expr_is_yes(tmp1)) { expr_free(e1); e1 = expr_alloc_symbol(&symbol_no); trans_count++; } expr_free(tmp2); expr_free(tmp1); expr_free(tmp); break; case E_AND: expr_eliminate_dups2(e1->type, &e1, &e1); // (FOO && BAR) || (!FOO || !BAR) -> y tmp1 = expr_transform(expr_alloc_one(E_NOT, expr_copy(e1))); tmp2 = expr_copy(e2); tmp = expr_extract_eq_or(&tmp1, &tmp2); if (expr_is_no(tmp1)) { expr_free(e1); e1 = expr_alloc_symbol(&symbol_yes); trans_count++; } expr_free(tmp2); expr_free(tmp1); expr_free(tmp); break; default: ; } #undef e1 #undef e2 } struct expr *expr_eliminate_dups(struct expr *e) { int oldcount; if (!e) return e; oldcount = trans_count; while (1) { trans_count = 0; switch (e->type) { case E_OR: case E_AND: expr_eliminate_dups1(e->type, &e, &e); expr_eliminate_dups2(e->type, &e, &e); default: ; } if (!trans_count) break; e = expr_eliminate_yn(e); } trans_count = oldcount; return e; } struct expr *expr_transform(struct expr *e) { struct expr *tmp; if (!e) return NULL; switch (e->type) { case E_EQUAL: case E_UNEQUAL: case E_SYMBOL: case E_LIST: break; default: e->left.expr = expr_transform(e->left.expr); e->right.expr = expr_transform(e->right.expr); } switch (e->type) { case E_EQUAL: if (e->left.sym->type != S_BOOLEAN) break; if (e->right.sym == &symbol_no) { e->type = E_NOT; e->left.expr = expr_alloc_symbol(e->left.sym); e->right.sym = NULL; break; } if (e->right.sym == &symbol_mod) { printf("boolean symbol %s tested for 'm'? test forced to 'n'\n", e->left.sym->name); e->type = E_SYMBOL; e->left.sym = &symbol_no; e->right.sym = NULL; break; } if (e->right.sym == &symbol_yes) { e->type = E_SYMBOL; e->right.sym = NULL; break; } break; case E_UNEQUAL: if (e->left.sym->type != S_BOOLEAN) break; if (e->right.sym == &symbol_no) { e->type = E_SYMBOL; e->right.sym = NULL; break; } if (e->right.sym == &symbol_mod) { printf("boolean symbol %s tested for 'm'? test forced to 'y'\n", e->left.sym->name); e->type = E_SYMBOL; e->left.sym = &symbol_yes; e->right.sym = NULL; break; } if (e->right.sym == &symbol_yes) { e->type = E_NOT; e->left.expr = expr_alloc_symbol(e->left.sym); e->right.sym = NULL; break; } break; case E_NOT: switch (e->left.expr->type) { case E_NOT: // !!a -> a tmp = e->left.expr->left.expr; free(e->left.expr); free(e); e = tmp; e = expr_transform(e); break; case E_EQUAL: case E_UNEQUAL: // !a='x' -> a!='x' tmp = e->left.expr; free(e); e = tmp; e->type = e->type == E_EQUAL ? E_UNEQUAL : E_EQUAL; break; case E_OR: // !(a || b) -> !a && !b tmp = e->left.expr; e->type = E_AND; e->right.expr = expr_alloc_one(E_NOT, tmp->right.expr); tmp->type = E_NOT; tmp->right.expr = NULL; e = expr_transform(e); break; case E_AND: // !(a && b) -> !a || !b tmp = e->left.expr; e->type = E_OR; e->right.expr = expr_alloc_one(E_NOT, tmp->right.expr); tmp->type = E_NOT; tmp->right.expr = NULL; e = expr_transform(e); break; case E_SYMBOL: if (e->left.expr->left.sym == &symbol_yes) { // !'y' -> 'n' tmp = e->left.expr; free(e); e = tmp; e->type = E_SYMBOL; e->left.sym = &symbol_no; break; } if (e->left.expr->left.sym == &symbol_mod) { // !'m' -> 'm' tmp = e->left.expr; free(e); e = tmp; e->type = E_SYMBOL; e->left.sym = &symbol_mod; break; } if (e->left.expr->left.sym == &symbol_no) { // !'n' -> 'y' tmp = e->left.expr; free(e); e = tmp; e->type = E_SYMBOL; e->left.sym = &symbol_yes; break; } break; default: ; } break; default: ; } return e; } int expr_contains_symbol(struct expr *dep, struct symbol *sym) { if (!dep) return 0; switch (dep->type) { case E_AND: case E_OR: return expr_contains_symbol(dep->left.expr, sym) || expr_contains_symbol(dep->right.expr, sym); case E_SYMBOL: return dep->left.sym == sym; case E_EQUAL: case E_UNEQUAL: return dep->left.sym == sym || dep->right.sym == sym; case E_NOT: return expr_contains_symbol(dep->left.expr, sym); default: ; } return 0; } bool expr_depends_symbol(struct expr *dep, struct symbol *sym) { if (!dep) return false; switch (dep->type) { case E_AND: return expr_depends_symbol(dep->left.expr, sym) || expr_depends_symbol(dep->right.expr, sym); case E_SYMBOL: return dep->left.sym == sym; case E_EQUAL: if (dep->left.sym == sym) { if (dep->right.sym == &symbol_yes || dep->right.sym == &symbol_mod) return true; } break; case E_UNEQUAL: if (dep->left.sym == sym) { if (dep->right.sym == &symbol_no) return true; } break; default: ; } return false; } struct expr *expr_extract_eq_and(struct expr **ep1, struct expr **ep2) { struct expr *tmp = NULL; expr_extract_eq(E_AND, &tmp, ep1, ep2); if (tmp) { *ep1 = expr_eliminate_yn(*ep1); *ep2 = expr_eliminate_yn(*ep2); } return tmp; } struct expr *expr_extract_eq_or(struct expr **ep1, struct expr **ep2) { struct expr *tmp = NULL; expr_extract_eq(E_OR, &tmp, ep1, ep2); if (tmp) { *ep1 = expr_eliminate_yn(*ep1); *ep2 = expr_eliminate_yn(*ep2); } return tmp; } void expr_extract_eq(enum expr_type type, struct expr **ep, struct expr **ep1, struct expr **ep2) { #define e1 (*ep1) #define e2 (*ep2) if (e1->type == type) { expr_extract_eq(type, ep, &e1->left.expr, &e2); expr_extract_eq(type, ep, &e1->right.expr, &e2); return; } if (e2->type == type) { expr_extract_eq(type, ep, ep1, &e2->left.expr); expr_extract_eq(type, ep, ep1, &e2->right.expr); return; } if (expr_eq(e1, e2)) { *ep = *ep ? expr_alloc_two(type, *ep, e1) : e1; expr_free(e2); if (type == E_AND) { e1 = expr_alloc_symbol(&symbol_yes); e2 = expr_alloc_symbol(&symbol_yes); } else if (type == E_OR) { e1 = expr_alloc_symbol(&symbol_no); e2 = expr_alloc_symbol(&symbol_no); } } #undef e1 #undef e2 } struct expr *expr_trans_compare(struct expr *e, enum expr_type type, struct symbol *sym) { struct expr *e1, *e2; if (!e) { e = expr_alloc_symbol(sym); if (type == E_UNEQUAL) e = expr_alloc_one(E_NOT, e); return e; } switch (e->type) { case E_AND: e1 = expr_trans_compare(e->left.expr, E_EQUAL, sym); e2 = expr_trans_compare(e->right.expr, E_EQUAL, sym); if (sym == &symbol_yes) e = expr_alloc_two(E_AND, e1, e2); if (sym == &symbol_no) e = expr_alloc_two(E_OR, e1, e2); if (type == E_UNEQUAL) e = expr_alloc_one(E_NOT, e); return e; case E_OR: e1 = expr_trans_compare(e->left.expr, E_EQUAL, sym); e2 = expr_trans_compare(e->right.expr, E_EQUAL, sym); if (sym == &symbol_yes) e = expr_alloc_two(E_OR, e1, e2); if (sym == &symbol_no) e = expr_alloc_two(E_AND, e1, e2); if (type == E_UNEQUAL) e = expr_alloc_one(E_NOT, e); return e; case E_NOT: return expr_trans_compare(e->left.expr, type == E_EQUAL ? E_UNEQUAL : E_EQUAL, sym); case E_UNEQUAL: case E_EQUAL: if (type == E_EQUAL) { if (sym == &symbol_yes) return expr_copy(e); if (sym == &symbol_mod) return expr_alloc_symbol(&symbol_no); if (sym == &symbol_no) return expr_alloc_one(E_NOT, expr_copy(e)); } else { if (sym == &symbol_yes) return expr_alloc_one(E_NOT, expr_copy(e)); if (sym == &symbol_mod) return expr_alloc_symbol(&symbol_yes); if (sym == &symbol_no) return expr_copy(e); } break; case E_SYMBOL: return expr_alloc_comp(type, e->left.sym, sym); case E_LIST: case E_RANGE: case E_NONE: /* panic */; } return NULL; } tristate expr_calc_value(struct expr *e) { tristate val1, val2; const char *str1, *str2; if (!e) return yes; switch (e->type) { case E_SYMBOL: sym_calc_value(e->left.sym); return e->left.sym->curr.tri; case E_AND: val1 = expr_calc_value(e->left.expr); val2 = expr_calc_value(e->right.expr); return EXPR_AND(val1, val2); case E_OR: val1 = expr_calc_value(e->left.expr); val2 = expr_calc_value(e->right.expr); return EXPR_OR(val1, val2); case E_NOT: val1 = expr_calc_value(e->left.expr); return EXPR_NOT(val1); case E_EQUAL: sym_calc_value(e->left.sym); sym_calc_value(e->right.sym); str1 = sym_get_string_value(e->left.sym); str2 = sym_get_string_value(e->right.sym); return !strcmp(str1, str2) ? yes : no; case E_UNEQUAL: sym_calc_value(e->left.sym); sym_calc_value(e->right.sym); str1 = sym_get_string_value(e->left.sym); str2 = sym_get_string_value(e->right.sym); return !strcmp(str1, str2) ? no : yes; default: printf("expr_calc_value: %d?\n", e->type); return no; } } int expr_compare_type(enum expr_type t1, enum expr_type t2) { #if 0 return 1; #else if (t1 == t2) return 0; switch (t1) { case E_EQUAL: case E_UNEQUAL: if (t2 == E_NOT) return 1; case E_NOT: if (t2 == E_AND) return 1; case E_AND: if (t2 == E_OR) return 1; case E_OR: if (t2 == E_LIST) return 1; case E_LIST: if (t2 == 0) return 1; default: return -1; } printf("[%dgt%d?]", t1, t2); return 0; #endif } static inline struct expr * expr_get_leftmost_symbol(const struct expr *e) { if (e == NULL) return NULL; while (e->type != E_SYMBOL) e = e->left.expr; return expr_copy(e); } /* * Given expression `e1' and `e2', returns the leaf of the longest * sub-expression of `e1' not containing 'e2. */ struct expr *expr_simplify_unmet_dep(struct expr *e1, struct expr *e2) { struct expr *ret; switch (e1->type) { case E_OR: return expr_alloc_and( expr_simplify_unmet_dep(e1->left.expr, e2), expr_simplify_unmet_dep(e1->right.expr, e2)); case E_AND: { struct expr *e; e = expr_alloc_and(expr_copy(e1), expr_copy(e2)); e = expr_eliminate_dups(e); ret = (!expr_eq(e, e1)) ? e1 : NULL; expr_free(e); break; } default: ret = e1; break; } return expr_get_leftmost_symbol(ret); } void expr_print(struct expr *e, void (*fn)(void *, struct symbol *, const char *), void *data, int prevtoken) { if (!e) { fn(data, NULL, "y"); return; } if (expr_compare_type(prevtoken, e->type) > 0) fn(data, NULL, "("); switch (e->type) { case E_SYMBOL: if (e->left.sym->name) fn(data, e->left.sym, e->left.sym->name); else fn(data, NULL, ""); break; case E_NOT: fn(data, NULL, "!"); expr_print(e->left.expr, fn, data, E_NOT); break; case E_EQUAL: if (e->left.sym->name) fn(data, e->left.sym, e->left.sym->name); else fn(data, NULL, ""); fn(data, NULL, "="); fn(data, e->right.sym, e->right.sym->name); break; case E_UNEQUAL: if (e->left.sym->name) fn(data, e->left.sym, e->left.sym->name); else fn(data, NULL, ""); fn(data, NULL, "!="); fn(data, e->right.sym, e->right.sym->name); break; case E_OR: expr_print(e->left.expr, fn, data, E_OR); fn(data, NULL, " || "); expr_print(e->right.expr, fn, data, E_OR); break; case E_AND: expr_print(e->left.expr, fn, data, E_AND); fn(data, NULL, " && "); expr_print(e->right.expr, fn, data, E_AND); break; case E_LIST: fn(data, e->right.sym, e->right.sym->name); if (e->left.expr) { fn(data, NULL, " ^ "); expr_print(e->left.expr, fn, data, E_LIST); } break; case E_RANGE: fn(data, NULL, "["); fn(data, e->left.sym, e->left.sym->name); fn(data, NULL, " "); fn(data, e->right.sym, e->right.sym->name); fn(data, NULL, "]"); break; default: { char buf[32]; sprintf(buf, "", e->type); fn(data, NULL, buf); break; } } if (expr_compare_type(prevtoken, e->type) > 0) fn(data, NULL, ")"); } static void expr_print_file_helper(void *data, struct symbol *sym, const char *str) { xfwrite(str, strlen(str), 1, data); } void expr_fprint(struct expr *e, FILE *out) { expr_print(e, expr_print_file_helper, out, E_NONE); } static void expr_print_gstr_helper(void *data, struct symbol *sym, const char *str) { struct gstr *gs = (struct gstr*)data; const char *sym_str = NULL; if (sym) sym_str = sym_get_string_value(sym); if (gs->max_width) { unsigned extra_length = strlen(str); const char *last_cr = strrchr(gs->s, '\n'); unsigned last_line_length; if (sym_str) extra_length += 4 + strlen(sym_str); if (!last_cr) last_cr = gs->s; last_line_length = strlen(gs->s) - (last_cr - gs->s); if ((last_line_length + extra_length) > gs->max_width) str_append(gs, "\\\n"); } str_append(gs, str); if (sym && sym->type != S_UNKNOWN) str_printf(gs, " [=%s]", sym_str); } void expr_gstr_print(struct expr *e, struct gstr *gs) { expr_print(e, expr_print_gstr_helper, gs, E_NONE); } tinyvisor/bios/tools/kconfig/images.c0000644006644000001440000001464511733243570020230 0ustar yuichi_xyusers/* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ static const char *xpm_load[] = { "22 22 5 1", ". c None", "# c #000000", "c c #838100", "a c #ffff00", "b c #ffffff", "......................", "......................", "......................", "............####....#.", "...........#....##.##.", "..................###.", ".................####.", ".####...........#####.", "#abab##########.......", "#babababababab#.......", "#ababababababa#.......", "#babababababab#.......", "#ababab###############", "#babab##cccccccccccc##", "#abab##cccccccccccc##.", "#bab##cccccccccccc##..", "#ab##cccccccccccc##...", "#b##cccccccccccc##....", "###cccccccccccc##.....", "##cccccccccccc##......", "###############.......", "......................"}; static const char *xpm_save[] = { "22 22 5 1", ". c None", "# c #000000", "a c #838100", "b c #c5c2c5", "c c #cdb6d5", "......................", ".####################.", ".#aa#bbbbbbbbbbbb#bb#.", ".#aa#bbbbbbbbbbbb#bb#.", ".#aa#bbbbbbbbbcbb####.", ".#aa#bbbccbbbbbbb#aa#.", ".#aa#bbbccbbbbbbb#aa#.", ".#aa#bbbbbbbbbbbb#aa#.", ".#aa#bbbbbbbbbbbb#aa#.", ".#aa#bbbbbbbbbbbb#aa#.", ".#aa#bbbbbbbbbbbb#aa#.", ".#aaa############aaa#.", ".#aaaaaaaaaaaaaaaaaa#.", ".#aaaaaaaaaaaaaaaaaa#.", ".#aaa#############aa#.", ".#aaa#########bbb#aa#.", ".#aaa#########bbb#aa#.", ".#aaa#########bbb#aa#.", ".#aaa#########bbb#aa#.", ".#aaa#########bbb#aa#.", "..##################..", "......................"}; static const char *xpm_back[] = { "22 22 3 1", ". c None", "# c #000083", "a c #838183", "......................", "......................", "......................", "......................", "......................", "...........######a....", "..#......##########...", "..##...####......##a..", "..###.###.........##..", "..######..........##..", "..#####...........##..", "..######..........##..", "..#######.........##..", "..########.......##a..", "...............a###...", "...............###....", "......................", "......................", "......................", "......................", "......................", "......................"}; static const char *xpm_tree_view[] = { "22 22 2 1", ". c None", "# c #000000", "......................", "......................", "......#...............", "......#...............", "......#...............", "......#...............", "......#...............", "......########........", "......#...............", "......#...............", "......#...............", "......#...............", "......#...............", "......########........", "......#...............", "......#...............", "......#...............", "......#...............", "......#...............", "......########........", "......................", "......................"}; static const char *xpm_single_view[] = { "22 22 2 1", ". c None", "# c #000000", "......................", "......................", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "..........#...........", "......................", "......................"}; static const char *xpm_split_view[] = { "22 22 2 1", ". c None", "# c #000000", "......................", "......................", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......#......#........", "......................", "......................"}; static const char *xpm_symbol_no[] = { "12 12 2 1", " c white", ". c black", " ", " .......... ", " . . ", " . . ", " . . ", " . . ", " . . ", " . . ", " . . ", " . . ", " .......... ", " "}; static const char *xpm_symbol_mod[] = { "12 12 2 1", " c white", ". c black", " ", " .......... ", " . . ", " . . ", " . .. . ", " . .... . ", " . .... . ", " . .. . ", " . . ", " . . ", " .......... ", " "}; static const char *xpm_symbol_yes[] = { "12 12 2 1", " c white", ". c black", " ", " .......... ", " . . ", " . . ", " . . . ", " . .. . ", " . . .. . ", " . .... . ", " . .. . ", " . . ", " .......... ", " "}; static const char *xpm_choice_no[] = { "12 12 2 1", " c white", ". c black", " ", " .... ", " .. .. ", " . . ", " . . ", " . . ", " . . ", " . . ", " . . ", " .. .. ", " .... ", " "}; static const char *xpm_choice_yes[] = { "12 12 2 1", " c white", ". c black", " ", " .... ", " .. .. ", " . . ", " . .. . ", " . .... . ", " . .... . ", " . .. . ", " . . ", " .. .. ", " .... ", " "}; static const char *xpm_menu[] = { "12 12 2 1", " c white", ". c black", " ", " .......... ", " . . ", " . .. . ", " . .... . ", " . ...... . ", " . ...... . ", " . .... . ", " . .. . ", " . . ", " .......... ", " "}; static const char *xpm_menu_inv[] = { "12 12 2 1", " c white", ". c black", " ", " .......... ", " .......... ", " .. ...... ", " .. .... ", " .. .. ", " .. .. ", " .. .... ", " .. ...... ", " .......... ", " .......... ", " "}; static const char *xpm_menuback[] = { "12 12 2 1", " c white", ". c black", " ", " .......... ", " . . ", " . .. . ", " . .... . ", " . ...... . ", " . ...... . ", " . .... . ", " . .. . ", " . . ", " .......... ", " "}; static const char *xpm_void[] = { "12 12 2 1", " c white", ". c black", " ", " ", " ", " ", " ", " ", " ", " ", " ", " ", " ", " "}; tinyvisor/bios/tools/kconfig/lkc_proto.h0000644006644000001440000000450711733243570020760 0ustar yuichi_xyusers#include /* confdata.c */ P(conf_parse,void,(const char *name)); P(conf_read,int,(const char *name)); P(conf_read_simple,int,(const char *name, int)); P(conf_write_defconfig,int,(const char *name)); P(conf_write,int,(const char *name)); P(conf_write_autoconf,int,(void)); P(conf_get_changed,bool,(void)); P(conf_set_changed_callback, void,(void (*fn)(void))); P(conf_set_message_callback, void,(void (*fn)(const char *fmt, va_list ap))); /* menu.c */ P(rootmenu,struct menu,); P(menu_is_visible, bool, (struct menu *menu)); P(menu_has_prompt, bool, (struct menu *menu)); P(menu_get_prompt,const char *,(struct menu *menu)); P(menu_get_root_menu,struct menu *,(struct menu *menu)); P(menu_get_parent_menu,struct menu *,(struct menu *menu)); P(menu_has_help,bool,(struct menu *menu)); P(menu_get_help,const char *,(struct menu *menu)); P(get_symbol_str, void, (struct gstr *r, struct symbol *sym)); P(get_relations_str, struct gstr, (struct symbol **sym_arr)); P(menu_get_ext_help,void,(struct menu *menu, struct gstr *help)); /* symbol.c */ P(symbol_hash,struct symbol *,[SYMBOL_HASHSIZE]); P(sym_lookup,struct symbol *,(const char *name, int flags)); P(sym_find,struct symbol *,(const char *name)); P(sym_expand_string_value,const char *,(const char *in)); P(sym_re_search,struct symbol **,(const char *pattern)); P(sym_type_name,const char *,(enum symbol_type type)); P(sym_calc_value,void,(struct symbol *sym)); P(sym_get_type,enum symbol_type,(struct symbol *sym)); P(sym_tristate_within_range,bool,(struct symbol *sym,tristate tri)); P(sym_set_tristate_value,bool,(struct symbol *sym,tristate tri)); P(sym_toggle_tristate_value,tristate,(struct symbol *sym)); P(sym_string_valid,bool,(struct symbol *sym, const char *newval)); P(sym_string_within_range,bool,(struct symbol *sym, const char *str)); P(sym_set_string_value,bool,(struct symbol *sym, const char *newval)); P(sym_is_changable,bool,(struct symbol *sym)); P(sym_get_choice_prop,struct property *,(struct symbol *sym)); P(sym_get_default_prop,struct property *,(struct symbol *sym)); P(sym_get_string_value,const char *,(struct symbol *sym)); P(prop_get_type_name,const char *,(enum prop_type type)); /* expr.c */ P(expr_compare_type,int,(enum expr_type t1, enum expr_type t2)); P(expr_print,void,(struct expr *e, void (*fn)(void *, struct symbol *, const char *), void *data, int prevtoken)); tinyvisor/bios/tools/kconfig/gconf.glade0000644006644000001440000006205211733243570020704 0ustar yuichi_xyusers True Gtk Kernel Configurator GTK_WINDOW_TOPLEVEL GTK_WIN_POS_NONE False 640 480 True False True False False GDK_WINDOW_TYPE_HINT_NORMAL GDK_GRAVITY_NORTH_WEST True False 0 True True _File True True Load a config file _Load True True gtk-open 1 0.5 0.5 0 0 True Save the config in .config _Save True True gtk-save 1 0.5 0.5 0 0 True Save the config in a file Save _as True True gtk-save-as 1 0.5 0.5 0 0 True True _Quit True True gtk-quit 1 0.5 0.5 0 0 True _Options True True Show name Show _name True False True Show range (Y/M/N) Show _range True False True Show value of the option Show _data True False True True Show normal options Show normal options True True True Show all options Show all _options True False set_option_mode1 True Show all options with prompts Show all prompt options True False set_option_mode1 True _Help True True _Introduction True True gtk-dialog-question 1 0.5 0.5 0 0 True _About True True gtk-properties 1 0.5 0.5 0 0 True _License True True gtk-justify-fill 1 0.5 0.5 0 0 0 False False True GTK_SHADOW_OUT GTK_POS_LEFT GTK_POS_TOP True GTK_ORIENTATION_HORIZONTAL GTK_TOOLBAR_BOTH True True True Goes up of one level (single view) Back True gtk-undo True True False False True True True True False True False False True Load a config file Load True gtk-open True True False False True True Save a config file Save True gtk-save True True False False True True True True False True False False True Single view Single True gtk-missing-image True True False False True True Split view Split True gtk-missing-image True True False False True True Full view Full True gtk-missing-image True True False False True True True True False True False False True Collapse the whole tree in the right frame Collapse True gtk-remove True True False False True True Expand the whole tree in the right frame Expand True gtk-add True True False False True 0 False False 1 True True 0 True GTK_POLICY_AUTOMATIC GTK_POLICY_AUTOMATIC GTK_SHADOW_IN GTK_CORNER_TOP_LEFT True True True False False False True False True True 0 True GTK_POLICY_AUTOMATIC GTK_POLICY_AUTOMATIC GTK_SHADOW_IN GTK_CORNER_TOP_LEFT True True True True False False False True False True GTK_POLICY_NEVER GTK_POLICY_AUTOMATIC GTK_SHADOW_IN GTK_CORNER_TOP_LEFT True True False False True GTK_JUSTIFY_LEFT GTK_WRAP_WORD True 0 0 0 0 0 0 Sorry, no help available for this option yet. True True True True 0 True True tinyvisor/bios/tools/kconfig/.gitignore0000644006644000001440000000026211733243570020575 0ustar yuichi_xyusers# # Generated files # config* lex.*.c *.tab.c *.tab.h zconf.hash.c *.moc lkc_defs.h gconf.glade.h *.pot *.mo # # configuration programs # conf mconf nconf qconf gconf kxgettext tinyvisor/bios/tools/kconfig/nconf.h0000644006644000001440000000357111733243570020067 0ustar yuichi_xyusers/* * Copyright (C) 2008 Nir Tzachar #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "ncurses.h" #define max(a, b) ({\ typeof(a) _a = a;\ typeof(b) _b = b;\ _a > _b ? _a : _b; }) #define min(a, b) ({\ typeof(a) _a = a;\ typeof(b) _b = b;\ _a < _b ? _a : _b; }) typedef enum { NORMAL = 1, MAIN_HEADING, MAIN_MENU_BOX, MAIN_MENU_FORE, MAIN_MENU_BACK, MAIN_MENU_GREY, MAIN_MENU_HEADING, SCROLLWIN_TEXT, SCROLLWIN_HEADING, SCROLLWIN_BOX, DIALOG_TEXT, DIALOG_MENU_FORE, DIALOG_MENU_BACK, DIALOG_BOX, INPUT_BOX, INPUT_HEADING, INPUT_TEXT, INPUT_FIELD, FUNCTION_TEXT, FUNCTION_HIGHLIGHT, ATTR_MAX } attributes_t; extern attributes_t attributes[]; typedef enum { F_HELP = 1, F_SYMBOL = 2, F_INSTS = 3, F_CONF = 4, F_BACK = 5, F_SAVE = 6, F_LOAD = 7, F_SEARCH = 8, F_EXIT = 9, } function_key; void set_colors(void); /* this changes the windows attributes !!! */ void print_in_middle(WINDOW *win, int starty, int startx, int width, const char *string, chtype color); int get_line_length(const char *line); int get_line_no(const char *text); const char *get_line(const char *text, int line_no); void fill_window(WINDOW *win, const char *text); int btn_dialog(WINDOW *main_window, const char *msg, int btn_num, ...); int dialog_inputbox(WINDOW *main_window, const char *title, const char *prompt, const char *init, char *result, int result_len); void refresh_all_windows(WINDOW *main_window); void show_scroll_win(WINDOW *main_window, const char *title, const char *text); tinyvisor/bios/tools/kconfig/qconf.h0000644006644000001440000001737411733243570020100 0ustar yuichi_xyusers/* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ #if QT_VERSION < 0x040000 #include #else #include #endif #include #if QT_VERSION < 0x040000 #define Q3ValueList QValueList #define Q3PopupMenu QPopupMenu #define Q3ListView QListView #define Q3ListViewItem QListViewItem #define Q3VBox QVBox #define Q3TextBrowser QTextBrowser #define Q3MainWindow QMainWindow #define Q3Action QAction #define Q3ToolBar QToolBar #define Q3ListViewItemIterator QListViewItemIterator #define Q3FileDialog QFileDialog #endif class ConfigView; class ConfigList; class ConfigItem; class ConfigLineEdit; class ConfigMainWindow; class ConfigSettings : public QSettings { public: Q3ValueList readSizes(const QString& key, bool *ok); bool writeSizes(const QString& key, const Q3ValueList& value); }; enum colIdx { promptColIdx, nameColIdx, noColIdx, modColIdx, yesColIdx, dataColIdx, colNr }; enum listMode { singleMode, menuMode, symbolMode, fullMode, listMode }; enum optionMode { normalOpt = 0, allOpt, promptOpt }; class ConfigList : public Q3ListView { Q_OBJECT typedef class Q3ListView Parent; public: ConfigList(ConfigView* p, const char *name = 0); void reinit(void); ConfigView* parent(void) const { return (ConfigView*)Parent::parent(); } ConfigItem* findConfigItem(struct menu *); protected: void keyPressEvent(QKeyEvent *e); void contentsMousePressEvent(QMouseEvent *e); void contentsMouseReleaseEvent(QMouseEvent *e); void contentsMouseMoveEvent(QMouseEvent *e); void contentsMouseDoubleClickEvent(QMouseEvent *e); void focusInEvent(QFocusEvent *e); void contextMenuEvent(QContextMenuEvent *e); public slots: void setRootMenu(struct menu *menu); void updateList(ConfigItem *item); void setValue(ConfigItem* item, tristate val); void changeValue(ConfigItem* item); void updateSelection(void); void saveSettings(void); signals: void menuChanged(struct menu *menu); void menuSelected(struct menu *menu); void parentSelected(void); void gotFocus(struct menu *); public: void updateListAll(void) { updateAll = true; updateList(NULL); updateAll = false; } ConfigList* listView() { return this; } ConfigItem* firstChild() const { return (ConfigItem *)Parent::firstChild(); } int mapIdx(colIdx idx) { return colMap[idx]; } void addColumn(colIdx idx, const QString& label) { colMap[idx] = Parent::addColumn(label); colRevMap[colMap[idx]] = idx; } void removeColumn(colIdx idx) { int col = colMap[idx]; if (col >= 0) { Parent::removeColumn(col); colRevMap[col] = colMap[idx] = -1; } } void setAllOpen(bool open); void setParentMenu(void); bool menuSkip(struct menu *); template void updateMenuList(P*, struct menu*); bool updateAll; QPixmap symbolYesPix, symbolModPix, symbolNoPix; QPixmap choiceYesPix, choiceNoPix; QPixmap menuPix, menuInvPix, menuBackPix, voidPix; bool showName, showRange, showData; enum listMode mode; enum optionMode optMode; struct menu *rootEntry; QColorGroup disabledColorGroup; QColorGroup inactivedColorGroup; Q3PopupMenu* headerPopup; private: int colMap[colNr]; int colRevMap[colNr]; }; class ConfigItem : public Q3ListViewItem { typedef class Q3ListViewItem Parent; public: ConfigItem(Q3ListView *parent, ConfigItem *after, struct menu *m, bool v) : Parent(parent, after), menu(m), visible(v), goParent(false) { init(); } ConfigItem(ConfigItem *parent, ConfigItem *after, struct menu *m, bool v) : Parent(parent, after), menu(m), visible(v), goParent(false) { init(); } ConfigItem(Q3ListView *parent, ConfigItem *after, bool v) : Parent(parent, after), menu(0), visible(v), goParent(true) { init(); } ~ConfigItem(void); void init(void); void okRename(int col); void updateMenu(void); void testUpdateMenu(bool v); ConfigList* listView() const { return (ConfigList*)Parent::listView(); } ConfigItem* firstChild() const { return (ConfigItem *)Parent::firstChild(); } ConfigItem* nextSibling() const { return (ConfigItem *)Parent::nextSibling(); } void setText(colIdx idx, const QString& text) { Parent::setText(listView()->mapIdx(idx), text); } QString text(colIdx idx) const { return Parent::text(listView()->mapIdx(idx)); } void setPixmap(colIdx idx, const QPixmap& pm) { Parent::setPixmap(listView()->mapIdx(idx), pm); } const QPixmap* pixmap(colIdx idx) const { return Parent::pixmap(listView()->mapIdx(idx)); } void paintCell(QPainter* p, const QColorGroup& cg, int column, int width, int align); ConfigItem* nextItem; struct menu *menu; bool visible; bool goParent; }; class ConfigLineEdit : public QLineEdit { Q_OBJECT typedef class QLineEdit Parent; public: ConfigLineEdit(ConfigView* parent); ConfigView* parent(void) const { return (ConfigView*)Parent::parent(); } void show(ConfigItem *i); void keyPressEvent(QKeyEvent *e); public: ConfigItem *item; }; class ConfigView : public Q3VBox { Q_OBJECT typedef class Q3VBox Parent; public: ConfigView(QWidget* parent, const char *name = 0); ~ConfigView(void); static void updateList(ConfigItem* item); static void updateListAll(void); bool showName(void) const { return list->showName; } bool showRange(void) const { return list->showRange; } bool showData(void) const { return list->showData; } public slots: void setShowName(bool); void setShowRange(bool); void setShowData(bool); void setOptionMode(QAction *); signals: void showNameChanged(bool); void showRangeChanged(bool); void showDataChanged(bool); public: ConfigList* list; ConfigLineEdit* lineEdit; static ConfigView* viewList; ConfigView* nextView; static QAction *showNormalAction; static QAction *showAllAction; static QAction *showPromptAction; }; class ConfigInfoView : public Q3TextBrowser { Q_OBJECT typedef class Q3TextBrowser Parent; public: ConfigInfoView(QWidget* parent, const char *name = 0); bool showDebug(void) const { return _showDebug; } public slots: void setInfo(struct menu *menu); void saveSettings(void); void setShowDebug(bool); signals: void showDebugChanged(bool); void menuSelected(struct menu *); protected: void symbolInfo(void); void menuInfo(void); QString debug_info(struct symbol *sym); static QString print_filter(const QString &str); static void expr_print_help(void *data, struct symbol *sym, const char *str); Q3PopupMenu* createPopupMenu(const QPoint& pos); void contentsContextMenuEvent(QContextMenuEvent *e); struct symbol *sym; struct menu *_menu; bool _showDebug; }; class ConfigSearchWindow : public QDialog { Q_OBJECT typedef class QDialog Parent; public: ConfigSearchWindow(ConfigMainWindow* parent, const char *name = 0); public slots: void saveSettings(void); void search(void); protected: QLineEdit* editField; QPushButton* searchButton; QSplitter* split; ConfigView* list; ConfigInfoView* info; struct symbol **result; }; class ConfigMainWindow : public Q3MainWindow { Q_OBJECT static Q3Action *saveAction; static void conf_changed(void); public: ConfigMainWindow(void); public slots: void changeMenu(struct menu *); void setMenuLink(struct menu *); void listFocusChanged(void); void goBack(void); void loadConfig(void); void saveConfig(void); void saveConfigAs(void); void searchConfig(void); void showSingleView(void); void showSplitView(void); void showFullView(void); void showIntro(void); void showAbout(void); void saveSettings(void); protected: void closeEvent(QCloseEvent *e); ConfigSearchWindow *searchWindow; ConfigView *menuView; ConfigList *menuList; ConfigView *configView; ConfigList *configList; ConfigInfoView *helpText; Q3ToolBar *toolBar; Q3Action *backAction; QSplitter* split1; QSplitter* split2; }; tinyvisor/bios/tools/kconfig/zconf.y0000644006644000001440000003654211733243570020130 0ustar yuichi_xyusers%{ /* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ #include #include #include #include #include #include #define LKC_DIRECT_LINK #include "lkc.h" #define printd(mask, fmt...) if (cdebug & (mask)) printf(fmt) #define PRINTD 0x0001 #define DEBUG_PARSE 0x0002 int cdebug = PRINTD; extern int zconflex(void); static void zconfprint(const char *err, ...); static void zconf_error(const char *err, ...); static void zconferror(const char *err); static bool zconf_endtoken(struct kconf_id *id, int starttoken, int endtoken); struct symbol *symbol_hash[SYMBOL_HASHSIZE]; static struct menu *current_menu, *current_entry; #define YYDEBUG 0 #if YYDEBUG #define YYERROR_VERBOSE #endif %} %expect 30 %union { char *string; struct file *file; struct symbol *symbol; struct expr *expr; struct menu *menu; struct kconf_id *id; } %token T_MAINMENU %token T_MENU %token T_ENDMENU %token T_SOURCE %token T_CHOICE %token T_ENDCHOICE %token T_COMMENT %token T_CONFIG %token T_MENUCONFIG %token T_HELP %token T_HELPTEXT %token T_IF %token T_ENDIF %token T_DEPENDS %token T_OPTIONAL %token T_PROMPT %token T_TYPE %token T_DEFAULT %token T_SELECT %token T_RANGE %token T_VISIBLE %token T_OPTION %token T_ON %token T_WORD %token T_WORD_QUOTE %token T_UNEQUAL %token T_CLOSE_PAREN %token T_OPEN_PAREN %token T_EOL %left T_OR %left T_AND %left T_EQUAL T_UNEQUAL %nonassoc T_NOT %type prompt %type symbol %type expr %type if_expr %type end %type option_name %type if_entry menu_entry choice_entry %type symbol_option_arg word_opt %destructor { fprintf(stderr, "%s:%d: missing end statement for this entry\n", $$->file->name, $$->lineno); if (current_menu == $$) menu_end_menu(); } if_entry menu_entry choice_entry %{ /* Include zconf.hash.c here so it can see the token constants. */ #include "zconf.hash.c" %} %% input: nl start | start; start: mainmenu_stmt stmt_list | stmt_list; stmt_list: /* empty */ | stmt_list common_stmt | stmt_list choice_stmt | stmt_list menu_stmt | stmt_list end { zconf_error("unexpected end statement"); } | stmt_list T_WORD error T_EOL { zconf_error("unknown statement \"%s\"", $2); } | stmt_list option_name error T_EOL { zconf_error("unexpected option \"%s\"", kconf_id_strings + $2->name); } | stmt_list error T_EOL { zconf_error("invalid statement"); } ; option_name: T_DEPENDS | T_PROMPT | T_TYPE | T_SELECT | T_OPTIONAL | T_RANGE | T_DEFAULT | T_VISIBLE ; common_stmt: T_EOL | if_stmt | comment_stmt | config_stmt | menuconfig_stmt | source_stmt ; option_error: T_WORD error T_EOL { zconf_error("unknown option \"%s\"", $1); } | error T_EOL { zconf_error("invalid option"); } ; /* config/menuconfig entry */ config_entry_start: T_CONFIG T_WORD T_EOL { struct symbol *sym = sym_lookup($2, 0); sym->flags |= SYMBOL_OPTIONAL; menu_add_entry(sym); printd(DEBUG_PARSE, "%s:%d:config %s\n", zconf_curname(), zconf_lineno(), $2); }; config_stmt: config_entry_start config_option_list { menu_end_entry(); printd(DEBUG_PARSE, "%s:%d:endconfig\n", zconf_curname(), zconf_lineno()); }; menuconfig_entry_start: T_MENUCONFIG T_WORD T_EOL { struct symbol *sym = sym_lookup($2, 0); sym->flags |= SYMBOL_OPTIONAL; menu_add_entry(sym); printd(DEBUG_PARSE, "%s:%d:menuconfig %s\n", zconf_curname(), zconf_lineno(), $2); }; menuconfig_stmt: menuconfig_entry_start config_option_list { if (current_entry->prompt) current_entry->prompt->type = P_MENU; else zconfprint("warning: menuconfig statement without prompt"); menu_end_entry(); printd(DEBUG_PARSE, "%s:%d:endconfig\n", zconf_curname(), zconf_lineno()); }; config_option_list: /* empty */ | config_option_list config_option | config_option_list symbol_option | config_option_list depends | config_option_list help | config_option_list option_error | config_option_list T_EOL ; config_option: T_TYPE prompt_stmt_opt T_EOL { menu_set_type($1->stype); printd(DEBUG_PARSE, "%s:%d:type(%u)\n", zconf_curname(), zconf_lineno(), $1->stype); }; config_option: T_PROMPT prompt if_expr T_EOL { menu_add_prompt(P_PROMPT, $2, $3); printd(DEBUG_PARSE, "%s:%d:prompt\n", zconf_curname(), zconf_lineno()); }; config_option: T_DEFAULT expr if_expr T_EOL { menu_add_expr(P_DEFAULT, $2, $3); if ($1->stype != S_UNKNOWN) menu_set_type($1->stype); printd(DEBUG_PARSE, "%s:%d:default(%u)\n", zconf_curname(), zconf_lineno(), $1->stype); }; config_option: T_SELECT T_WORD if_expr T_EOL { menu_add_symbol(P_SELECT, sym_lookup($2, 0), $3); printd(DEBUG_PARSE, "%s:%d:select\n", zconf_curname(), zconf_lineno()); }; config_option: T_RANGE symbol symbol if_expr T_EOL { menu_add_expr(P_RANGE, expr_alloc_comp(E_RANGE,$2, $3), $4); printd(DEBUG_PARSE, "%s:%d:range\n", zconf_curname(), zconf_lineno()); }; symbol_option: T_OPTION symbol_option_list T_EOL ; symbol_option_list: /* empty */ | symbol_option_list T_WORD symbol_option_arg { struct kconf_id *id = kconf_id_lookup($2, strlen($2)); if (id && id->flags & TF_OPTION) menu_add_option(id->token, $3); else zconfprint("warning: ignoring unknown option %s", $2); free($2); }; symbol_option_arg: /* empty */ { $$ = NULL; } | T_EQUAL prompt { $$ = $2; } ; /* choice entry */ choice: T_CHOICE word_opt T_EOL { struct symbol *sym = sym_lookup($2, SYMBOL_CHOICE); sym->flags |= SYMBOL_AUTO; menu_add_entry(sym); menu_add_expr(P_CHOICE, NULL, NULL); printd(DEBUG_PARSE, "%s:%d:choice\n", zconf_curname(), zconf_lineno()); }; choice_entry: choice choice_option_list { $$ = menu_add_menu(); }; choice_end: end { if (zconf_endtoken($1, T_CHOICE, T_ENDCHOICE)) { menu_end_menu(); printd(DEBUG_PARSE, "%s:%d:endchoice\n", zconf_curname(), zconf_lineno()); } }; choice_stmt: choice_entry choice_block choice_end ; choice_option_list: /* empty */ | choice_option_list choice_option | choice_option_list depends | choice_option_list help | choice_option_list T_EOL | choice_option_list option_error ; choice_option: T_PROMPT prompt if_expr T_EOL { menu_add_prompt(P_PROMPT, $2, $3); printd(DEBUG_PARSE, "%s:%d:prompt\n", zconf_curname(), zconf_lineno()); }; choice_option: T_TYPE prompt_stmt_opt T_EOL { if ($1->stype == S_BOOLEAN || $1->stype == S_TRISTATE) { menu_set_type($1->stype); printd(DEBUG_PARSE, "%s:%d:type(%u)\n", zconf_curname(), zconf_lineno(), $1->stype); } else YYERROR; }; choice_option: T_OPTIONAL T_EOL { current_entry->sym->flags |= SYMBOL_OPTIONAL; printd(DEBUG_PARSE, "%s:%d:optional\n", zconf_curname(), zconf_lineno()); }; choice_option: T_DEFAULT T_WORD if_expr T_EOL { if ($1->stype == S_UNKNOWN) { menu_add_symbol(P_DEFAULT, sym_lookup($2, 0), $3); printd(DEBUG_PARSE, "%s:%d:default\n", zconf_curname(), zconf_lineno()); } else YYERROR; }; choice_block: /* empty */ | choice_block common_stmt ; /* if entry */ if_entry: T_IF expr nl { printd(DEBUG_PARSE, "%s:%d:if\n", zconf_curname(), zconf_lineno()); menu_add_entry(NULL); menu_add_dep($2); $$ = menu_add_menu(); }; if_end: end { if (zconf_endtoken($1, T_IF, T_ENDIF)) { menu_end_menu(); printd(DEBUG_PARSE, "%s:%d:endif\n", zconf_curname(), zconf_lineno()); } }; if_stmt: if_entry if_block if_end ; if_block: /* empty */ | if_block common_stmt | if_block menu_stmt | if_block choice_stmt ; /* mainmenu entry */ mainmenu_stmt: T_MAINMENU prompt nl { menu_add_prompt(P_MENU, $2, NULL); }; /* menu entry */ menu: T_MENU prompt T_EOL { menu_add_entry(NULL); menu_add_prompt(P_MENU, $2, NULL); printd(DEBUG_PARSE, "%s:%d:menu\n", zconf_curname(), zconf_lineno()); }; menu_entry: menu visibility_list depends_list { $$ = menu_add_menu(); }; menu_end: end { if (zconf_endtoken($1, T_MENU, T_ENDMENU)) { menu_end_menu(); printd(DEBUG_PARSE, "%s:%d:endmenu\n", zconf_curname(), zconf_lineno()); } }; menu_stmt: menu_entry menu_block menu_end ; menu_block: /* empty */ | menu_block common_stmt | menu_block menu_stmt | menu_block choice_stmt ; source_stmt: T_SOURCE prompt T_EOL { printd(DEBUG_PARSE, "%s:%d:source %s\n", zconf_curname(), zconf_lineno(), $2); zconf_nextfile($2); }; /* comment entry */ comment: T_COMMENT prompt T_EOL { menu_add_entry(NULL); menu_add_prompt(P_COMMENT, $2, NULL); printd(DEBUG_PARSE, "%s:%d:comment\n", zconf_curname(), zconf_lineno()); }; comment_stmt: comment depends_list { menu_end_entry(); }; /* help option */ help_start: T_HELP T_EOL { printd(DEBUG_PARSE, "%s:%d:help\n", zconf_curname(), zconf_lineno()); zconf_starthelp(); }; help: help_start T_HELPTEXT { current_entry->help = $2; }; /* depends option */ depends_list: /* empty */ | depends_list depends | depends_list T_EOL | depends_list option_error ; depends: T_DEPENDS T_ON expr T_EOL { menu_add_dep($3); printd(DEBUG_PARSE, "%s:%d:depends on\n", zconf_curname(), zconf_lineno()); }; /* visibility option */ visibility_list: /* empty */ | visibility_list visible | visibility_list T_EOL ; visible: T_VISIBLE if_expr { menu_add_visibility($2); }; /* prompt statement */ prompt_stmt_opt: /* empty */ | prompt if_expr { menu_add_prompt(P_PROMPT, $1, $2); }; prompt: T_WORD | T_WORD_QUOTE ; end: T_ENDMENU T_EOL { $$ = $1; } | T_ENDCHOICE T_EOL { $$ = $1; } | T_ENDIF T_EOL { $$ = $1; } ; nl: T_EOL | nl T_EOL ; if_expr: /* empty */ { $$ = NULL; } | T_IF expr { $$ = $2; } ; expr: symbol { $$ = expr_alloc_symbol($1); } | symbol T_EQUAL symbol { $$ = expr_alloc_comp(E_EQUAL, $1, $3); } | symbol T_UNEQUAL symbol { $$ = expr_alloc_comp(E_UNEQUAL, $1, $3); } | T_OPEN_PAREN expr T_CLOSE_PAREN { $$ = $2; } | T_NOT expr { $$ = expr_alloc_one(E_NOT, $2); } | expr T_OR expr { $$ = expr_alloc_two(E_OR, $1, $3); } | expr T_AND expr { $$ = expr_alloc_two(E_AND, $1, $3); } ; symbol: T_WORD { $$ = sym_lookup($1, 0); free($1); } | T_WORD_QUOTE { $$ = sym_lookup($1, SYMBOL_CONST); free($1); } ; word_opt: /* empty */ { $$ = NULL; } | T_WORD %% void conf_parse(const char *name) { struct symbol *sym; int i; zconf_initscan(name); sym_init(); _menu_init(); modules_sym = sym_lookup(NULL, 0); modules_sym->type = S_BOOLEAN; modules_sym->flags |= SYMBOL_AUTO; rootmenu.prompt = menu_add_prompt(P_MENU, "Linux Kernel Configuration", NULL); #if YYDEBUG if (getenv("ZCONF_DEBUG")) zconfdebug = 1; #endif zconfparse(); if (zconfnerrs) exit(1); if (!modules_sym->prop) { struct property *prop; prop = prop_alloc(P_DEFAULT, modules_sym); prop->expr = expr_alloc_symbol(sym_lookup("MODULES", 0)); } rootmenu.prompt->text = _(rootmenu.prompt->text); rootmenu.prompt->text = sym_expand_string_value(rootmenu.prompt->text); menu_finalize(&rootmenu); for_all_symbols(i, sym) { if (sym_check_deps(sym)) zconfnerrs++; } if (zconfnerrs) exit(1); sym_set_change_count(1); } static const char *zconf_tokenname(int token) { switch (token) { case T_MENU: return "menu"; case T_ENDMENU: return "endmenu"; case T_CHOICE: return "choice"; case T_ENDCHOICE: return "endchoice"; case T_IF: return "if"; case T_ENDIF: return "endif"; case T_DEPENDS: return "depends"; case T_VISIBLE: return "visible"; } return ""; } static bool zconf_endtoken(struct kconf_id *id, int starttoken, int endtoken) { if (id->token != endtoken) { zconf_error("unexpected '%s' within %s block", kconf_id_strings + id->name, zconf_tokenname(starttoken)); zconfnerrs++; return false; } if (current_menu->file != current_file) { zconf_error("'%s' in different file than '%s'", kconf_id_strings + id->name, zconf_tokenname(starttoken)); fprintf(stderr, "%s:%d: location of the '%s'\n", current_menu->file->name, current_menu->lineno, zconf_tokenname(starttoken)); zconfnerrs++; return false; } return true; } static void zconfprint(const char *err, ...) { va_list ap; fprintf(stderr, "%s:%d: ", zconf_curname(), zconf_lineno()); va_start(ap, err); vfprintf(stderr, err, ap); va_end(ap); fprintf(stderr, "\n"); } static void zconf_error(const char *err, ...) { va_list ap; zconfnerrs++; fprintf(stderr, "%s:%d: ", zconf_curname(), zconf_lineno()); va_start(ap, err); vfprintf(stderr, err, ap); va_end(ap); fprintf(stderr, "\n"); } static void zconferror(const char *err) { #if YYDEBUG fprintf(stderr, "%s:%d: %s\n", zconf_curname(), zconf_lineno() + 1, err); #endif } static void print_quoted_string(FILE *out, const char *str) { const char *p; int len; putc('"', out); while ((p = strchr(str, '"'))) { len = p - str; if (len) fprintf(out, "%.*s", len, str); fputs("\\\"", out); str = p + 1; } fputs(str, out); putc('"', out); } static void print_symbol(FILE *out, struct menu *menu) { struct symbol *sym = menu->sym; struct property *prop; if (sym_is_choice(sym)) fprintf(out, "\nchoice\n"); else fprintf(out, "\nconfig %s\n", sym->name); switch (sym->type) { case S_BOOLEAN: fputs(" boolean\n", out); break; case S_TRISTATE: fputs(" tristate\n", out); break; case S_STRING: fputs(" string\n", out); break; case S_INT: fputs(" integer\n", out); break; case S_HEX: fputs(" hex\n", out); break; default: fputs(" ???\n", out); break; } for (prop = sym->prop; prop; prop = prop->next) { if (prop->menu != menu) continue; switch (prop->type) { case P_PROMPT: fputs(" prompt ", out); print_quoted_string(out, prop->text); if (!expr_is_yes(prop->visible.expr)) { fputs(" if ", out); expr_fprint(prop->visible.expr, out); } fputc('\n', out); break; case P_DEFAULT: fputs( " default ", out); expr_fprint(prop->expr, out); if (!expr_is_yes(prop->visible.expr)) { fputs(" if ", out); expr_fprint(prop->visible.expr, out); } fputc('\n', out); break; case P_CHOICE: fputs(" #choice value\n", out); break; case P_SELECT: fputs( " select ", out); expr_fprint(prop->expr, out); fputc('\n', out); break; case P_RANGE: fputs( " range ", out); expr_fprint(prop->expr, out); fputc('\n', out); break; case P_MENU: fputs( " menu ", out); print_quoted_string(out, prop->text); fputc('\n', out); break; default: fprintf(out, " unknown prop %d!\n", prop->type); break; } } if (menu->help) { int len = strlen(menu->help); while (menu->help[--len] == '\n') menu->help[len] = 0; fprintf(out, " help\n%s\n", menu->help); } } void zconfdump(FILE *out) { struct property *prop; struct symbol *sym; struct menu *menu; menu = rootmenu.list; while (menu) { if ((sym = menu->sym)) print_symbol(out, menu); else if ((prop = menu->prompt)) { switch (prop->type) { case P_COMMENT: fputs("\ncomment ", out); print_quoted_string(out, prop->text); fputs("\n", out); break; case P_MENU: fputs("\nmenu ", out); print_quoted_string(out, prop->text); fputs("\n", out); break; default: ; } if (!expr_is_yes(prop->visible.expr)) { fputs(" depends ", out); expr_fprint(prop->visible.expr, out); fputc('\n', out); } } if (menu->list) menu = menu->list; else if (menu->next) menu = menu->next; else while ((menu = menu->parent)) { if (menu->prompt && menu->prompt->type == P_MENU) fputs("\nendmenu\n", out); if (menu->next) { menu = menu->next; break; } } } } #include "lex.zconf.c" #include "util.c" #include "confdata.c" #include "expr.c" #include "symbol.c" #include "menu.c" tinyvisor/bios/tools/kconfig/POTFILES.in0000644006644000001440000000052111733243570020360 0ustar yuichi_xyuserstools/kconfig/lxdialog/checklist.c tools/kconfig/lxdialog/inputbox.c tools/kconfig/lxdialog/menubox.c tools/kconfig/lxdialog/textbox.c tools/kconfig/lxdialog/util.c tools/kconfig/lxdialog/yesno.c tools/kconfig/mconf.c tools/kconfig/conf.c tools/kconfig/confdata.c tools/kconfig/gconf.c tools/kconfig/gconf.glade.h tools/kconfig/qconf.cc tinyvisor/bios/tools/kconfig/nconf.gui.c0000644006644000001440000003307311733243570020645 0ustar yuichi_xyusers/* * Copyright (C) 2008 Nir Tzachar 0) win_rows = msg_lines+4; else win_rows = msg_lines+2; win = newwin(win_rows, total_width+4, y, x); keypad(win, TRUE); menu_win = derwin(win, 1, btns_width, win_rows-2, 1+(total_width+2-btns_width)/2); menu = new_menu(btns); msg_win = derwin(win, win_rows-2, msg_width, 1, 1+(total_width+2-msg_width)/2); set_menu_fore(menu, attributes[DIALOG_MENU_FORE]); set_menu_back(menu, attributes[DIALOG_MENU_BACK]); (void) wattrset(win, attributes[DIALOG_BOX]); box(win, 0, 0); /* print message */ (void) wattrset(msg_win, attributes[DIALOG_TEXT]); fill_window(msg_win, msg); set_menu_win(menu, win); set_menu_sub(menu, menu_win); set_menu_format(menu, 1, btn_num); menu_opts_off(menu, O_SHOWDESC); menu_opts_off(menu, O_SHOWMATCH); menu_opts_on(menu, O_ONEVALUE); menu_opts_on(menu, O_NONCYCLIC); set_menu_mark(menu, ""); post_menu(menu); touchwin(win); refresh_all_windows(main_window); while ((res = wgetch(win))) { switch (res) { case KEY_LEFT: menu_driver(menu, REQ_LEFT_ITEM); break; case KEY_RIGHT: menu_driver(menu, REQ_RIGHT_ITEM); break; case 10: /* ENTER */ case 27: /* ESCAPE */ case ' ': case KEY_F(F_BACK): case KEY_F(F_EXIT): break; } touchwin(win); refresh_all_windows(main_window); if (res == 10 || res == ' ') { res = item_index(current_item(menu)); break; } else if (res == 27 || res == KEY_F(F_BACK) || res == KEY_F(F_EXIT)) { res = KEY_EXIT; break; } } unpost_menu(menu); free_menu(menu); for (i = 0; i < btn_num; i++) free_item(btns[i]); delwin(win); return res; } int dialog_inputbox(WINDOW *main_window, const char *title, const char *prompt, const char *init, char *result, int result_len) { int prompt_lines = 0; int prompt_width = 0; WINDOW *win; WINDOW *prompt_win; WINDOW *form_win; PANEL *panel; int i, x, y; int res = -1; int cursor_position = strlen(init); /* find the widest line of msg: */ prompt_lines = get_line_no(prompt); for (i = 0; i < prompt_lines; i++) { const char *line = get_line(prompt, i); int len = get_line_length(line); prompt_width = max(prompt_width, len); } if (title) prompt_width = max(prompt_width, strlen(title)); /* place dialog in middle of screen */ y = (LINES-(prompt_lines+4))/2; x = (COLS-(prompt_width+4))/2; strncpy(result, init, result_len); /* create the windows */ win = newwin(prompt_lines+6, prompt_width+7, y, x); prompt_win = derwin(win, prompt_lines+1, prompt_width, 2, 2); form_win = derwin(win, 1, prompt_width, prompt_lines+3, 2); keypad(form_win, TRUE); (void) wattrset(form_win, attributes[INPUT_FIELD]); (void) wattrset(win, attributes[INPUT_BOX]); box(win, 0, 0); (void) wattrset(win, attributes[INPUT_HEADING]); if (title) mvwprintw(win, 0, 3, "%s", title); /* print message */ (void) wattrset(prompt_win, attributes[INPUT_TEXT]); fill_window(prompt_win, prompt); mvwprintw(form_win, 0, 0, "%*s", prompt_width, " "); mvwprintw(form_win, 0, 0, "%s", result); /* create panels */ panel = new_panel(win); /* show the cursor */ curs_set(1); touchwin(win); refresh_all_windows(main_window); while ((res = wgetch(form_win))) { int len = strlen(result); switch (res) { case 10: /* ENTER */ case 27: /* ESCAPE */ case KEY_F(F_HELP): case KEY_F(F_EXIT): case KEY_F(F_BACK): break; case 127: case KEY_BACKSPACE: if (cursor_position > 0) { memmove(&result[cursor_position-1], &result[cursor_position], len-cursor_position+1); cursor_position--; } break; case KEY_DC: if (cursor_position >= 0 && cursor_position < len) { memmove(&result[cursor_position], &result[cursor_position+1], len-cursor_position+1); } break; case KEY_UP: case KEY_RIGHT: if (cursor_position < len && cursor_position < min(result_len, prompt_width)) cursor_position++; break; case KEY_DOWN: case KEY_LEFT: if (cursor_position > 0) cursor_position--; break; default: if ((isgraph(res) || isspace(res)) && len-2 < result_len) { /* insert the char at the proper position */ memmove(&result[cursor_position+1], &result[cursor_position], len+1); result[cursor_position] = res; cursor_position++; } else { mvprintw(0, 0, "unknow key: %d\n", res); } break; } wmove(form_win, 0, 0); wclrtoeol(form_win); mvwprintw(form_win, 0, 0, "%*s", prompt_width, " "); mvwprintw(form_win, 0, 0, "%s", result); wmove(form_win, 0, cursor_position); touchwin(win); refresh_all_windows(main_window); if (res == 10) { res = 0; break; } else if (res == 27 || res == KEY_F(F_BACK) || res == KEY_F(F_EXIT)) { res = KEY_EXIT; break; } else if (res == KEY_F(F_HELP)) { res = 1; break; } } /* hide the cursor */ curs_set(0); del_panel(panel); delwin(prompt_win); delwin(form_win); delwin(win); return res; } /* refresh all windows in the correct order */ void refresh_all_windows(WINDOW *main_window) { update_panels(); touchwin(main_window); refresh(); } /* layman's scrollable window... */ void show_scroll_win(WINDOW *main_window, const char *title, const char *text) { int res; int total_lines = get_line_no(text); int x, y; int start_x = 0, start_y = 0; int text_lines = 0, text_cols = 0; int total_cols = 0; int win_cols = 0; int win_lines = 0; int i = 0; WINDOW *win; WINDOW *pad; PANEL *panel; /* find the widest line of msg: */ total_lines = get_line_no(text); for (i = 0; i < total_lines; i++) { const char *line = get_line(text, i); int len = get_line_length(line); total_cols = max(total_cols, len+2); } /* create the pad */ pad = newpad(total_lines+10, total_cols+10); (void) wattrset(pad, attributes[SCROLLWIN_TEXT]); fill_window(pad, text); win_lines = min(total_lines+4, LINES-2); win_cols = min(total_cols+2, COLS-2); text_lines = max(win_lines-4, 0); text_cols = max(win_cols-2, 0); /* place window in middle of screen */ y = (LINES-win_lines)/2; x = (COLS-win_cols)/2; win = newwin(win_lines, win_cols, y, x); keypad(win, TRUE); /* show the help in the help window, and show the help panel */ (void) wattrset(win, attributes[SCROLLWIN_BOX]); box(win, 0, 0); (void) wattrset(win, attributes[SCROLLWIN_HEADING]); mvwprintw(win, 0, 3, " %s ", title); panel = new_panel(win); /* handle scrolling */ do { copywin(pad, win, start_y, start_x, 2, 2, text_lines, text_cols, 0); print_in_middle(win, text_lines+2, 0, text_cols, "", attributes[DIALOG_MENU_FORE]); wrefresh(win); res = wgetch(win); switch (res) { case KEY_NPAGE: case ' ': start_y += text_lines-2; break; case KEY_PPAGE: start_y -= text_lines+2; break; case KEY_HOME: start_y = 0; break; case KEY_END: start_y = total_lines-text_lines; break; case KEY_DOWN: case 'j': start_y++; break; case KEY_UP: case 'k': start_y--; break; case KEY_LEFT: case 'h': start_x--; break; case KEY_RIGHT: case 'l': start_x++; break; } if (res == 10 || res == 27 || res == 'q' || res == KEY_F(F_BACK) || res == KEY_F(F_EXIT)) { break; } if (start_y < 0) start_y = 0; if (start_y >= total_lines-text_lines) start_y = total_lines-text_lines; if (start_x < 0) start_x = 0; if (start_x >= total_cols-text_cols) start_x = total_cols-text_cols; } while (res); del_panel(panel); delwin(win); refresh_all_windows(main_window); } tinyvisor/bios/tools/kconfig/kxgettext.c0000644006644000001440000001017411733243570021003 0ustar yuichi_xyusers/* * Arnaldo Carvalho de Melo , 2005 * * Released under the terms of the GNU GPL v2.0 */ #include #include #define LKC_DIRECT_LINK #include "lkc.h" static char *escape(const char* text, char *bf, int len) { char *bfp = bf; int multiline = strchr(text, '\n') != NULL; int eol = 0; int textlen = strlen(text); if ((textlen > 0) && (text[textlen-1] == '\n')) eol = 1; *bfp++ = '"'; --len; if (multiline) { *bfp++ = '"'; *bfp++ = '\n'; *bfp++ = '"'; len -= 3; } while (*text != '\0' && len > 1) { if (*text == '"') *bfp++ = '\\'; else if (*text == '\n') { *bfp++ = '\\'; *bfp++ = 'n'; *bfp++ = '"'; *bfp++ = '\n'; *bfp++ = '"'; len -= 5; ++text; goto next; } else if (*text == '\\') { *bfp++ = '\\'; len--; } *bfp++ = *text++; next: --len; } if (multiline && eol) bfp -= 3; *bfp++ = '"'; *bfp = '\0'; return bf; } struct file_line { struct file_line *next; const char *file; int lineno; }; static struct file_line *file_line__new(const char *file, int lineno) { struct file_line *self = malloc(sizeof(*self)); if (self == NULL) goto out; self->file = file; self->lineno = lineno; self->next = NULL; out: return self; } struct message { const char *msg; const char *option; struct message *next; struct file_line *files; }; static struct message *message__list; static struct message *message__new(const char *msg, char *option, const char *file, int lineno) { struct message *self = malloc(sizeof(*self)); if (self == NULL) goto out; self->files = file_line__new(file, lineno); if (self->files == NULL) goto out_fail; self->msg = strdup(msg); if (self->msg == NULL) goto out_fail_msg; self->option = option; self->next = NULL; out: return self; out_fail_msg: free(self->files); out_fail: free(self); self = NULL; goto out; } static struct message *mesage__find(const char *msg) { struct message *m = message__list; while (m != NULL) { if (strcmp(m->msg, msg) == 0) break; m = m->next; } return m; } static int message__add_file_line(struct message *self, const char *file, int lineno) { int rc = -1; struct file_line *fl = file_line__new(file, lineno); if (fl == NULL) goto out; fl->next = self->files; self->files = fl; rc = 0; out: return rc; } static int message__add(const char *msg, char *option, const char *file, int lineno) { int rc = 0; char bf[16384]; char *escaped = escape(msg, bf, sizeof(bf)); struct message *m = mesage__find(escaped); if (m != NULL) rc = message__add_file_line(m, file, lineno); else { m = message__new(escaped, option, file, lineno); if (m != NULL) { m->next = message__list; message__list = m; } else rc = -1; } return rc; } static void menu_build_message_list(struct menu *menu) { struct menu *child; message__add(menu_get_prompt(menu), NULL, menu->file == NULL ? "Root Menu" : menu->file->name, menu->lineno); if (menu->sym != NULL && menu_has_help(menu)) message__add(menu_get_help(menu), menu->sym->name, menu->file == NULL ? "Root Menu" : menu->file->name, menu->lineno); for (child = menu->list; child != NULL; child = child->next) if (child->prompt != NULL) menu_build_message_list(child); } static void message__print_file_lineno(struct message *self) { struct file_line *fl = self->files; putchar('\n'); if (self->option != NULL) printf("# %s:00000\n", self->option); printf("#: %s:%d", fl->file, fl->lineno); fl = fl->next; while (fl != NULL) { printf(", %s:%d", fl->file, fl->lineno); fl = fl->next; } putchar('\n'); } static void message__print_gettext_msgid_msgstr(struct message *self) { message__print_file_lineno(self); printf("msgid %s\n" "msgstr \"\"\n", self->msg); } static void menu__xgettext(void) { struct message *m = message__list; while (m != NULL) { /* skip empty lines ("") */ if (strlen(m->msg) > sizeof("\"\"")) message__print_gettext_msgid_msgstr(m); m = m->next; } } int main(int ac, char **av) { conf_parse(av[1]); menu_build_message_list(menu_get_root_menu(NULL)); menu__xgettext(); return 0; } tinyvisor/bios/tools/kconfig/check.sh0000644006644000001440000000032611733243570020217 0ustar yuichi_xyusers#!/bin/sh # Needed for systems without gettext $* -xc -o /dev/null - > /dev/null 2>&1 << EOF #include int main() { gettext(""); return 0; } EOF if [ ! "$?" -eq "0" ]; then echo -DKBUILD_NO_NLS; fi tinyvisor/bios/tools/kconfig/mconf.c0000644006644000001440000005700311733243570020060 0ustar yuichi_xyusers/* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. * * Introduced single menu mode (show all sub-menus in one large tree). * 2002-11-06 Petr Baudis * * i18n, 2005, Arnaldo Carvalho de Melo */ #include #include #include #include #include #include #include #include #include #define LKC_DIRECT_LINK #include "lkc.h" #include "lxdialog/dialog.h" static const char mconf_readme[] = N_( "Overview\n" "--------\n" "This interface let you select features and parameters for the build.\n" "Features can either be built-in, modularized, or ignored. Parameters\n" "must be entered in as decimal or hexadecimal numbers or text.\n" "\n" "Menu items beginning with following braces represent features that\n" " [ ] can be built in or removed\n" " < > can be built in, modularized or removed\n" " { } can be built in or modularized (selected by other feature)\n" " - - are selected by other feature,\n" "while *, M or whitespace inside braces means to build in, build as\n" "a module or to exclude the feature respectively.\n" "\n" "To change any of these features, highlight it with the cursor\n" "keys and press to build it in, to make it a module or\n" " to removed it. You may also press the to cycle\n" "through the available options (ie. Y->N->M->Y).\n" "\n" "Some additional keyboard hints:\n" "\n" "Menus\n" "----------\n" "o Use the Up/Down arrow keys (cursor keys) to highlight the item\n" " you wish to change or submenu wish to select and press .\n" " Submenus are designated by \"--->\".\n" "\n" " Shortcut: Press the option's highlighted letter (hotkey).\n" " Pressing a hotkey more than once will sequence\n" " through all visible items which use that hotkey.\n" "\n" " You may also use the and keys to scroll\n" " unseen options into view.\n" "\n" "o To exit a menu use the cursor keys to highlight the button\n" " and press .\n" "\n" " Shortcut: Press or or if there is no hotkey\n" " using those letters. You may press a single , but\n" " there is a delayed response which you may find annoying.\n" "\n" " Also, the and cursor keys will cycle between and\n" " \n" "\n" "\n" "Data Entry\n" "-----------\n" "o Enter the requested information and press \n" " If you are entering hexadecimal values, it is not necessary to\n" " add the '0x' prefix to the entry.\n" "\n" "o For help, use the or cursor keys to highlight the help option\n" " and press . You can try as well.\n" "\n" "\n" "Text Box (Help Window)\n" "--------\n" "o Use the cursor keys to scroll up/down/left/right. The VI editor\n" " keys h,j,k,l function here as do and for those\n" " who are familiar with less and lynx.\n" "\n" "o Press , , or to exit.\n" "\n" "\n" "Alternate Configuration Files\n" "-----------------------------\n" "Menuconfig supports the use of alternate configuration files for\n" "those who, for various reasons, find it necessary to switch\n" "between different configurations.\n" "\n" "At the end of the main menu you will find two options. One is\n" "for saving the current configuration to a file of your choosing.\n" "The other option is for loading a previously saved alternate\n" "configuration.\n" "\n" "Even if you don't use alternate configuration files, but you\n" "find during a Menuconfig session that you have completely messed\n" "up your settings, you may use the \"Load Alternate...\" option to\n" "restore your previously saved settings from \".config\" without\n" "restarting Menuconfig.\n" "\n" "Other information\n" "-----------------\n" "If you use Menuconfig in an XTERM window make sure you have your\n" "$TERM variable set to point to a xterm definition which supports color.\n" "Otherwise, Menuconfig will look rather bad. Menuconfig will not\n" "display correctly in a RXVT window because rxvt displays only one\n" "intensity of color, bright.\n" "\n" "Menuconfig will display larger menus on screens or xterms which are\n" "set to display more than the standard 25 row by 80 column geometry.\n" "In order for this to work, the \"stty size\" command must be able to\n" "display the screen's current row and column geometry. I STRONGLY\n" "RECOMMEND that you make sure you do NOT have the shell variables\n" "LINES and COLUMNS exported into your environment. Some distributions\n" "export those variables via /etc/profile. Some ncurses programs can\n" "become confused when those variables (LINES & COLUMNS) don't reflect\n" "the true screen size.\n" "\n" "Optional personality available\n" "------------------------------\n" "If you prefer to have all of the options listed in a single menu, rather\n" "than the default multimenu hierarchy, run the menuconfig with\n" "MENUCONFIG_MODE environment variable set to single_menu. Example:\n" "\n" "make MENUCONFIG_MODE=single_menu menuconfig\n" "\n" " will then unroll the appropriate category, or enfold it if it\n" "is already unrolled.\n" "\n" "Note that this mode can eventually be a little more CPU expensive\n" "(especially with a larger number of unrolled categories) than the\n" "default mode.\n" "\n" "Different color themes available\n" "--------------------------------\n" "It is possible to select different color themes using the variable\n" "MENUCONFIG_COLOR. To select a theme use:\n" "\n" "make MENUCONFIG_COLOR= menuconfig\n" "\n" "Available themes are\n" " mono => selects colors suitable for monochrome displays\n" " blackbg => selects a color scheme with black background\n" " classic => theme with blue background. The classic look\n" " bluetitle => a LCD friendly version of classic. (default)\n" "\n"), menu_instructions[] = N_( "Arrow keys navigate the menu. " " selects submenus --->. " "Highlighted letters are hotkeys. " "Pressing includes, excludes, modularizes features. " "Press to exit, for Help, for Search. " "Legend: [*] built-in [ ] excluded module < > module capable"), radiolist_instructions[] = N_( "Use the arrow keys to navigate this window or " "press the hotkey of the item you wish to select " "followed by the . " "Press for additional information about this option."), inputbox_instructions_int[] = N_( "Please enter a decimal value. " "Fractions will not be accepted. " "Use the key to move from the input field to the buttons below it."), inputbox_instructions_hex[] = N_( "Please enter a hexadecimal value. " "Use the key to move from the input field to the buttons below it."), inputbox_instructions_string[] = N_( "Please enter a string value. " "Use the key to move from the input field to the buttons below it."), setmod_text[] = N_( "This feature depends on another which has been configured as a module.\n" "As a result, this feature will be built as a module."), load_config_text[] = N_( "Enter the name of the configuration file you wish to load. " "Accept the name shown to restore the configuration you " "last retrieved. Leave blank to abort."), load_config_help[] = N_( "\n" "For various reasons, one may wish to keep several different\n" "configurations available on a single machine.\n" "\n" "If you have saved a previous configuration in a file other than the\n" "default one, entering its name here will allow you to modify that\n" "configuration.\n" "\n" "If you are uncertain, then you have probably never used alternate\n" "configuration files. You should therefore leave this blank to abort.\n"), save_config_text[] = N_( "Enter a filename to which this configuration should be saved " "as an alternate. Leave blank to abort."), save_config_help[] = N_( "\n" "For various reasons, one may wish to keep different configurations\n" "available on a single machine.\n" "\n" "Entering a file name here will allow you to later retrieve, modify\n" "and use the current configuration as an alternate to whatever\n" "configuration options you have selected at that time.\n" "\n" "If you are uncertain what all this means then you should probably\n" "leave this blank.\n"), search_help[] = N_( "\n" "Search for symbols and display their relations.\n" "Regular expressions are allowed.\n" "Example: search for \"^FOO\"\n" "Result:\n" "-----------------------------------------------------------------\n" "Symbol: FOO [=m]\n" "Prompt: Foo bus is used to drive the bar HW\n" "Defined at drivers/pci/Kconfig:47\n" "Depends on: X86_LOCAL_APIC && X86_IO_APIC || IA64\n" "Location:\n" " -> Bus options (PCI, PCMCIA, EISA, MCA, ISA)\n" " -> PCI support (PCI [=y])\n" " -> PCI access mode ( [=y])\n" "Selects: LIBCRC32\n" "Selected by: BAR\n" "-----------------------------------------------------------------\n" "o The line 'Prompt:' shows the text used in the menu structure for\n" " this symbol\n" "o The 'Defined at' line tell at what file / line number the symbol\n" " is defined\n" "o The 'Depends on:' line tell what symbols needs to be defined for\n" " this symbol to be visible in the menu (selectable)\n" "o The 'Location:' lines tell where in the menu structure this symbol\n" " is located\n" " A location followed by a [=y] indicate that this is a selectable\n" " menu item - and current value is displayed inside brackets.\n" "o The 'Selects:' line tell what symbol will be automatically\n" " selected if this symbol is selected (y or m)\n" "o The 'Selected by' line tell what symbol has selected this symbol\n" "\n" "Only relevant lines are shown.\n" "\n\n" "Search examples:\n" "Examples: USB => find all symbols containing USB\n" " ^USB => find all symbols starting with USB\n" " USB$ => find all symbols ending with USB\n" "\n"); static int indent; static struct menu *current_menu; static int child_count; static int single_menu_mode; static int show_all_options; static void conf(struct menu *menu); static void conf_choice(struct menu *menu); static void conf_string(struct menu *menu); static void conf_load(void); static void conf_save(void); static void show_textbox(const char *title, const char *text, int r, int c); static void show_helptext(const char *title, const char *text); static void show_help(struct menu *menu); static char filename[PATH_MAX+1]; static void set_config_filename(const char *config_filename) { static char menu_backtitle[PATH_MAX+128]; int size; size = snprintf(menu_backtitle, sizeof(menu_backtitle), "%s - %s", config_filename, rootmenu.prompt->text); if (size >= sizeof(menu_backtitle)) menu_backtitle[sizeof(menu_backtitle)-1] = '\0'; set_dialog_backtitle(menu_backtitle); size = snprintf(filename, sizeof(filename), "%s", config_filename); if (size >= sizeof(filename)) filename[sizeof(filename)-1] = '\0'; } static void search_conf(void) { struct symbol **sym_arr; struct gstr res; char *dialog_input; int dres; again: dialog_clear(); dres = dialog_inputbox(_("Search Configuration Parameter"), _("Enter " CONFIG_ " (sub)string to search for " "(with or without \"" CONFIG_ "\")"), 10, 75, ""); switch (dres) { case 0: break; case 1: show_helptext(_("Search Configuration"), search_help); goto again; default: return; } /* strip the prefix if necessary */ dialog_input = dialog_input_result; if (strncasecmp(dialog_input_result, CONFIG_, strlen(CONFIG_)) == 0) dialog_input += strlen(CONFIG_); sym_arr = sym_re_search(dialog_input); res = get_relations_str(sym_arr); free(sym_arr); show_textbox(_("Search Results"), str_get(&res), 0, 0); str_free(&res); } static void build_conf(struct menu *menu) { struct symbol *sym; struct property *prop; struct menu *child; int type, tmp, doint = 2; tristate val; char ch; bool visible; /* * note: menu_is_visible() has side effect that it will * recalc the value of the symbol. */ visible = menu_is_visible(menu); if (show_all_options && !menu_has_prompt(menu)) return; else if (!show_all_options && !visible) return; sym = menu->sym; prop = menu->prompt; if (!sym) { if (prop && menu != current_menu) { const char *prompt = menu_get_prompt(menu); switch (prop->type) { case P_MENU: child_count++; prompt = _(prompt); if (single_menu_mode) { item_make("%s%*c%s", menu->data ? "-->" : "++>", indent + 1, ' ', prompt); } else item_make(" %*c%s --->", indent + 1, ' ', prompt); item_set_tag('m'); item_set_data(menu); if (single_menu_mode && menu->data) goto conf_childs; return; case P_COMMENT: if (prompt) { child_count++; item_make(" %*c*** %s ***", indent + 1, ' ', _(prompt)); item_set_tag(':'); item_set_data(menu); } break; default: if (prompt) { child_count++; item_make("---%*c%s", indent + 1, ' ', _(prompt)); item_set_tag(':'); item_set_data(menu); } } } else doint = 0; goto conf_childs; } type = sym_get_type(sym); if (sym_is_choice(sym)) { struct symbol *def_sym = sym_get_choice_value(sym); struct menu *def_menu = NULL; child_count++; for (child = menu->list; child; child = child->next) { if (menu_is_visible(child) && child->sym == def_sym) def_menu = child; } val = sym_get_tristate_value(sym); if (sym_is_changable(sym)) { switch (type) { case S_BOOLEAN: item_make("[%c]", val == no ? ' ' : '*'); break; case S_TRISTATE: switch (val) { case yes: ch = '*'; break; case mod: ch = 'M'; break; default: ch = ' '; break; } item_make("<%c>", ch); break; } item_set_tag('t'); item_set_data(menu); } else { item_make(" "); item_set_tag(def_menu ? 't' : ':'); item_set_data(menu); } item_add_str("%*c%s", indent + 1, ' ', _(menu_get_prompt(menu))); if (val == yes) { if (def_menu) { item_add_str(" (%s)", _(menu_get_prompt(def_menu))); item_add_str(" --->"); if (def_menu->list) { indent += 2; build_conf(def_menu); indent -= 2; } } return; } } else { if (menu == current_menu) { item_make("---%*c%s", indent + 1, ' ', _(menu_get_prompt(menu))); item_set_tag(':'); item_set_data(menu); goto conf_childs; } child_count++; val = sym_get_tristate_value(sym); if (sym_is_choice_value(sym) && val == yes) { item_make(" "); item_set_tag(':'); item_set_data(menu); } else { switch (type) { case S_BOOLEAN: if (sym_is_changable(sym)) item_make("[%c]", val == no ? ' ' : '*'); else item_make("-%c-", val == no ? ' ' : '*'); item_set_tag('t'); item_set_data(menu); break; case S_TRISTATE: switch (val) { case yes: ch = '*'; break; case mod: ch = 'M'; break; default: ch = ' '; break; } if (sym_is_changable(sym)) { if (sym->rev_dep.tri == mod) item_make("{%c}", ch); else item_make("<%c>", ch); } else item_make("-%c-", ch); item_set_tag('t'); item_set_data(menu); break; default: tmp = 2 + strlen(sym_get_string_value(sym)); /* () = 2 */ item_make("(%s)", sym_get_string_value(sym)); tmp = indent - tmp + 4; if (tmp < 0) tmp = 0; item_add_str("%*c%s%s", tmp, ' ', _(menu_get_prompt(menu)), (sym_has_value(sym) || !sym_is_changable(sym)) ? "" : _(" (NEW)")); item_set_tag('s'); item_set_data(menu); goto conf_childs; } } item_add_str("%*c%s%s", indent + 1, ' ', _(menu_get_prompt(menu)), (sym_has_value(sym) || !sym_is_changable(sym)) ? "" : _(" (NEW)")); if (menu->prompt->type == P_MENU) { item_add_str(" --->"); return; } } conf_childs: indent += doint; for (child = menu->list; child; child = child->next) build_conf(child); indent -= doint; } static void conf(struct menu *menu) { struct menu *submenu; const char *prompt = menu_get_prompt(menu); struct symbol *sym; struct menu *active_menu = NULL; int res; int s_scroll = 0; while (1) { item_reset(); current_menu = menu; build_conf(menu); if (!child_count) break; if (menu == &rootmenu) { item_make("--- "); item_set_tag(':'); item_make(_(" Load an Alternate Configuration File")); item_set_tag('L'); item_make(_(" Save an Alternate Configuration File")); item_set_tag('S'); } dialog_clear(); res = dialog_menu(prompt ? _(prompt) : _("Main Menu"), _(menu_instructions), active_menu, &s_scroll); if (res == 1 || res == KEY_ESC || res == -ERRDISPLAYTOOSMALL) break; if (!item_activate_selected()) continue; if (!item_tag()) continue; submenu = item_data(); active_menu = item_data(); if (submenu) sym = submenu->sym; else sym = NULL; switch (res) { case 0: switch (item_tag()) { case 'm': if (single_menu_mode) submenu->data = (void *) (long) !submenu->data; else conf(submenu); break; case 't': if (sym_is_choice(sym) && sym_get_tristate_value(sym) == yes) conf_choice(submenu); else if (submenu->prompt->type == P_MENU) conf(submenu); break; case 's': conf_string(submenu); break; case 'L': conf_load(); break; case 'S': conf_save(); break; } break; case 2: if (sym) show_help(submenu); else show_helptext(_("README"), _(mconf_readme)); break; case 3: if (item_is_tag('t')) { if (sym_set_tristate_value(sym, yes)) break; if (sym_set_tristate_value(sym, mod)) show_textbox(NULL, setmod_text, 6, 74); } break; case 4: if (item_is_tag('t')) sym_set_tristate_value(sym, no); break; case 5: if (item_is_tag('t')) sym_set_tristate_value(sym, mod); break; case 6: if (item_is_tag('t')) sym_toggle_tristate_value(sym); else if (item_is_tag('m')) conf(submenu); break; case 7: search_conf(); break; case 8: show_all_options = !show_all_options; break; } } } static void show_textbox(const char *title, const char *text, int r, int c) { dialog_clear(); dialog_textbox(title, text, r, c); } static void show_helptext(const char *title, const char *text) { show_textbox(title, text, 0, 0); } static void show_help(struct menu *menu) { struct gstr help = str_new(); help.max_width = getmaxx(stdscr) - 10; menu_get_ext_help(menu, &help); show_helptext(_(menu_get_prompt(menu)), str_get(&help)); str_free(&help); } static void conf_choice(struct menu *menu) { const char *prompt = _(menu_get_prompt(menu)); struct menu *child; struct symbol *active; active = sym_get_choice_value(menu->sym); while (1) { int res; int selected; item_reset(); current_menu = menu; for (child = menu->list; child; child = child->next) { if (!menu_is_visible(child)) continue; if (child->sym) item_make("%s", _(menu_get_prompt(child))); else { item_make("*** %s ***", _(menu_get_prompt(child))); item_set_tag(':'); } item_set_data(child); if (child->sym == active) item_set_selected(1); if (child->sym == sym_get_choice_value(menu->sym)) item_set_tag('X'); } dialog_clear(); res = dialog_checklist(prompt ? _(prompt) : _("Main Menu"), _(radiolist_instructions), 15, 70, 6); selected = item_activate_selected(); switch (res) { case 0: if (selected) { child = item_data(); if (!child->sym) break; sym_set_tristate_value(child->sym, yes); } return; case 1: if (selected) { child = item_data(); show_help(child); active = child->sym; } else show_help(menu); break; case KEY_ESC: return; case -ERRDISPLAYTOOSMALL: return; } } } static void conf_string(struct menu *menu) { const char *prompt = menu_get_prompt(menu); while (1) { int res; const char *heading; switch (sym_get_type(menu->sym)) { case S_INT: heading = _(inputbox_instructions_int); break; case S_HEX: heading = _(inputbox_instructions_hex); break; case S_STRING: heading = _(inputbox_instructions_string); break; default: heading = _("Internal mconf error!"); } dialog_clear(); res = dialog_inputbox(prompt ? _(prompt) : _("Main Menu"), heading, 10, 75, sym_get_string_value(menu->sym)); switch (res) { case 0: if (sym_set_string_value(menu->sym, dialog_input_result)) return; show_textbox(NULL, _("You have made an invalid entry."), 5, 43); break; case 1: show_help(menu); break; case KEY_ESC: return; } } } static void conf_load(void) { while (1) { int res; dialog_clear(); res = dialog_inputbox(NULL, load_config_text, 11, 55, filename); switch(res) { case 0: if (!dialog_input_result[0]) return; if (!conf_read(dialog_input_result)) { set_config_filename(dialog_input_result); sym_set_change_count(1); return; } show_textbox(NULL, _("File does not exist!"), 5, 38); break; case 1: show_helptext(_("Load Alternate Configuration"), load_config_help); break; case KEY_ESC: return; } } } static void conf_save(void) { while (1) { int res; dialog_clear(); res = dialog_inputbox(NULL, save_config_text, 11, 55, filename); switch(res) { case 0: if (!dialog_input_result[0]) return; if (!conf_write(dialog_input_result)) { set_config_filename(dialog_input_result); return; } show_textbox(NULL, _("Can't create file! Probably a nonexistent directory."), 5, 60); break; case 1: show_helptext(_("Save Alternate Configuration"), save_config_help); break; case KEY_ESC: return; } } } int main(int ac, char **av) { int saved_x, saved_y; char *mode; int res; setlocale(LC_ALL, ""); bindtextdomain(PACKAGE, LOCALEDIR); textdomain(PACKAGE); conf_parse(av[1]); conf_read(NULL); mode = getenv("MENUCONFIG_MODE"); if (mode) { if (!strcasecmp(mode, "single_menu")) single_menu_mode = 1; } initscr(); getyx(stdscr, saved_y, saved_x); if (init_dialog(NULL)) { fprintf(stderr, N_("Your display is too small to run Menuconfig!\n")); fprintf(stderr, N_("It must be at least 19 lines by 80 columns.\n")); return 1; } set_config_filename(conf_get_configname()); do { conf(&rootmenu); dialog_clear(); if (conf_get_changed()) res = dialog_yesno(NULL, _("Do you wish to save your " "new configuration?\n" " to continue."), 6, 60); else res = -1; } while (res == KEY_ESC); end_dialog(saved_x, saved_y); switch (res) { case 0: if (conf_write(filename)) { fprintf(stderr, _("\n\n" "Error while writing of the configuration.\n" "Your configuration changes were NOT saved." "\n\n")); return 1; } case -1: printf(_("\n\n" "*** End of the configuration.\n" "*** Execute 'make' to start the build or try 'make help'." "\n\n")); break; default: fprintf(stderr, _("\n\n" "Your configuration changes were NOT saved." "\n\n")); } return 0; } tinyvisor/bios/tools/kconfig/gconf.c0000644006644000001440000011747011733243570020057 0ustar yuichi_xyusers/* Hey EMACS -*- linux-c -*- */ /* * * Copyright (C) 2002-2003 Romain Lievin * Released under the terms of the GNU GPL v2.0. * */ #ifdef HAVE_CONFIG_H # include #endif #include "lkc.h" #include "images.c" #include #include #include #include #include #include #include #include #include //#define DEBUG enum { SINGLE_VIEW, SPLIT_VIEW, FULL_VIEW }; enum { OPT_NORMAL, OPT_ALL, OPT_PROMPT }; static gint view_mode = FULL_VIEW; static gboolean show_name = TRUE; static gboolean show_range = TRUE; static gboolean show_value = TRUE; static gboolean resizeable = FALSE; static int opt_mode = OPT_NORMAL; GtkWidget *main_wnd = NULL; GtkWidget *tree1_w = NULL; // left frame GtkWidget *tree2_w = NULL; // right frame GtkWidget *text_w = NULL; GtkWidget *hpaned = NULL; GtkWidget *vpaned = NULL; GtkWidget *back_btn = NULL; GtkWidget *save_btn = NULL; GtkWidget *save_menu_item = NULL; GtkTextTag *tag1, *tag2; GdkColor color; GtkTreeStore *tree1, *tree2, *tree; GtkTreeModel *model1, *model2; static GtkTreeIter *parents[256]; static gint indent; static struct menu *current; // current node for SINGLE view static struct menu *browsed; // browsed node for SPLIT view enum { COL_OPTION, COL_NAME, COL_NO, COL_MOD, COL_YES, COL_VALUE, COL_MENU, COL_COLOR, COL_EDIT, COL_PIXBUF, COL_PIXVIS, COL_BTNVIS, COL_BTNACT, COL_BTNINC, COL_BTNRAD, COL_NUMBER }; static void display_list(void); static void display_tree(struct menu *menu); static void display_tree_part(void); static void update_tree(struct menu *src, GtkTreeIter * dst); static void set_node(GtkTreeIter * node, struct menu *menu, gchar ** row); static gchar **fill_row(struct menu *menu); static void conf_changed(void); /* Helping/Debugging Functions */ const char *dbg_sym_flags(int val) { static char buf[256]; bzero(buf, 256); if (val & SYMBOL_CONST) strcat(buf, "const/"); if (val & SYMBOL_CHECK) strcat(buf, "check/"); if (val & SYMBOL_CHOICE) strcat(buf, "choice/"); if (val & SYMBOL_CHOICEVAL) strcat(buf, "choiceval/"); if (val & SYMBOL_VALID) strcat(buf, "valid/"); if (val & SYMBOL_OPTIONAL) strcat(buf, "optional/"); if (val & SYMBOL_WRITE) strcat(buf, "write/"); if (val & SYMBOL_CHANGED) strcat(buf, "changed/"); if (val & SYMBOL_AUTO) strcat(buf, "auto/"); buf[strlen(buf) - 1] = '\0'; return buf; } void replace_button_icon(GladeXML * xml, GdkDrawable * window, GtkStyle * style, gchar * btn_name, gchar ** xpm) { GdkPixmap *pixmap; GdkBitmap *mask; GtkToolButton *button; GtkWidget *image; pixmap = gdk_pixmap_create_from_xpm_d(window, &mask, &style->bg[GTK_STATE_NORMAL], xpm); button = GTK_TOOL_BUTTON(glade_xml_get_widget(xml, btn_name)); image = gtk_image_new_from_pixmap(pixmap, mask); gtk_widget_show(image); gtk_tool_button_set_icon_widget(button, image); } /* Main Window Initialization */ void init_main_window(const gchar * glade_file) { GladeXML *xml; GtkWidget *widget; GtkTextBuffer *txtbuf; GtkStyle *style; xml = glade_xml_new(glade_file, "window1", NULL); if (!xml) g_error(_("GUI loading failed !\n")); glade_xml_signal_autoconnect(xml); main_wnd = glade_xml_get_widget(xml, "window1"); hpaned = glade_xml_get_widget(xml, "hpaned1"); vpaned = glade_xml_get_widget(xml, "vpaned1"); tree1_w = glade_xml_get_widget(xml, "treeview1"); tree2_w = glade_xml_get_widget(xml, "treeview2"); text_w = glade_xml_get_widget(xml, "textview3"); back_btn = glade_xml_get_widget(xml, "button1"); gtk_widget_set_sensitive(back_btn, FALSE); widget = glade_xml_get_widget(xml, "show_name1"); gtk_check_menu_item_set_active((GtkCheckMenuItem *) widget, show_name); widget = glade_xml_get_widget(xml, "show_range1"); gtk_check_menu_item_set_active((GtkCheckMenuItem *) widget, show_range); widget = glade_xml_get_widget(xml, "show_data1"); gtk_check_menu_item_set_active((GtkCheckMenuItem *) widget, show_value); save_btn = glade_xml_get_widget(xml, "button3"); save_menu_item = glade_xml_get_widget(xml, "save1"); conf_set_changed_callback(conf_changed); style = gtk_widget_get_style(main_wnd); widget = glade_xml_get_widget(xml, "toolbar1"); #if 0 /* Use stock Gtk icons instead */ replace_button_icon(xml, main_wnd->window, style, "button1", (gchar **) xpm_back); replace_button_icon(xml, main_wnd->window, style, "button2", (gchar **) xpm_load); replace_button_icon(xml, main_wnd->window, style, "button3", (gchar **) xpm_save); #endif replace_button_icon(xml, main_wnd->window, style, "button4", (gchar **) xpm_single_view); replace_button_icon(xml, main_wnd->window, style, "button5", (gchar **) xpm_split_view); replace_button_icon(xml, main_wnd->window, style, "button6", (gchar **) xpm_tree_view); #if 0 switch (view_mode) { case SINGLE_VIEW: widget = glade_xml_get_widget(xml, "button4"); g_signal_emit_by_name(widget, "clicked"); break; case SPLIT_VIEW: widget = glade_xml_get_widget(xml, "button5"); g_signal_emit_by_name(widget, "clicked"); break; case FULL_VIEW: widget = glade_xml_get_widget(xml, "button6"); g_signal_emit_by_name(widget, "clicked"); break; } #endif txtbuf = gtk_text_view_get_buffer(GTK_TEXT_VIEW(text_w)); tag1 = gtk_text_buffer_create_tag(txtbuf, "mytag1", "foreground", "red", "weight", PANGO_WEIGHT_BOLD, NULL); tag2 = gtk_text_buffer_create_tag(txtbuf, "mytag2", /*"style", PANGO_STYLE_OBLIQUE, */ NULL); gtk_window_set_title(GTK_WINDOW(main_wnd), rootmenu.prompt->text); gtk_widget_show(main_wnd); } void init_tree_model(void) { gint i; tree = tree2 = gtk_tree_store_new(COL_NUMBER, G_TYPE_STRING, G_TYPE_STRING, G_TYPE_STRING, G_TYPE_STRING, G_TYPE_STRING, G_TYPE_STRING, G_TYPE_POINTER, GDK_TYPE_COLOR, G_TYPE_BOOLEAN, GDK_TYPE_PIXBUF, G_TYPE_BOOLEAN, G_TYPE_BOOLEAN, G_TYPE_BOOLEAN, G_TYPE_BOOLEAN, G_TYPE_BOOLEAN); model2 = GTK_TREE_MODEL(tree2); for (parents[0] = NULL, i = 1; i < 256; i++) parents[i] = (GtkTreeIter *) g_malloc(sizeof(GtkTreeIter)); tree1 = gtk_tree_store_new(COL_NUMBER, G_TYPE_STRING, G_TYPE_STRING, G_TYPE_STRING, G_TYPE_STRING, G_TYPE_STRING, G_TYPE_STRING, G_TYPE_POINTER, GDK_TYPE_COLOR, G_TYPE_BOOLEAN, GDK_TYPE_PIXBUF, G_TYPE_BOOLEAN, G_TYPE_BOOLEAN, G_TYPE_BOOLEAN, G_TYPE_BOOLEAN, G_TYPE_BOOLEAN); model1 = GTK_TREE_MODEL(tree1); } void init_left_tree(void) { GtkTreeView *view = GTK_TREE_VIEW(tree1_w); GtkCellRenderer *renderer; GtkTreeSelection *sel; GtkTreeViewColumn *column; gtk_tree_view_set_model(view, model1); gtk_tree_view_set_headers_visible(view, TRUE); gtk_tree_view_set_rules_hint(view, FALSE); column = gtk_tree_view_column_new(); gtk_tree_view_append_column(view, column); gtk_tree_view_column_set_title(column, _("Options")); renderer = gtk_cell_renderer_toggle_new(); gtk_tree_view_column_pack_start(GTK_TREE_VIEW_COLUMN(column), renderer, FALSE); gtk_tree_view_column_set_attributes(GTK_TREE_VIEW_COLUMN(column), renderer, "active", COL_BTNACT, "inconsistent", COL_BTNINC, "visible", COL_BTNVIS, "radio", COL_BTNRAD, NULL); renderer = gtk_cell_renderer_text_new(); gtk_tree_view_column_pack_start(GTK_TREE_VIEW_COLUMN(column), renderer, FALSE); gtk_tree_view_column_set_attributes(GTK_TREE_VIEW_COLUMN(column), renderer, "text", COL_OPTION, "foreground-gdk", COL_COLOR, NULL); sel = gtk_tree_view_get_selection(view); gtk_tree_selection_set_mode(sel, GTK_SELECTION_SINGLE); gtk_widget_realize(tree1_w); } static void renderer_edited(GtkCellRendererText * cell, const gchar * path_string, const gchar * new_text, gpointer user_data); static void renderer_toggled(GtkCellRendererToggle * cellrenderertoggle, gchar * arg1, gpointer user_data); void init_right_tree(void) { GtkTreeView *view = GTK_TREE_VIEW(tree2_w); GtkCellRenderer *renderer; GtkTreeSelection *sel; GtkTreeViewColumn *column; gint i; gtk_tree_view_set_model(view, model2); gtk_tree_view_set_headers_visible(view, TRUE); gtk_tree_view_set_rules_hint(view, FALSE); column = gtk_tree_view_column_new(); gtk_tree_view_append_column(view, column); gtk_tree_view_column_set_title(column, _("Options")); renderer = gtk_cell_renderer_pixbuf_new(); gtk_tree_view_column_pack_start(GTK_TREE_VIEW_COLUMN(column), renderer, FALSE); gtk_tree_view_column_set_attributes(GTK_TREE_VIEW_COLUMN(column), renderer, "pixbuf", COL_PIXBUF, "visible", COL_PIXVIS, NULL); renderer = gtk_cell_renderer_toggle_new(); gtk_tree_view_column_pack_start(GTK_TREE_VIEW_COLUMN(column), renderer, FALSE); gtk_tree_view_column_set_attributes(GTK_TREE_VIEW_COLUMN(column), renderer, "active", COL_BTNACT, "inconsistent", COL_BTNINC, "visible", COL_BTNVIS, "radio", COL_BTNRAD, NULL); /*g_signal_connect(G_OBJECT(renderer), "toggled", G_CALLBACK(renderer_toggled), NULL); */ renderer = gtk_cell_renderer_text_new(); gtk_tree_view_column_pack_start(GTK_TREE_VIEW_COLUMN(column), renderer, FALSE); gtk_tree_view_column_set_attributes(GTK_TREE_VIEW_COLUMN(column), renderer, "text", COL_OPTION, "foreground-gdk", COL_COLOR, NULL); renderer = gtk_cell_renderer_text_new(); gtk_tree_view_insert_column_with_attributes(view, -1, _("Name"), renderer, "text", COL_NAME, "foreground-gdk", COL_COLOR, NULL); renderer = gtk_cell_renderer_text_new(); gtk_tree_view_insert_column_with_attributes(view, -1, "N", renderer, "text", COL_NO, "foreground-gdk", COL_COLOR, NULL); renderer = gtk_cell_renderer_text_new(); gtk_tree_view_insert_column_with_attributes(view, -1, "M", renderer, "text", COL_MOD, "foreground-gdk", COL_COLOR, NULL); renderer = gtk_cell_renderer_text_new(); gtk_tree_view_insert_column_with_attributes(view, -1, "Y", renderer, "text", COL_YES, "foreground-gdk", COL_COLOR, NULL); renderer = gtk_cell_renderer_text_new(); gtk_tree_view_insert_column_with_attributes(view, -1, _("Value"), renderer, "text", COL_VALUE, "editable", COL_EDIT, "foreground-gdk", COL_COLOR, NULL); g_signal_connect(G_OBJECT(renderer), "edited", G_CALLBACK(renderer_edited), NULL); column = gtk_tree_view_get_column(view, COL_NAME); gtk_tree_view_column_set_visible(column, show_name); column = gtk_tree_view_get_column(view, COL_NO); gtk_tree_view_column_set_visible(column, show_range); column = gtk_tree_view_get_column(view, COL_MOD); gtk_tree_view_column_set_visible(column, show_range); column = gtk_tree_view_get_column(view, COL_YES); gtk_tree_view_column_set_visible(column, show_range); column = gtk_tree_view_get_column(view, COL_VALUE); gtk_tree_view_column_set_visible(column, show_value); if (resizeable) { for (i = 0; i < COL_VALUE; i++) { column = gtk_tree_view_get_column(view, i); gtk_tree_view_column_set_resizable(column, TRUE); } } sel = gtk_tree_view_get_selection(view); gtk_tree_selection_set_mode(sel, GTK_SELECTION_SINGLE); } /* Utility Functions */ static void text_insert_help(struct menu *menu) { GtkTextBuffer *buffer; GtkTextIter start, end; const char *prompt = _(menu_get_prompt(menu)); struct gstr help = str_new(); menu_get_ext_help(menu, &help); buffer = gtk_text_view_get_buffer(GTK_TEXT_VIEW(text_w)); gtk_text_buffer_get_bounds(buffer, &start, &end); gtk_text_buffer_delete(buffer, &start, &end); gtk_text_view_set_left_margin(GTK_TEXT_VIEW(text_w), 15); gtk_text_buffer_get_end_iter(buffer, &end); gtk_text_buffer_insert_with_tags(buffer, &end, prompt, -1, tag1, NULL); gtk_text_buffer_insert_at_cursor(buffer, "\n\n", 2); gtk_text_buffer_get_end_iter(buffer, &end); gtk_text_buffer_insert_with_tags(buffer, &end, str_get(&help), -1, tag2, NULL); str_free(&help); } static void text_insert_msg(const char *title, const char *message) { GtkTextBuffer *buffer; GtkTextIter start, end; const char *msg = message; buffer = gtk_text_view_get_buffer(GTK_TEXT_VIEW(text_w)); gtk_text_buffer_get_bounds(buffer, &start, &end); gtk_text_buffer_delete(buffer, &start, &end); gtk_text_view_set_left_margin(GTK_TEXT_VIEW(text_w), 15); gtk_text_buffer_get_end_iter(buffer, &end); gtk_text_buffer_insert_with_tags(buffer, &end, title, -1, tag1, NULL); gtk_text_buffer_insert_at_cursor(buffer, "\n\n", 2); gtk_text_buffer_get_end_iter(buffer, &end); gtk_text_buffer_insert_with_tags(buffer, &end, msg, -1, tag2, NULL); } /* Main Windows Callbacks */ void on_save_activate(GtkMenuItem * menuitem, gpointer user_data); gboolean on_window1_delete_event(GtkWidget * widget, GdkEvent * event, gpointer user_data) { GtkWidget *dialog, *label; gint result; if (!conf_get_changed()) return FALSE; dialog = gtk_dialog_new_with_buttons(_("Warning !"), GTK_WINDOW(main_wnd), (GtkDialogFlags) (GTK_DIALOG_MODAL | GTK_DIALOG_DESTROY_WITH_PARENT), GTK_STOCK_OK, GTK_RESPONSE_YES, GTK_STOCK_NO, GTK_RESPONSE_NO, GTK_STOCK_CANCEL, GTK_RESPONSE_CANCEL, NULL); gtk_dialog_set_default_response(GTK_DIALOG(dialog), GTK_RESPONSE_CANCEL); label = gtk_label_new(_("\nSave configuration ?\n")); gtk_container_add(GTK_CONTAINER(GTK_DIALOG(dialog)->vbox), label); gtk_widget_show(label); result = gtk_dialog_run(GTK_DIALOG(dialog)); switch (result) { case GTK_RESPONSE_YES: on_save_activate(NULL, NULL); return FALSE; case GTK_RESPONSE_NO: return FALSE; case GTK_RESPONSE_CANCEL: case GTK_RESPONSE_DELETE_EVENT: default: gtk_widget_destroy(dialog); return TRUE; } return FALSE; } void on_window1_destroy(GtkObject * object, gpointer user_data) { gtk_main_quit(); } void on_window1_size_request(GtkWidget * widget, GtkRequisition * requisition, gpointer user_data) { static gint old_h; gint w, h; if (widget->window == NULL) gtk_window_get_default_size(GTK_WINDOW(main_wnd), &w, &h); else gdk_window_get_size(widget->window, &w, &h); if (h == old_h) return; old_h = h; gtk_paned_set_position(GTK_PANED(vpaned), 2 * h / 3); } /* Menu & Toolbar Callbacks */ static void load_filename(GtkFileSelection * file_selector, gpointer user_data) { const gchar *fn; fn = gtk_file_selection_get_filename(GTK_FILE_SELECTION (user_data)); if (conf_read(fn)) text_insert_msg(_("Error"), _("Unable to load configuration !")); else display_tree(&rootmenu); } void on_load1_activate(GtkMenuItem * menuitem, gpointer user_data) { GtkWidget *fs; fs = gtk_file_selection_new(_("Load file...")); g_signal_connect(GTK_OBJECT(GTK_FILE_SELECTION(fs)->ok_button), "clicked", G_CALLBACK(load_filename), (gpointer) fs); g_signal_connect_swapped(GTK_OBJECT (GTK_FILE_SELECTION(fs)->ok_button), "clicked", G_CALLBACK(gtk_widget_destroy), (gpointer) fs); g_signal_connect_swapped(GTK_OBJECT (GTK_FILE_SELECTION(fs)->cancel_button), "clicked", G_CALLBACK(gtk_widget_destroy), (gpointer) fs); gtk_widget_show(fs); } void on_save_activate(GtkMenuItem * menuitem, gpointer user_data) { if (conf_write(NULL)) text_insert_msg(_("Error"), _("Unable to save configuration !")); } static void store_filename(GtkFileSelection * file_selector, gpointer user_data) { const gchar *fn; fn = gtk_file_selection_get_filename(GTK_FILE_SELECTION (user_data)); if (conf_write(fn)) text_insert_msg(_("Error"), _("Unable to save configuration !")); gtk_widget_destroy(GTK_WIDGET(user_data)); } void on_save_as1_activate(GtkMenuItem * menuitem, gpointer user_data) { GtkWidget *fs; fs = gtk_file_selection_new(_("Save file as...")); g_signal_connect(GTK_OBJECT(GTK_FILE_SELECTION(fs)->ok_button), "clicked", G_CALLBACK(store_filename), (gpointer) fs); g_signal_connect_swapped(GTK_OBJECT (GTK_FILE_SELECTION(fs)->ok_button), "clicked", G_CALLBACK(gtk_widget_destroy), (gpointer) fs); g_signal_connect_swapped(GTK_OBJECT (GTK_FILE_SELECTION(fs)->cancel_button), "clicked", G_CALLBACK(gtk_widget_destroy), (gpointer) fs); gtk_widget_show(fs); } void on_quit1_activate(GtkMenuItem * menuitem, gpointer user_data) { if (!on_window1_delete_event(NULL, NULL, NULL)) gtk_widget_destroy(GTK_WIDGET(main_wnd)); } void on_show_name1_activate(GtkMenuItem * menuitem, gpointer user_data) { GtkTreeViewColumn *col; show_name = GTK_CHECK_MENU_ITEM(menuitem)->active; col = gtk_tree_view_get_column(GTK_TREE_VIEW(tree2_w), COL_NAME); if (col) gtk_tree_view_column_set_visible(col, show_name); } void on_show_range1_activate(GtkMenuItem * menuitem, gpointer user_data) { GtkTreeViewColumn *col; show_range = GTK_CHECK_MENU_ITEM(menuitem)->active; col = gtk_tree_view_get_column(GTK_TREE_VIEW(tree2_w), COL_NO); if (col) gtk_tree_view_column_set_visible(col, show_range); col = gtk_tree_view_get_column(GTK_TREE_VIEW(tree2_w), COL_MOD); if (col) gtk_tree_view_column_set_visible(col, show_range); col = gtk_tree_view_get_column(GTK_TREE_VIEW(tree2_w), COL_YES); if (col) gtk_tree_view_column_set_visible(col, show_range); } void on_show_data1_activate(GtkMenuItem * menuitem, gpointer user_data) { GtkTreeViewColumn *col; show_value = GTK_CHECK_MENU_ITEM(menuitem)->active; col = gtk_tree_view_get_column(GTK_TREE_VIEW(tree2_w), COL_VALUE); if (col) gtk_tree_view_column_set_visible(col, show_value); } void on_set_option_mode1_activate(GtkMenuItem *menuitem, gpointer user_data) { opt_mode = OPT_NORMAL; gtk_tree_store_clear(tree2); display_tree(&rootmenu); /* instead of update_tree to speed-up */ } void on_set_option_mode2_activate(GtkMenuItem *menuitem, gpointer user_data) { opt_mode = OPT_ALL; gtk_tree_store_clear(tree2); display_tree(&rootmenu); /* instead of update_tree to speed-up */ } void on_set_option_mode3_activate(GtkMenuItem *menuitem, gpointer user_data) { opt_mode = OPT_PROMPT; gtk_tree_store_clear(tree2); display_tree(&rootmenu); /* instead of update_tree to speed-up */ } void on_introduction1_activate(GtkMenuItem * menuitem, gpointer user_data) { GtkWidget *dialog; const gchar *intro_text = _( "Welcome to gkc, the GTK+ graphical configuration tool\n" "For each option, a blank box indicates the feature is disabled, a\n" "check indicates it is enabled, and a dot indicates that it is to\n" "be compiled as a module. Clicking on the box will cycle through the three states.\n" "\n" "If you do not see an option (e.g., a device driver) that you\n" "believe should be present, try turning on Show All Options\n" "under the Options menu.\n" "Although there is no cross reference yet to help you figure out\n" "what other options must be enabled to support the option you\n" "are interested in, you can still view the help of a grayed-out\n" "option.\n" "\n" "Toggling Show Debug Info under the Options menu will show \n" "the dependencies, which you can then match by examining other options."); dialog = gtk_message_dialog_new(GTK_WINDOW(main_wnd), GTK_DIALOG_DESTROY_WITH_PARENT, GTK_MESSAGE_INFO, GTK_BUTTONS_CLOSE, intro_text); g_signal_connect_swapped(GTK_OBJECT(dialog), "response", G_CALLBACK(gtk_widget_destroy), GTK_OBJECT(dialog)); gtk_widget_show_all(dialog); } void on_about1_activate(GtkMenuItem * menuitem, gpointer user_data) { GtkWidget *dialog; const gchar *about_text = _("gkc is copyright (c) 2002 Romain Lievin .\n" "Based on the source code from Roman Zippel.\n"); dialog = gtk_message_dialog_new(GTK_WINDOW(main_wnd), GTK_DIALOG_DESTROY_WITH_PARENT, GTK_MESSAGE_INFO, GTK_BUTTONS_CLOSE, about_text); g_signal_connect_swapped(GTK_OBJECT(dialog), "response", G_CALLBACK(gtk_widget_destroy), GTK_OBJECT(dialog)); gtk_widget_show_all(dialog); } void on_license1_activate(GtkMenuItem * menuitem, gpointer user_data) { GtkWidget *dialog; const gchar *license_text = _("gkc is released under the terms of the GNU GPL v2.\n" "For more information, please see the source code or\n" "visit http://www.fsf.org/licenses/licenses.html\n"); dialog = gtk_message_dialog_new(GTK_WINDOW(main_wnd), GTK_DIALOG_DESTROY_WITH_PARENT, GTK_MESSAGE_INFO, GTK_BUTTONS_CLOSE, license_text); g_signal_connect_swapped(GTK_OBJECT(dialog), "response", G_CALLBACK(gtk_widget_destroy), GTK_OBJECT(dialog)); gtk_widget_show_all(dialog); } void on_back_clicked(GtkButton * button, gpointer user_data) { enum prop_type ptype; current = current->parent; ptype = current->prompt ? current->prompt->type : P_UNKNOWN; if (ptype != P_MENU) current = current->parent; display_tree_part(); if (current == &rootmenu) gtk_widget_set_sensitive(back_btn, FALSE); } void on_load_clicked(GtkButton * button, gpointer user_data) { on_load1_activate(NULL, user_data); } void on_single_clicked(GtkButton * button, gpointer user_data) { view_mode = SINGLE_VIEW; gtk_paned_set_position(GTK_PANED(hpaned), 0); gtk_widget_hide(tree1_w); current = &rootmenu; display_tree_part(); } void on_split_clicked(GtkButton * button, gpointer user_data) { gint w, h; view_mode = SPLIT_VIEW; gtk_widget_show(tree1_w); gtk_window_get_default_size(GTK_WINDOW(main_wnd), &w, &h); gtk_paned_set_position(GTK_PANED(hpaned), w / 2); if (tree2) gtk_tree_store_clear(tree2); display_list(); /* Disable back btn, like in full mode. */ gtk_widget_set_sensitive(back_btn, FALSE); } void on_full_clicked(GtkButton * button, gpointer user_data) { view_mode = FULL_VIEW; gtk_paned_set_position(GTK_PANED(hpaned), 0); gtk_widget_hide(tree1_w); if (tree2) gtk_tree_store_clear(tree2); display_tree(&rootmenu); gtk_widget_set_sensitive(back_btn, FALSE); } void on_collapse_clicked(GtkButton * button, gpointer user_data) { gtk_tree_view_collapse_all(GTK_TREE_VIEW(tree2_w)); } void on_expand_clicked(GtkButton * button, gpointer user_data) { gtk_tree_view_expand_all(GTK_TREE_VIEW(tree2_w)); } /* CTree Callbacks */ /* Change hex/int/string value in the cell */ static void renderer_edited(GtkCellRendererText * cell, const gchar * path_string, const gchar * new_text, gpointer user_data) { GtkTreePath *path = gtk_tree_path_new_from_string(path_string); GtkTreeIter iter; const char *old_def, *new_def; struct menu *menu; struct symbol *sym; if (!gtk_tree_model_get_iter(model2, &iter, path)) return; gtk_tree_model_get(model2, &iter, COL_MENU, &menu, -1); sym = menu->sym; gtk_tree_model_get(model2, &iter, COL_VALUE, &old_def, -1); new_def = new_text; sym_set_string_value(sym, new_def); update_tree(&rootmenu, NULL); gtk_tree_path_free(path); } /* Change the value of a symbol and update the tree */ static void change_sym_value(struct menu *menu, gint col) { struct symbol *sym = menu->sym; tristate oldval, newval; if (!sym) return; if (col == COL_NO) newval = no; else if (col == COL_MOD) newval = mod; else if (col == COL_YES) newval = yes; else return; switch (sym_get_type(sym)) { case S_BOOLEAN: case S_TRISTATE: oldval = sym_get_tristate_value(sym); if (!sym_tristate_within_range(sym, newval)) newval = yes; sym_set_tristate_value(sym, newval); if (view_mode == FULL_VIEW) update_tree(&rootmenu, NULL); else if (view_mode == SPLIT_VIEW) { update_tree(browsed, NULL); display_list(); } else if (view_mode == SINGLE_VIEW) display_tree_part(); //fixme: keep exp/coll break; case S_INT: case S_HEX: case S_STRING: default: break; } } static void toggle_sym_value(struct menu *menu) { if (!menu->sym) return; sym_toggle_tristate_value(menu->sym); if (view_mode == FULL_VIEW) update_tree(&rootmenu, NULL); else if (view_mode == SPLIT_VIEW) { update_tree(browsed, NULL); display_list(); } else if (view_mode == SINGLE_VIEW) display_tree_part(); //fixme: keep exp/coll } static void renderer_toggled(GtkCellRendererToggle * cell, gchar * path_string, gpointer user_data) { GtkTreePath *path, *sel_path = NULL; GtkTreeIter iter, sel_iter; GtkTreeSelection *sel; struct menu *menu; path = gtk_tree_path_new_from_string(path_string); if (!gtk_tree_model_get_iter(model2, &iter, path)) return; sel = gtk_tree_view_get_selection(GTK_TREE_VIEW(tree2_w)); if (gtk_tree_selection_get_selected(sel, NULL, &sel_iter)) sel_path = gtk_tree_model_get_path(model2, &sel_iter); if (!sel_path) goto out1; if (gtk_tree_path_compare(path, sel_path)) goto out2; gtk_tree_model_get(model2, &iter, COL_MENU, &menu, -1); toggle_sym_value(menu); out2: gtk_tree_path_free(sel_path); out1: gtk_tree_path_free(path); } static gint column2index(GtkTreeViewColumn * column) { gint i; for (i = 0; i < COL_NUMBER; i++) { GtkTreeViewColumn *col; col = gtk_tree_view_get_column(GTK_TREE_VIEW(tree2_w), i); if (col == column) return i; } return -1; } /* User click: update choice (full) or goes down (single) */ gboolean on_treeview2_button_press_event(GtkWidget * widget, GdkEventButton * event, gpointer user_data) { GtkTreeView *view = GTK_TREE_VIEW(widget); GtkTreePath *path; GtkTreeViewColumn *column; GtkTreeIter iter; struct menu *menu; gint col; #if GTK_CHECK_VERSION(2,1,4) // bug in ctree with earlier version of GTK gint tx = (gint) event->x; gint ty = (gint) event->y; gint cx, cy; gtk_tree_view_get_path_at_pos(view, tx, ty, &path, &column, &cx, &cy); #else gtk_tree_view_get_cursor(view, &path, &column); #endif if (path == NULL) return FALSE; if (!gtk_tree_model_get_iter(model2, &iter, path)) return FALSE; gtk_tree_model_get(model2, &iter, COL_MENU, &menu, -1); col = column2index(column); if (event->type == GDK_2BUTTON_PRESS) { enum prop_type ptype; ptype = menu->prompt ? menu->prompt->type : P_UNKNOWN; if (ptype == P_MENU && view_mode != FULL_VIEW && col == COL_OPTION) { // goes down into menu current = menu; display_tree_part(); gtk_widget_set_sensitive(back_btn, TRUE); } else if ((col == COL_OPTION)) { toggle_sym_value(menu); gtk_tree_view_expand_row(view, path, TRUE); } } else { if (col == COL_VALUE) { toggle_sym_value(menu); gtk_tree_view_expand_row(view, path, TRUE); } else if (col == COL_NO || col == COL_MOD || col == COL_YES) { change_sym_value(menu, col); gtk_tree_view_expand_row(view, path, TRUE); } } return FALSE; } /* Key pressed: update choice */ gboolean on_treeview2_key_press_event(GtkWidget * widget, GdkEventKey * event, gpointer user_data) { GtkTreeView *view = GTK_TREE_VIEW(widget); GtkTreePath *path; GtkTreeViewColumn *column; GtkTreeIter iter; struct menu *menu; gint col; gtk_tree_view_get_cursor(view, &path, &column); if (path == NULL) return FALSE; if (event->keyval == GDK_space) { if (gtk_tree_view_row_expanded(view, path)) gtk_tree_view_collapse_row(view, path); else gtk_tree_view_expand_row(view, path, FALSE); return TRUE; } if (event->keyval == GDK_KP_Enter) { } if (widget == tree1_w) return FALSE; gtk_tree_model_get_iter(model2, &iter, path); gtk_tree_model_get(model2, &iter, COL_MENU, &menu, -1); if (!strcasecmp(event->string, "n")) col = COL_NO; else if (!strcasecmp(event->string, "m")) col = COL_MOD; else if (!strcasecmp(event->string, "y")) col = COL_YES; else col = -1; change_sym_value(menu, col); return FALSE; } /* Row selection changed: update help */ void on_treeview2_cursor_changed(GtkTreeView * treeview, gpointer user_data) { GtkTreeSelection *selection; GtkTreeIter iter; struct menu *menu; selection = gtk_tree_view_get_selection(treeview); if (gtk_tree_selection_get_selected(selection, &model2, &iter)) { gtk_tree_model_get(model2, &iter, COL_MENU, &menu, -1); text_insert_help(menu); } } /* User click: display sub-tree in the right frame. */ gboolean on_treeview1_button_press_event(GtkWidget * widget, GdkEventButton * event, gpointer user_data) { GtkTreeView *view = GTK_TREE_VIEW(widget); GtkTreePath *path; GtkTreeViewColumn *column; GtkTreeIter iter; struct menu *menu; gint tx = (gint) event->x; gint ty = (gint) event->y; gint cx, cy; gtk_tree_view_get_path_at_pos(view, tx, ty, &path, &column, &cx, &cy); if (path == NULL) return FALSE; gtk_tree_model_get_iter(model1, &iter, path); gtk_tree_model_get(model1, &iter, COL_MENU, &menu, -1); if (event->type == GDK_2BUTTON_PRESS) { toggle_sym_value(menu); current = menu; display_tree_part(); } else { browsed = menu; display_tree_part(); } gtk_widget_realize(tree2_w); gtk_tree_view_set_cursor(view, path, NULL, FALSE); gtk_widget_grab_focus(tree2_w); return FALSE; } /* Fill a row of strings */ static gchar **fill_row(struct menu *menu) { static gchar *row[COL_NUMBER]; struct symbol *sym = menu->sym; const char *def; int stype; tristate val; enum prop_type ptype; int i; for (i = COL_OPTION; i <= COL_COLOR; i++) g_free(row[i]); bzero(row, sizeof(row)); row[COL_OPTION] = g_strdup_printf("%s %s", _(menu_get_prompt(menu)), sym && !sym_has_value(sym) ? "(NEW)" : ""); if (opt_mode == OPT_ALL && !menu_is_visible(menu)) row[COL_COLOR] = g_strdup("DarkGray"); else if (opt_mode == OPT_PROMPT && menu_has_prompt(menu) && !menu_is_visible(menu)) row[COL_COLOR] = g_strdup("DarkGray"); else row[COL_COLOR] = g_strdup("Black"); ptype = menu->prompt ? menu->prompt->type : P_UNKNOWN; switch (ptype) { case P_MENU: row[COL_PIXBUF] = (gchar *) xpm_menu; if (view_mode == SINGLE_VIEW) row[COL_PIXVIS] = GINT_TO_POINTER(TRUE); row[COL_BTNVIS] = GINT_TO_POINTER(FALSE); break; case P_COMMENT: row[COL_PIXBUF] = (gchar *) xpm_void; row[COL_PIXVIS] = GINT_TO_POINTER(FALSE); row[COL_BTNVIS] = GINT_TO_POINTER(FALSE); break; default: row[COL_PIXBUF] = (gchar *) xpm_void; row[COL_PIXVIS] = GINT_TO_POINTER(FALSE); row[COL_BTNVIS] = GINT_TO_POINTER(TRUE); break; } if (!sym) return row; row[COL_NAME] = g_strdup(sym->name); sym_calc_value(sym); sym->flags &= ~SYMBOL_CHANGED; if (sym_is_choice(sym)) { // parse childs for getting final value struct menu *child; struct symbol *def_sym = sym_get_choice_value(sym); struct menu *def_menu = NULL; row[COL_BTNVIS] = GINT_TO_POINTER(FALSE); for (child = menu->list; child; child = child->next) { if (menu_is_visible(child) && child->sym == def_sym) def_menu = child; } if (def_menu) row[COL_VALUE] = g_strdup(_(menu_get_prompt(def_menu))); } if (sym->flags & SYMBOL_CHOICEVAL) row[COL_BTNRAD] = GINT_TO_POINTER(TRUE); stype = sym_get_type(sym); switch (stype) { case S_BOOLEAN: if (GPOINTER_TO_INT(row[COL_PIXVIS]) == FALSE) row[COL_BTNVIS] = GINT_TO_POINTER(TRUE); if (sym_is_choice(sym)) break; case S_TRISTATE: val = sym_get_tristate_value(sym); switch (val) { case no: row[COL_NO] = g_strdup("N"); row[COL_VALUE] = g_strdup("N"); row[COL_BTNACT] = GINT_TO_POINTER(FALSE); row[COL_BTNINC] = GINT_TO_POINTER(FALSE); break; case mod: row[COL_MOD] = g_strdup("M"); row[COL_VALUE] = g_strdup("M"); row[COL_BTNINC] = GINT_TO_POINTER(TRUE); break; case yes: row[COL_YES] = g_strdup("Y"); row[COL_VALUE] = g_strdup("Y"); row[COL_BTNACT] = GINT_TO_POINTER(TRUE); row[COL_BTNINC] = GINT_TO_POINTER(FALSE); break; } if (val != no && sym_tristate_within_range(sym, no)) row[COL_NO] = g_strdup("_"); if (val != mod && sym_tristate_within_range(sym, mod)) row[COL_MOD] = g_strdup("_"); if (val != yes && sym_tristate_within_range(sym, yes)) row[COL_YES] = g_strdup("_"); break; case S_INT: case S_HEX: case S_STRING: def = sym_get_string_value(sym); row[COL_VALUE] = g_strdup(def); row[COL_EDIT] = GINT_TO_POINTER(TRUE); row[COL_BTNVIS] = GINT_TO_POINTER(FALSE); break; } return row; } /* Set the node content with a row of strings */ static void set_node(GtkTreeIter * node, struct menu *menu, gchar ** row) { GdkColor color; gboolean success; GdkPixbuf *pix; pix = gdk_pixbuf_new_from_xpm_data((const char **) row[COL_PIXBUF]); gdk_color_parse(row[COL_COLOR], &color); gdk_colormap_alloc_colors(gdk_colormap_get_system(), &color, 1, FALSE, FALSE, &success); gtk_tree_store_set(tree, node, COL_OPTION, row[COL_OPTION], COL_NAME, row[COL_NAME], COL_NO, row[COL_NO], COL_MOD, row[COL_MOD], COL_YES, row[COL_YES], COL_VALUE, row[COL_VALUE], COL_MENU, (gpointer) menu, COL_COLOR, &color, COL_EDIT, GPOINTER_TO_INT(row[COL_EDIT]), COL_PIXBUF, pix, COL_PIXVIS, GPOINTER_TO_INT(row[COL_PIXVIS]), COL_BTNVIS, GPOINTER_TO_INT(row[COL_BTNVIS]), COL_BTNACT, GPOINTER_TO_INT(row[COL_BTNACT]), COL_BTNINC, GPOINTER_TO_INT(row[COL_BTNINC]), COL_BTNRAD, GPOINTER_TO_INT(row[COL_BTNRAD]), -1); g_object_unref(pix); } /* Add a node to the tree */ static void place_node(struct menu *menu, char **row) { GtkTreeIter *parent = parents[indent - 1]; GtkTreeIter *node = parents[indent]; gtk_tree_store_append(tree, node, parent); set_node(node, menu, row); } /* Find a node in the GTK+ tree */ static GtkTreeIter found; /* * Find a menu in the GtkTree starting at parent. */ GtkTreeIter *gtktree_iter_find_node(GtkTreeIter * parent, struct menu *tofind) { GtkTreeIter iter; GtkTreeIter *child = &iter; gboolean valid; GtkTreeIter *ret; valid = gtk_tree_model_iter_children(model2, child, parent); while (valid) { struct menu *menu; gtk_tree_model_get(model2, child, 6, &menu, -1); if (menu == tofind) { memcpy(&found, child, sizeof(GtkTreeIter)); return &found; } ret = gtktree_iter_find_node(child, tofind); if (ret) return ret; valid = gtk_tree_model_iter_next(model2, child); } return NULL; } /* * Update the tree by adding/removing entries * Does not change other nodes */ static void update_tree(struct menu *src, GtkTreeIter * dst) { struct menu *child1; GtkTreeIter iter, tmp; GtkTreeIter *child2 = &iter; gboolean valid; GtkTreeIter *sibling; struct symbol *sym; struct property *prop; struct menu *menu1, *menu2; if (src == &rootmenu) indent = 1; valid = gtk_tree_model_iter_children(model2, child2, dst); for (child1 = src->list; child1; child1 = child1->next) { prop = child1->prompt; sym = child1->sym; reparse: menu1 = child1; if (valid) gtk_tree_model_get(model2, child2, COL_MENU, &menu2, -1); else menu2 = NULL; // force adding of a first child #ifdef DEBUG printf("%*c%s | %s\n", indent, ' ', menu1 ? menu_get_prompt(menu1) : "nil", menu2 ? menu_get_prompt(menu2) : "nil"); #endif if ((opt_mode == OPT_NORMAL && !menu_is_visible(child1)) || (opt_mode == OPT_PROMPT && !menu_has_prompt(child1)) || (opt_mode == OPT_ALL && !menu_get_prompt(child1))) { /* remove node */ if (gtktree_iter_find_node(dst, menu1) != NULL) { memcpy(&tmp, child2, sizeof(GtkTreeIter)); valid = gtk_tree_model_iter_next(model2, child2); gtk_tree_store_remove(tree2, &tmp); if (!valid) return; /* next parent */ else goto reparse; /* next child */ } else continue; } if (menu1 != menu2) { if (gtktree_iter_find_node(dst, menu1) == NULL) { // add node if (!valid && !menu2) sibling = NULL; else sibling = child2; gtk_tree_store_insert_before(tree2, child2, dst, sibling); set_node(child2, menu1, fill_row(menu1)); if (menu2 == NULL) valid = TRUE; } else { // remove node memcpy(&tmp, child2, sizeof(GtkTreeIter)); valid = gtk_tree_model_iter_next(model2, child2); gtk_tree_store_remove(tree2, &tmp); if (!valid) return; // next parent else goto reparse; // next child } } else if (sym && (sym->flags & SYMBOL_CHANGED)) { set_node(child2, menu1, fill_row(menu1)); } indent++; update_tree(child1, child2); indent--; valid = gtk_tree_model_iter_next(model2, child2); } } /* Display the whole tree (single/split/full view) */ static void display_tree(struct menu *menu) { struct symbol *sym; struct property *prop; struct menu *child; enum prop_type ptype; if (menu == &rootmenu) { indent = 1; current = &rootmenu; } for (child = menu->list; child; child = child->next) { prop = child->prompt; sym = child->sym; ptype = prop ? prop->type : P_UNKNOWN; if (sym) sym->flags &= ~SYMBOL_CHANGED; if ((view_mode == SPLIT_VIEW) && !(child->flags & MENU_ROOT) && (tree == tree1)) continue; if ((view_mode == SPLIT_VIEW) && (child->flags & MENU_ROOT) && (tree == tree2)) continue; if ((opt_mode == OPT_NORMAL && menu_is_visible(child)) || (opt_mode == OPT_PROMPT && menu_has_prompt(child)) || (opt_mode == OPT_ALL && menu_get_prompt(child))) place_node(child, fill_row(child)); #ifdef DEBUG printf("%*c%s: ", indent, ' ', menu_get_prompt(child)); printf("%s", child->flags & MENU_ROOT ? "rootmenu | " : ""); printf("%s", prop_get_type_name(ptype)); printf(" | "); if (sym) { printf("%s", sym_type_name(sym->type)); printf(" | "); printf("%s", dbg_sym_flags(sym->flags)); printf("\n"); } else printf("\n"); #endif if ((view_mode != FULL_VIEW) && (ptype == P_MENU) && (tree == tree2)) continue; /* if (((menu != &rootmenu) && !(menu->flags & MENU_ROOT)) || (view_mode == FULL_VIEW) || (view_mode == SPLIT_VIEW))*/ if (((view_mode == SINGLE_VIEW) && (menu->flags & MENU_ROOT)) || (view_mode == FULL_VIEW) || (view_mode == SPLIT_VIEW)) { indent++; display_tree(child); indent--; } } } /* Display a part of the tree starting at current node (single/split view) */ static void display_tree_part(void) { if (tree2) gtk_tree_store_clear(tree2); if (view_mode == SINGLE_VIEW) display_tree(current); else if (view_mode == SPLIT_VIEW) display_tree(browsed); gtk_tree_view_expand_all(GTK_TREE_VIEW(tree2_w)); } /* Display the list in the left frame (split view) */ static void display_list(void) { if (tree1) gtk_tree_store_clear(tree1); tree = tree1; display_tree(&rootmenu); gtk_tree_view_expand_all(GTK_TREE_VIEW(tree1_w)); tree = tree2; } void fixup_rootmenu(struct menu *menu) { struct menu *child; static int menu_cnt = 0; menu->flags |= MENU_ROOT; for (child = menu->list; child; child = child->next) { if (child->prompt && child->prompt->type == P_MENU) { menu_cnt++; fixup_rootmenu(child); menu_cnt--; } else if (!menu_cnt) fixup_rootmenu(child); } } /* Main */ int main(int ac, char *av[]) { const char *name; char *env; gchar *glade_file; #ifndef LKC_DIRECT_LINK kconfig_load(); #endif bindtextdomain(PACKAGE, LOCALEDIR); bind_textdomain_codeset(PACKAGE, "UTF-8"); textdomain(PACKAGE); /* GTK stuffs */ gtk_set_locale(); gtk_init(&ac, &av); glade_init(); //add_pixmap_directory (PACKAGE_DATA_DIR "/" PACKAGE "/pixmaps"); //add_pixmap_directory (PACKAGE_SOURCE_DIR "/pixmaps"); /* Determine GUI path */ env = getenv(SRCTREE); if (env) glade_file = g_strconcat(env, "/tools/kconfig/gconf.glade", NULL); else if (av[0][0] == '/') glade_file = g_strconcat(av[0], ".glade", NULL); else glade_file = g_strconcat(g_get_current_dir(), "/", av[0], ".glade", NULL); /* Conf stuffs */ if (ac > 1 && av[1][0] == '-') { switch (av[1][1]) { case 'a': //showAll = 1; break; case 'h': case '?': printf("%s \n", av[0]); exit(0); } name = av[2]; } else name = av[1]; conf_parse(name); fixup_rootmenu(&rootmenu); conf_read(NULL); /* Load the interface and connect signals */ init_main_window(glade_file); init_tree_model(); init_left_tree(); init_right_tree(); switch (view_mode) { case SINGLE_VIEW: display_tree_part(); break; case SPLIT_VIEW: display_list(); break; case FULL_VIEW: display_tree(&rootmenu); break; } gtk_main(); return 0; } static void conf_changed(void) { bool changed = conf_get_changed(); gtk_widget_set_sensitive(save_btn, changed); gtk_widget_set_sensitive(save_menu_item, changed); } tinyvisor/bios/tools/kconfig/expr.h0000644006644000001440000001576011733243570017745 0ustar yuichi_xyusers/* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ #ifndef EXPR_H #define EXPR_H #ifdef __cplusplus extern "C" { #endif #include #ifndef __cplusplus #include #endif struct file { struct file *next; struct file *parent; const char *name; int lineno; int flags; }; #define FILE_BUSY 0x0001 #define FILE_SCANNED 0x0002 typedef enum tristate { no, mod, yes } tristate; enum expr_type { E_NONE, E_OR, E_AND, E_NOT, E_EQUAL, E_UNEQUAL, E_LIST, E_SYMBOL, E_RANGE }; union expr_data { struct expr *expr; struct symbol *sym; }; struct expr { enum expr_type type; union expr_data left, right; }; #define EXPR_OR(dep1, dep2) (((dep1)>(dep2))?(dep1):(dep2)) #define EXPR_AND(dep1, dep2) (((dep1)<(dep2))?(dep1):(dep2)) #define EXPR_NOT(dep) (2-(dep)) #define expr_list_for_each_sym(l, e, s) \ for (e = (l); e && (s = e->right.sym); e = e->left.expr) struct expr_value { struct expr *expr; tristate tri; }; struct symbol_value { void *val; tristate tri; }; enum symbol_type { S_UNKNOWN, S_BOOLEAN, S_TRISTATE, S_INT, S_HEX, S_STRING, S_OTHER }; /* enum values are used as index to symbol.def[] */ enum { S_DEF_USER, /* main user value */ S_DEF_AUTO, /* values read from auto.conf */ S_DEF_DEF3, /* Reserved for UI usage */ S_DEF_DEF4, /* Reserved for UI usage */ S_DEF_COUNT }; struct symbol { struct symbol *next; char *name; enum symbol_type type; struct symbol_value curr; struct symbol_value def[S_DEF_COUNT]; tristate visible; int flags; struct property *prop; struct expr_value dir_dep; struct expr_value rev_dep; }; #define for_all_symbols(i, sym) for (i = 0; i < SYMBOL_HASHSIZE; i++) for (sym = symbol_hash[i]; sym; sym = sym->next) if (sym->type != S_OTHER) #define SYMBOL_CONST 0x0001 /* symbol is const */ #define SYMBOL_CHECK 0x0008 /* used during dependency checking */ #define SYMBOL_CHOICE 0x0010 /* start of a choice block (null name) */ #define SYMBOL_CHOICEVAL 0x0020 /* used as a value in a choice block */ #define SYMBOL_VALID 0x0080 /* set when symbol.curr is calculated */ #define SYMBOL_OPTIONAL 0x0100 /* choice is optional - values can be 'n' */ #define SYMBOL_WRITE 0x0200 /* ? */ #define SYMBOL_CHANGED 0x0400 /* ? */ #define SYMBOL_AUTO 0x1000 /* value from environment variable */ #define SYMBOL_CHECKED 0x2000 /* used during dependency checking */ #define SYMBOL_WARNED 0x8000 /* warning has been issued */ /* Set when symbol.def[] is used */ #define SYMBOL_DEF 0x10000 /* First bit of SYMBOL_DEF */ #define SYMBOL_DEF_USER 0x10000 /* symbol.def[S_DEF_USER] is valid */ #define SYMBOL_DEF_AUTO 0x20000 /* symbol.def[S_DEF_AUTO] is valid */ #define SYMBOL_DEF3 0x40000 /* symbol.def[S_DEF_3] is valid */ #define SYMBOL_DEF4 0x80000 /* symbol.def[S_DEF_4] is valid */ #define SYMBOL_MAXLENGTH 256 #define SYMBOL_HASHSIZE 9973 /* A property represent the config options that can be associated * with a config "symbol". * Sample: * config FOO * default y * prompt "foo prompt" * select BAR * config BAZ * int "BAZ Value" * range 1..255 */ enum prop_type { P_UNKNOWN, P_PROMPT, /* prompt "foo prompt" or "BAZ Value" */ P_COMMENT, /* text associated with a comment */ P_MENU, /* prompt associated with a menuconfig option */ P_DEFAULT, /* default y */ P_CHOICE, /* choice value */ P_SELECT, /* select BAR */ P_RANGE, /* range 7..100 (for a symbol) */ P_ENV, /* value from environment variable */ P_SYMBOL, /* where a symbol is defined */ }; struct property { struct property *next; /* next property - null if last */ struct symbol *sym; /* the symbol for which the property is associated */ enum prop_type type; /* type of property */ const char *text; /* the prompt value - P_PROMPT, P_MENU, P_COMMENT */ struct expr_value visible; struct expr *expr; /* the optional conditional part of the property */ struct menu *menu; /* the menu the property are associated with * valid for: P_SELECT, P_RANGE, P_CHOICE, * P_PROMPT, P_DEFAULT, P_MENU, P_COMMENT */ struct file *file; /* what file was this property defined */ int lineno; /* what lineno was this property defined */ }; #define for_all_properties(sym, st, tok) \ for (st = sym->prop; st; st = st->next) \ if (st->type == (tok)) #define for_all_defaults(sym, st) for_all_properties(sym, st, P_DEFAULT) #define for_all_choices(sym, st) for_all_properties(sym, st, P_CHOICE) #define for_all_prompts(sym, st) \ for (st = sym->prop; st; st = st->next) \ if (st->text) struct menu { struct menu *next; struct menu *parent; struct menu *list; struct symbol *sym; struct property *prompt; struct expr *visibility; struct expr *dep; unsigned int flags; char *help; struct file *file; int lineno; void *data; }; #define MENU_CHANGED 0x0001 #define MENU_ROOT 0x0002 #ifndef SWIG extern struct file *file_list; extern struct file *current_file; struct file *lookup_file(const char *name); extern struct symbol symbol_yes, symbol_no, symbol_mod; extern struct symbol *modules_sym; extern struct symbol *sym_defconfig_list; extern int cdebug; struct expr *expr_alloc_symbol(struct symbol *sym); struct expr *expr_alloc_one(enum expr_type type, struct expr *ce); struct expr *expr_alloc_two(enum expr_type type, struct expr *e1, struct expr *e2); struct expr *expr_alloc_comp(enum expr_type type, struct symbol *s1, struct symbol *s2); struct expr *expr_alloc_and(struct expr *e1, struct expr *e2); struct expr *expr_alloc_or(struct expr *e1, struct expr *e2); struct expr *expr_copy(const struct expr *org); void expr_free(struct expr *e); int expr_eq(struct expr *e1, struct expr *e2); void expr_eliminate_eq(struct expr **ep1, struct expr **ep2); tristate expr_calc_value(struct expr *e); struct expr *expr_eliminate_yn(struct expr *e); struct expr *expr_trans_bool(struct expr *e); struct expr *expr_eliminate_dups(struct expr *e); struct expr *expr_transform(struct expr *e); int expr_contains_symbol(struct expr *dep, struct symbol *sym); bool expr_depends_symbol(struct expr *dep, struct symbol *sym); struct expr *expr_extract_eq_and(struct expr **ep1, struct expr **ep2); struct expr *expr_extract_eq_or(struct expr **ep1, struct expr **ep2); void expr_extract_eq(enum expr_type type, struct expr **ep, struct expr **ep1, struct expr **ep2); struct expr *expr_trans_compare(struct expr *e, enum expr_type type, struct symbol *sym); struct expr *expr_simplify_unmet_dep(struct expr *e1, struct expr *e2); void expr_fprint(struct expr *e, FILE *out); struct gstr; /* forward */ void expr_gstr_print(struct expr *e, struct gstr *gs); static inline int expr_is_yes(struct expr *e) { return !e || (e->type == E_SYMBOL && e->left.sym == &symbol_yes); } static inline int expr_is_no(struct expr *e) { return e && (e->type == E_SYMBOL && e->left.sym == &symbol_no); } #endif #ifdef __cplusplus } #endif #endif /* EXPR_H */ tinyvisor/bios/tools/kconfig/conf.c0000644006644000001440000003226311733243570017704 0ustar yuichi_xyusers/* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ #include #include #include #include #include #include #include #include #include #include #define LKC_DIRECT_LINK #include "lkc.h" static void conf(struct menu *menu); static void check_conf(struct menu *menu); enum input_mode { oldaskconfig, silentoldconfig, oldconfig, allnoconfig, allyesconfig, allmodconfig, alldefconfig, randconfig, defconfig, savedefconfig, listnewconfig, oldnoconfig, } input_mode = oldaskconfig; char *defconfig_file; static int indent = 1; static int valid_stdin = 1; static int sync_kconfig; static int conf_cnt; static char line[128]; static struct menu *rootEntry; static void print_help(struct menu *menu) { struct gstr help = str_new(); menu_get_ext_help(menu, &help); printf("\n%s\n", str_get(&help)); str_free(&help); } static void strip(char *str) { char *p = str; int l; while ((isspace(*p))) p++; l = strlen(p); if (p != str) memmove(str, p, l + 1); if (!l) return; p = str + l - 1; while ((isspace(*p))) *p-- = 0; } static void check_stdin(void) { if (!valid_stdin) { printf(_("aborted!\n\n")); printf(_("Console input/output is redirected. ")); printf(_("Run 'make oldconfig' to update configuration.\n\n")); exit(1); } } static int conf_askvalue(struct symbol *sym, const char *def) { enum symbol_type type = sym_get_type(sym); if (!sym_has_value(sym)) printf(_("(NEW) ")); line[0] = '\n'; line[1] = 0; if (!sym_is_changable(sym)) { printf("%s\n", def); line[0] = '\n'; line[1] = 0; return 0; } switch (input_mode) { case oldconfig: case silentoldconfig: if (sym_has_value(sym)) { printf("%s\n", def); return 0; } check_stdin(); case oldaskconfig: fflush(stdout); xfgets(line, 128, stdin); return 1; default: break; } switch (type) { case S_INT: case S_HEX: case S_STRING: printf("%s\n", def); return 1; default: ; } printf("%s", line); return 1; } static int conf_string(struct menu *menu) { struct symbol *sym = menu->sym; const char *def; while (1) { printf("%*s%s ", indent - 1, "", _(menu->prompt->text)); printf("(%s) ", sym->name); def = sym_get_string_value(sym); if (sym_get_string_value(sym)) printf("[%s] ", def); if (!conf_askvalue(sym, def)) return 0; switch (line[0]) { case '\n': break; case '?': /* print help */ if (line[1] == '\n') { print_help(menu); def = NULL; break; } default: line[strlen(line)-1] = 0; def = line; } if (def && sym_set_string_value(sym, def)) return 0; } } static int conf_sym(struct menu *menu) { struct symbol *sym = menu->sym; tristate oldval, newval; while (1) { printf("%*s%s ", indent - 1, "", _(menu->prompt->text)); if (sym->name) printf("(%s) ", sym->name); putchar('['); oldval = sym_get_tristate_value(sym); switch (oldval) { case no: putchar('N'); break; case mod: putchar('M'); break; case yes: putchar('Y'); break; } if (oldval != no && sym_tristate_within_range(sym, no)) printf("/n"); if (oldval != mod && sym_tristate_within_range(sym, mod)) printf("/m"); if (oldval != yes && sym_tristate_within_range(sym, yes)) printf("/y"); if (menu_has_help(menu)) printf("/?"); printf("] "); if (!conf_askvalue(sym, sym_get_string_value(sym))) return 0; strip(line); switch (line[0]) { case 'n': case 'N': newval = no; if (!line[1] || !strcmp(&line[1], "o")) break; continue; case 'm': case 'M': newval = mod; if (!line[1]) break; continue; case 'y': case 'Y': newval = yes; if (!line[1] || !strcmp(&line[1], "es")) break; continue; case 0: newval = oldval; break; case '?': goto help; default: continue; } if (sym_set_tristate_value(sym, newval)) return 0; help: print_help(menu); } } static int conf_choice(struct menu *menu) { struct symbol *sym, *def_sym; struct menu *child; bool is_new; sym = menu->sym; is_new = !sym_has_value(sym); if (sym_is_changable(sym)) { conf_sym(menu); sym_calc_value(sym); switch (sym_get_tristate_value(sym)) { case no: return 1; case mod: return 0; case yes: break; } } else { switch (sym_get_tristate_value(sym)) { case no: return 1; case mod: printf("%*s%s\n", indent - 1, "", _(menu_get_prompt(menu))); return 0; case yes: break; } } while (1) { int cnt, def; printf("%*s%s\n", indent - 1, "", _(menu_get_prompt(menu))); def_sym = sym_get_choice_value(sym); cnt = def = 0; line[0] = 0; for (child = menu->list; child; child = child->next) { if (!menu_is_visible(child)) continue; if (!child->sym) { printf("%*c %s\n", indent, '*', _(menu_get_prompt(child))); continue; } cnt++; if (child->sym == def_sym) { def = cnt; printf("%*c", indent, '>'); } else printf("%*c", indent, ' '); printf(" %d. %s", cnt, _(menu_get_prompt(child))); if (child->sym->name) printf(" (%s)", child->sym->name); if (!sym_has_value(child->sym)) printf(_(" (NEW)")); printf("\n"); } printf(_("%*schoice"), indent - 1, ""); if (cnt == 1) { printf("[1]: 1\n"); goto conf_childs; } printf("[1-%d", cnt); if (menu_has_help(menu)) printf("?"); printf("]: "); switch (input_mode) { case oldconfig: case silentoldconfig: if (!is_new) { cnt = def; printf("%d\n", cnt); break; } check_stdin(); case oldaskconfig: fflush(stdout); xfgets(line, 128, stdin); strip(line); if (line[0] == '?') { print_help(menu); continue; } if (!line[0]) cnt = def; else if (isdigit(line[0])) cnt = atoi(line); else continue; break; default: break; } conf_childs: for (child = menu->list; child; child = child->next) { if (!child->sym || !menu_is_visible(child)) continue; if (!--cnt) break; } if (!child) continue; if (line[strlen(line) - 1] == '?') { print_help(child); continue; } sym_set_choice_value(sym, child->sym); for (child = child->list; child; child = child->next) { indent += 2; conf(child); indent -= 2; } return 1; } } static void conf(struct menu *menu) { struct symbol *sym; struct property *prop; struct menu *child; if (!menu_is_visible(menu)) return; sym = menu->sym; prop = menu->prompt; if (prop) { const char *prompt; switch (prop->type) { case P_MENU: if ((input_mode == silentoldconfig || input_mode == listnewconfig || input_mode == oldnoconfig) && rootEntry != menu) { check_conf(menu); return; } case P_COMMENT: prompt = menu_get_prompt(menu); if (prompt) printf("%*c\n%*c %s\n%*c\n", indent, '*', indent, '*', _(prompt), indent, '*'); default: ; } } if (!sym) goto conf_childs; if (sym_is_choice(sym)) { conf_choice(menu); if (sym->curr.tri != mod) return; goto conf_childs; } switch (sym->type) { case S_INT: case S_HEX: case S_STRING: conf_string(menu); break; default: conf_sym(menu); break; } conf_childs: if (sym) indent += 2; for (child = menu->list; child; child = child->next) conf(child); if (sym) indent -= 2; } static void check_conf(struct menu *menu) { struct symbol *sym; struct menu *child; if (!menu_is_visible(menu)) return; sym = menu->sym; if (sym && !sym_has_value(sym)) { if (sym_is_changable(sym) || (sym_is_choice(sym) && sym_get_tristate_value(sym) == yes)) { if (input_mode == listnewconfig) { if (sym->name && !sym_is_choice_value(sym)) { printf("%s%s\n", CONFIG_, sym->name); } } else if (input_mode != oldnoconfig) { if (!conf_cnt++) printf(_("*\n* Restart config...\n*\n")); rootEntry = menu_get_parent_menu(menu); conf(rootEntry); } } } for (child = menu->list; child; child = child->next) check_conf(child); } static struct option long_opts[] = { {"oldaskconfig", no_argument, NULL, oldaskconfig}, {"oldconfig", no_argument, NULL, oldconfig}, {"silentoldconfig", no_argument, NULL, silentoldconfig}, {"defconfig", optional_argument, NULL, defconfig}, {"savedefconfig", required_argument, NULL, savedefconfig}, {"allnoconfig", no_argument, NULL, allnoconfig}, {"allyesconfig", no_argument, NULL, allyesconfig}, {"allmodconfig", no_argument, NULL, allmodconfig}, {"alldefconfig", no_argument, NULL, alldefconfig}, {"randconfig", no_argument, NULL, randconfig}, {"listnewconfig", no_argument, NULL, listnewconfig}, {"oldnoconfig", no_argument, NULL, oldnoconfig}, {NULL, 0, NULL, 0} }; int main(int ac, char **av) { int opt; const char *name; struct stat tmpstat; setlocale(LC_ALL, ""); bindtextdomain(PACKAGE, LOCALEDIR); textdomain(PACKAGE); while ((opt = getopt_long(ac, av, "", long_opts, NULL)) != -1) { input_mode = (enum input_mode)opt; switch (opt) { case silentoldconfig: sync_kconfig = 1; break; case defconfig: case savedefconfig: defconfig_file = optarg; break; case randconfig: { struct timeval now; unsigned int seed; /* * Use microseconds derived seed, * compensate for systems where it may be zero */ gettimeofday(&now, NULL); seed = (unsigned int)((now.tv_sec + 1) * (now.tv_usec + 1)); srand(seed); break; } case '?': fprintf(stderr, _("See README for usage info\n")); exit(1); break; } } if (ac == optind) { printf(_("%s: Kconfig file missing\n"), av[0]); exit(1); } name = av[optind]; conf_parse(name); //zconfdump(stdout); if (sync_kconfig) { name = conf_get_configname(); if (stat(name, &tmpstat)) { fprintf(stderr, _("***\n" "*** Configuration file \"%s\" not found!\n" "***\n" "*** Please run some configurator (e.g. \"make oldconfig\" or\n" "*** \"make menuconfig\" or \"make xconfig\").\n" "***\n"), name); exit(1); } } switch (input_mode) { case defconfig: if (!defconfig_file) defconfig_file = conf_get_default_confname(); if (conf_read(defconfig_file)) { printf(_("***\n" "*** Can't find default configuration \"%s\"!\n" "***\n"), defconfig_file); exit(1); } break; case savedefconfig: case silentoldconfig: case oldaskconfig: case oldconfig: case listnewconfig: case oldnoconfig: conf_read(NULL); break; case allnoconfig: case allyesconfig: case allmodconfig: case alldefconfig: case randconfig: name = getenv("KCONFIG_ALLCONFIG"); if (name && !stat(name, &tmpstat)) { conf_read_simple(name, S_DEF_USER); break; } switch (input_mode) { case allnoconfig: name = "allno.config"; break; case allyesconfig: name = "allyes.config"; break; case allmodconfig: name = "allmod.config"; break; case alldefconfig: name = "alldef.config"; break; case randconfig: name = "allrandom.config"; break; default: break; } if (!stat(name, &tmpstat)) conf_read_simple(name, S_DEF_USER); else if (!stat("all.config", &tmpstat)) conf_read_simple("all.config", S_DEF_USER); break; default: break; } if (sync_kconfig) { if (conf_get_changed()) { name = getenv("KCONFIG_NOSILENTUPDATE"); if (name && *name) { fprintf(stderr, _("\n*** The configuration requires explicit update.\n\n")); return 1; } } valid_stdin = isatty(0) && isatty(1) && isatty(2); } switch (input_mode) { case allnoconfig: conf_set_all_new_symbols(def_no); break; case allyesconfig: conf_set_all_new_symbols(def_yes); break; case allmodconfig: conf_set_all_new_symbols(def_mod); break; case alldefconfig: conf_set_all_new_symbols(def_default); break; case randconfig: conf_set_all_new_symbols(def_random); break; case defconfig: conf_set_all_new_symbols(def_default); break; case savedefconfig: break; case oldaskconfig: rootEntry = &rootmenu; conf(&rootmenu); input_mode = silentoldconfig; /* fall through */ case oldconfig: case listnewconfig: case oldnoconfig: case silentoldconfig: /* Update until a loop caused no more changes */ do { conf_cnt = 0; check_conf(&rootmenu); } while (conf_cnt && (input_mode != listnewconfig && input_mode != oldnoconfig)); break; } if (sync_kconfig) { /* silentoldconfig is used during the build so we shall update autoconf. * All other commands are only used to generate a config. */ if (conf_get_changed() && conf_write(NULL)) { fprintf(stderr, _("\n*** Error during writing of the configuration.\n\n")); exit(1); } if (conf_write_autoconf()) { fprintf(stderr, _("\n*** Error during update of the configuration.\n\n")); return 1; } } else if (input_mode == savedefconfig) { if (conf_write_defconfig(defconfig_file)) { fprintf(stderr, _("n*** Error while saving defconfig to: %s\n\n"), defconfig_file); return 1; } } else if (input_mode != listnewconfig) { if (conf_write(NULL)) { fprintf(stderr, _("\n*** Error during writing of the configuration.\n\n")); exit(1); } } return 0; } /* * Helper function to facilitate fgets() by Jean Sacren. */ void xfgets(str, size, in) char *str; int size; FILE *in; { if (fgets(str, size, in) == NULL) fprintf(stderr, "\nError in reading or end of file.\n"); } tinyvisor/bios/tools/kconfig/menu.c0000644006644000001440000003552611733243570017730 0ustar yuichi_xyusers/* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ #include #include #define LKC_DIRECT_LINK #include "lkc.h" static const char nohelp_text[] = N_( "There is no help available for this option.\n"); struct menu rootmenu; static struct menu **last_entry_ptr; struct file *file_list; struct file *current_file; void menu_warn(struct menu *menu, const char *fmt, ...) { va_list ap; va_start(ap, fmt); fprintf(stderr, "%s:%d:warning: ", menu->file->name, menu->lineno); vfprintf(stderr, fmt, ap); fprintf(stderr, "\n"); va_end(ap); } static void prop_warn(struct property *prop, const char *fmt, ...) { va_list ap; va_start(ap, fmt); fprintf(stderr, "%s:%d:warning: ", prop->file->name, prop->lineno); vfprintf(stderr, fmt, ap); fprintf(stderr, "\n"); va_end(ap); } void _menu_init(void) { current_entry = current_menu = &rootmenu; last_entry_ptr = &rootmenu.list; } void menu_add_entry(struct symbol *sym) { struct menu *menu; menu = malloc(sizeof(*menu)); memset(menu, 0, sizeof(*menu)); menu->sym = sym; menu->parent = current_menu; menu->file = current_file; menu->lineno = zconf_lineno(); *last_entry_ptr = menu; last_entry_ptr = &menu->next; current_entry = menu; if (sym) menu_add_symbol(P_SYMBOL, sym, NULL); } void menu_end_entry(void) { } struct menu *menu_add_menu(void) { menu_end_entry(); last_entry_ptr = ¤t_entry->list; return current_menu = current_entry; } void menu_end_menu(void) { last_entry_ptr = ¤t_menu->next; current_menu = current_menu->parent; } static struct expr *menu_check_dep(struct expr *e) { if (!e) return e; switch (e->type) { case E_NOT: e->left.expr = menu_check_dep(e->left.expr); break; case E_OR: case E_AND: e->left.expr = menu_check_dep(e->left.expr); e->right.expr = menu_check_dep(e->right.expr); break; case E_SYMBOL: /* change 'm' into 'm' && MODULES */ if (e->left.sym == &symbol_mod) return expr_alloc_and(e, expr_alloc_symbol(modules_sym)); break; default: break; } return e; } void menu_add_dep(struct expr *dep) { current_entry->dep = expr_alloc_and(current_entry->dep, menu_check_dep(dep)); } void menu_set_type(int type) { struct symbol *sym = current_entry->sym; if (sym->type == type) return; if (sym->type == S_UNKNOWN) { sym->type = type; return; } menu_warn(current_entry, "type of '%s' redefined from '%s' to '%s'", sym->name ? sym->name : "", sym_type_name(sym->type), sym_type_name(type)); } struct property *menu_add_prop(enum prop_type type, char *prompt, struct expr *expr, struct expr *dep) { struct property *prop = prop_alloc(type, current_entry->sym); prop->menu = current_entry; prop->expr = expr; prop->visible.expr = menu_check_dep(dep); if (prompt) { if (isspace(*prompt)) { prop_warn(prop, "leading whitespace ignored"); while (isspace(*prompt)) prompt++; } if (current_entry->prompt && current_entry != &rootmenu) prop_warn(prop, "prompt redefined"); /* Apply all upper menus' visibilities to actual prompts. */ if(type == P_PROMPT) { struct menu *menu = current_entry; while ((menu = menu->parent) != NULL) { if (!menu->visibility) continue; prop->visible.expr = expr_alloc_and(prop->visible.expr, menu->visibility); } } current_entry->prompt = prop; } prop->text = prompt; return prop; } struct property *menu_add_prompt(enum prop_type type, char *prompt, struct expr *dep) { return menu_add_prop(type, prompt, NULL, dep); } void menu_add_visibility(struct expr *expr) { current_entry->visibility = expr_alloc_and(current_entry->visibility, expr); } void menu_add_expr(enum prop_type type, struct expr *expr, struct expr *dep) { menu_add_prop(type, NULL, expr, dep); } void menu_add_symbol(enum prop_type type, struct symbol *sym, struct expr *dep) { menu_add_prop(type, NULL, expr_alloc_symbol(sym), dep); } void menu_add_option(int token, char *arg) { struct property *prop; switch (token) { case T_OPT_MODULES: prop = prop_alloc(P_DEFAULT, modules_sym); prop->expr = expr_alloc_symbol(current_entry->sym); break; case T_OPT_DEFCONFIG_LIST: if (!sym_defconfig_list) sym_defconfig_list = current_entry->sym; else if (sym_defconfig_list != current_entry->sym) zconf_error("trying to redefine defconfig symbol"); break; case T_OPT_ENV: prop_add_env(arg); break; } } static int menu_validate_number(struct symbol *sym, struct symbol *sym2) { return sym2->type == S_INT || sym2->type == S_HEX || (sym2->type == S_UNKNOWN && sym_string_valid(sym, sym2->name)); } static void sym_check_prop(struct symbol *sym) { struct property *prop; struct symbol *sym2; for (prop = sym->prop; prop; prop = prop->next) { switch (prop->type) { case P_DEFAULT: if ((sym->type == S_STRING || sym->type == S_INT || sym->type == S_HEX) && prop->expr->type != E_SYMBOL) prop_warn(prop, "default for config symbol '%s'" " must be a single symbol", sym->name); if (prop->expr->type != E_SYMBOL) break; sym2 = prop_get_symbol(prop); if (sym->type == S_HEX || sym->type == S_INT) { if (!menu_validate_number(sym, sym2)) prop_warn(prop, "'%s': number is invalid", sym->name); } break; case P_SELECT: sym2 = prop_get_symbol(prop); if (sym->type != S_BOOLEAN && sym->type != S_TRISTATE) prop_warn(prop, "config symbol '%s' uses select, but is " "not boolean or tristate", sym->name); else if (sym2->type != S_UNKNOWN && sym2->type != S_BOOLEAN && sym2->type != S_TRISTATE) prop_warn(prop, "'%s' has wrong type. 'select' only " "accept arguments of boolean and " "tristate type", sym2->name); break; case P_RANGE: if (sym->type != S_INT && sym->type != S_HEX) prop_warn(prop, "range is only allowed " "for int or hex symbols"); if (!menu_validate_number(sym, prop->expr->left.sym) || !menu_validate_number(sym, prop->expr->right.sym)) prop_warn(prop, "range is invalid"); break; default: ; } } } void menu_finalize(struct menu *parent) { struct menu *menu, *last_menu; struct symbol *sym; struct property *prop; struct expr *parentdep, *basedep, *dep, *dep2, **ep; sym = parent->sym; if (parent->list) { if (sym && sym_is_choice(sym)) { if (sym->type == S_UNKNOWN) { /* find the first choice value to find out choice type */ current_entry = parent; for (menu = parent->list; menu; menu = menu->next) { if (menu->sym && menu->sym->type != S_UNKNOWN) { menu_set_type(menu->sym->type); break; } } } /* set the type of the remaining choice values */ for (menu = parent->list; menu; menu = menu->next) { current_entry = menu; if (menu->sym && menu->sym->type == S_UNKNOWN) menu_set_type(sym->type); } parentdep = expr_alloc_symbol(sym); } else if (parent->prompt) parentdep = parent->prompt->visible.expr; else parentdep = parent->dep; for (menu = parent->list; menu; menu = menu->next) { basedep = expr_transform(menu->dep); basedep = expr_alloc_and(expr_copy(parentdep), basedep); basedep = expr_eliminate_dups(basedep); menu->dep = basedep; if (menu->sym) prop = menu->sym->prop; else prop = menu->prompt; for (; prop; prop = prop->next) { if (prop->menu != menu) continue; dep = expr_transform(prop->visible.expr); dep = expr_alloc_and(expr_copy(basedep), dep); dep = expr_eliminate_dups(dep); if (menu->sym && menu->sym->type != S_TRISTATE) dep = expr_trans_bool(dep); prop->visible.expr = dep; if (prop->type == P_SELECT) { struct symbol *es = prop_get_symbol(prop); es->rev_dep.expr = expr_alloc_or(es->rev_dep.expr, expr_alloc_and(expr_alloc_symbol(menu->sym), expr_copy(dep))); } } } for (menu = parent->list; menu; menu = menu->next) menu_finalize(menu); } else if (sym) { basedep = parent->prompt ? parent->prompt->visible.expr : NULL; basedep = expr_trans_compare(basedep, E_UNEQUAL, &symbol_no); basedep = expr_eliminate_dups(expr_transform(basedep)); last_menu = NULL; for (menu = parent->next; menu; menu = menu->next) { dep = menu->prompt ? menu->prompt->visible.expr : menu->dep; if (!expr_contains_symbol(dep, sym)) break; if (expr_depends_symbol(dep, sym)) goto next; dep = expr_trans_compare(dep, E_UNEQUAL, &symbol_no); dep = expr_eliminate_dups(expr_transform(dep)); dep2 = expr_copy(basedep); expr_eliminate_eq(&dep, &dep2); expr_free(dep); if (!expr_is_yes(dep2)) { expr_free(dep2); break; } expr_free(dep2); next: menu_finalize(menu); menu->parent = parent; last_menu = menu; } if (last_menu) { parent->list = parent->next; parent->next = last_menu->next; last_menu->next = NULL; } sym->dir_dep.expr = parent->dep; } for (menu = parent->list; menu; menu = menu->next) { if (sym && sym_is_choice(sym) && menu->sym && !sym_is_choice_value(menu->sym)) { current_entry = menu; menu->sym->flags |= SYMBOL_CHOICEVAL; if (!menu->prompt) menu_warn(menu, "choice value must have a prompt"); for (prop = menu->sym->prop; prop; prop = prop->next) { if (prop->type == P_DEFAULT) prop_warn(prop, "defaults for choice " "values not supported"); if (prop->menu == menu) continue; if (prop->type == P_PROMPT && prop->menu->parent->sym != sym) prop_warn(prop, "choice value used outside its choice group"); } /* Non-tristate choice values of tristate choices must * depend on the choice being set to Y. The choice * values' dependencies were propagated to their * properties above, so the change here must be re- * propagated. */ if (sym->type == S_TRISTATE && menu->sym->type != S_TRISTATE) { basedep = expr_alloc_comp(E_EQUAL, sym, &symbol_yes); menu->dep = expr_alloc_and(basedep, menu->dep); for (prop = menu->sym->prop; prop; prop = prop->next) { if (prop->menu != menu) continue; prop->visible.expr = expr_alloc_and(expr_copy(basedep), prop->visible.expr); } } menu_add_symbol(P_CHOICE, sym, NULL); prop = sym_get_choice_prop(sym); for (ep = &prop->expr; *ep; ep = &(*ep)->left.expr) ; *ep = expr_alloc_one(E_LIST, NULL); (*ep)->right.sym = menu->sym; } if (menu->list && (!menu->prompt || !menu->prompt->text)) { for (last_menu = menu->list; ; last_menu = last_menu->next) { last_menu->parent = parent; if (!last_menu->next) break; } last_menu->next = menu->next; menu->next = menu->list; menu->list = NULL; } } if (sym && !(sym->flags & SYMBOL_WARNED)) { if (sym->type == S_UNKNOWN) menu_warn(parent, "config symbol defined without type"); if (sym_is_choice(sym) && !parent->prompt) menu_warn(parent, "choice must have a prompt"); /* Check properties connected to this symbol */ sym_check_prop(sym); sym->flags |= SYMBOL_WARNED; } if (sym && !sym_is_optional(sym) && parent->prompt) { sym->rev_dep.expr = expr_alloc_or(sym->rev_dep.expr, expr_alloc_and(parent->prompt->visible.expr, expr_alloc_symbol(&symbol_mod))); } } bool menu_has_prompt(struct menu *menu) { if (!menu->prompt) return false; return true; } bool menu_is_visible(struct menu *menu) { struct menu *child; struct symbol *sym; tristate visible; if (!menu->prompt) return false; if (menu->visibility) { if (expr_calc_value(menu->visibility) == no) return no; } sym = menu->sym; if (sym) { sym_calc_value(sym); visible = menu->prompt->visible.tri; } else visible = menu->prompt->visible.tri = expr_calc_value(menu->prompt->visible.expr); if (visible != no) return true; if (!sym || sym_get_tristate_value(menu->sym) == no) return false; for (child = menu->list; child; child = child->next) { if (menu_is_visible(child)) { if (sym) sym->flags |= SYMBOL_DEF_USER; return true; } } return false; } const char *menu_get_prompt(struct menu *menu) { if (menu->prompt) return menu->prompt->text; else if (menu->sym) return menu->sym->name; return NULL; } struct menu *menu_get_root_menu(struct menu *menu) { return &rootmenu; } struct menu *menu_get_parent_menu(struct menu *menu) { enum prop_type type; for (; menu != &rootmenu; menu = menu->parent) { type = menu->prompt ? menu->prompt->type : 0; if (type == P_MENU) break; } return menu; } bool menu_has_help(struct menu *menu) { return menu->help != NULL; } const char *menu_get_help(struct menu *menu) { if (menu->help) return menu->help; else return ""; } static void get_prompt_str(struct gstr *r, struct property *prop) { int i, j; struct menu *submenu[8], *menu; str_printf(r, _("Prompt: %s\n"), _(prop->text)); str_printf(r, _(" Defined at %s:%d\n"), prop->menu->file->name, prop->menu->lineno); if (!expr_is_yes(prop->visible.expr)) { str_append(r, _(" Depends on: ")); expr_gstr_print(prop->visible.expr, r); str_append(r, "\n"); } menu = prop->menu->parent; for (i = 0; menu != &rootmenu && i < 8; menu = menu->parent) submenu[i++] = menu; if (i > 0) { str_printf(r, _(" Location:\n")); for (j = 4; --i >= 0; j += 2) { menu = submenu[i]; str_printf(r, "%*c-> %s", j, ' ', _(menu_get_prompt(menu))); if (menu->sym) { str_printf(r, " (%s [=%s])", menu->sym->name ? menu->sym->name : _(""), sym_get_string_value(menu->sym)); } str_append(r, "\n"); } } } void get_symbol_str(struct gstr *r, struct symbol *sym) { bool hit; struct property *prop; if (sym && sym->name) { str_printf(r, "Symbol: %s [=%s]\n", sym->name, sym_get_string_value(sym)); str_printf(r, "Type : %s\n", sym_type_name(sym->type)); if (sym->type == S_INT || sym->type == S_HEX) { prop = sym_get_range_prop(sym); if (prop) { str_printf(r, "Range : "); expr_gstr_print(prop->expr, r); str_append(r, "\n"); } } } for_all_prompts(sym, prop) get_prompt_str(r, prop); hit = false; for_all_properties(sym, prop, P_SELECT) { if (!hit) { str_append(r, " Selects: "); hit = true; } else str_printf(r, " && "); expr_gstr_print(prop->expr, r); } if (hit) str_append(r, "\n"); if (sym->rev_dep.expr) { str_append(r, _(" Selected by: ")); expr_gstr_print(sym->rev_dep.expr, r); str_append(r, "\n"); } str_append(r, "\n\n"); } struct gstr get_relations_str(struct symbol **sym_arr) { struct symbol *sym; struct gstr res = str_new(); int i; for (i = 0; sym_arr && (sym = sym_arr[i]); i++) get_symbol_str(&res, sym); if (!i) str_append(&res, _("No matches found.\n")); return res; } void menu_get_ext_help(struct menu *menu, struct gstr *help) { struct symbol *sym = menu->sym; if (menu_has_help(menu)) { if (sym->name) { str_printf(help, "%s%s:\n\n", CONFIG_, sym->name); str_append(help, _(menu_get_help(menu))); str_append(help, "\n"); } } else { str_append(help, nohelp_text); } if (sym) get_symbol_str(help, sym); } tinyvisor/bios/tools/kconfig/kconfig_load.c0000644006644000001440000000120211733243570021363 0ustar yuichi_xyusers#include #include #include #include "lkc.h" #define P(name,type,arg) type (*name ## _p) arg #include "lkc_proto.h" #undef P void kconfig_load(void) { void *handle; char *error; handle = dlopen("./libkconfig.so", RTLD_LAZY); if (!handle) { handle = dlopen("./tools/kconfig/libkconfig.so", RTLD_LAZY); if (!handle) { fprintf(stderr, "%s\n", dlerror()); exit(1); } } #define P(name,type,arg) \ { \ name ## _p = dlsym(handle, #name); \ if ((error = dlerror())) { \ fprintf(stderr, "%s\n", error); \ exit(1); \ } \ } #include "lkc_proto.h" #undef P } tinyvisor/bios/tools/kconfig/zconf.l0000644006644000001440000001464411733243570020112 0ustar yuichi_xyusers%option backup nostdinit noyywrap never-interactive full ecs %option 8bit backup nodefault perf-report perf-report %option noinput %x COMMAND HELP STRING PARAM %{ /* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ #include #include #include #include #include #define LKC_DIRECT_LINK #include "lkc.h" #define START_STRSIZE 16 static struct { struct file *file; int lineno; } current_pos; static char *text; static int text_size, text_asize; struct buffer { struct buffer *parent; YY_BUFFER_STATE state; }; struct buffer *current_buf; static int last_ts, first_ts; static void zconf_endhelp(void); static void zconf_endfile(void); static void new_string(void) { text = malloc(START_STRSIZE); text_asize = START_STRSIZE; text_size = 0; *text = 0; } static void append_string(const char *str, int size) { int new_size = text_size + size + 1; if (new_size > text_asize) { new_size += START_STRSIZE - 1; new_size &= -START_STRSIZE; text = realloc(text, new_size); text_asize = new_size; } memcpy(text + text_size, str, size); text_size += size; text[text_size] = 0; } static void alloc_string(const char *str, int size) { text = malloc(size + 1); memcpy(text, str, size); text[size] = 0; } %} ws [ \n\t] n [A-Za-z0-9_] %% int str = 0; int ts, i; [ \t]*#.*\n | [ \t]*\n { current_file->lineno++; return T_EOL; } [ \t]*#.* [ \t]+ { BEGIN(COMMAND); } . { unput(yytext[0]); BEGIN(COMMAND); } { {n}+ { struct kconf_id *id = kconf_id_lookup(yytext, yyleng); BEGIN(PARAM); current_pos.file = current_file; current_pos.lineno = current_file->lineno; if (id && id->flags & TF_COMMAND) { zconflval.id = id; return id->token; } alloc_string(yytext, yyleng); zconflval.string = text; return T_WORD; } . \n { BEGIN(INITIAL); current_file->lineno++; return T_EOL; } } { "&&" return T_AND; "||" return T_OR; "(" return T_OPEN_PAREN; ")" return T_CLOSE_PAREN; "!" return T_NOT; "=" return T_EQUAL; "!=" return T_UNEQUAL; \"|\' { str = yytext[0]; new_string(); BEGIN(STRING); } \n BEGIN(INITIAL); current_file->lineno++; return T_EOL; --- /* ignore */ ({n}|[-/.])+ { struct kconf_id *id = kconf_id_lookup(yytext, yyleng); if (id && id->flags & TF_PARAM) { zconflval.id = id; return id->token; } alloc_string(yytext, yyleng); zconflval.string = text; return T_WORD; } #.* /* comment */ \\\n current_file->lineno++; . <> { BEGIN(INITIAL); } } { [^'"\\\n]+/\n { append_string(yytext, yyleng); zconflval.string = text; return T_WORD_QUOTE; } [^'"\\\n]+ { append_string(yytext, yyleng); } \\.?/\n { append_string(yytext + 1, yyleng - 1); zconflval.string = text; return T_WORD_QUOTE; } \\.? { append_string(yytext + 1, yyleng - 1); } \'|\" { if (str == yytext[0]) { BEGIN(PARAM); zconflval.string = text; return T_WORD_QUOTE; } else append_string(yytext, 1); } \n { printf("%s:%d:warning: multi-line strings not supported\n", zconf_curname(), zconf_lineno()); current_file->lineno++; BEGIN(INITIAL); return T_EOL; } <> { BEGIN(INITIAL); } } { [ \t]+ { ts = 0; for (i = 0; i < yyleng; i++) { if (yytext[i] == '\t') ts = (ts & ~7) + 8; else ts++; } last_ts = ts; if (first_ts) { if (ts < first_ts) { zconf_endhelp(); return T_HELPTEXT; } ts -= first_ts; while (ts > 8) { append_string(" ", 8); ts -= 8; } append_string(" ", ts); } } [ \t]*\n/[^ \t\n] { current_file->lineno++; zconf_endhelp(); return T_HELPTEXT; } [ \t]*\n { current_file->lineno++; append_string("\n", 1); } [^ \t\n].* { while (yyleng) { if ((yytext[yyleng-1] != ' ') && (yytext[yyleng-1] != '\t')) break; yyleng--; } append_string(yytext, yyleng); if (!first_ts) first_ts = last_ts; } <> { zconf_endhelp(); return T_HELPTEXT; } } <> { if (current_file) { zconf_endfile(); return T_EOL; } fclose(yyin); yyterminate(); } %% void zconf_starthelp(void) { new_string(); last_ts = first_ts = 0; BEGIN(HELP); } static void zconf_endhelp(void) { zconflval.string = text; BEGIN(INITIAL); } /* * Try to open specified file with following names: * ./name * $(srctree)/name * The latter is used when srctree is separate from objtree * when compiling the kernel. * Return NULL if file is not found. */ FILE *zconf_fopen(const char *name) { char *env, fullname[PATH_MAX+1]; FILE *f; f = fopen(name, "r"); if (!f && name != NULL && name[0] != '/') { env = getenv(SRCTREE); if (env) { sprintf(fullname, "%s/%s", env, name); f = fopen(fullname, "r"); } } return f; } void zconf_initscan(const char *name) { yyin = zconf_fopen(name); if (!yyin) { printf("can't find file %s\n", name); exit(1); } current_buf = malloc(sizeof(*current_buf)); memset(current_buf, 0, sizeof(*current_buf)); current_file = file_lookup(name); current_file->lineno = 1; current_file->flags = FILE_BUSY; } void zconf_nextfile(const char *name) { struct file *file = file_lookup(name); struct buffer *buf = malloc(sizeof(*buf)); memset(buf, 0, sizeof(*buf)); current_buf->state = YY_CURRENT_BUFFER; yyin = zconf_fopen(file->name); if (!yyin) { printf("%s:%d: can't open file \"%s\"\n", zconf_curname(), zconf_lineno(), file->name); exit(1); } yy_switch_to_buffer(yy_create_buffer(yyin, YY_BUF_SIZE)); buf->parent = current_buf; current_buf = buf; if (file->flags & FILE_BUSY) { printf("%s:%d: do not source '%s' from itself\n", zconf_curname(), zconf_lineno(), name); exit(1); } if (file->flags & FILE_SCANNED) { printf("%s:%d: file '%s' is already sourced from '%s'\n", zconf_curname(), zconf_lineno(), name, file->parent->name); exit(1); } file->flags |= FILE_BUSY; file->lineno = 1; file->parent = current_file; current_file = file; } static void zconf_endfile(void) { struct buffer *parent; current_file->flags |= FILE_SCANNED; current_file->flags &= ~FILE_BUSY; current_file = current_file->parent; parent = current_buf->parent; if (parent) { fclose(yyin); yy_delete_buffer(YY_CURRENT_BUFFER); yy_switch_to_buffer(parent->state); } free(current_buf); current_buf = parent; } int zconf_lineno(void) { return current_pos.lineno; } const char *zconf_curname(void) { return current_pos.file ? current_pos.file->name : ""; } tinyvisor/bios/tools/kconfig/lxdialog/0000755006644000001440000000000012206363326020406 5ustar yuichi_xyuserstinyvisor/bios/tools/kconfig/lxdialog/menubox.c0000644006644000001440000002546611733243570022246 0ustar yuichi_xyusers/* * menubox.c -- implements the menu box * * ORIGINAL AUTHOR: Savio Lam (lam836@cs.cuhk.hk) * MODIFIED FOR LINUX KERNEL CONFIG BY: William Roadcap (roadcapw@cfw.com) * * 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; either version 2 * of the License, or (at your option) any later version. * * 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. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ /* * Changes by Clifford Wolf (god@clifford.at) * * [ 1998-06-13 ] * * *) A bugfix for the Page-Down problem * * *) Formerly when I used Page Down and Page Up, the cursor would be set * to the first position in the menu box. Now lxdialog is a bit * smarter and works more like other menu systems (just have a look at * it). * * *) Formerly if I selected something my scrolling would be broken because * lxdialog is re-invoked by the Menuconfig shell script, can't * remember the last scrolling position, and just sets it so that the * cursor is at the bottom of the box. Now it writes the temporary file * lxdialog.scrltmp which contains this information. The file is * deleted by lxdialog if the user leaves a submenu or enters a new * one, but it would be nice if Menuconfig could make another "rm -f" * just to be sure. Just try it out - you will recognise a difference! * * [ 1998-06-14 ] * * *) Now lxdialog is crash-safe against broken "lxdialog.scrltmp" files * and menus change their size on the fly. * * *) If for some reason the last scrolling position is not saved by * lxdialog, it sets the scrolling so that the selected item is in the * middle of the menu box, not at the bottom. * * 02 January 1999, Michael Elizabeth Chastain (mec@shout.net) * Reset 'scroll' to 0 if the value from lxdialog.scrltmp is bogus. * This fixes a bug in Menuconfig where using ' ' to descend into menus * would leave mis-synchronized lxdialog.scrltmp files lying around, * fscanf would read in 'scroll', and eventually that value would get used. */ #include "dialog.h" static int menu_width, item_x; /* * Print menu item */ static void do_print_item(WINDOW * win, const char *item, int line_y, int selected, int hotkey) { int j; char *menu_item = malloc(menu_width + 1); strncpy(menu_item, item, menu_width - item_x); menu_item[menu_width - item_x] = '\0'; j = first_alpha(menu_item, "YyNnMmHh"); /* Clear 'residue' of last item */ wattrset(win, dlg.menubox.atr); wmove(win, line_y, 0); #if OLD_NCURSES { int i; for (i = 0; i < menu_width; i++) waddch(win, ' '); } #else wclrtoeol(win); #endif wattrset(win, selected ? dlg.item_selected.atr : dlg.item.atr); mvwaddstr(win, line_y, item_x, menu_item); if (hotkey) { wattrset(win, selected ? dlg.tag_key_selected.atr : dlg.tag_key.atr); mvwaddch(win, line_y, item_x + j, menu_item[j]); } if (selected) { wmove(win, line_y, item_x + 1); } free(menu_item); wrefresh(win); } #define print_item(index, choice, selected) \ do { \ item_set(index); \ do_print_item(menu, item_str(), choice, selected, !item_is_tag(':')); \ } while (0) /* * Print the scroll indicators. */ static void print_arrows(WINDOW * win, int item_no, int scroll, int y, int x, int height) { int cur_y, cur_x; getyx(win, cur_y, cur_x); wmove(win, y, x); if (scroll > 0) { wattrset(win, dlg.uarrow.atr); waddch(win, ACS_UARROW); waddstr(win, "(-)"); } else { wattrset(win, dlg.menubox.atr); waddch(win, ACS_HLINE); waddch(win, ACS_HLINE); waddch(win, ACS_HLINE); waddch(win, ACS_HLINE); } y = y + height + 1; wmove(win, y, x); wrefresh(win); if ((height < item_no) && (scroll + height < item_no)) { wattrset(win, dlg.darrow.atr); waddch(win, ACS_DARROW); waddstr(win, "(+)"); } else { wattrset(win, dlg.menubox_border.atr); waddch(win, ACS_HLINE); waddch(win, ACS_HLINE); waddch(win, ACS_HLINE); waddch(win, ACS_HLINE); } wmove(win, cur_y, cur_x); wrefresh(win); } /* * Display the termination buttons. */ static void print_buttons(WINDOW * win, int height, int width, int selected) { int x = width / 2 - 16; int y = height - 2; print_button(win, gettext("Select"), y, x, selected == 0); print_button(win, gettext(" Exit "), y, x + 12, selected == 1); print_button(win, gettext(" Help "), y, x + 24, selected == 2); wmove(win, y, x + 1 + 12 * selected); wrefresh(win); } /* scroll up n lines (n may be negative) */ static void do_scroll(WINDOW *win, int *scroll, int n) { /* Scroll menu up */ scrollok(win, TRUE); wscrl(win, n); scrollok(win, FALSE); *scroll = *scroll + n; wrefresh(win); } /* * Display a menu for choosing among a number of options */ int dialog_menu(const char *title, const char *prompt, const void *selected, int *s_scroll) { int i, j, x, y, box_x, box_y; int height, width, menu_height; int key = 0, button = 0, scroll = 0, choice = 0; int first_item = 0, max_choice; WINDOW *dialog, *menu; do_resize: height = getmaxy(stdscr); width = getmaxx(stdscr); if (height < 15 || width < 65) return -ERRDISPLAYTOOSMALL; height -= 4; width -= 5; menu_height = height - 10; max_choice = MIN(menu_height, item_count()); /* center dialog box on screen */ x = (COLS - width) / 2; y = (LINES - height) / 2; draw_shadow(stdscr, y, x, height, width); dialog = newwin(height, width, y, x); keypad(dialog, TRUE); draw_box(dialog, 0, 0, height, width, dlg.dialog.atr, dlg.border.atr); wattrset(dialog, dlg.border.atr); mvwaddch(dialog, height - 3, 0, ACS_LTEE); for (i = 0; i < width - 2; i++) waddch(dialog, ACS_HLINE); wattrset(dialog, dlg.dialog.atr); wbkgdset(dialog, dlg.dialog.atr & A_COLOR); waddch(dialog, ACS_RTEE); print_title(dialog, title, width); wattrset(dialog, dlg.dialog.atr); print_autowrap(dialog, prompt, width - 2, 1, 3); menu_width = width - 6; box_y = height - menu_height - 5; box_x = (width - menu_width) / 2 - 1; /* create new window for the menu */ menu = subwin(dialog, menu_height, menu_width, y + box_y + 1, x + box_x + 1); keypad(menu, TRUE); /* draw a box around the menu items */ draw_box(dialog, box_y, box_x, menu_height + 2, menu_width + 2, dlg.menubox_border.atr, dlg.menubox.atr); if (menu_width >= 80) item_x = (menu_width - 70) / 2; else item_x = 4; /* Set choice to default item */ item_foreach() if (selected && (selected == item_data())) choice = item_n(); /* get the saved scroll info */ scroll = *s_scroll; if ((scroll <= choice) && (scroll + max_choice > choice) && (scroll >= 0) && (scroll + max_choice <= item_count())) { first_item = scroll; choice = choice - scroll; } else { scroll = 0; } if ((choice >= max_choice)) { if (choice >= item_count() - max_choice / 2) scroll = first_item = item_count() - max_choice; else scroll = first_item = choice - max_choice / 2; choice = choice - scroll; } /* Print the menu */ for (i = 0; i < max_choice; i++) { print_item(first_item + i, i, i == choice); } wnoutrefresh(menu); print_arrows(dialog, item_count(), scroll, box_y, box_x + item_x + 1, menu_height); print_buttons(dialog, height, width, 0); wmove(menu, choice, item_x + 1); wrefresh(menu); while (key != KEY_ESC) { key = wgetch(menu); if (key < 256 && isalpha(key)) key = tolower(key); if (strchr("ynmh", key)) i = max_choice; else { for (i = choice + 1; i < max_choice; i++) { item_set(scroll + i); j = first_alpha(item_str(), "YyNnMmHh"); if (key == tolower(item_str()[j])) break; } if (i == max_choice) for (i = 0; i < max_choice; i++) { item_set(scroll + i); j = first_alpha(item_str(), "YyNnMmHh"); if (key == tolower(item_str()[j])) break; } } if (i < max_choice || key == KEY_UP || key == KEY_DOWN || key == '-' || key == '+' || key == KEY_PPAGE || key == KEY_NPAGE) { /* Remove highligt of current item */ print_item(scroll + choice, choice, FALSE); if (key == KEY_UP || key == '-') { if (choice < 2 && scroll) { /* Scroll menu down */ do_scroll(menu, &scroll, -1); print_item(scroll, 0, FALSE); } else choice = MAX(choice - 1, 0); } else if (key == KEY_DOWN || key == '+') { print_item(scroll+choice, choice, FALSE); if ((choice > max_choice - 3) && (scroll + max_choice < item_count())) { /* Scroll menu up */ do_scroll(menu, &scroll, 1); print_item(scroll+max_choice - 1, max_choice - 1, FALSE); } else choice = MIN(choice + 1, max_choice - 1); } else if (key == KEY_PPAGE) { scrollok(menu, TRUE); for (i = 0; (i < max_choice); i++) { if (scroll > 0) { do_scroll(menu, &scroll, -1); print_item(scroll, 0, FALSE); } else { if (choice > 0) choice--; } } } else if (key == KEY_NPAGE) { for (i = 0; (i < max_choice); i++) { if (scroll + max_choice < item_count()) { do_scroll(menu, &scroll, 1); print_item(scroll+max_choice-1, max_choice - 1, FALSE); } else { if (choice + 1 < max_choice) choice++; } } } else choice = i; print_item(scroll + choice, choice, TRUE); print_arrows(dialog, item_count(), scroll, box_y, box_x + item_x + 1, menu_height); wnoutrefresh(dialog); wrefresh(menu); continue; /* wait for another key press */ } switch (key) { case KEY_LEFT: case TAB: case KEY_RIGHT: button = ((key == KEY_LEFT ? --button : ++button) < 0) ? 2 : (button > 2 ? 0 : button); print_buttons(dialog, height, width, button); wrefresh(menu); break; case ' ': case 's': case 'y': case 'n': case 'm': case '/': case 'h': case '?': case 'z': case '\n': /* save scroll info */ *s_scroll = scroll; delwin(menu); delwin(dialog); item_set(scroll + choice); item_set_selected(1); switch (key) { case 'h': case '?': return 2; case 's': case 'y': return 3; case 'n': return 4; case 'm': return 5; case ' ': return 6; case '/': return 7; case 'z': return 8; case '\n': return button; } return 0; case 'e': case 'x': key = KEY_ESC; break; case KEY_ESC: key = on_key_esc(menu); break; case KEY_RESIZE: on_key_resize(); delwin(menu); delwin(dialog); goto do_resize; } } delwin(menu); delwin(dialog); return key; /* ESC pressed */ } tinyvisor/bios/tools/kconfig/lxdialog/util.c0000644006644000001440000004130711733243570021536 0ustar yuichi_xyusers/* * util.c * * ORIGINAL AUTHOR: Savio Lam (lam836@cs.cuhk.hk) * MODIFIED FOR LINUX KERNEL CONFIG BY: William Roadcap (roadcap@cfw.com) * * 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; either version 2 * of the License, or (at your option) any later version. * * 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. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ #include #include "dialog.h" struct dialog_info dlg; static void set_mono_theme(void) { dlg.screen.atr = A_NORMAL; dlg.shadow.atr = A_NORMAL; dlg.dialog.atr = A_NORMAL; dlg.title.atr = A_BOLD; dlg.border.atr = A_NORMAL; dlg.button_active.atr = A_REVERSE; dlg.button_inactive.atr = A_DIM; dlg.button_key_active.atr = A_REVERSE; dlg.button_key_inactive.atr = A_BOLD; dlg.button_label_active.atr = A_REVERSE; dlg.button_label_inactive.atr = A_NORMAL; dlg.inputbox.atr = A_NORMAL; dlg.inputbox_border.atr = A_NORMAL; dlg.searchbox.atr = A_NORMAL; dlg.searchbox_title.atr = A_BOLD; dlg.searchbox_border.atr = A_NORMAL; dlg.position_indicator.atr = A_BOLD; dlg.menubox.atr = A_NORMAL; dlg.menubox_border.atr = A_NORMAL; dlg.item.atr = A_NORMAL; dlg.item_selected.atr = A_REVERSE; dlg.tag.atr = A_BOLD; dlg.tag_selected.atr = A_REVERSE; dlg.tag_key.atr = A_BOLD; dlg.tag_key_selected.atr = A_REVERSE; dlg.check.atr = A_BOLD; dlg.check_selected.atr = A_REVERSE; dlg.uarrow.atr = A_BOLD; dlg.darrow.atr = A_BOLD; } #define DLG_COLOR(dialog, f, b, h) \ do { \ dlg.dialog.fg = (f); \ dlg.dialog.bg = (b); \ dlg.dialog.hl = (h); \ } while (0) static void set_classic_theme(void) { DLG_COLOR(screen, COLOR_CYAN, COLOR_BLUE, true); DLG_COLOR(shadow, COLOR_BLACK, COLOR_BLACK, true); DLG_COLOR(dialog, COLOR_BLACK, COLOR_WHITE, false); DLG_COLOR(title, COLOR_YELLOW, COLOR_WHITE, true); DLG_COLOR(border, COLOR_WHITE, COLOR_WHITE, true); DLG_COLOR(button_active, COLOR_WHITE, COLOR_BLUE, true); DLG_COLOR(button_inactive, COLOR_BLACK, COLOR_WHITE, false); DLG_COLOR(button_key_active, COLOR_WHITE, COLOR_BLUE, true); DLG_COLOR(button_key_inactive, COLOR_RED, COLOR_WHITE, false); DLG_COLOR(button_label_active, COLOR_YELLOW, COLOR_BLUE, true); DLG_COLOR(button_label_inactive, COLOR_BLACK, COLOR_WHITE, true); DLG_COLOR(inputbox, COLOR_BLACK, COLOR_WHITE, false); DLG_COLOR(inputbox_border, COLOR_BLACK, COLOR_WHITE, false); DLG_COLOR(searchbox, COLOR_BLACK, COLOR_WHITE, false); DLG_COLOR(searchbox_title, COLOR_YELLOW, COLOR_WHITE, true); DLG_COLOR(searchbox_border, COLOR_WHITE, COLOR_WHITE, true); DLG_COLOR(position_indicator, COLOR_YELLOW, COLOR_WHITE, true); DLG_COLOR(menubox, COLOR_BLACK, COLOR_WHITE, false); DLG_COLOR(menubox_border, COLOR_WHITE, COLOR_WHITE, true); DLG_COLOR(item, COLOR_BLACK, COLOR_WHITE, false); DLG_COLOR(item_selected, COLOR_WHITE, COLOR_BLUE, true); DLG_COLOR(tag, COLOR_YELLOW, COLOR_WHITE, true); DLG_COLOR(tag_selected, COLOR_YELLOW, COLOR_BLUE, true); DLG_COLOR(tag_key, COLOR_YELLOW, COLOR_WHITE, true); DLG_COLOR(tag_key_selected, COLOR_YELLOW, COLOR_BLUE, true); DLG_COLOR(check, COLOR_BLACK, COLOR_WHITE, false); DLG_COLOR(check_selected, COLOR_WHITE, COLOR_BLUE, true); DLG_COLOR(uarrow, COLOR_GREEN, COLOR_WHITE, true); DLG_COLOR(darrow, COLOR_GREEN, COLOR_WHITE, true); } static void set_blackbg_theme(void) { DLG_COLOR(screen, COLOR_RED, COLOR_BLACK, true); DLG_COLOR(shadow, COLOR_BLACK, COLOR_BLACK, false); DLG_COLOR(dialog, COLOR_WHITE, COLOR_BLACK, false); DLG_COLOR(title, COLOR_RED, COLOR_BLACK, false); DLG_COLOR(border, COLOR_BLACK, COLOR_BLACK, true); DLG_COLOR(button_active, COLOR_YELLOW, COLOR_RED, false); DLG_COLOR(button_inactive, COLOR_YELLOW, COLOR_BLACK, false); DLG_COLOR(button_key_active, COLOR_YELLOW, COLOR_RED, true); DLG_COLOR(button_key_inactive, COLOR_RED, COLOR_BLACK, false); DLG_COLOR(button_label_active, COLOR_WHITE, COLOR_RED, false); DLG_COLOR(button_label_inactive, COLOR_BLACK, COLOR_BLACK, true); DLG_COLOR(inputbox, COLOR_YELLOW, COLOR_BLACK, false); DLG_COLOR(inputbox_border, COLOR_YELLOW, COLOR_BLACK, false); DLG_COLOR(searchbox, COLOR_YELLOW, COLOR_BLACK, false); DLG_COLOR(searchbox_title, COLOR_YELLOW, COLOR_BLACK, true); DLG_COLOR(searchbox_border, COLOR_BLACK, COLOR_BLACK, true); DLG_COLOR(position_indicator, COLOR_RED, COLOR_BLACK, false); DLG_COLOR(menubox, COLOR_YELLOW, COLOR_BLACK, false); DLG_COLOR(menubox_border, COLOR_BLACK, COLOR_BLACK, true); DLG_COLOR(item, COLOR_WHITE, COLOR_BLACK, false); DLG_COLOR(item_selected, COLOR_WHITE, COLOR_RED, false); DLG_COLOR(tag, COLOR_RED, COLOR_BLACK, false); DLG_COLOR(tag_selected, COLOR_YELLOW, COLOR_RED, true); DLG_COLOR(tag_key, COLOR_RED, COLOR_BLACK, false); DLG_COLOR(tag_key_selected, COLOR_YELLOW, COLOR_RED, true); DLG_COLOR(check, COLOR_YELLOW, COLOR_BLACK, false); DLG_COLOR(check_selected, COLOR_YELLOW, COLOR_RED, true); DLG_COLOR(uarrow, COLOR_RED, COLOR_BLACK, false); DLG_COLOR(darrow, COLOR_RED, COLOR_BLACK, false); } static void set_bluetitle_theme(void) { set_classic_theme(); DLG_COLOR(title, COLOR_BLUE, COLOR_WHITE, true); DLG_COLOR(button_key_active, COLOR_YELLOW, COLOR_BLUE, true); DLG_COLOR(button_label_active, COLOR_WHITE, COLOR_BLUE, true); DLG_COLOR(searchbox_title, COLOR_BLUE, COLOR_WHITE, true); DLG_COLOR(position_indicator, COLOR_BLUE, COLOR_WHITE, true); DLG_COLOR(tag, COLOR_BLUE, COLOR_WHITE, true); DLG_COLOR(tag_key, COLOR_BLUE, COLOR_WHITE, true); } /* * Select color theme */ static int set_theme(const char *theme) { int use_color = 1; if (!theme) set_bluetitle_theme(); else if (strcmp(theme, "classic") == 0) set_classic_theme(); else if (strcmp(theme, "bluetitle") == 0) set_bluetitle_theme(); else if (strcmp(theme, "blackbg") == 0) set_blackbg_theme(); else if (strcmp(theme, "mono") == 0) use_color = 0; return use_color; } static void init_one_color(struct dialog_color *color) { static int pair = 0; pair++; init_pair(pair, color->fg, color->bg); if (color->hl) color->atr = A_BOLD | COLOR_PAIR(pair); else color->atr = COLOR_PAIR(pair); } static void init_dialog_colors(void) { init_one_color(&dlg.screen); init_one_color(&dlg.shadow); init_one_color(&dlg.dialog); init_one_color(&dlg.title); init_one_color(&dlg.border); init_one_color(&dlg.button_active); init_one_color(&dlg.button_inactive); init_one_color(&dlg.button_key_active); init_one_color(&dlg.button_key_inactive); init_one_color(&dlg.button_label_active); init_one_color(&dlg.button_label_inactive); init_one_color(&dlg.inputbox); init_one_color(&dlg.inputbox_border); init_one_color(&dlg.searchbox); init_one_color(&dlg.searchbox_title); init_one_color(&dlg.searchbox_border); init_one_color(&dlg.position_indicator); init_one_color(&dlg.menubox); init_one_color(&dlg.menubox_border); init_one_color(&dlg.item); init_one_color(&dlg.item_selected); init_one_color(&dlg.tag); init_one_color(&dlg.tag_selected); init_one_color(&dlg.tag_key); init_one_color(&dlg.tag_key_selected); init_one_color(&dlg.check); init_one_color(&dlg.check_selected); init_one_color(&dlg.uarrow); init_one_color(&dlg.darrow); } /* * Setup for color display */ static void color_setup(const char *theme) { int use_color; use_color = set_theme(theme); if (use_color && has_colors()) { start_color(); init_dialog_colors(); } else set_mono_theme(); } /* * Set window to attribute 'attr' */ void attr_clear(WINDOW * win, int height, int width, chtype attr) { int i, j; wattrset(win, attr); for (i = 0; i < height; i++) { wmove(win, i, 0); for (j = 0; j < width; j++) waddch(win, ' '); } touchwin(win); } void dialog_clear(void) { attr_clear(stdscr, LINES, COLS, dlg.screen.atr); /* Display background title if it exists ... - SLH */ if (dlg.backtitle != NULL) { int i; wattrset(stdscr, dlg.screen.atr); mvwaddstr(stdscr, 0, 1, (char *)dlg.backtitle); wmove(stdscr, 1, 1); for (i = 1; i < COLS - 1; i++) waddch(stdscr, ACS_HLINE); } wnoutrefresh(stdscr); } /* * Do some initialization for dialog */ int init_dialog(const char *backtitle) { int height, width; initscr(); /* Init curses */ getmaxyx(stdscr, height, width); if (height < 19 || width < 80) { endwin(); return -ERRDISPLAYTOOSMALL; } dlg.backtitle = backtitle; color_setup(getenv("MENUCONFIG_COLOR")); keypad(stdscr, TRUE); cbreak(); noecho(); dialog_clear(); return 0; } void set_dialog_backtitle(const char *backtitle) { dlg.backtitle = backtitle; } /* * End using dialog functions. */ void end_dialog(int x, int y) { /* move cursor back to original position */ move(y, x); refresh(); endwin(); } /* Print the title of the dialog. Center the title and truncate * tile if wider than dialog (- 2 chars). **/ void print_title(WINDOW *dialog, const char *title, int width) { if (title) { int tlen = MIN(width - 2, strlen(title)); wattrset(dialog, dlg.title.atr); mvwaddch(dialog, 0, (width - tlen) / 2 - 1, ' '); mvwaddnstr(dialog, 0, (width - tlen)/2, title, tlen); waddch(dialog, ' '); } } /* * Print a string of text in a window, automatically wrap around to the * next line if the string is too long to fit on one line. Newline * characters '\n' are replaced by spaces. We start on a new line * if there is no room for at least 4 nonblanks following a double-space. */ void print_autowrap(WINDOW * win, const char *prompt, int width, int y, int x) { int newl, cur_x, cur_y; int i, prompt_len, room, wlen; char tempstr[MAX_LEN + 1], *word, *sp, *sp2; strcpy(tempstr, prompt); prompt_len = strlen(tempstr); /* * Remove newlines */ for (i = 0; i < prompt_len; i++) { if (tempstr[i] == '\n') tempstr[i] = ' '; } if (prompt_len <= width - x * 2) { /* If prompt is short */ wmove(win, y, (width - prompt_len) / 2); waddstr(win, tempstr); } else { cur_x = x; cur_y = y; newl = 1; word = tempstr; while (word && *word) { sp = strchr(word, ' '); if (sp) *sp++ = 0; /* Wrap to next line if either the word does not fit, or it is the first word of a new sentence, and it is short, and the next word does not fit. */ room = width - cur_x; wlen = strlen(word); if (wlen > room || (newl && wlen < 4 && sp && wlen + 1 + strlen(sp) > room && (!(sp2 = strchr(sp, ' ')) || wlen + 1 + (sp2 - sp) > room))) { cur_y++; cur_x = x; } wmove(win, cur_y, cur_x); waddstr(win, word); getyx(win, cur_y, cur_x); cur_x++; if (sp && *sp == ' ') { cur_x++; /* double space */ while (*++sp == ' ') ; newl = 1; } else newl = 0; word = sp; } } } /* * Print a button */ void print_button(WINDOW * win, const char *label, int y, int x, int selected) { int i, temp; wmove(win, y, x); wattrset(win, selected ? dlg.button_active.atr : dlg.button_inactive.atr); waddstr(win, "<"); temp = strspn(label, " "); label += temp; wattrset(win, selected ? dlg.button_label_active.atr : dlg.button_label_inactive.atr); for (i = 0; i < temp; i++) waddch(win, ' '); wattrset(win, selected ? dlg.button_key_active.atr : dlg.button_key_inactive.atr); waddch(win, label[0]); wattrset(win, selected ? dlg.button_label_active.atr : dlg.button_label_inactive.atr); waddstr(win, (char *)label + 1); wattrset(win, selected ? dlg.button_active.atr : dlg.button_inactive.atr); waddstr(win, ">"); wmove(win, y, x + temp + 1); } /* * Draw a rectangular box with line drawing characters */ void draw_box(WINDOW * win, int y, int x, int height, int width, chtype box, chtype border) { int i, j; wattrset(win, 0); for (i = 0; i < height; i++) { wmove(win, y + i, x); for (j = 0; j < width; j++) if (!i && !j) waddch(win, border | ACS_ULCORNER); else if (i == height - 1 && !j) waddch(win, border | ACS_LLCORNER); else if (!i && j == width - 1) waddch(win, box | ACS_URCORNER); else if (i == height - 1 && j == width - 1) waddch(win, box | ACS_LRCORNER); else if (!i) waddch(win, border | ACS_HLINE); else if (i == height - 1) waddch(win, box | ACS_HLINE); else if (!j) waddch(win, border | ACS_VLINE); else if (j == width - 1) waddch(win, box | ACS_VLINE); else waddch(win, box | ' '); } } /* * Draw shadows along the right and bottom edge to give a more 3D look * to the boxes */ void draw_shadow(WINDOW * win, int y, int x, int height, int width) { int i; if (has_colors()) { /* Whether terminal supports color? */ wattrset(win, dlg.shadow.atr); wmove(win, y + height, x + 2); for (i = 0; i < width; i++) waddch(win, winch(win) & A_CHARTEXT); for (i = y + 1; i < y + height + 1; i++) { wmove(win, i, x + width); waddch(win, winch(win) & A_CHARTEXT); waddch(win, winch(win) & A_CHARTEXT); } wnoutrefresh(win); } } /* * Return the position of the first alphabetic character in a string. */ int first_alpha(const char *string, const char *exempt) { int i, in_paren = 0, c; for (i = 0; i < strlen(string); i++) { c = tolower(string[i]); if (strchr("<[(", c)) ++in_paren; if (strchr(">])", c) && in_paren > 0) --in_paren; if ((!in_paren) && isalpha(c) && strchr(exempt, c) == 0) return i; } return 0; } /* * ncurses uses ESC to detect escaped char sequences. This resutl in * a small timeout before ESC is actually delivered to the application. * lxdialog suggest which is correctly translated to two * times esc. But then we need to ignore the second esc to avoid stepping * out one menu too much. Filter away all escaped key sequences since * keypad(FALSE) turn off ncurses support for escape sequences - and thats * needed to make notimeout() do as expected. */ int on_key_esc(WINDOW *win) { int key; int key2; int key3; nodelay(win, TRUE); keypad(win, FALSE); key = wgetch(win); key2 = wgetch(win); do { key3 = wgetch(win); } while (key3 != ERR); nodelay(win, FALSE); keypad(win, TRUE); if (key == KEY_ESC && key2 == ERR) return KEY_ESC; else if (key != ERR && key != KEY_ESC && key2 == ERR) ungetch(key); return -1; } /* redraw screen in new size */ int on_key_resize(void) { dialog_clear(); return KEY_RESIZE; } struct dialog_list *item_cur; struct dialog_list item_nil; struct dialog_list *item_head; void item_reset(void) { struct dialog_list *p, *next; for (p = item_head; p; p = next) { next = p->next; free(p); } item_head = NULL; item_cur = &item_nil; } void item_make(const char *fmt, ...) { va_list ap; struct dialog_list *p = malloc(sizeof(*p)); if (item_head) item_cur->next = p; else item_head = p; item_cur = p; memset(p, 0, sizeof(*p)); va_start(ap, fmt); vsnprintf(item_cur->node.str, sizeof(item_cur->node.str), fmt, ap); va_end(ap); } void item_add_str(const char *fmt, ...) { va_list ap; size_t avail; avail = sizeof(item_cur->node.str) - strlen(item_cur->node.str); va_start(ap, fmt); vsnprintf(item_cur->node.str + strlen(item_cur->node.str), avail, fmt, ap); item_cur->node.str[sizeof(item_cur->node.str) - 1] = '\0'; va_end(ap); } void item_set_tag(char tag) { item_cur->node.tag = tag; } void item_set_data(void *ptr) { item_cur->node.data = ptr; } void item_set_selected(int val) { item_cur->node.selected = val; } int item_activate_selected(void) { item_foreach() if (item_is_selected()) return 1; return 0; } void *item_data(void) { return item_cur->node.data; } char item_tag(void) { return item_cur->node.tag; } int item_count(void) { int n = 0; struct dialog_list *p; for (p = item_head; p; p = p->next) n++; return n; } void item_set(int n) { int i = 0; item_foreach() if (i++ == n) return; } int item_n(void) { int n = 0; struct dialog_list *p; for (p = item_head; p; p = p->next) { if (p == item_cur) return n; n++; } return 0; } const char *item_str(void) { return item_cur->node.str; } int item_is_selected(void) { return (item_cur->node.selected != 0); } int item_is_tag(char tag) { return (item_cur->node.tag == tag); } tinyvisor/bios/tools/kconfig/lxdialog/BIG.FAT.WARNING0000644006644000001440000000035211733243570022451 0ustar yuichi_xyusersThis is NOT the official version of dialog. This version has been significantly modified from the original. It is for use by the Linux kernel configuration script. Please do not bother Savio Lam with questions about this program. tinyvisor/bios/tools/kconfig/lxdialog/check-lxdialog.sh0000644006644000001440000000335311733243570023626 0ustar yuichi_xyusers#!/bin/sh # Check ncurses compatibility # What library to link ldflags() { for ext in so a dylib ; do for lib in ncursesw ncurses curses ; do $cc -print-file-name=lib${lib}.${ext} | grep -q / if [ $? -eq 0 ]; then echo "-l${lib}" exit fi done done exit 1 } # Where is ncurses.h? ccflags() { if [ -f /usr/include/ncurses/ncurses.h ]; then echo '-I/usr/include/ncurses -DCURSES_LOC=""' elif [ -f /usr/include/ncurses/curses.h ]; then echo '-I/usr/include/ncurses -DCURSES_LOC=""' elif [ -f /usr/include/ncursesw/curses.h ]; then echo '-I/usr/include/ncursesw -DCURSES_LOC=""' elif [ -f /usr/include/ncurses.h ]; then echo '-DCURSES_LOC=""' else echo '-DCURSES_LOC=""' fi } # Temp file, try to clean up after us tmp=.lxdialog.tmp trap "rm -f $tmp" 0 1 2 3 15 # Check if we can link to ncurses check() { $cc -xc - -o $tmp 2>/dev/null <<'EOF' #include CURSES_LOC main() {} EOF if [ $? != 0 ]; then echo " *** Unable to find the ncurses libraries or the" 1>&2 echo " *** required header files." 1>&2 echo " *** 'make menuconfig' requires the ncurses libraries." 1>&2 echo " *** " 1>&2 echo " *** Install ncurses (ncurses-devel) and try again." 1>&2 echo " *** " 1>&2 exit 1 fi } usage() { printf "Usage: $0 [-check compiler options|-ccflags|-ldflags compiler options]\n" } if [ $# -eq 0 ]; then usage exit 1 fi cc="" case "$1" in "-check") shift cc="$@" check ;; "-ccflags") ccflags ;; "-ldflags") shift cc="$@" ldflags ;; "*") usage exit 1 ;; esac tinyvisor/bios/tools/kconfig/lxdialog/dialog.h0000644006644000001440000001505011733243570022021 0ustar yuichi_xyusers/* * dialog.h -- common declarations for all dialog modules * * AUTHOR: Savio Lam (lam836@cs.cuhk.hk) * * 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; either version 2 * of the License, or (at your option) any later version. * * 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. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ #include #include #include #include #include #include #include #ifndef KBUILD_NO_NLS # include #else # define gettext(Msgid) ((const char *) (Msgid)) #endif #ifdef __sun__ #define CURS_MACROS #endif #include CURSES_LOC /* * Colors in ncurses 1.9.9e do not work properly since foreground and * background colors are OR'd rather than separately masked. This version * of dialog was hacked to work with ncurses 1.9.9e, making it incompatible * with standard curses. The simplest fix (to make this work with standard * curses) uses the wbkgdset() function, not used in the original hack. * Turn it off if we're building with 1.9.9e, since it just confuses things. */ #if defined(NCURSES_VERSION) && defined(_NEED_WRAP) && !defined(GCC_PRINTFLIKE) #define OLD_NCURSES 1 #undef wbkgdset #define wbkgdset(w,p) /*nothing */ #else #define OLD_NCURSES 0 #endif #define TR(params) _tracef params #define KEY_ESC 27 #define TAB 9 #define MAX_LEN 2048 #define BUF_SIZE (10*1024) #define MIN(x,y) (x < y ? x : y) #define MAX(x,y) (x > y ? x : y) #ifndef ACS_ULCORNER #define ACS_ULCORNER '+' #endif #ifndef ACS_LLCORNER #define ACS_LLCORNER '+' #endif #ifndef ACS_URCORNER #define ACS_URCORNER '+' #endif #ifndef ACS_LRCORNER #define ACS_LRCORNER '+' #endif #ifndef ACS_HLINE #define ACS_HLINE '-' #endif #ifndef ACS_VLINE #define ACS_VLINE '|' #endif #ifndef ACS_LTEE #define ACS_LTEE '+' #endif #ifndef ACS_RTEE #define ACS_RTEE '+' #endif #ifndef ACS_UARROW #define ACS_UARROW '^' #endif #ifndef ACS_DARROW #define ACS_DARROW 'v' #endif /* error return codes */ #define ERRDISPLAYTOOSMALL (KEY_MAX + 1) /* * Color definitions */ struct dialog_color { chtype atr; /* Color attribute */ int fg; /* foreground */ int bg; /* background */ int hl; /* highlight this item */ }; struct dialog_info { const char *backtitle; struct dialog_color screen; struct dialog_color shadow; struct dialog_color dialog; struct dialog_color title; struct dialog_color border; struct dialog_color button_active; struct dialog_color button_inactive; struct dialog_color button_key_active; struct dialog_color button_key_inactive; struct dialog_color button_label_active; struct dialog_color button_label_inactive; struct dialog_color inputbox; struct dialog_color inputbox_border; struct dialog_color searchbox; struct dialog_color searchbox_title; struct dialog_color searchbox_border; struct dialog_color position_indicator; struct dialog_color menubox; struct dialog_color menubox_border; struct dialog_color item; struct dialog_color item_selected; struct dialog_color tag; struct dialog_color tag_selected; struct dialog_color tag_key; struct dialog_color tag_key_selected; struct dialog_color check; struct dialog_color check_selected; struct dialog_color uarrow; struct dialog_color darrow; }; /* * Global variables */ extern struct dialog_info dlg; extern char dialog_input_result[]; /* * Function prototypes */ /* item list as used by checklist and menubox */ void item_reset(void); void item_make(const char *fmt, ...); void item_add_str(const char *fmt, ...); void item_set_tag(char tag); void item_set_data(void *p); void item_set_selected(int val); int item_activate_selected(void); void *item_data(void); char item_tag(void); /* item list manipulation for lxdialog use */ #define MAXITEMSTR 200 struct dialog_item { char str[MAXITEMSTR]; /* promtp displayed */ char tag; void *data; /* pointer to menu item - used by menubox+checklist */ int selected; /* Set to 1 by dialog_*() function if selected. */ }; /* list of lialog_items */ struct dialog_list { struct dialog_item node; struct dialog_list *next; }; extern struct dialog_list *item_cur; extern struct dialog_list item_nil; extern struct dialog_list *item_head; int item_count(void); void item_set(int n); int item_n(void); const char *item_str(void); int item_is_selected(void); int item_is_tag(char tag); #define item_foreach() \ for (item_cur = item_head ? item_head: item_cur; \ item_cur && (item_cur != &item_nil); item_cur = item_cur->next) /* generic key handlers */ int on_key_esc(WINDOW *win); int on_key_resize(void); int init_dialog(const char *backtitle); void set_dialog_backtitle(const char *backtitle); void end_dialog(int x, int y); void attr_clear(WINDOW * win, int height, int width, chtype attr); void dialog_clear(void); void print_autowrap(WINDOW * win, const char *prompt, int width, int y, int x); void print_button(WINDOW * win, const char *label, int y, int x, int selected); void print_title(WINDOW *dialog, const char *title, int width); void draw_box(WINDOW * win, int y, int x, int height, int width, chtype box, chtype border); void draw_shadow(WINDOW * win, int y, int x, int height, int width); int first_alpha(const char *string, const char *exempt); int dialog_yesno(const char *title, const char *prompt, int height, int width); int dialog_msgbox(const char *title, const char *prompt, int height, int width, int pause); int dialog_textbox(const char *title, const char *file, int height, int width); int dialog_menu(const char *title, const char *prompt, const void *selected, int *s_scroll); int dialog_checklist(const char *title, const char *prompt, int height, int width, int list_height); extern char dialog_input_result[]; int dialog_inputbox(const char *title, const char *prompt, int height, int width, const char *init); /* * This is the base for fictitious keys, which activate * the buttons. * * Mouse-generated keys are the following: * -- the first 32 are used as numbers, in addition to '0'-'9' * -- the lowercase are used to signal mouse-enter events (M_EVENT + 'o') * -- uppercase chars are used to invoke the button (M_EVENT + 'O') */ #define M_EVENT (KEY_MAX+1) tinyvisor/bios/tools/kconfig/lxdialog/checklist.c0000644006644000001440000002031211733243570022523 0ustar yuichi_xyusers/* * checklist.c -- implements the checklist box * * ORIGINAL AUTHOR: Savio Lam (lam836@cs.cuhk.hk) * Stuart Herbert - S.Herbert@sheffield.ac.uk: radiolist extension * Alessandro Rubini - rubini@ipvvis.unipv.it: merged the two * MODIFIED FOR LINUX KERNEL CONFIG BY: William Roadcap (roadcap@cfw.com) * * 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; either version 2 * of the License, or (at your option) any later version. * * 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. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ #include "dialog.h" static int list_width, check_x, item_x; /* * Print list item */ static void print_item(WINDOW * win, int choice, int selected) { int i; char *list_item = malloc(list_width + 1); strncpy(list_item, item_str(), list_width - item_x); list_item[list_width - item_x] = '\0'; /* Clear 'residue' of last item */ wattrset(win, dlg.menubox.atr); wmove(win, choice, 0); for (i = 0; i < list_width; i++) waddch(win, ' '); wmove(win, choice, check_x); wattrset(win, selected ? dlg.check_selected.atr : dlg.check.atr); if (!item_is_tag(':')) wprintw(win, "(%c)", item_is_tag('X') ? 'X' : ' '); wattrset(win, selected ? dlg.tag_selected.atr : dlg.tag.atr); mvwaddch(win, choice, item_x, list_item[0]); wattrset(win, selected ? dlg.item_selected.atr : dlg.item.atr); waddstr(win, list_item + 1); if (selected) { wmove(win, choice, check_x + 1); wrefresh(win); } free(list_item); } /* * Print the scroll indicators. */ static void print_arrows(WINDOW * win, int choice, int item_no, int scroll, int y, int x, int height) { wmove(win, y, x); if (scroll > 0) { wattrset(win, dlg.uarrow.atr); waddch(win, ACS_UARROW); waddstr(win, "(-)"); } else { wattrset(win, dlg.menubox.atr); waddch(win, ACS_HLINE); waddch(win, ACS_HLINE); waddch(win, ACS_HLINE); waddch(win, ACS_HLINE); } y = y + height + 1; wmove(win, y, x); if ((height < item_no) && (scroll + choice < item_no - 1)) { wattrset(win, dlg.darrow.atr); waddch(win, ACS_DARROW); waddstr(win, "(+)"); } else { wattrset(win, dlg.menubox_border.atr); waddch(win, ACS_HLINE); waddch(win, ACS_HLINE); waddch(win, ACS_HLINE); waddch(win, ACS_HLINE); } } /* * Display the termination buttons */ static void print_buttons(WINDOW * dialog, int height, int width, int selected) { int x = width / 2 - 11; int y = height - 2; print_button(dialog, gettext("Select"), y, x, selected == 0); print_button(dialog, gettext(" Help "), y, x + 14, selected == 1); wmove(dialog, y, x + 1 + 14 * selected); wrefresh(dialog); } /* * Display a dialog box with a list of options that can be turned on or off * in the style of radiolist (only one option turned on at a time). */ int dialog_checklist(const char *title, const char *prompt, int height, int width, int list_height) { int i, x, y, box_x, box_y; int key = 0, button = 0, choice = 0, scroll = 0, max_choice; WINDOW *dialog, *list; /* which item to highlight */ item_foreach() { if (item_is_tag('X')) choice = item_n(); if (item_is_selected()) { choice = item_n(); break; } } do_resize: if (getmaxy(stdscr) < (height + 6)) return -ERRDISPLAYTOOSMALL; if (getmaxx(stdscr) < (width + 6)) return -ERRDISPLAYTOOSMALL; max_choice = MIN(list_height, item_count()); /* center dialog box on screen */ x = (COLS - width) / 2; y = (LINES - height) / 2; draw_shadow(stdscr, y, x, height, width); dialog = newwin(height, width, y, x); keypad(dialog, TRUE); draw_box(dialog, 0, 0, height, width, dlg.dialog.atr, dlg.border.atr); wattrset(dialog, dlg.border.atr); mvwaddch(dialog, height - 3, 0, ACS_LTEE); for (i = 0; i < width - 2; i++) waddch(dialog, ACS_HLINE); wattrset(dialog, dlg.dialog.atr); waddch(dialog, ACS_RTEE); print_title(dialog, title, width); wattrset(dialog, dlg.dialog.atr); print_autowrap(dialog, prompt, width - 2, 1, 3); list_width = width - 6; box_y = height - list_height - 5; box_x = (width - list_width) / 2 - 1; /* create new window for the list */ list = subwin(dialog, list_height, list_width, y + box_y + 1, x + box_x + 1); keypad(list, TRUE); /* draw a box around the list items */ draw_box(dialog, box_y, box_x, list_height + 2, list_width + 2, dlg.menubox_border.atr, dlg.menubox.atr); /* Find length of longest item in order to center checklist */ check_x = 0; item_foreach() check_x = MAX(check_x, strlen(item_str()) + 4); check_x = MIN(check_x, list_width); check_x = (list_width - check_x) / 2; item_x = check_x + 4; if (choice >= list_height) { scroll = choice - list_height + 1; choice -= scroll; } /* Print the list */ for (i = 0; i < max_choice; i++) { item_set(scroll + i); print_item(list, i, i == choice); } print_arrows(dialog, choice, item_count(), scroll, box_y, box_x + check_x + 5, list_height); print_buttons(dialog, height, width, 0); wnoutrefresh(dialog); wnoutrefresh(list); doupdate(); while (key != KEY_ESC) { key = wgetch(dialog); for (i = 0; i < max_choice; i++) { item_set(i + scroll); if (toupper(key) == toupper(item_str()[0])) break; } if (i < max_choice || key == KEY_UP || key == KEY_DOWN || key == '+' || key == '-') { if (key == KEY_UP || key == '-') { if (!choice) { if (!scroll) continue; /* Scroll list down */ if (list_height > 1) { /* De-highlight current first item */ item_set(scroll); print_item(list, 0, FALSE); scrollok(list, TRUE); wscrl(list, -1); scrollok(list, FALSE); } scroll--; item_set(scroll); print_item(list, 0, TRUE); print_arrows(dialog, choice, item_count(), scroll, box_y, box_x + check_x + 5, list_height); wnoutrefresh(dialog); wrefresh(list); continue; /* wait for another key press */ } else i = choice - 1; } else if (key == KEY_DOWN || key == '+') { if (choice == max_choice - 1) { if (scroll + choice >= item_count() - 1) continue; /* Scroll list up */ if (list_height > 1) { /* De-highlight current last item before scrolling up */ item_set(scroll + max_choice - 1); print_item(list, max_choice - 1, FALSE); scrollok(list, TRUE); wscrl(list, 1); scrollok(list, FALSE); } scroll++; item_set(scroll + max_choice - 1); print_item(list, max_choice - 1, TRUE); print_arrows(dialog, choice, item_count(), scroll, box_y, box_x + check_x + 5, list_height); wnoutrefresh(dialog); wrefresh(list); continue; /* wait for another key press */ } else i = choice + 1; } if (i != choice) { /* De-highlight current item */ item_set(scroll + choice); print_item(list, choice, FALSE); /* Highlight new item */ choice = i; item_set(scroll + choice); print_item(list, choice, TRUE); wnoutrefresh(dialog); wrefresh(list); } continue; /* wait for another key press */ } switch (key) { case 'H': case 'h': case '?': button = 1; /* fall-through */ case 'S': case 's': case ' ': case '\n': item_foreach() item_set_selected(0); item_set(scroll + choice); item_set_selected(1); delwin(list); delwin(dialog); return button; case TAB: case KEY_LEFT: case KEY_RIGHT: button = ((key == KEY_LEFT ? --button : ++button) < 0) ? 1 : (button > 1 ? 0 : button); print_buttons(dialog, height, width, button); wrefresh(dialog); break; case 'X': case 'x': key = KEY_ESC; break; case KEY_ESC: key = on_key_esc(dialog); break; case KEY_RESIZE: delwin(list); delwin(dialog); on_key_resize(); goto do_resize; } /* Now, update everything... */ doupdate(); } delwin(list); delwin(dialog); return key; /* ESC pressed */ } tinyvisor/bios/tools/kconfig/lxdialog/.gitignore0000644006644000001440000000003711733243570022400 0ustar yuichi_xyusers# # Generated files # lxdialog tinyvisor/bios/tools/kconfig/lxdialog/textbox.c0000644006644000001440000002167611733243570022265 0ustar yuichi_xyusers/* * textbox.c -- implements the text box * * ORIGINAL AUTHOR: Savio Lam (lam836@cs.cuhk.hk) * MODIFIED FOR LINUX KERNEL CONFIG BY: William Roadcap (roadcap@cfw.com) * * 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; either version 2 * of the License, or (at your option) any later version. * * 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. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ #include "dialog.h" static void back_lines(int n); static void print_page(WINDOW * win, int height, int width); static void print_line(WINDOW * win, int row, int width); static char *get_line(void); static void print_position(WINDOW * win); static int hscroll; static int begin_reached, end_reached, page_length; static const char *buf; static const char *page; /* * refresh window content */ static void refresh_text_box(WINDOW *dialog, WINDOW *box, int boxh, int boxw, int cur_y, int cur_x) { print_page(box, boxh, boxw); print_position(dialog); wmove(dialog, cur_y, cur_x); /* Restore cursor position */ wrefresh(dialog); } /* * Display text from a file in a dialog box. */ int dialog_textbox(const char *title, const char *tbuf, int initial_height, int initial_width) { int i, x, y, cur_x, cur_y, key = 0; int height, width, boxh, boxw; int passed_end; WINDOW *dialog, *box; begin_reached = 1; end_reached = 0; page_length = 0; hscroll = 0; buf = tbuf; page = buf; /* page is pointer to start of page to be displayed */ do_resize: getmaxyx(stdscr, height, width); if (height < 8 || width < 8) return -ERRDISPLAYTOOSMALL; if (initial_height != 0) height = initial_height; else if (height > 4) height -= 4; else height = 0; if (initial_width != 0) width = initial_width; else if (width > 5) width -= 5; else width = 0; /* center dialog box on screen */ x = (COLS - width) / 2; y = (LINES - height) / 2; draw_shadow(stdscr, y, x, height, width); dialog = newwin(height, width, y, x); keypad(dialog, TRUE); /* Create window for box region, used for scrolling text */ boxh = height - 4; boxw = width - 2; box = subwin(dialog, boxh, boxw, y + 1, x + 1); wattrset(box, dlg.dialog.atr); wbkgdset(box, dlg.dialog.atr & A_COLOR); keypad(box, TRUE); /* register the new window, along with its borders */ draw_box(dialog, 0, 0, height, width, dlg.dialog.atr, dlg.border.atr); wattrset(dialog, dlg.border.atr); mvwaddch(dialog, height - 3, 0, ACS_LTEE); for (i = 0; i < width - 2; i++) waddch(dialog, ACS_HLINE); wattrset(dialog, dlg.dialog.atr); wbkgdset(dialog, dlg.dialog.atr & A_COLOR); waddch(dialog, ACS_RTEE); print_title(dialog, title, width); print_button(dialog, gettext(" Exit "), height - 2, width / 2 - 4, TRUE); wnoutrefresh(dialog); getyx(dialog, cur_y, cur_x); /* Save cursor position */ /* Print first page of text */ attr_clear(box, boxh, boxw, dlg.dialog.atr); refresh_text_box(dialog, box, boxh, boxw, cur_y, cur_x); while ((key != KEY_ESC) && (key != '\n')) { key = wgetch(dialog); switch (key) { case 'E': /* Exit */ case 'e': case 'X': case 'x': delwin(box); delwin(dialog); return 0; case 'g': /* First page */ case KEY_HOME: if (!begin_reached) { begin_reached = 1; page = buf; refresh_text_box(dialog, box, boxh, boxw, cur_y, cur_x); } break; case 'G': /* Last page */ case KEY_END: end_reached = 1; /* point to last char in buf */ page = buf + strlen(buf); back_lines(boxh); refresh_text_box(dialog, box, boxh, boxw, cur_y, cur_x); break; case 'K': /* Previous line */ case 'k': case KEY_UP: if (!begin_reached) { back_lines(page_length + 1); /* We don't call print_page() here but use * scrolling to ensure faster screen update. * However, 'end_reached' and 'page_length' * should still be updated, and 'page' should * point to start of next page. This is done * by calling get_line() in the following * 'for' loop. */ scrollok(box, TRUE); wscrl(box, -1); /* Scroll box region down one line */ scrollok(box, FALSE); page_length = 0; passed_end = 0; for (i = 0; i < boxh; i++) { if (!i) { /* print first line of page */ print_line(box, 0, boxw); wnoutrefresh(box); } else /* Called to update 'end_reached' and 'page' */ get_line(); if (!passed_end) page_length++; if (end_reached && !passed_end) passed_end = 1; } print_position(dialog); wmove(dialog, cur_y, cur_x); /* Restore cursor position */ wrefresh(dialog); } break; case 'B': /* Previous page */ case 'b': case KEY_PPAGE: if (begin_reached) break; back_lines(page_length + boxh); refresh_text_box(dialog, box, boxh, boxw, cur_y, cur_x); break; case 'J': /* Next line */ case 'j': case KEY_DOWN: if (!end_reached) { begin_reached = 0; scrollok(box, TRUE); scroll(box); /* Scroll box region up one line */ scrollok(box, FALSE); print_line(box, boxh - 1, boxw); wnoutrefresh(box); print_position(dialog); wmove(dialog, cur_y, cur_x); /* Restore cursor position */ wrefresh(dialog); } break; case KEY_NPAGE: /* Next page */ case ' ': if (end_reached) break; begin_reached = 0; refresh_text_box(dialog, box, boxh, boxw, cur_y, cur_x); break; case '0': /* Beginning of line */ case 'H': /* Scroll left */ case 'h': case KEY_LEFT: if (hscroll <= 0) break; if (key == '0') hscroll = 0; else hscroll--; /* Reprint current page to scroll horizontally */ back_lines(page_length); refresh_text_box(dialog, box, boxh, boxw, cur_y, cur_x); break; case 'L': /* Scroll right */ case 'l': case KEY_RIGHT: if (hscroll >= MAX_LEN) break; hscroll++; /* Reprint current page to scroll horizontally */ back_lines(page_length); refresh_text_box(dialog, box, boxh, boxw, cur_y, cur_x); break; case KEY_ESC: key = on_key_esc(dialog); break; case KEY_RESIZE: back_lines(height); delwin(box); delwin(dialog); on_key_resize(); goto do_resize; } } delwin(box); delwin(dialog); return key; /* ESC pressed */ } /* * Go back 'n' lines in text. Called by dialog_textbox(). * 'page' will be updated to point to the desired line in 'buf'. */ static void back_lines(int n) { int i; begin_reached = 0; /* Go back 'n' lines */ for (i = 0; i < n; i++) { if (*page == '\0') { if (end_reached) { end_reached = 0; continue; } } if (page == buf) { begin_reached = 1; return; } page--; do { if (page == buf) { begin_reached = 1; return; } page--; } while (*page != '\n'); page++; } } /* * Print a new page of text. Called by dialog_textbox(). */ static void print_page(WINDOW * win, int height, int width) { int i, passed_end = 0; page_length = 0; for (i = 0; i < height; i++) { print_line(win, i, width); if (!passed_end) page_length++; if (end_reached && !passed_end) passed_end = 1; } wnoutrefresh(win); } /* * Print a new line of text. Called by dialog_textbox() and print_page(). */ static void print_line(WINDOW * win, int row, int width) { int y, x; char *line; line = get_line(); line += MIN(strlen(line), hscroll); /* Scroll horizontally */ wmove(win, row, 0); /* move cursor to correct line */ waddch(win, ' '); waddnstr(win, line, MIN(strlen(line), width - 2)); getyx(win, y, x); /* Clear 'residue' of previous line */ #if OLD_NCURSES { int i; for (i = 0; i < width - x; i++) waddch(win, ' '); } #else wclrtoeol(win); #endif } /* * Return current line of text. Called by dialog_textbox() and print_line(). * 'page' should point to start of current line before calling, and will be * updated to point to start of next line. */ static char *get_line(void) { int i = 0; static char line[MAX_LEN + 1]; end_reached = 0; while (*page != '\n') { if (*page == '\0') { if (!end_reached) { end_reached = 1; break; } } else if (i < MAX_LEN) line[i++] = *(page++); else { /* Truncate lines longer than MAX_LEN characters */ if (i == MAX_LEN) line[i++] = '\0'; page++; } } if (i <= MAX_LEN) line[i] = '\0'; if (!end_reached) page++; /* move pass '\n' */ return line; } /* * Print current position */ static void print_position(WINDOW * win) { int percent; wattrset(win, dlg.position_indicator.atr); wbkgdset(win, dlg.position_indicator.atr & A_COLOR); percent = (page - buf) * 100 / strlen(buf); wmove(win, getmaxy(win) - 3, getmaxx(win) - 9); wprintw(win, "(%3d%%)", percent); } tinyvisor/bios/tools/kconfig/lxdialog/yesno.c0000644006644000001440000000553011733243570021714 0ustar yuichi_xyusers/* * yesno.c -- implements the yes/no box * * ORIGINAL AUTHOR: Savio Lam (lam836@cs.cuhk.hk) * MODIFIED FOR LINUX KERNEL CONFIG BY: William Roadcap (roadcap@cfw.com) * * 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; either version 2 * of the License, or (at your option) any later version. * * 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. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ #include "dialog.h" /* * Display termination buttons */ static void print_buttons(WINDOW * dialog, int height, int width, int selected) { int x = width / 2 - 10; int y = height - 2; print_button(dialog, gettext(" Yes "), y, x, selected == 0); print_button(dialog, gettext(" No "), y, x + 13, selected == 1); wmove(dialog, y, x + 1 + 13 * selected); wrefresh(dialog); } /* * Display a dialog box with two buttons - Yes and No */ int dialog_yesno(const char *title, const char *prompt, int height, int width) { int i, x, y, key = 0, button = 0; WINDOW *dialog; do_resize: if (getmaxy(stdscr) < (height + 4)) return -ERRDISPLAYTOOSMALL; if (getmaxx(stdscr) < (width + 4)) return -ERRDISPLAYTOOSMALL; /* center dialog box on screen */ x = (COLS - width) / 2; y = (LINES - height) / 2; draw_shadow(stdscr, y, x, height, width); dialog = newwin(height, width, y, x); keypad(dialog, TRUE); draw_box(dialog, 0, 0, height, width, dlg.dialog.atr, dlg.border.atr); wattrset(dialog, dlg.border.atr); mvwaddch(dialog, height - 3, 0, ACS_LTEE); for (i = 0; i < width - 2; i++) waddch(dialog, ACS_HLINE); wattrset(dialog, dlg.dialog.atr); waddch(dialog, ACS_RTEE); print_title(dialog, title, width); wattrset(dialog, dlg.dialog.atr); print_autowrap(dialog, prompt, width - 2, 1, 3); print_buttons(dialog, height, width, 0); while (key != KEY_ESC) { key = wgetch(dialog); switch (key) { case 'Y': case 'y': delwin(dialog); return 0; case 'N': case 'n': delwin(dialog); return 1; case TAB: case KEY_LEFT: case KEY_RIGHT: button = ((key == KEY_LEFT ? --button : ++button) < 0) ? 1 : (button > 1 ? 0 : button); print_buttons(dialog, height, width, button); wrefresh(dialog); break; case ' ': case '\n': delwin(dialog); return button; case KEY_ESC: key = on_key_esc(dialog); break; case KEY_RESIZE: delwin(dialog); on_key_resize(); goto do_resize; } } delwin(dialog); return key; /* ESC pressed */ } tinyvisor/bios/tools/kconfig/lxdialog/inputbox.c0000644006644000001440000001364611733243570022436 0ustar yuichi_xyusers/* * inputbox.c -- implements the input box * * ORIGINAL AUTHOR: Savio Lam (lam836@cs.cuhk.hk) * MODIFIED FOR LINUX KERNEL CONFIG BY: William Roadcap (roadcap@cfw.com) * * 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; either version 2 * of the License, or (at your option) any later version. * * 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. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */ #include "dialog.h" char dialog_input_result[MAX_LEN + 1]; /* * Print the termination buttons */ static void print_buttons(WINDOW * dialog, int height, int width, int selected) { int x = width / 2 - 11; int y = height - 2; print_button(dialog, gettext(" Ok "), y, x, selected == 0); print_button(dialog, gettext(" Help "), y, x + 14, selected == 1); wmove(dialog, y, x + 1 + 14 * selected); wrefresh(dialog); } /* * Display a dialog box for inputing a string */ int dialog_inputbox(const char *title, const char *prompt, int height, int width, const char *init) { int i, x, y, box_y, box_x, box_width; int input_x = 0, scroll = 0, key = 0, button = -1; char *instr = dialog_input_result; WINDOW *dialog; if (!init) instr[0] = '\0'; else strcpy(instr, init); do_resize: if (getmaxy(stdscr) <= (height - 2)) return -ERRDISPLAYTOOSMALL; if (getmaxx(stdscr) <= (width - 2)) return -ERRDISPLAYTOOSMALL; /* center dialog box on screen */ x = (COLS - width) / 2; y = (LINES - height) / 2; draw_shadow(stdscr, y, x, height, width); dialog = newwin(height, width, y, x); keypad(dialog, TRUE); draw_box(dialog, 0, 0, height, width, dlg.dialog.atr, dlg.border.atr); wattrset(dialog, dlg.border.atr); mvwaddch(dialog, height - 3, 0, ACS_LTEE); for (i = 0; i < width - 2; i++) waddch(dialog, ACS_HLINE); wattrset(dialog, dlg.dialog.atr); waddch(dialog, ACS_RTEE); print_title(dialog, title, width); wattrset(dialog, dlg.dialog.atr); print_autowrap(dialog, prompt, width - 2, 1, 3); /* Draw the input field box */ box_width = width - 6; getyx(dialog, y, x); box_y = y + 2; box_x = (width - box_width) / 2; draw_box(dialog, y + 1, box_x - 1, 3, box_width + 2, dlg.dialog.atr, dlg.border.atr); print_buttons(dialog, height, width, 0); /* Set up the initial value */ wmove(dialog, box_y, box_x); wattrset(dialog, dlg.inputbox.atr); input_x = strlen(instr); if (input_x >= box_width) { scroll = input_x - box_width + 1; input_x = box_width - 1; for (i = 0; i < box_width - 1; i++) waddch(dialog, instr[scroll + i]); } else { waddstr(dialog, instr); } wmove(dialog, box_y, box_x + input_x); wrefresh(dialog); while (key != KEY_ESC) { key = wgetch(dialog); if (button == -1) { /* Input box selected */ switch (key) { case TAB: case KEY_UP: case KEY_DOWN: break; case KEY_LEFT: continue; case KEY_RIGHT: continue; case KEY_BACKSPACE: case 127: if (input_x || scroll) { wattrset(dialog, dlg.inputbox.atr); if (!input_x) { scroll = scroll < box_width - 1 ? 0 : scroll - (box_width - 1); wmove(dialog, box_y, box_x); for (i = 0; i < box_width; i++) waddch(dialog, instr[scroll + input_x + i] ? instr[scroll + input_x + i] : ' '); input_x = strlen(instr) - scroll; } else input_x--; instr[scroll + input_x] = '\0'; mvwaddch(dialog, box_y, input_x + box_x, ' '); wmove(dialog, box_y, input_x + box_x); wrefresh(dialog); } continue; default: if (key < 0x100 && isprint(key)) { if (scroll + input_x < MAX_LEN) { wattrset(dialog, dlg.inputbox.atr); instr[scroll + input_x] = key; instr[scroll + input_x + 1] = '\0'; if (input_x == box_width - 1) { scroll++; wmove(dialog, box_y, box_x); for (i = 0; i < box_width - 1; i++) waddch(dialog, instr [scroll + i]); } else { wmove(dialog, box_y, input_x++ + box_x); waddch(dialog, key); } wrefresh(dialog); } else flash(); /* Alarm user about overflow */ continue; } } } switch (key) { case 'O': case 'o': delwin(dialog); return 0; case 'H': case 'h': delwin(dialog); return 1; case KEY_UP: case KEY_LEFT: switch (button) { case -1: button = 1; /* Indicates "Help" button is selected */ print_buttons(dialog, height, width, 1); break; case 0: button = -1; /* Indicates input box is selected */ print_buttons(dialog, height, width, 0); wmove(dialog, box_y, box_x + input_x); wrefresh(dialog); break; case 1: button = 0; /* Indicates "OK" button is selected */ print_buttons(dialog, height, width, 0); break; } break; case TAB: case KEY_DOWN: case KEY_RIGHT: switch (button) { case -1: button = 0; /* Indicates "OK" button is selected */ print_buttons(dialog, height, width, 0); break; case 0: button = 1; /* Indicates "Help" button is selected */ print_buttons(dialog, height, width, 1); break; case 1: button = -1; /* Indicates input box is selected */ print_buttons(dialog, height, width, 0); wmove(dialog, box_y, box_x + input_x); wrefresh(dialog); break; } break; case ' ': case '\n': delwin(dialog); return (button == -1 ? 0 : button); case 'X': case 'x': key = KEY_ESC; break; case KEY_ESC: key = on_key_esc(dialog); break; case KEY_RESIZE: delwin(dialog); on_key_resize(); goto do_resize; } } delwin(dialog); return KEY_ESC; /* ESC pressed */ } tinyvisor/bios/tools/kconfig/symbol.c0000644006644000001440000006501111733243570020261 0ustar yuichi_xyusers/* * Copyright (C) 2002 Roman Zippel * Released under the terms of the GNU GPL v2.0. */ #include #include #include #include #include #define LKC_DIRECT_LINK #include "lkc.h" struct symbol symbol_yes = { .name = "y", .curr = { "y", yes }, .flags = SYMBOL_CONST|SYMBOL_VALID, }, symbol_mod = { .name = "m", .curr = { "m", mod }, .flags = SYMBOL_CONST|SYMBOL_VALID, }, symbol_no = { .name = "n", .curr = { "n", no }, .flags = SYMBOL_CONST|SYMBOL_VALID, }, symbol_empty = { .name = "", .curr = { "", no }, .flags = SYMBOL_VALID, }; struct symbol *sym_defconfig_list; struct symbol *modules_sym; tristate modules_val; struct expr *sym_env_list; static void sym_add_default(struct symbol *sym, const char *def) { struct property *prop = prop_alloc(P_DEFAULT, sym); prop->expr = expr_alloc_symbol(sym_lookup(def, SYMBOL_CONST)); } void sym_init(void) { struct symbol *sym; struct utsname uts; static bool inited = false; if (inited) return; inited = true; uname(&uts); sym = sym_lookup("UNAME_RELEASE", 0); sym->type = S_STRING; sym->flags |= SYMBOL_AUTO; sym_add_default(sym, uts.release); } enum symbol_type sym_get_type(struct symbol *sym) { enum symbol_type type = sym->type; if (type == S_TRISTATE) { if (sym_is_choice_value(sym) && sym->visible == yes) type = S_BOOLEAN; else if (modules_val == no) type = S_BOOLEAN; } return type; } const char *sym_type_name(enum symbol_type type) { switch (type) { case S_BOOLEAN: return "boolean"; case S_TRISTATE: return "tristate"; case S_INT: return "integer"; case S_HEX: return "hex"; case S_STRING: return "string"; case S_UNKNOWN: return "unknown"; case S_OTHER: break; } return "???"; } struct property *sym_get_choice_prop(struct symbol *sym) { struct property *prop; for_all_choices(sym, prop) return prop; return NULL; } struct property *sym_get_env_prop(struct symbol *sym) { struct property *prop; for_all_properties(sym, prop, P_ENV) return prop; return NULL; } struct property *sym_get_default_prop(struct symbol *sym) { struct property *prop; for_all_defaults(sym, prop) { prop->visible.tri = expr_calc_value(prop->visible.expr); if (prop->visible.tri != no) return prop; } return NULL; } static struct property *sym_get_range_prop(struct symbol *sym) { struct property *prop; for_all_properties(sym, prop, P_RANGE) { prop->visible.tri = expr_calc_value(prop->visible.expr); if (prop->visible.tri != no) return prop; } return NULL; } static int sym_get_range_val(struct symbol *sym, int base) { sym_calc_value(sym); switch (sym->type) { case S_INT: base = 10; break; case S_HEX: base = 16; break; default: break; } return strtol(sym->curr.val, NULL, base); } static void sym_validate_range(struct symbol *sym) { struct property *prop; int base, val, val2; char str[64]; switch (sym->type) { case S_INT: base = 10; break; case S_HEX: base = 16; break; default: return; } prop = sym_get_range_prop(sym); if (!prop) return; val = strtol(sym->curr.val, NULL, base); val2 = sym_get_range_val(prop->expr->left.sym, base); if (val >= val2) { val2 = sym_get_range_val(prop->expr->right.sym, base); if (val <= val2) return; } if (sym->type == S_INT) sprintf(str, "%d", val2); else sprintf(str, "0x%x", val2); sym->curr.val = strdup(str); } static void sym_calc_visibility(struct symbol *sym) { struct property *prop; tristate tri; /* any prompt visible? */ tri = no; for_all_prompts(sym, prop) { prop->visible.tri = expr_calc_value(prop->visible.expr); tri = EXPR_OR(tri, prop->visible.tri); } if (tri == mod && (sym->type != S_TRISTATE || modules_val == no)) tri = yes; if (sym->visible != tri) { sym->visible = tri; sym_set_changed(sym); } if (sym_is_choice_value(sym)) return; /* defaulting to "yes" if no explicit "depends on" are given */ tri = yes; if (sym->dir_dep.expr) tri = expr_calc_value(sym->dir_dep.expr); if (tri == mod) tri = yes; if (sym->dir_dep.tri != tri) { sym->dir_dep.tri = tri; sym_set_changed(sym); } tri = no; if (sym->rev_dep.expr) tri = expr_calc_value(sym->rev_dep.expr); if (tri == mod && sym_get_type(sym) == S_BOOLEAN) tri = yes; if (sym->rev_dep.tri != tri) { sym->rev_dep.tri = tri; sym_set_changed(sym); } } /* * Find the default symbol for a choice. * First try the default values for the choice symbol * Next locate the first visible choice value * Return NULL if none was found */ struct symbol *sym_choice_default(struct symbol *sym) { struct symbol *def_sym; struct property *prop; struct expr *e; /* any of the defaults visible? */ for_all_defaults(sym, prop) { prop->visible.tri = expr_calc_value(prop->visible.expr); if (prop->visible.tri == no) continue; def_sym = prop_get_symbol(prop); if (def_sym->visible != no) return def_sym; } /* just get the first visible value */ prop = sym_get_choice_prop(sym); expr_list_for_each_sym(prop->expr, e, def_sym) if (def_sym->visible != no) return def_sym; /* failed to locate any defaults */ return NULL; } static struct symbol *sym_calc_choice(struct symbol *sym) { struct symbol *def_sym; struct property *prop; struct expr *e; /* first calculate all choice values' visibilities */ prop = sym_get_choice_prop(sym); expr_list_for_each_sym(prop->expr, e, def_sym) sym_calc_visibility(def_sym); /* is the user choice visible? */ def_sym = sym->def[S_DEF_USER].val; if (def_sym && def_sym->visible != no) return def_sym; def_sym = sym_choice_default(sym); if (def_sym == NULL) /* no choice? reset tristate value */ sym->curr.tri = no; return def_sym; } void sym_calc_value(struct symbol *sym) { struct symbol_value newval, oldval; struct property *prop; struct expr *e; if (!sym) return; if (sym->flags & SYMBOL_VALID) return; sym->flags |= SYMBOL_VALID; oldval = sym->curr; switch (sym->type) { case S_INT: case S_HEX: case S_STRING: newval = symbol_empty.curr; break; case S_BOOLEAN: case S_TRISTATE: newval = symbol_no.curr; break; default: sym->curr.val = sym->name; sym->curr.tri = no; return; } if (!sym_is_choice_value(sym)) sym->flags &= ~SYMBOL_WRITE; sym_calc_visibility(sym); /* set default if recursively called */ sym->curr = newval; switch (sym_get_type(sym)) { case S_BOOLEAN: case S_TRISTATE: if (sym_is_choice_value(sym) && sym->visible == yes) { prop = sym_get_choice_prop(sym); newval.tri = (prop_get_symbol(prop)->curr.val == sym) ? yes : no; } else { if (sym->visible != no) { /* if the symbol is visible use the user value * if available, otherwise try the default value */ sym->flags |= SYMBOL_WRITE; if (sym_has_value(sym)) { newval.tri = EXPR_AND(sym->def[S_DEF_USER].tri, sym->visible); goto calc_newval; } } if (sym->rev_dep.tri != no) sym->flags |= SYMBOL_WRITE; if (!sym_is_choice(sym)) { prop = sym_get_default_prop(sym); if (prop) { sym->flags |= SYMBOL_WRITE; newval.tri = EXPR_AND(expr_calc_value(prop->expr), prop->visible.tri); } } calc_newval: if (sym->dir_dep.tri == no && sym->rev_dep.tri != no) { struct expr *e; e = expr_simplify_unmet_dep(sym->rev_dep.expr, sym->dir_dep.expr); fprintf(stderr, "warning: ("); expr_fprint(e, stderr); fprintf(stderr, ") selects %s which has unmet direct dependencies (", sym->name); expr_fprint(sym->dir_dep.expr, stderr); fprintf(stderr, ")\n"); expr_free(e); } newval.tri = EXPR_OR(newval.tri, sym->rev_dep.tri); } if (newval.tri == mod && sym_get_type(sym) == S_BOOLEAN) newval.tri = yes; break; case S_STRING: case S_HEX: case S_INT: if (sym->visible != no) { sym->flags |= SYMBOL_WRITE; if (sym_has_value(sym)) { newval.val = sym->def[S_DEF_USER].val; break; } } prop = sym_get_default_prop(sym); if (prop) { struct symbol *ds = prop_get_symbol(prop); if (ds) { sym->flags |= SYMBOL_WRITE; sym_calc_value(ds); newval.val = ds->curr.val; } } break; default: ; } sym->curr = newval; if (sym_is_choice(sym) && newval.tri == yes) sym->curr.val = sym_calc_choice(sym); sym_validate_range(sym); if (memcmp(&oldval, &sym->curr, sizeof(oldval))) { sym_set_changed(sym); if (modules_sym == sym) { sym_set_all_changed(); modules_val = modules_sym->curr.tri; } } if (sym_is_choice(sym)) { struct symbol *choice_sym; prop = sym_get_choice_prop(sym); expr_list_for_each_sym(prop->expr, e, choice_sym) { if ((sym->flags & SYMBOL_WRITE) && choice_sym->visible != no) choice_sym->flags |= SYMBOL_WRITE; if (sym->flags & SYMBOL_CHANGED) sym_set_changed(choice_sym); } } if (sym->flags & SYMBOL_AUTO) sym->flags &= ~SYMBOL_WRITE; } void sym_clear_all_valid(void) { struct symbol *sym; int i; for_all_symbols(i, sym) sym->flags &= ~SYMBOL_VALID; sym_add_change_count(1); if (modules_sym) sym_calc_value(modules_sym); } void sym_set_changed(struct symbol *sym) { struct property *prop; sym->flags |= SYMBOL_CHANGED; for (prop = sym->prop; prop; prop = prop->next) { if (prop->menu) prop->menu->flags |= MENU_CHANGED; } } void sym_set_all_changed(void) { struct symbol *sym; int i; for_all_symbols(i, sym) sym_set_changed(sym); } bool sym_tristate_within_range(struct symbol *sym, tristate val) { int type = sym_get_type(sym); if (sym->visible == no) return false; if (type != S_BOOLEAN && type != S_TRISTATE) return false; if (type == S_BOOLEAN && val == mod) return false; if (sym->visible <= sym->rev_dep.tri) return false; if (sym_is_choice_value(sym) && sym->visible == yes) return val == yes; return val >= sym->rev_dep.tri && val <= sym->visible; } bool sym_set_tristate_value(struct symbol *sym, tristate val) { tristate oldval = sym_get_tristate_value(sym); if (oldval != val && !sym_tristate_within_range(sym, val)) return false; if (!(sym->flags & SYMBOL_DEF_USER)) { sym->flags |= SYMBOL_DEF_USER; sym_set_changed(sym); } /* * setting a choice value also resets the new flag of the choice * symbol and all other choice values. */ if (sym_is_choice_value(sym) && val == yes) { struct symbol *cs = prop_get_symbol(sym_get_choice_prop(sym)); struct property *prop; struct expr *e; cs->def[S_DEF_USER].val = sym; cs->flags |= SYMBOL_DEF_USER; prop = sym_get_choice_prop(cs); for (e = prop->expr; e; e = e->left.expr) { if (e->right.sym->visible != no) e->right.sym->flags |= SYMBOL_DEF_USER; } } sym->def[S_DEF_USER].tri = val; if (oldval != val) sym_clear_all_valid(); return true; } tristate sym_toggle_tristate_value(struct symbol *sym) { tristate oldval, newval; oldval = newval = sym_get_tristate_value(sym); do { switch (newval) { case no: newval = mod; break; case mod: newval = yes; break; case yes: newval = no; break; } if (sym_set_tristate_value(sym, newval)) break; } while (oldval != newval); return newval; } bool sym_string_valid(struct symbol *sym, const char *str) { signed char ch; switch (sym->type) { case S_STRING: return true; case S_INT: ch = *str++; if (ch == '-') ch = *str++; if (!isdigit(ch)) return false; if (ch == '0' && *str != 0) return false; while ((ch = *str++)) { if (!isdigit(ch)) return false; } return true; case S_HEX: if (str[0] == '0' && (str[1] == 'x' || str[1] == 'X')) str += 2; ch = *str++; do { if (!isxdigit(ch)) return false; } while ((ch = *str++)); return true; case S_BOOLEAN: case S_TRISTATE: switch (str[0]) { case 'y': case 'Y': case 'm': case 'M': case 'n': case 'N': return true; } return false; default: return false; } } bool sym_string_within_range(struct symbol *sym, const char *str) { struct property *prop; int val; switch (sym->type) { case S_STRING: return sym_string_valid(sym, str); case S_INT: if (!sym_string_valid(sym, str)) return false; prop = sym_get_range_prop(sym); if (!prop) return true; val = strtol(str, NULL, 10); return val >= sym_get_range_val(prop->expr->left.sym, 10) && val <= sym_get_range_val(prop->expr->right.sym, 10); case S_HEX: if (!sym_string_valid(sym, str)) return false; prop = sym_get_range_prop(sym); if (!prop) return true; val = strtol(str, NULL, 16); return val >= sym_get_range_val(prop->expr->left.sym, 16) && val <= sym_get_range_val(prop->expr->right.sym, 16); case S_BOOLEAN: case S_TRISTATE: switch (str[0]) { case 'y': case 'Y': return sym_tristate_within_range(sym, yes); case 'm': case 'M': return sym_tristate_within_range(sym, mod); case 'n': case 'N': return sym_tristate_within_range(sym, no); } return false; default: return false; } } bool sym_set_string_value(struct symbol *sym, const char *newval) { const char *oldval; char *val; int size; switch (sym->type) { case S_BOOLEAN: case S_TRISTATE: switch (newval[0]) { case 'y': case 'Y': return sym_set_tristate_value(sym, yes); case 'm': case 'M': return sym_set_tristate_value(sym, mod); case 'n': case 'N': return sym_set_tristate_value(sym, no); } return false; default: ; } if (!sym_string_within_range(sym, newval)) return false; if (!(sym->flags & SYMBOL_DEF_USER)) { sym->flags |= SYMBOL_DEF_USER; sym_set_changed(sym); } oldval = sym->def[S_DEF_USER].val; size = strlen(newval) + 1; if (sym->type == S_HEX && (newval[0] != '0' || (newval[1] != 'x' && newval[1] != 'X'))) { size += 2; sym->def[S_DEF_USER].val = val = malloc(size); *val++ = '0'; *val++ = 'x'; } else if (!oldval || strcmp(oldval, newval)) sym->def[S_DEF_USER].val = val = malloc(size); else return true; strcpy(val, newval); free((void *)oldval); sym_clear_all_valid(); return true; } /* * Find the default value associated to a symbol. * For tristate symbol handle the modules=n case * in which case "m" becomes "y". * If the symbol does not have any default then fallback * to the fixed default values. */ const char *sym_get_string_default(struct symbol *sym) { struct property *prop; struct symbol *ds; const char *str; tristate val; sym_calc_visibility(sym); sym_calc_value(modules_sym); val = symbol_no.curr.tri; str = symbol_empty.curr.val; /* If symbol has a default value look it up */ prop = sym_get_default_prop(sym); if (prop != NULL) { switch (sym->type) { case S_BOOLEAN: case S_TRISTATE: /* The visibility may limit the value from yes => mod */ val = EXPR_AND(expr_calc_value(prop->expr), prop->visible.tri); break; default: /* * The following fails to handle the situation * where a default value is further limited by * the valid range. */ ds = prop_get_symbol(prop); if (ds != NULL) { sym_calc_value(ds); str = (const char *)ds->curr.val; } } } /* Handle select statements */ val = EXPR_OR(val, sym->rev_dep.tri); /* transpose mod to yes if modules are not enabled */ if (val == mod) if (!sym_is_choice_value(sym) && modules_sym->curr.tri == no) val = yes; /* transpose mod to yes if type is bool */ if (sym->type == S_BOOLEAN && val == mod) val = yes; switch (sym->type) { case S_BOOLEAN: case S_TRISTATE: switch (val) { case no: return "n"; case mod: return "m"; case yes: return "y"; } case S_INT: case S_HEX: return str; case S_STRING: return str; case S_OTHER: case S_UNKNOWN: break; } return ""; } const char *sym_get_string_value(struct symbol *sym) { tristate val; switch (sym->type) { case S_BOOLEAN: case S_TRISTATE: val = sym_get_tristate_value(sym); switch (val) { case no: return "n"; case mod: return "m"; case yes: return "y"; } break; default: ; } return (const char *)sym->curr.val; } bool sym_is_changable(struct symbol *sym) { return sym->visible > sym->rev_dep.tri; } static unsigned strhash(const char *s) { /* fnv32 hash */ unsigned hash = 2166136261U; for (; *s; s++) hash = (hash ^ *s) * 0x01000193; return hash; } struct symbol *sym_lookup(const char *name, int flags) { struct symbol *symbol; char *new_name; int hash; if (name) { if (name[0] && !name[1]) { switch (name[0]) { case 'y': return &symbol_yes; case 'm': return &symbol_mod; case 'n': return &symbol_no; } } hash = strhash(name) % SYMBOL_HASHSIZE; for (symbol = symbol_hash[hash]; symbol; symbol = symbol->next) { if (symbol->name && !strcmp(symbol->name, name) && (flags ? symbol->flags & flags : !(symbol->flags & (SYMBOL_CONST|SYMBOL_CHOICE)))) return symbol; } new_name = strdup(name); } else { new_name = NULL; hash = 0; } symbol = malloc(sizeof(*symbol)); memset(symbol, 0, sizeof(*symbol)); symbol->name = new_name; symbol->type = S_UNKNOWN; symbol->flags |= flags; symbol->next = symbol_hash[hash]; symbol_hash[hash] = symbol; return symbol; } struct symbol *sym_find(const char *name) { struct symbol *symbol = NULL; int hash = 0; if (!name) return NULL; if (name[0] && !name[1]) { switch (name[0]) { case 'y': return &symbol_yes; case 'm': return &symbol_mod; case 'n': return &symbol_no; } } hash = strhash(name) % SYMBOL_HASHSIZE; for (symbol = symbol_hash[hash]; symbol; symbol = symbol->next) { if (symbol->name && !strcmp(symbol->name, name) && !(symbol->flags & SYMBOL_CONST)) break; } return symbol; } /* * Expand symbol's names embedded in the string given in argument. Symbols' * name to be expanded shall be prefixed by a '$'. Unknown symbol expands to * the empty string. */ const char *sym_expand_string_value(const char *in) { const char *src; char *res; size_t reslen; reslen = strlen(in) + 1; res = malloc(reslen); res[0] = '\0'; while ((src = strchr(in, '$'))) { char *p, name[SYMBOL_MAXLENGTH]; const char *symval = ""; struct symbol *sym; size_t newlen; strncat(res, in, src - in); src++; p = name; while (isalnum(*src) || *src == '_') *p++ = *src++; *p = '\0'; sym = sym_find(name); if (sym != NULL) { sym_calc_value(sym); symval = sym_get_string_value(sym); } newlen = strlen(res) + strlen(symval) + strlen(src) + 1; if (newlen > reslen) { reslen = newlen; res = realloc(res, reslen); } strcat(res, symval); in = src; } strcat(res, in); return res; } struct symbol **sym_re_search(const char *pattern) { struct symbol *sym, **sym_arr = NULL; int i, cnt, size; regex_t re; cnt = size = 0; /* Skip if empty */ if (strlen(pattern) == 0) return NULL; if (regcomp(&re, pattern, REG_EXTENDED|REG_NOSUB|REG_ICASE)) return NULL; for_all_symbols(i, sym) { if (sym->flags & SYMBOL_CONST || !sym->name) continue; if (regexec(&re, sym->name, 0, NULL, 0)) continue; if (cnt + 1 >= size) { void *tmp = sym_arr; size += 16; sym_arr = realloc(sym_arr, size * sizeof(struct symbol *)); if (!sym_arr) { free(tmp); return NULL; } } sym_calc_value(sym); sym_arr[cnt++] = sym; } if (sym_arr) sym_arr[cnt] = NULL; regfree(&re); return sym_arr; } /* * When we check for recursive dependencies we use a stack to save * current state so we can print out relevant info to user. * The entries are located on the call stack so no need to free memory. * Note inser() remove() must always match to properly clear the stack. */ static struct dep_stack { struct dep_stack *prev, *next; struct symbol *sym; struct property *prop; struct expr *expr; } *check_top; static void dep_stack_insert(struct dep_stack *stack, struct symbol *sym) { memset(stack, 0, sizeof(*stack)); if (check_top) check_top->next = stack; stack->prev = check_top; stack->sym = sym; check_top = stack; } static void dep_stack_remove(void) { check_top = check_top->prev; if (check_top) check_top->next = NULL; } /* * Called when we have detected a recursive dependency. * check_top point to the top of the stact so we use * the ->prev pointer to locate the bottom of the stack. */ static void sym_check_print_recursive(struct symbol *last_sym) { struct dep_stack *stack; struct symbol *sym, *next_sym; struct menu *menu = NULL; struct property *prop; struct dep_stack cv_stack; if (sym_is_choice_value(last_sym)) { dep_stack_insert(&cv_stack, last_sym); last_sym = prop_get_symbol(sym_get_choice_prop(last_sym)); } for (stack = check_top; stack != NULL; stack = stack->prev) if (stack->sym == last_sym) break; if (!stack) { fprintf(stderr, "unexpected recursive dependency error\n"); return; } for (; stack; stack = stack->next) { sym = stack->sym; next_sym = stack->next ? stack->next->sym : last_sym; prop = stack->prop; if (prop == NULL) prop = stack->sym->prop; /* for choice values find the menu entry (used below) */ if (sym_is_choice(sym) || sym_is_choice_value(sym)) { for (prop = sym->prop; prop; prop = prop->next) { menu = prop->menu; if (prop->menu) break; } } if (stack->sym == last_sym) fprintf(stderr, "%s:%d:error: recursive dependency detected!\n", prop->file->name, prop->lineno); if (stack->expr) { fprintf(stderr, "%s:%d:\tsymbol %s %s value contains %s\n", prop->file->name, prop->lineno, sym->name ? sym->name : "", prop_get_type_name(prop->type), next_sym->name ? next_sym->name : ""); } else if (stack->prop) { fprintf(stderr, "%s:%d:\tsymbol %s depends on %s\n", prop->file->name, prop->lineno, sym->name ? sym->name : "", next_sym->name ? next_sym->name : ""); } else if (sym_is_choice(sym)) { fprintf(stderr, "%s:%d:\tchoice %s contains symbol %s\n", menu->file->name, menu->lineno, sym->name ? sym->name : "", next_sym->name ? next_sym->name : ""); } else if (sym_is_choice_value(sym)) { fprintf(stderr, "%s:%d:\tsymbol %s is part of choice %s\n", menu->file->name, menu->lineno, sym->name ? sym->name : "", next_sym->name ? next_sym->name : ""); } else { fprintf(stderr, "%s:%d:\tsymbol %s is selected by %s\n", prop->file->name, prop->lineno, sym->name ? sym->name : "", next_sym->name ? next_sym->name : ""); } } if (check_top == &cv_stack) dep_stack_remove(); } static struct symbol *sym_check_expr_deps(struct expr *e) { struct symbol *sym; if (!e) return NULL; switch (e->type) { case E_OR: case E_AND: sym = sym_check_expr_deps(e->left.expr); if (sym) return sym; return sym_check_expr_deps(e->right.expr); case E_NOT: return sym_check_expr_deps(e->left.expr); case E_EQUAL: case E_UNEQUAL: sym = sym_check_deps(e->left.sym); if (sym) return sym; return sym_check_deps(e->right.sym); case E_SYMBOL: return sym_check_deps(e->left.sym); default: break; } printf("Oops! How to check %d?\n", e->type); return NULL; } /* return NULL when dependencies are OK */ static struct symbol *sym_check_sym_deps(struct symbol *sym) { struct symbol *sym2; struct property *prop; struct dep_stack stack; dep_stack_insert(&stack, sym); sym2 = sym_check_expr_deps(sym->rev_dep.expr); if (sym2) goto out; for (prop = sym->prop; prop; prop = prop->next) { if (prop->type == P_CHOICE || prop->type == P_SELECT) continue; stack.prop = prop; sym2 = sym_check_expr_deps(prop->visible.expr); if (sym2) break; if (prop->type != P_DEFAULT || sym_is_choice(sym)) continue; stack.expr = prop->expr; sym2 = sym_check_expr_deps(prop->expr); if (sym2) break; stack.expr = NULL; } out: dep_stack_remove(); return sym2; } static struct symbol *sym_check_choice_deps(struct symbol *choice) { struct symbol *sym, *sym2; struct property *prop; struct expr *e; struct dep_stack stack; dep_stack_insert(&stack, choice); prop = sym_get_choice_prop(choice); expr_list_for_each_sym(prop->expr, e, sym) sym->flags |= (SYMBOL_CHECK | SYMBOL_CHECKED); choice->flags |= (SYMBOL_CHECK | SYMBOL_CHECKED); sym2 = sym_check_sym_deps(choice); choice->flags &= ~SYMBOL_CHECK; if (sym2) goto out; expr_list_for_each_sym(prop->expr, e, sym) { sym2 = sym_check_sym_deps(sym); if (sym2) break; } out: expr_list_for_each_sym(prop->expr, e, sym) sym->flags &= ~SYMBOL_CHECK; if (sym2 && sym_is_choice_value(sym2) && prop_get_symbol(sym_get_choice_prop(sym2)) == choice) sym2 = choice; dep_stack_remove(); return sym2; } struct symbol *sym_check_deps(struct symbol *sym) { struct symbol *sym2; struct property *prop; if (sym->flags & SYMBOL_CHECK) { sym_check_print_recursive(sym); return sym; } if (sym->flags & SYMBOL_CHECKED) return NULL; if (sym_is_choice_value(sym)) { struct dep_stack stack; /* for choice groups start the check with main choice symbol */ dep_stack_insert(&stack, sym); prop = sym_get_choice_prop(sym); sym2 = sym_check_deps(prop_get_symbol(prop)); dep_stack_remove(); } else if (sym_is_choice(sym)) { sym2 = sym_check_choice_deps(sym); } else { sym->flags |= (SYMBOL_CHECK | SYMBOL_CHECKED); sym2 = sym_check_sym_deps(sym); sym->flags &= ~SYMBOL_CHECK; } if (sym2 && sym2 == sym) sym2 = NULL; return sym2; } struct property *prop_alloc(enum prop_type type, struct symbol *sym) { struct property *prop; struct property **propp; prop = malloc(sizeof(*prop)); memset(prop, 0, sizeof(*prop)); prop->type = type; prop->sym = sym; prop->file = current_file; prop->lineno = zconf_lineno(); /* append property to the prop list of symbol */ if (sym) { for (propp = &sym->prop; *propp; propp = &(*propp)->next) ; *propp = prop; } return prop; } struct symbol *prop_get_symbol(struct property *prop) { if (prop->expr && (prop->expr->type == E_SYMBOL || prop->expr->type == E_LIST)) return prop->expr->left.sym; return NULL; } const char *prop_get_type_name(enum prop_type type) { switch (type) { case P_PROMPT: return "prompt"; case P_ENV: return "env"; case P_COMMENT: return "comment"; case P_MENU: return "menu"; case P_DEFAULT: return "default"; case P_CHOICE: return "choice"; case P_SELECT: return "select"; case P_RANGE: return "range"; case P_SYMBOL: return "symbol"; case P_UNKNOWN: break; } return "unknown"; } static void prop_add_env(const char *env) { struct symbol *sym, *sym2; struct property *prop; char *p; sym = current_entry->sym; sym->flags |= SYMBOL_AUTO; for_all_properties(sym, prop, P_ENV) { sym2 = prop_get_symbol(prop); if (strcmp(sym2->name, env)) menu_warn(current_entry, "redefining environment symbol from %s", sym2->name); return; } prop = prop_alloc(P_ENV, sym); prop->expr = expr_alloc_symbol(sym_lookup(env, SYMBOL_CONST)); sym_env_list = expr_alloc_one(E_LIST, sym_env_list); sym_env_list->right.sym = sym; p = getenv(env); if (p) sym_add_default(sym, p); else menu_warn(current_entry, "environment variable %s undefined", env); } tinyvisor/bios/TODO0000644006644000001440000000127111733243570014516 0ustar yuichi_xyusersReview changes committed to coreboot, virtualbox, qemu, kvm, and bochs cvs tip. * bochs cvs (20100104): -- changes synched * coreboot (r3348): (bochs 20060708) -- no noteworthy enhancements * qemu - now uses SeaBIOS * kvm - now uses SeaBIOS * virtualbox (r13560): (bochs 20061231) -- lots of mouse changes, logo, scsi/etherboot hooks, floppy data rate?, int19 calls post The __call16 code does a long jump to the interrupt trampolines - this is unnecessary. Support PCIv3 roms? Add support for PCI "configuration code" extensions? Possibly add option to eliminate tsc based delays on emulators. Possibly support sending debug information over EHCI debug port. tinyvisor/bios/README.CSM0000644006644000001440000000213012172661303015316 0ustar yuichi_xyusersEnabling CONFIG_CSM allows SeaBIOS to be built as a Compatibility Support Module for use with the OMVF/EDK-II UEFI firmware. It will provide "legacy" BIOS services for booting non-EFI operating systems and will also allow OVMF to display on otherwise unsupported video hardware by using the traditional VGA BIOS. Windows 2008r2 is known to use INT 10h BIOS calls even when booted via EFI, and the presence of a CSM makes this work as expected too. Having built SeaBIOS with CONFIG_CSM, you should be able to drop the result into your OVMF build tree at OvmfPkg/Csm/Csm16/Csm16.bin and then build OVMF with 'build -D CSM_ENABLE'. The SeaBIOS binary will be included as a discrete file within the 'Flash Volume' which is created, and there are tools which will extract it and allow it to be replaced; satisfying the requirements of the LGPL licence. A patch to OVMF is required, to prevent it from marking the region from 0xC0000-0xFFFFF as read-only before invoking our Legacy16Boot method. See http://www.sourceforge.net/mailarchive/forum.php?thread_name=50FD7290.9060003%40redhat.com&forum_name=edk2-devel tinyvisor/bios/Makefile0000644006644000001440000002160112172661303015461 0ustar yuichi_xyusers# SeaBIOS build system # # Copyright (C) 2008-2012 Kevin O'Connor # # This file may be distributed under the terms of the GNU LGPLv3 license. # Output directory OUT=out/ # Source files SRCBOTH=misc.c stacks.c output.c util.c block.c floppy.c ata.c mouse.c \ kbd.c pci.c serial.c clock.c pic.c cdrom.c ps2port.c smp.c resume.c \ pnpbios.c vgahooks.c ramdisk.c pcibios.c blockcmd.c \ usb.c usb-uhci.c usb-ohci.c usb-ehci.c usb-hid.c usb-msc.c \ virtio-ring.c virtio-pci.c virtio-blk.c virtio-scsi.c apm.c ahci.c \ usb-uas.c lsi-scsi.c esp-scsi.c megasas.c SRC16=$(SRCBOTH) system.c disk.c font.c SRC32FLAT=$(SRCBOTH) post.c shadow.c memmap.c pmm.c coreboot.c boot.c \ acpi.c smm.c mptable.c pirtable.c smbios.c pciinit.c optionroms.c mtrr.c \ lzmadecode.c bootsplash.c jpeg.c usb-hub.c paravirt.c \ biostables.c xen.c bmp.c romfile.c csm.c SRC32SEG=util.c output.c pci.c pcibios.c apm.c stacks.c # Default compiler flags cc-option=$(shell if test -z "`$(1) $(2) -S -o /dev/null -xc /dev/null 2>&1`" \ ; then echo "$(2)"; else echo "$(3)"; fi ;) CPPFLAGS = -P -MD -MT $@ COMMONCFLAGS := -I$(OUT) -Os -MD -g \ -Wall -Wno-strict-aliasing -Wold-style-definition \ $(call cc-option,$(CC),-Wtype-limits,) \ -m32 -march=i386 -mregparm=3 -mpreferred-stack-boundary=2 \ -minline-all-stringops \ -freg-struct-return -ffreestanding -fno-delete-null-pointer-checks \ -ffunction-sections -fdata-sections -fno-common COMMONCFLAGS += $(call cc-option,$(CC),-nopie,) COMMONCFLAGS += $(call cc-option,$(CC),-fno-stack-protector,) COMMONCFLAGS += $(call cc-option,$(CC),-fno-stack-protector-all,) CFLAGS32FLAT := $(COMMONCFLAGS) -DMODE16=0 -DMODESEGMENT=0 -fomit-frame-pointer CFLAGSSEG := $(COMMONCFLAGS) -DMODESEGMENT=1 -fno-defer-pop \ $(call cc-option,$(CC),-fno-jump-tables,-DMANUAL_NO_JUMP_TABLE) \ $(call cc-option,$(CC),-fno-tree-switch-conversion,) CFLAGS32SEG := $(CFLAGSSEG) -DMODE16=0 -fomit-frame-pointer CFLAGS16INC := $(CFLAGSSEG) -DMODE16=1 -Wa,src/code16gcc.s \ $(call cc-option,$(CC),--param large-stack-frame=4,-fno-inline) CFLAGS16 := $(CFLAGS16INC) -fomit-frame-pointer # Run with "make V=1" to see the actual compile commands ifdef V Q= else Q=@ MAKEFLAGS += --no-print-directory endif # Common command definitions export HOSTCC := $(CC) export CONFIG_SHELL := sh export KCONFIG_AUTOHEADER := autoconf.h export KCONFIG_CONFIG := $(CURDIR)/.config AS=as OBJCOPY=objcopy OBJDUMP=objdump STRIP=strip PYTHON=python CPP=cpp IASL:=iasl # Default targets -include $(KCONFIG_CONFIG) target-y = $(OUT) $(OUT)bios.bin target-$(CONFIG_BUILD_VGABIOS) += $(OUT)vgabios.bin all: $(target-y) # Make definitions .PHONY : all clean distclean FORCE .DELETE_ON_ERROR: vpath %.c src vgasrc vpath %.S src vgasrc ################ Common build rules # Verify the build environment works. TESTGCC:=$(shell OUT="$(OUT)" CC="$(CC)" LD="$(LD)" IASL="$(IASL)" tools/test-build.sh) ifeq "$(TESTGCC)" "-1" $(error "Please upgrade the build environment") endif ifeq "$(TESTGCC)" "0" # Use -fwhole-program CFLAGSWHOLE=-fwhole-program -DWHOLE_PROGRAM endif # Do a whole file compile by textually including all C code. define whole-compile @echo " Compiling whole program $3" $(Q)printf '$(foreach i,$2,#include "$(CURDIR)/$i"\n)' > $3.tmp.c $(Q)$(CC) $1 $(CFLAGSWHOLE) -c $3.tmp.c -o $3 endef %.strip.o: %.o @echo " Stripping $@" $(Q)$(STRIP) $< -o $@ $(OUT)%.s: %.c @echo " Compiling to assembler $@" $(Q)$(CC) $(CFLAGS16) -S -c $< -o $@ $(OUT)%.o: %.c $(OUT)autoconf.h @echo " Compile checking $@" $(Q)$(CC) $(CFLAGS32FLAT) -c $< -o $@ $(OUT)%.lds: %.lds.S @echo " Precompiling $@" $(Q)$(CPP) $(CPPFLAGS) -D__ASSEMBLY__ $< -o $@ ################ Main BIOS build rules $(OUT)asm-offsets.s: $(OUT)autoconf.h $(OUT)asm-offsets.h: $(OUT)asm-offsets.s @echo " Generating offset file $@" $(Q)./tools/gen-offsets.sh $< $@ $(OUT)ccode16.o: $(OUT)autoconf.h $(patsubst %.c, $(OUT)%.o,$(SRC16)) ; $(call whole-compile, $(CFLAGS16), $(addprefix src/, $(SRC16)),$@) $(OUT)code32seg.o: $(OUT)autoconf.h $(patsubst %.c, $(OUT)%.o,$(SRC32SEG)) ; $(call whole-compile, $(CFLAGS32SEG), $(addprefix src/, $(SRC32SEG)),$@) $(OUT)ccode32flat.o: $(OUT)autoconf.h $(patsubst %.c, $(OUT)%.o,$(SRC32FLAT)) ; $(call whole-compile, $(CFLAGS32FLAT), $(addprefix src/, $(SRC32FLAT)),$@) $(OUT)romlayout.o: romlayout.S $(OUT)asm-offsets.h @echo " Compiling (16bit) $@" $(Q)$(CC) $(CFLAGS16) -c -D__ASSEMBLY__ $< -o $@ $(OUT)romlayout16.lds: $(OUT)ccode32flat.o $(OUT)code32seg.o $(OUT)ccode16.o $(OUT)romlayout.o tools/layoutrom.py tools/buildversion.sh @echo " Building ld scripts" $(Q)./tools/buildversion.sh $(OUT)version.c $(Q)$(CC) $(CFLAGS32FLAT) -c $(OUT)version.c -o $(OUT)version.o $(Q)$(LD) -melf_i386 -r $(OUT)ccode32flat.o $(OUT)version.o -o $(OUT)code32flat.o $(Q)$(LD) -melf_i386 -r $(OUT)ccode16.o $(OUT)romlayout.o -o $(OUT)code16.o $(Q)$(OBJDUMP) -thr $(OUT)code32flat.o > $(OUT)code32flat.o.objdump $(Q)$(OBJDUMP) -thr $(OUT)code32seg.o > $(OUT)code32seg.o.objdump $(Q)$(OBJDUMP) -thr $(OUT)code16.o > $(OUT)code16.o.objdump $(Q)$(PYTHON) ./tools/layoutrom.py $(OUT)code16.o.objdump $(OUT)code32seg.o.objdump $(OUT)code32flat.o.objdump $(OUT)romlayout16.lds $(OUT)romlayout32seg.lds $(OUT)romlayout32flat.lds # These are actually built by tools/layoutrom.py above, but by pulling them # into an extra rule we prevent make -j from spawning layoutrom.py 4 times. $(OUT)romlayout32seg.lds $(OUT)romlayout32flat.lds $(OUT)code32flat.o $(OUT)code16.o: $(OUT)romlayout16.lds $(OUT)rom16.o: $(OUT)code16.o $(OUT)romlayout16.lds @echo " Linking $@" $(Q)$(LD) -T $(OUT)romlayout16.lds $< -o $@ $(OUT)rom32seg.o: $(OUT)code32seg.o $(OUT)romlayout32seg.lds @echo " Linking $@" $(Q)$(LD) -T $(OUT)romlayout32seg.lds $< -o $@ $(OUT)rom.o: $(OUT)rom16.strip.o $(OUT)rom32seg.strip.o $(OUT)code32flat.o $(OUT)romlayout32flat.lds @echo " Linking $@" $(Q)$(LD) -T $(OUT)romlayout32flat.lds $(OUT)rom16.strip.o $(OUT)rom32seg.strip.o $(OUT)code32flat.o -o $@ $(OUT)bios.bin.elf $(OUT)bios.bin: $(OUT)rom.o tools/checkrom.py @echo " Prepping $@" $(Q)$(OBJDUMP) -thr $< > $<.objdump $(Q)$(OBJCOPY) -O binary $< $(OUT)bios.bin.raw $(Q)$(PYTHON) ./tools/checkrom.py $<.objdump $(OUT)bios.bin.raw $(OUT)bios.bin $(Q)$(STRIP) -R .comment $< -o $(OUT)bios.bin.elf ################ VGA build rules # VGA src files SRCVGA=src/output.c src/util.c src/pci.c \ vgasrc/vgabios.c vgasrc/vgafb.c vgasrc/vgafonts.c vgasrc/vbe.c \ vgasrc/stdvga.c vgasrc/stdvgamodes.c vgasrc/stdvgaio.c \ vgasrc/clext.c vgasrc/bochsvga.c vgasrc/geodevga.c CFLAGS16VGA = $(CFLAGS16INC) -Isrc $(OUT)vgaccode16.raw.s: $(OUT)autoconf.h ; $(call whole-compile, $(CFLAGS16VGA) -S, $(SRCVGA),$@) $(OUT)vgaccode16.o: $(OUT)vgaccode16.raw.s tools/vgafixup.py @echo " Fixup VGA rom assembler" $(Q)$(PYTHON) ./tools/vgafixup.py $< $(OUT)vgaccode16.s $(Q)$(AS) --32 src/code16gcc.s $(OUT)vgaccode16.s -o $@ $(OUT)vgaentry.o: vgaentry.S $(OUT)autoconf.h @echo " Compiling (16bit) $@" $(Q)$(CC) $(CFLAGS16VGA) -c -D__ASSEMBLY__ $< -o $@ $(OUT)vgarom.o: $(OUT)vgaccode16.o $(OUT)vgaentry.o $(OUT)vgalayout.lds tools/buildversion.sh @echo " Linking $@" $(Q)./tools/buildversion.sh $(OUT)vgaversion.c VAR16 $(Q)$(CC) $(CFLAGS16VGA) -c $(OUT)vgaversion.c -o $(OUT)vgaversion.o $(Q)$(LD) --gc-sections -T $(OUT)vgalayout.lds $(OUT)vgaccode16.o $(OUT)vgaentry.o $(OUT)vgaversion.o -o $@ $(OUT)vgabios.bin.raw: $(OUT)vgarom.o @echo " Extracting binary $@" $(Q)$(OBJCOPY) -O binary $< $@ $(OUT)vgabios.bin: $(OUT)vgabios.bin.raw tools/buildrom.py @echo " Finalizing rom $@" $(Q)$(PYTHON) ./tools/buildrom.py $< $@ ################ DSDT build rules iasl-option=$(shell if test -z "`$(1) $(2) 2>&1 > /dev/null`" \ ; then echo "$(2)"; else echo "$(3)"; fi ;) $(OUT)%.hex: src/%.dsl ./tools/acpi_extract_preprocess.py ./tools/acpi_extract.py @echo " Compiling IASL $@" $(Q)$(CPP) $(CPPFLAGS) $< -o $(OUT)$*.dsl.i.orig $(Q)$(PYTHON) ./tools/acpi_extract_preprocess.py $(OUT)$*.dsl.i.orig > $(OUT)$*.dsl.i $(Q)$(IASL) $(call iasl-option,$(IASL),-Pn,) -vs -l -tc -p $(OUT)$* $(OUT)$*.dsl.i $(Q)$(PYTHON) ./tools/acpi_extract.py $(OUT)$*.lst > $(OUT)$*.off $(Q)cat $(OUT)$*.off > $@ $(OUT)acpi.o: $(OUT)acpi-dsdt.hex $(OUT)ssdt-proc.hex $(OUT)ssdt-pcihp.hex $(OUT)ssdt-misc.hex $(OUT)q35-acpi-dsdt.hex ################ Kconfig rules define do-kconfig $(Q)mkdir -p $(OUT)/tools/kconfig/lxdialog $(Q)mkdir -p $(OUT)/include/config $(Q)$(MAKE) -C $(OUT) -f $(CURDIR)/tools/kconfig/Makefile srctree=$(CURDIR) src=tools/kconfig obj=tools/kconfig Q=$(Q) Kconfig=$(CURDIR)/src/Kconfig $1 endef $(OUT)autoconf.h : $(KCONFIG_CONFIG) ; $(call do-kconfig, silentoldconfig) $(KCONFIG_CONFIG): src/Kconfig vgasrc/Kconfig ; $(call do-kconfig, defconfig) %onfig: ; $(call do-kconfig, $@) help: ; $(call do-kconfig, $@) ################ Generic rules clean: $(Q)rm -rf $(OUT) distclean: clean $(Q)rm -f .config .config.old $(OUT): $(Q)mkdir $@ -include $(OUT)*.d tinyvisor/bios/.version0000644006644000001440000000000612172666314015512 0ustar yuichi_xyusers1.7.3 tinyvisor/bios/src/0000755006644000001440000000000012206363327014613 5ustar yuichi_xyuserstinyvisor/bios/src/xen.h0000644006644000001440000001502412172661303015555 0ustar yuichi_xyusers#ifndef __XEN_H #define __XEN_H void xen_preinit(void); void xen_ramsize_preinit(void); void xen_hypercall_setup(void); void xen_biostable_setup(void); extern unsigned long xen_hypercall_page; #define _hypercall0(type, name) \ ({ \ unsigned long __hentry = xen_hypercall_page+__HYPERVISOR_##name*32; \ long __res; \ asm volatile ( \ "call *%%eax" \ : "=a" (__res) \ : "0" (__hentry) \ : "memory" ); \ (type)__res; \ }) #define _hypercall1(type, name, a1) \ ({ \ unsigned long __hentry = xen_hypercall_page+__HYPERVISOR_##name*32; \ long __res, __ign1; \ asm volatile ( \ "call *%%eax" \ : "=a" (__res), "=b" (__ign1) \ : "0" (__hentry), "1" ((long)(a1)) \ : "memory" ); \ (type)__res; \ }) #define _hypercall2(type, name, a1, a2) \ ({ \ unsigned long __hentry = xen_hypercall_page+__HYPERVISOR_##name*32; \ long __res, __ign1, __ign2; \ asm volatile ( \ "call *%%eax" \ : "=a" (__res), "=b" (__ign1), "=c" (__ign2) \ : "0" (__hentry), "1" ((long)(a1)), "2" ((long)(a2)) \ : "memory" ); \ (type)__res; \ }) #define _hypercall3(type, name, a1, a2, a3) \ ({ \ unsigned long __hentry = xen_hypercall_page+__HYPERVISOR_##name*32; \ long __res, __ign1, __ign2, __ign3; \ asm volatile ( \ "call *%%eax" \ : "=a" (__res), "=b" (__ign1), "=c" (__ign2), \ "=d" (__ign3) \ : "0" (__hentry), "1" ((long)(a1)), "2" ((long)(a2)), \ "3" ((long)(a3)) \ : "memory" ); \ (type)__res; \ }) #define _hypercall4(type, name, a1, a2, a3, a4) \ ({ \ unsigned long __hentry = xen_hypercall_page+__HYPERVISOR_##name*32; \ long __res, __ign1, __ign2, __ign3, __ign4; \ asm volatile ( \ "call *%%eax" \ : "=a" (__res), "=b" (__ign1), "=c" (__ign2), \ "=d" (__ign3), "=S" (__ign4) \ : "0" (__hentry), "1" ((long)(a1)), "2" ((long)(a2)), \ "3" ((long)(a3)), "4" ((long)(a4)) \ : "memory" ); \ (type)__res; \ }) #define _hypercall5(type, name, a1, a2, a3, a4, a5) \ ({ \ unsigned long __hentry = xen_hypercall_page+__HYPERVISOR_##name*32; \ long __res, __ign1, __ign2, __ign3, __ign4, __ign5; \ asm volatile ( \ "call *%%eax" \ : "=a" (__res), "=b" (__ign1), "=c" (__ign2), \ "=d" (__ign3), "=S" (__ign4), "=D" (__ign5) \ : "0" (__hentry), "1" ((long)(a1)), "2" ((long)(a2)), \ "3" ((long)(a3)), "4" ((long)(a4)), \ "5" ((long)(a5)) \ : "memory" ); \ (type)__res; \ }) /****************************************************************************** * * The following interface definitions are taken from Xen and have the * following license: * * Permission is hereby granted, free of charge, to any person obtaining a copy * of this software and associated documentation files (the "Software"), to * deal in the Software without restriction, including without limitation the * rights to use, copy, modify, merge, publish, distribute, sublicense, and/or * sell copies of the Software, and to permit persons to whom the Software is * furnished to do so, subject to the following conditions: * * The above copyright notice and this permission notice shall be included in * all copies or substantial portions of the Software. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER * DEALINGS IN THE SOFTWARE. */ /* xen.h */ #define __HYPERVISOR_xen_version 17 /* version.h */ /* arg == xen_extraversion_t. */ #define XENVER_extraversion 1 typedef char xen_extraversion_t[16]; #define XEN_EXTRAVERSION_LEN (sizeof(xen_extraversion_t)) #endif tinyvisor/bios/src/usb-ehci.h0000644006644000001440000001144412172661303016464 0ustar yuichi_xyusers#ifndef __USB_EHCI_H #define __USB_EHCI_H // usb-ehci.c int ehci_setup(struct pci_device *pci, int busid, struct pci_device *comppci); struct usbdevice_s; struct usb_endpoint_descriptor; struct usb_pipe *ehci_alloc_pipe(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc); struct usb_pipe; int ehci_control(struct usb_pipe *p, int dir, const void *cmd, int cmdsize , void *data, int datasize); int ehci_send_bulk(struct usb_pipe *p, int dir, void *data, int datasize); int ehci_poll_intr(struct usb_pipe *p, void *data); /**************************************************************** * ehci structs and flags ****************************************************************/ struct ehci_caps { u8 caplength; u8 reserved_01; u16 hciversion; u32 hcsparams; u32 hccparams; u64 portroute; } PACKED; #define HCC_64BIT_ADDR 1 #define HCS_N_PORTS_MASK 0xf struct ehci_regs { u32 usbcmd; u32 usbsts; u32 usbintr; u32 frindex; u32 ctrldssegment; u32 periodiclistbase; u32 asynclistbase; u32 reserved[9]; u32 configflag; u32 portsc[0]; } PACKED; #define CMD_PARK (1<<11) #define CMD_PARK_CNT(c) (((c)>>8)&3) #define CMD_LRESET (1<<7) #define CMD_IAAD (1<<6) #define CMD_ASE (1<<5) #define CMD_PSE (1<<4) #define CMD_HCRESET (1<<1) #define CMD_RUN (1<<0) #define STS_ASS (1<<15) #define STS_PSS (1<<14) #define STS_RECL (1<<13) #define STS_HALT (1<<12) #define STS_IAA (1<<5) #define STS_FATAL (1<<4) #define STS_FLR (1<<3) #define STS_PCD (1<<2) #define STS_ERR (1<<1) #define STS_INT (1<<0) #define FLAG_CF (1<<0) #define PORT_WKOC_E (1<<22) #define PORT_WKDISC_E (1<<21) #define PORT_WKCONN_E (1<<20) #define PORT_TEST_PKT (0x4<<16) #define PORT_LED_OFF (0<<14) #define PORT_LED_AMBER (1<<14) #define PORT_LED_GREEN (2<<14) #define PORT_LED_MASK (3<<14) #define PORT_OWNER (1<<13) #define PORT_POWER (1<<12) #define PORT_LINESTATUS_MASK (3<<10) #define PORT_LINESTATUS_KSTATE (1<<10) #define PORT_RESET (1<<8) #define PORT_SUSPEND (1<<7) #define PORT_RESUME (1<<6) #define PORT_OCC (1<<5) #define PORT_OC (1<<4) #define PORT_PEC (1<<3) #define PORT_PE (1<<2) #define PORT_CSC (1<<1) #define PORT_CONNECT (1<<0) #define PORT_RWC_BITS (PORT_CSC | PORT_PEC | PORT_OCC) #define EHCI_QH_ALIGN 128 // Can't span a 4K boundary, so increase from 32 struct ehci_qh { u32 next; u32 info1; u32 info2; u32 current; u32 qtd_next; u32 alt_next; u32 token; u32 buf[5]; u32 buf_hi[5]; } PACKED; #define QH_CONTROL (1 << 27) #define QH_MAXPACKET_SHIFT 16 #define QH_MAXPACKET_MASK (0x7ff << QH_MAXPACKET_SHIFT) #define QH_HEAD (1 << 15) #define QH_TOGGLECONTROL (1 << 14) #define QH_SPEED_SHIFT 12 #define QH_SPEED_MASK (0x3 << QH_SPEED_SHIFT) #define QH_EP_SHIFT 8 #define QH_EP_MASK (0xf << QH_EP_SHIFT) #define QH_DEVADDR_SHIFT 0 #define QH_DEVADDR_MASK (0x7f << QH_DEVADDR_SHIFT) #define QH_SMASK_SHIFT 0 #define QH_SMASK_MASK (0xff << QH_SMASK_SHIFT) #define QH_CMASK_SHIFT 8 #define QH_CMASK_MASK (0xff << QH_CMASK_SHIFT) #define QH_HUBADDR_SHIFT 16 #define QH_HUBADDR_MASK (0x7f << QH_HUBADDR_SHIFT) #define QH_HUBPORT_SHIFT 23 #define QH_HUBPORT_MASK (0x7f << QH_HUBPORT_SHIFT) #define QH_MULT_SHIFT 30 #define QH_MULT_MASK (0x3 << QH_MULT_SHIFT) #define EHCI_PTR_BITS 0x001F #define EHCI_PTR_TERM 0x0001 #define EHCI_PTR_QH 0x0002 #define EHCI_QTD_ALIGN 64 // Can't span a 4K boundary, so increase from 32 struct ehci_qtd { u32 qtd_next; u32 alt_next; u32 token; u32 buf[5]; u32 buf_hi[5]; /* keep struct size a multiple of 64 bytes, as we're allocating arrays. Without this padding, the second qtd could have the wrong alignment. */ } PACKED __aligned(EHCI_QTD_ALIGN); #define QTD_TOGGLE (1 << 31) #define QTD_LENGTH_SHIFT 16 #define QTD_LENGTH_MASK (0x7fff << QTD_LENGTH_SHIFT) #define QTD_CERR_SHIFT 10 #define QTD_CERR_MASK (0x3 << QTD_CERR_SHIFT) #define QTD_IOC (1 << 15) #define QTD_PID_OUT (0x0 << 8) #define QTD_PID_IN (0x1 << 8) #define QTD_PID_SETUP (0x2 << 8) #define QTD_STS_ACTIVE (1 << 7) #define QTD_STS_HALT (1 << 6) #define QTD_STS_DBE (1 << 5) #define QTD_STS_BABBLE (1 << 4) #define QTD_STS_XACT (1 << 3) #define QTD_STS_MMF (1 << 2) #define QTD_STS_STS (1 << 1) #define QTD_STS_PING (1 << 0) #define ehci_explen(len) (((len) << QTD_LENGTH_SHIFT) & QTD_LENGTH_MASK) #define ehci_maxerr(err) (((err) << QTD_CERR_SHIFT) & QTD_CERR_MASK) struct ehci_framelist { u32 links[1024]; } PACKED; #endif // usb-ehci.h tinyvisor/bios/src/entryfuncs.S0000644006644000001440000001111112172661303017127 0ustar yuichi_xyusers// Macros for entering C code // // Copyright (C) 2008,2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. /**************************************************************** * Entry macros ****************************************************************/ .macro PUSHBREGS pushl %eax // Save registers (matches struct bregs) pushl %ecx pushl %edx pushl %ebx pushl %ebp pushl %esi pushl %edi pushw %es pushw %ds .endm .macro POPBREGS popw %ds // Restore registers (from struct bregs) popw %es popl %edi popl %esi popl %ebp popl %ebx popl %edx popl %ecx popl %eax .endm // Call a C function - this does the minimal work necessary to // call into C. It sets up %ds, backs up %es, and backs up // those registers that are call clobbered by the C compiler. .macro ENTRY cfunc cli // In case something far-calls instead of using "int" cld pushl %eax // Save registers clobbered by C code pushl %ecx pushl %edx pushw %es pushw %ds movw %ss, %ax // Move %ss to %ds movw %ax, %ds pushl %esp // Backup %esp, then clear high bits movzwl %sp, %esp calll \cfunc popl %esp // Restore %esp (including high bits) popw %ds // Restore registers saved above popw %es popl %edx popl %ecx popl %eax .endm // As above, but get calling function from stack. .macro ENTRY_ST cli cld pushl %ecx pushl %edx pushw %es pushw %ds movw %ss, %cx // Move %ss to %ds movw %cx, %ds pushl %esp // Backup %esp, then clear high bits movzwl %sp, %esp movl 16(%esp), %ecx // Get calling function movl %eax, 16(%esp) // Save %eax calll *%ecx popl %esp // Restore %esp (including high bits) popw %ds // Restore registers saved above popw %es popl %edx popl %ecx popl %eax .endm // Call a C function with current register list as an // argument. This backs up the registers and sets %eax // to point to the backup. On return, the registers are // restored from the structure. .macro ENTRY_ARG cfunc cli cld PUSHBREGS movw %ss, %ax // Move %ss to %ds movw %ax, %ds movl %esp, %ebx // Backup %esp, then zero high bits movzwl %sp, %esp movl %esp, %eax // First arg is pointer to struct bregs calll \cfunc movl %ebx, %esp // Restore %esp (including high bits) POPBREGS .endm // As above, but get calling function from stack. .macro ENTRY_ARG_ST cli cld pushl %ecx pushl %edx pushl %ebx pushl %ebp pushl %esi pushl %edi pushw %es pushw %ds movw %ss, %cx // Move %ss to %ds movw %cx, %ds movl %esp, %ebx // Backup %esp, then zero high bits movzwl %sp, %esp movl 28(%esp), %ecx // Get calling function movl %eax, 28(%esp) // Save %eax movl %esp, %eax // First arg is pointer to struct bregs calll *%ecx movl %ebx, %esp // Restore %esp (including high bits) POPBREGS .endm // Same as ENTRY_ARG, but don't mangle %esp .macro ENTRY_ARG_ESP cfunc cli cld PUSHBREGS movw %ss, %ax // Move %ss to %ds movw %ax, %ds movl %esp, %eax // First arg is pointer to struct bregs calll \cfunc POPBREGS .endm // Reset stack, transition to 32bit mode, and call a C function. // Clobbers %ax .macro ENTRY_INTO32 cfunc xorw %ax, %ax movw %ax, %ss movl $ BUILD_STACK_ADDR , %esp movl $ \cfunc , %edx jmp transition32 .endm // Declare a function .macro DECLFUNC func .section .text.asm.\func .global \func .endm // Declare an exported function .macro EXPORTFUNC func .section .text.asm.export.\func .global \func .endm tinyvisor/bios/src/mtrr.c0000644006644000001440000000630412172661303015743 0ustar yuichi_xyusers// Initialize MTRRs - mostly useful on KVM. // // Copyright (C) 2006 Fabrice Bellard // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "config.h" // CONFIG_* #include "pci.h" // pcimem_start #include "paravirt.h" // RamSize #define MSR_MTRRcap 0x000000fe #define MSR_MTRRfix64K_00000 0x00000250 #define MSR_MTRRfix16K_80000 0x00000258 #define MSR_MTRRfix16K_A0000 0x00000259 #define MSR_MTRRfix4K_C0000 0x00000268 #define MSR_MTRRfix4K_C8000 0x00000269 #define MSR_MTRRfix4K_D0000 0x0000026a #define MSR_MTRRfix4K_D8000 0x0000026b #define MSR_MTRRfix4K_E0000 0x0000026c #define MSR_MTRRfix4K_E8000 0x0000026d #define MSR_MTRRfix4K_F0000 0x0000026e #define MSR_MTRRfix4K_F8000 0x0000026f #define MSR_MTRRdefType 0x000002ff #define MTRRphysBase_MSR(reg) (0x200 + 2 * (reg)) #define MTRRphysMask_MSR(reg) (0x200 + 2 * (reg) + 1) #define MTRR_MEMTYPE_UC 0 #define MTRR_MEMTYPE_WC 1 #define MTRR_MEMTYPE_WT 4 #define MTRR_MEMTYPE_WP 5 #define MTRR_MEMTYPE_WB 6 void mtrr_setup(void) { if (!CONFIG_MTRR_INIT) return; u32 eax, ebx, ecx, edx, cpuid_features; cpuid(1, &eax, &ebx, &ecx, &cpuid_features); if (!(cpuid_features & CPUID_MTRR)) return; if (!(cpuid_features & CPUID_MSR)) return; dprintf(3, "init mtrr\n"); u32 mtrr_cap = rdmsr(MSR_MTRRcap); int vcnt = mtrr_cap & 0xff; int fix = mtrr_cap & 0x100; if (!vcnt || !fix) return; // Disable MTRRs wrmsr_smp(MSR_MTRRdefType, 0); // Set fixed MTRRs union u64b { u8 valb[8]; u64 val; } u; u.val = 0; int i; for (i = 0; i < 8; i++) if (RamSize >= 65536 * (i + 1)) u.valb[i] = MTRR_MEMTYPE_WB; wrmsr_smp(MSR_MTRRfix64K_00000, u.val); u.val = 0; for (i = 0; i < 8; i++) if (RamSize >= 0x80000 + 16384 * (i + 1)) u.valb[i] = MTRR_MEMTYPE_WB; wrmsr_smp(MSR_MTRRfix16K_80000, u.val); wrmsr_smp(MSR_MTRRfix16K_A0000, 0); // 0xA0000-0xC0000 is uncached int j; for (j = 0; j < 8; j++) { u.val = 0; for (i = 0; i < 8; i++) if (RamSize >= 0xC0000 + j * 0x8000 + 4096 * (i + 1)) u.valb[i] = MTRR_MEMTYPE_WP; wrmsr_smp(MSR_MTRRfix4K_C0000 + j, u.val); } // Set variable MTRRs int phys_bits = 36; cpuid(0x80000000u, &eax, &ebx, &ecx, &edx); if (eax >= 0x80000008) { /* Get physical bits from leaf 0x80000008 (if available) */ cpuid(0x80000008u, &eax, &ebx, &ecx, &edx); phys_bits = eax & 0xff; } u64 phys_mask = ((1ull << phys_bits) - 1); for (i=0; i" #sym " %0 " #val : : "i" (val)) #define BLANK() \ asm volatile("\n->" : : ) #define OFFSET(sym, str, mem) \ DEFINE(sym, offsetof(struct str, mem)) #define COMMENT(x) \ asm volatile("\n->#" x) #endif // gen-defs.h tinyvisor/bios/src/usb-msc.c0000644006644000001440000001355212172661303016333 0ustar yuichi_xyusers// Code for handling USB Mass Storage Controller devices. // // Copyright (C) 2010 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "config.h" // CONFIG_USB_MSC #include "usb-msc.h" // usb_msc_setup #include "usb.h" // struct usb_s #include "biosvar.h" // GET_GLOBAL #include "blockcmd.h" // cdb_read #include "disk.h" // DTYPE_USB #include "boot.h" // bootprio_find_usb struct usbdrive_s { struct drive_s drive; struct usb_pipe *bulkin, *bulkout; int lun; }; /**************************************************************** * Bulk-only drive command processing ****************************************************************/ #define USB_CDB_SIZE 12 #define CBW_SIGNATURE 0x43425355 // USBC struct cbw_s { u32 dCBWSignature; u32 dCBWTag; u32 dCBWDataTransferLength; u8 bmCBWFlags; u8 bCBWLUN; u8 bCBWCBLength; u8 CBWCB[16]; } PACKED; #define CSW_SIGNATURE 0x53425355 // USBS struct csw_s { u32 dCSWSignature; u32 dCSWTag; u32 dCSWDataResidue; u8 bCSWStatus; } PACKED; static int usb_msc_send(struct usbdrive_s *udrive_g, int dir, void *buf, u32 bytes) { struct usb_pipe *pipe; if (dir == USB_DIR_OUT) pipe = GET_GLOBAL(udrive_g->bulkout); else pipe = GET_GLOBAL(udrive_g->bulkin); return usb_send_bulk(pipe, dir, buf, bytes); } // Low-level usb command transmit function. int usb_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize) { if (!CONFIG_USB_MSC) return 0; dprintf(16, "usb_cmd_data id=%p write=%d count=%d bs=%d buf=%p\n" , op->drive_g, 0, op->count, blocksize, op->buf_fl); struct usbdrive_s *udrive_g = container_of( op->drive_g, struct usbdrive_s, drive); // Setup command block wrapper. u32 bytes = blocksize * op->count; struct cbw_s cbw; memset(&cbw, 0, sizeof(cbw)); memcpy(cbw.CBWCB, cdbcmd, USB_CDB_SIZE); cbw.dCBWSignature = CBW_SIGNATURE; cbw.dCBWTag = 999; // XXX cbw.dCBWDataTransferLength = bytes; cbw.bmCBWFlags = cdb_is_read(cdbcmd, blocksize) ? USB_DIR_IN : USB_DIR_OUT; cbw.bCBWLUN = GET_GLOBAL(udrive_g->lun); cbw.bCBWCBLength = USB_CDB_SIZE; // Transfer cbw to device. int ret = usb_msc_send(udrive_g, USB_DIR_OUT , MAKE_FLATPTR(GET_SEG(SS), &cbw), sizeof(cbw)); if (ret) goto fail; // Transfer data to/from device. if (bytes) { ret = usb_msc_send(udrive_g, cbw.bmCBWFlags, op->buf_fl, bytes); if (ret) goto fail; } // Transfer csw info. struct csw_s csw; ret = usb_msc_send(udrive_g, USB_DIR_IN , MAKE_FLATPTR(GET_SEG(SS), &csw), sizeof(csw)); if (ret) goto fail; if (!csw.bCSWStatus) return DISK_RET_SUCCESS; if (csw.bCSWStatus == 2) goto fail; if (blocksize) op->count -= csw.dCSWDataResidue / blocksize; return DISK_RET_EBADTRACK; fail: // XXX - reset connection dprintf(1, "USB transmission failed\n"); op->count = 0; return DISK_RET_EBADTRACK; } static int usb_msc_maxlun(struct usb_pipe *pipe) { struct usb_ctrlrequest req; req.bRequestType = USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE; req.bRequest = 0xfe; req.wValue = 0; req.wIndex = 0; req.wLength = 1; unsigned char maxlun; int ret = send_default_control(pipe, &req, &maxlun); if (ret) return 0; return maxlun; } static int usb_msc_lun_setup(struct usb_pipe *inpipe, struct usb_pipe *outpipe, struct usbdevice_s *usbdev, int lun) { // Allocate drive structure. struct usbdrive_s *udrive_g = malloc_fseg(sizeof(*udrive_g)); if (!udrive_g) { warn_noalloc(); return -1; } memset(udrive_g, 0, sizeof(*udrive_g)); udrive_g->drive.type = DTYPE_USB; udrive_g->bulkin = inpipe; udrive_g->bulkout = outpipe; udrive_g->lun = lun; int prio = bootprio_find_usb(usbdev, lun); int ret = scsi_drive_setup(&udrive_g->drive, "USB MSC", prio); if (ret) { dprintf(1, "Unable to configure USB MSC drive.\n"); free(udrive_g); return -1; } return 0; } /**************************************************************** * Setup ****************************************************************/ // Configure a usb msc device. int usb_msc_setup(struct usbdevice_s *usbdev) { if (!CONFIG_USB_MSC) return -1; // Verify right kind of device struct usb_interface_descriptor *iface = usbdev->iface; if ((iface->bInterfaceSubClass != US_SC_SCSI && iface->bInterfaceSubClass != US_SC_ATAPI_8070 && iface->bInterfaceSubClass != US_SC_ATAPI_8020) || iface->bInterfaceProtocol != US_PR_BULK) { dprintf(1, "Unsupported MSC USB device (subclass=%02x proto=%02x)\n" , iface->bInterfaceSubClass, iface->bInterfaceProtocol); return -1; } // Find bulk in and bulk out endpoints. struct usb_pipe *inpipe = NULL, *outpipe = NULL; struct usb_endpoint_descriptor *indesc = findEndPointDesc( usbdev, USB_ENDPOINT_XFER_BULK, USB_DIR_IN); struct usb_endpoint_descriptor *outdesc = findEndPointDesc( usbdev, USB_ENDPOINT_XFER_BULK, USB_DIR_OUT); if (!indesc || !outdesc) goto fail; inpipe = usb_alloc_pipe(usbdev, indesc); outpipe = usb_alloc_pipe(usbdev, outdesc); if (!inpipe || !outpipe) goto fail; int maxlun = usb_msc_maxlun(usbdev->defpipe); int lun, pipesused = 0; for (lun = 0; lun < maxlun + 1; lun++) { int ret = usb_msc_lun_setup(inpipe, outpipe, usbdev, lun); if (!ret) pipesused = 1; } if (!pipesused) goto fail; return 0; fail: dprintf(1, "Unable to configure USB MSC device.\n"); free_pipe(inpipe); free_pipe(outpipe); return -1; } tinyvisor/bios/src/Kconfig0000644006644000001440000002737112172661303016125 0ustar yuichi_xyusers# Kconfig SeaBIOS configuration mainmenu "SeaBIOS Configuration" menu "General Features" choice prompt "Build Target" default QEMU config COREBOOT bool "Build for coreboot" help Configure as a coreboot payload. config QEMU bool "Build for QEMU/Xen/KVM/Bochs" select QEMU_HARDWARE help Configure for an emulated machine (QEMU, Xen, KVM, or Bochs). config CSM bool "Build as Compatibilty Support Module for EFI BIOS" help Configure to be used by EFI firmware as Compatibility Support module (CSM) to provide legacy BIOS services. endchoice config QEMU_HARDWARE bool "Support hardware found on emulators (QEMU/Xen/KVM/Bochs)" if !QEMU default n help Support virtual hardware when the code detects it is running on an emulator. config XEN depends on QEMU bool "Support Xen HVM" default y help Configure to be used by xen hvmloader, for a HVM guest. config THREADS bool "Parallelize hardware init" default y help Support running hardware initialization in parallel. config THREAD_OPTIONROMS depends on THREADS && !CSM bool "Hardware init during option ROM execution" default n help Allow hardware init to run in parallel with optionrom execution. This can reduce boot time, but can cause some timing variations during option ROM code execution. It is not known if all option ROMs will behave properly with this option. config RELOCATE_INIT bool "Copy init code to high memory" default y help Support relocating the one time initialization code to high memory. config BOOTMENU depends on BOOT bool "Bootmenu" default y help Support an interactive boot menu at end of post. config BOOTSPLASH depends on BOOTMENU bool "Graphical boot splash screen" default y help Support showing a graphical boot splash screen. config BOOTORDER depends on BOOT bool "Boot ordering" default y help Support controlling of the boot order via the fw_cfg/CBFS "bootorder" file. config COREBOOT_FLASH depends on COREBOOT bool "coreboot CBFS support" default y help Support searching coreboot flash format. config LZMA depends on COREBOOT_FLASH bool "CBFS lzma support" default y help Support CBFS files compressed using the lzma decompression algorighm. config FLASH_FLOPPY depends on COREBOOT_FLASH bool "Floppy images in CBFS" default y help Support floppy images in coreboot flash. config ENTRY_EXTRASTACK bool "Use internal stack for 16bit interrupt entry points" default y help Utilize an internal stack for all the legacy 16bit interrupt entry points. This reduces the amount of space on the caller's stack that SeaBIOS uses. This may adversely impact any legacy operating systems that call the BIOS in 16bit protected mode. endmenu menu "Hardware support" config ATA depends on DRIVES bool "ATA controllers" default y help Support for IDE disk code. config ATA_DMA depends on ATA bool "ATA DMA" default n help Detect and try to use ATA bus mastering DMA controllers. config ATA_PIO32 depends on ATA bool "ATA 32bit PIO" default n help Use 32bit PIO accesses on ATA (minor optimization on PCI transfers). config AHCI depends on DRIVES bool "AHCI controllers" default y help Support for AHCI disk code. config VIRTIO_BLK depends on DRIVES && QEMU_HARDWARE bool "virtio-blk controllers" default y help Support boot from virtio-blk storage. config VIRTIO_SCSI depends on DRIVES && QEMU_HARDWARE bool "virtio-scsi controllers" default y help Support boot from virtio-scsi storage. config ESP_SCSI depends on DRIVES && QEMU_HARDWARE bool "AMD PCscsi controllers" default y help Support boot from AMD PCscsi storage. config LSI_SCSI depends on DRIVES && QEMU_HARDWARE bool "lsi53c895a scsi controllers" default y help Support boot from qemu-emulated lsi53c895a scsi storage. config MEGASAS depends on DRIVES bool "LSI MegaRAID SAS controllers" default y help Support boot from LSI MegaRAID SAS scsi storage. config FLOPPY depends on DRIVES bool "Floppy controller" default y help Support floppy drive access. config PS2PORT depends on KEYBOARD || MOUSE bool "PS/2 port" default y help Support PS2 ports (keyboard and mouse). config USB bool "USB" default y help Support USB devices. config USB_UHCI depends on USB bool "USB UHCI controllers" default y help Support USB UHCI controllers. config USB_OHCI depends on USB bool "USB OHCI controllers" default y help Support USB OHCI controllers. config USB_EHCI depends on USB bool "USB EHCI controllers" default y help Support USB EHCI controllers. config USB_MSC depends on USB && DRIVES bool "USB drives" default y help Support USB BOT (bulk-only transport) disks. config USB_UAS depends on USB && DRIVES bool "UAS drives" default y help Support USB UAS (usb attached scsi) disks. config USB_HUB depends on USB bool "USB hubs" default y help Support USB hubs. config USB_KEYBOARD depends on USB && KEYBOARD bool "USB keyboards" default y help Support USB keyboards. config USB_MOUSE depends on USB && MOUSE bool "USB mice" default y help Support USB mice. config SERIAL bool "Serial port" default y help Support serial ports. This also enables int 14 serial port calls. config LPT bool "Parallel port" default y help Support parallel ports. This also enables int 17 parallel port calls. config USE_SMM depends on QEMU bool "System Management Mode (SMM)" default y help Support System Management Mode (on emulators). config MTRR_INIT depends on QEMU bool "Initialize MTRRs" default y help Initialize the Memory Type Range Registers (on emulators). config PMTIMER bool "Use ACPI timer" default y help Use the ACPI timer instead of the TSC for timekeeping (on qemu). endmenu menu "BIOS interfaces" config DRIVES bool "Drive interface" default y help Support int13 disk/floppy drive functions. config CDROM_BOOT depends on DRIVES bool "DVD/CDROM booting" default y help Support for booting from a CD. (El Torito spec support.) config CDROM_EMU depends on CDROM_BOOT bool "DVD/CDROM boot drive emulation" default y help Support bootable CDROMs that emulate a floppy/harddrive. config PCIBIOS bool "PCIBIOS interface" default y help Support int 1a/b1 PCI BIOS calls. config APMBIOS bool "APM interface" default y help Support int 15/53 APM BIOS calls. config PNPBIOS bool "PnP BIOS interface" default y help Support PnP BIOS entry point. config OPTIONROMS bool "Option ROMS" default y help Support finding and running option roms during POST. config OPTIONROMS_DEPLOYED depends on OPTIONROMS && QEMU bool "Option roms are already at 0xc0000-0xf0000" default n help Select this if option ROMs are already copied to 0xc0000-0xf0000. This must only be selected when using Bochs or QEMU versions older than 0.12. config PMM depends on OPTIONROMS bool "PMM interface" default y help Support Post Memory Manager (PMM) entry point. config BOOT bool "Boot interface" default y help Support int 19/18 system bootup support. config KEYBOARD bool "Keyboard interface" default y help Support int 16 keyboard calls. config KBD_CALL_INT15_4F depends on KEYBOARD bool "Keyboard hook interface" default y help Support calling int155f on each keyboard event. config MOUSE bool "Mouse interface" default y help Support for int15c2 mouse calls. config S3_RESUME bool "S3 resume" default y help Support S3 resume handler. config VGAHOOKS bool "Hardware specific VGA helpers" default y help Support int 155f BIOS callbacks specific to some Intel and VIA on-board vga devices. config DISABLE_A20 bool "Disable A20" default n help Disable A20 on 16bit boot. endmenu menu "BIOS Tables" depends on QEMU config PIRTABLE bool "PIR table" default y help Support generation of a PIR table in 0xf000 segment. config MPTABLE bool "MPTable" default y help Support generation of MPTable. config SMBIOS bool "SMBIOS" default y help Support generation of SM BIOS tables. This is also sometimes called DMI. config ACPI bool "ACPI" default y help Support generation of ACPI tables. config ACPI_DSDT bool "Include default ACPI DSDT" default y depends on ACPI help Include default DSDT ACPI table in BIOS. Required for QEMU 1.3 and older. This option can be disabled for QEMU 1.4 and newer to save some space in the ROM file. If unsure, say Y. endmenu source vgasrc/Kconfig menu "Debugging" config DEBUG_LEVEL int "Debug level" default 1 help Control how verbose debug output is. The higher the number, the more verbose SeaBIOS will be. Set to zero to disable debugging. config DEBUG_SERIAL depends on DEBUG_LEVEL != 0 bool "Serial port debugging" default n help Send debugging information to serial port. config DEBUG_SERIAL_PORT depends on DEBUG_SERIAL hex "Serial port base address" default 0x3f8 help Base port for serial - generally 0x3f8, 0x2f8, 0x3e8, or 0x2e8. config DEBUG_IO depends on QEMU_HARDWARE && DEBUG_LEVEL != 0 bool "Special IO port debugging" default y help Some emulators or hypervisors provide with a way to output debug information by outputing strings in a special port present in the IO space. endmenu tinyvisor/bios/src/virtio-ring.c0000644006644000001440000000762312172661303017235 0ustar yuichi_xyusers/* virtio-pci.c - virtio ring management * * (c) Copyright 2008 Bull S.A.S. * * Author: Laurent Vivier * * some parts from Linux Virtio Ring * * Copyright Rusty Russell IBM Corporation 2007 * * Adopted for Seabios: Gleb Natapov * * This work is licensed under the terms of the GNU LGPLv3 * See the COPYING file in the top-level directory. * * */ #include "virtio-ring.h" #include "virtio-pci.h" #include "biosvar.h" // GET_GLOBAL #include "util.h" // dprintf #define BUG() do { \ panic("BUG: failure at %d/%s()!\n", __LINE__, __func__); \ } while (0) #define BUG_ON(condition) do { if (condition) BUG(); } while (0) /* * vring_more_used * * is there some used buffers ? * */ int vring_more_used(struct vring_virtqueue *vq) { struct vring_used *used = GET_LOWFLAT(vq->vring.used); int more = GET_LOWFLAT(vq->last_used_idx) != GET_LOWFLAT(used->idx); /* Make sure ring reads are done after idx read above. */ smp_rmb(); return more; } /* * vring_free * * put at the begin of the free list the current desc[head] */ void vring_detach(struct vring_virtqueue *vq, unsigned int head) { struct vring *vr = &vq->vring; struct vring_desc *desc = GET_LOWFLAT(vr->desc); unsigned int i; /* find end of given descriptor */ i = head; while (GET_LOWFLAT(desc[i].flags) & VRING_DESC_F_NEXT) i = GET_LOWFLAT(desc[i].next); /* link it with free list and point to it */ SET_LOWFLAT(desc[i].next, GET_LOWFLAT(vq->free_head)); SET_LOWFLAT(vq->free_head, head); } /* * vring_get_buf * * get a buffer from the used list * */ int vring_get_buf(struct vring_virtqueue *vq, unsigned int *len) { struct vring *vr = &vq->vring; struct vring_used_elem *elem; struct vring_used *used = GET_LOWFLAT(vq->vring.used); u32 id; int ret; // BUG_ON(!vring_more_used(vq)); elem = &used->ring[GET_LOWFLAT(vq->last_used_idx) % GET_LOWFLAT(vr->num)]; id = GET_LOWFLAT(elem->id); if (len != NULL) *len = GET_LOWFLAT(elem->len); ret = GET_LOWFLAT(vq->vdata[id]); vring_detach(vq, id); SET_LOWFLAT(vq->last_used_idx, GET_LOWFLAT(vq->last_used_idx) + 1); return ret; } void vring_add_buf(struct vring_virtqueue *vq, struct vring_list list[], unsigned int out, unsigned int in, int index, int num_added) { struct vring *vr = &vq->vring; int i, av, head, prev; struct vring_desc *desc = GET_LOWFLAT(vr->desc); struct vring_avail *avail = GET_LOWFLAT(vr->avail); BUG_ON(out + in == 0); prev = 0; head = GET_LOWFLAT(vq->free_head); for (i = head; out; i = GET_LOWFLAT(desc[i].next), out--) { SET_LOWFLAT(desc[i].flags, VRING_DESC_F_NEXT); SET_LOWFLAT(desc[i].addr, (u64)virt_to_phys(list->addr)); SET_LOWFLAT(desc[i].len, list->length); prev = i; list++; } for ( ; in; i = GET_LOWFLAT(desc[i].next), in--) { SET_LOWFLAT(desc[i].flags, VRING_DESC_F_NEXT|VRING_DESC_F_WRITE); SET_LOWFLAT(desc[i].addr, (u64)virt_to_phys(list->addr)); SET_LOWFLAT(desc[i].len, list->length); prev = i; list++; } SET_LOWFLAT(desc[prev].flags, GET_LOWFLAT(desc[prev].flags) & ~VRING_DESC_F_NEXT); SET_LOWFLAT(vq->free_head, i); SET_LOWFLAT(vq->vdata[head], index); av = (GET_LOWFLAT(avail->idx) + num_added) % GET_LOWFLAT(vr->num); SET_LOWFLAT(avail->ring[av], head); } void vring_kick(unsigned int ioaddr, struct vring_virtqueue *vq, int num_added) { struct vring *vr = &vq->vring; struct vring_avail *avail = GET_LOWFLAT(vr->avail); /* Make sure idx update is done after ring write. */ smp_wmb(); SET_LOWFLAT(avail->idx, GET_LOWFLAT(avail->idx) + num_added); vp_notify(ioaddr, GET_LOWFLAT(vq->queue_index)); } tinyvisor/bios/src/lzmadecode.h0000644006644000001440000000317611733243570017103 0ustar yuichi_xyusers/* LzmaDecode.h LZMA Decoder interface LZMA SDK 4.40 Copyright (c) 1999-2006 Igor Pavlov (2006-05-01) http://www.7-zip.org/ LZMA SDK is licensed under two licenses: 1) GNU Lesser General Public License (GNU LGPL) 2) Common Public License (CPL) It means that you can select one of these two licenses and follow rules of that license. SPECIAL EXCEPTION: Igor Pavlov, as the author of this code, expressly permits you to statically or dynamically link your code (or bind by name) to the interfaces of this file without subjecting your linked code to the terms of the CPL or GNU LGPL. Any modifications or additions to this file, however, are subject to the LGPL or CPL terms. */ #ifndef __LZMADECODE_H #define __LZMADECODE_H typedef unsigned char Byte; typedef unsigned short UInt16; typedef unsigned int UInt32; typedef UInt32 SizeT; #define CProb UInt16 #define LZMA_RESULT_OK 0 #define LZMA_RESULT_DATA_ERROR 1 #define LZMA_BASE_SIZE 1846 #define LZMA_LIT_SIZE 768 #define LZMA_PROPERTIES_SIZE 5 typedef struct _CLzmaProperties { int lc; int lp; int pb; }CLzmaProperties; int LzmaDecodeProperties(CLzmaProperties *propsRes, const unsigned char *propsData, int size); #define LzmaGetNumProbs(Properties) (LZMA_BASE_SIZE + (LZMA_LIT_SIZE << ((Properties)->lc + (Properties)->lp))) #define kLzmaNeedInitId (-2) typedef struct _CLzmaDecoderState { CLzmaProperties Properties; CProb *Probs; } CLzmaDecoderState; int LzmaDecode(CLzmaDecoderState *vs, const unsigned char *inStream, SizeT inSize, SizeT *inSizeProcessed, unsigned char *outStream, SizeT outSize, SizeT *outSizeProcessed); #endif tinyvisor/bios/src/romlayout.S0000644006644000001440000004232012172661303016770 0ustar yuichi_xyusers// Rom layout and bios assembler to C interface. // // Copyright (C) 2008-2012 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "config.h" // CONFIG_* #include "ioport.h" // PORT_A20 #include "bregs.h" // CR0_* #include "cmos.h" // CMOS_RESET_CODE #include "asm-offsets.h" // BREGS_* #include "entryfuncs.S" // ENTRY_* /**************************************************************** * Call trampolines ****************************************************************/ // Place CPU into 32bit mode from 16bit mode. // %edx = return location (in 32bit mode) // Clobbers: ecx, flags, segment registers, cr0, idt/gdt DECLFUNC transition32 .code16gcc transition32: movl %eax, %ecx // Disable irqs (and clear direction flag) cli cld // Disable nmi movl $CMOS_RESET_CODE|NMI_DISABLE_BIT, %eax outb %al, $PORT_CMOS_INDEX inb $PORT_CMOS_DATA, %al // enable a20 inb $PORT_A20, %al orb $A20_ENABLE_BIT, %al outb %al, $PORT_A20 // Set segment descriptors lidtw %cs:pmode_IDT_info lgdtw %cs:rombios32_gdt_48 // Enable protected mode movl %cr0, %eax orl $CR0_PE, %eax movl %eax, %cr0 // start 32bit protected mode code ljmpl $SEG32_MODE32_CS, $(BUILD_BIOS_ADDR + 1f) .code32 1: // init data segments movl $SEG32_MODE32_DS, %eax movw %ax, %ds movw %ax, %es movw %ax, %ss movw %ax, %fs movw %ax, %gs movl %ecx, %eax jmpl *%edx // Place CPU into 16bit mode from 32bit mode. // %edx = return location (in 16bit mode) // Clobbers: ecx, flags, segment registers, cr0, idt/gdt DECLFUNC transition16 .global transition16big transition16: movl %eax, %ecx // restore data segment limits to 0xffff movl $SEG32_MODE16_DS, %eax movw %ax, %ds movw %ax, %es movw %ax, %ss movw %ax, %fs movw %ax, %gs #if CONFIG_DISABLE_A20 // disable a20 inb $PORT_A20, %al andb $~A20_ENABLE_BIT, %al outb %al, $PORT_A20 #endif // Jump to 16bit mode ljmpw $SEG32_MODE16_CS, $1f transition16big: movl %eax, %ecx movl $SEG32_MODE16BIG_DS, %eax movw %ax, %ds movw %ax, %es movw %ax, %ss movw %ax, %fs movw %ax, %gs ljmpw $SEG32_MODE16BIG_CS, $1f .code16gcc 1: // Disable protected mode movl %cr0, %eax andl $~CR0_PE, %eax movl %eax, %cr0 // far jump to flush CPU queue after transition to real mode ljmpw $SEG_BIOS, $2f 2: // restore IDT to normal real-mode defaults lidtw %cs:rmode_IDT_info // Clear segment registers xorw %ax, %ax movw %ax, %fs movw %ax, %gs movw %ax, %es movw %ax, %ds movw %ax, %ss // Assume stack is in segment 0 movl %ecx, %eax jmpl *%edx // Far call a 16bit function from 16bit mode with a specified cpu register state // %es:%eax = address of struct bregs // Clobbers: %e[bcd]x, %e[ds]i, flags DECLFUNC __farcall16 __farcall16: // Save %eax, %ebp pushl %ebp pushl %eax pushl %es // Setup for iretw call pushw %cs pushw $1f // return point pushw %es:BREGS_flags(%eax) // flags pushl %es:BREGS_code(%eax) // CS:IP // Load calling registers. movl %es:BREGS_edi(%eax), %edi movl %es:BREGS_esi(%eax), %esi movl %es:BREGS_ebp(%eax), %ebp movl %es:BREGS_ebx(%eax), %ebx movl %es:BREGS_edx(%eax), %edx movl %es:BREGS_ecx(%eax), %ecx movw %es:BREGS_ds(%eax), %ds pushl %es:BREGS_eax(%eax) movw %es:BREGS_es(%eax), %es popl %eax // Invoke call iretw // XXX - just do a lcalll 1: // Store flags, es, eax pushfw cli cld pushw %es pushl %eax movw 0x08(%esp), %es movl 0x0c(%esp), %eax popl %es:BREGS_eax(%eax) popw %es:BREGS_es(%eax) popw %es:BREGS_flags(%eax) // Store remaining registers movl %edi, %es:BREGS_edi(%eax) movl %esi, %es:BREGS_esi(%eax) movl %ebp, %es:BREGS_ebp(%eax) movl %ebx, %es:BREGS_ebx(%eax) movl %edx, %es:BREGS_edx(%eax) movl %ecx, %es:BREGS_ecx(%eax) movw %ds, %es:BREGS_ds(%eax) movw %ss, %cx movw %cx, %ds // Restore %ds == %ss // Remove %es/%eax, restore %ebp popl %eax popl %eax popl %ebp retl // Call a 16bit SeaBIOS function from SeaBIOS 32bit C code. // %ebx = calling function // Clobbers: %ecx, %edx, flags, segment registers, idt/gdt DECLFUNC __call16 .global __call16big .code32 __call16: movl $1f, %edx jmp transition16 __call16big: movl $1f, %edx jmp transition16big // Make call. .code16gcc 1: calll *%ebx // Return via transition32 movl $(2f + BUILD_BIOS_ADDR), %edx jmp transition32 .code32 2: retl .code16gcc // IRQ trampolines .macro IRQ_TRAMPOLINE num DECLFUNC irq_trampoline_0x\num irq_trampoline_0x\num : int $0x\num lretw .endm IRQ_TRAMPOLINE 02 IRQ_TRAMPOLINE 10 IRQ_TRAMPOLINE 13 IRQ_TRAMPOLINE 15 IRQ_TRAMPOLINE 16 IRQ_TRAMPOLINE 18 IRQ_TRAMPOLINE 19 IRQ_TRAMPOLINE 1c IRQ_TRAMPOLINE 4a /**************************************************************** * Misc. entry points. ****************************************************************/ // Resume (and reboot) entry point - called from entry_post DECLFUNC entry_resume entry_resume: // Disable interrupts cli cld // Use the ExtraStack in low mem. movl $_zonelow_seg, %eax movw %ax, %ds movw %ax, %ss movl $ExtraStack + BUILD_EXTRA_STACK_SIZE, %esp // Call handler. jmp handle_resume // PMM entry point DECLFUNC entry_pmm entry_pmm: pushl %esp // Backup %esp, then clear high bits movzwl %sp, %esp pushfl // Save registers clobbered by C code cli cld pushl %eax pushl %ecx pushl %edx pushw %es pushw %ds movw %ss, %cx // Move %ss to %ds movw %cx, %ds movl $_cfunc32flat_handle_pmm, %eax // Setup: call32(handle_pmm, args, -1) leal 28(%esp), %edx // %edx points to start of args movl $-1, %ecx calll call32 movw %ax, 12(%esp) // Modify %ax:%dx to return %eax shrl $16, %eax movw %ax, 4(%esp) popw %ds // Restore saved registers popw %es popl %edx popl %ecx popl %eax popfl popl %esp lretw // PnP entry points DECLFUNC entry_pnp_real .global entry_pnp_prot entry_pnp_prot: pushl %esp jmp 1f entry_pnp_real: pushl %esp // Backup %esp, then clear high bits movzwl %sp, %esp 1: pushfl // Save registers clobbered by C code cli cld pushl %eax pushl %ecx pushl %edx pushw %es pushw %ds movw %ss, %cx // Move %ss to %ds movw %cx, %ds leal 28(%esp), %eax // %eax points to start of u16 args calll handle_pnp movw %ax, 12(%esp) // Modify %eax to return %ax popw %ds popw %es popl %edx popl %ecx popl %eax popfl popl %esp lretw // APM entry points DECLFUNC entry_apm16 entry_apm16: pushfw // save flags pushl %eax // dummy ENTRY_ARG handle_apm addw $4, %sp // pop dummy popfw // restore flags lretw .code32 DECLFUNC entry_apm32 entry_apm32: pushfl pushl %gs pushl %cs // Move second descriptor after %cs to %gs addl $16, (%esp) popl %gs ENTRY_ARG_ESP _cfunc32seg_handle_apm popl %gs popfl lretl // PCI-BIOS entry points DECLFUNC entry_pcibios32 entry_pcibios32: pushfl pushl %gs // Backup %gs and set %gs=%ds pushl %ds popl %gs ENTRY_ARG_ESP _cfunc32seg_handle_pcibios popl %gs popfl lretl .code16gcc DECLFUNC entry_pcibios16 entry_pcibios16: ENTRY_ARG handle_pcibios iretw // BIOS32 support .code32 DECLFUNC entry_bios32 entry_bios32: pushfl #if CONFIG_PCIBIOS // Check for PCI-BIOS request cmpl $0x49435024, %eax // $PCI jne 1f movl $BUILD_BIOS_ADDR, %ebx movl $BUILD_BIOS_SIZE, %ecx movl $entry_pcibios32, %edx xorb %al, %al jmp 2f #endif // Unknown request 1: movb $0x80, %al // Return to caller 2: popfl lretl // 32bit elf entry point EXPORTFUNC entry_elf entry_elf: cli cld lidtl (BUILD_BIOS_ADDR + pmode_IDT_info) lgdtl (BUILD_BIOS_ADDR + rombios32_gdt_48) movl $SEG32_MODE32_DS, %eax movw %ax, %ds movw %ax, %es movw %ax, %fs movw %ax, %gs movw %ax, %ss movl $BUILD_STACK_ADDR, %esp ljmpl $SEG32_MODE32_CS, $_cfunc32flat_handle_post .code16gcc // UEFI Compatibility Support Module (CSM) entry point EXPORTFUNC entry_csm entry_csm: // Backup register state pushfw cli cld pushl %eax // dummy PUSHBREGS // Backup stack location and convert to a "flat pointer" movl %ss, %eax movw %ax, BREGS_code+2(%esp) // Store %ss in bregs->code.seg shll $4, %eax addl %esp, %eax // Change to BUILD_STACK_ADDR stack xorl %ebx, %ebx movw %bx, %ss movl $BUILD_STACK_ADDR, %esp // Jump to 32bit mode and call handle_csm(bregs) movl $_cfunc32flat_handle_csm, %edx jmp transition32 DECLFUNC __csm_return .code32 __csm_return: movl $1f, %edx jmp transition16big .code16gcc // Switch back to original stack 1: movzwl BREGS_code+2(%eax), %edx movl %edx, %ecx shll $4, %ecx subl %ecx, %eax movl %edx, %ss movl %eax, %esp // Restore register state and return. POPBREGS addw $4, %sp // pop dummy popfw lretw /**************************************************************** * Interrupt entry points ****************************************************************/ // Main entry point for interrupts handled on extra stack DECLFUNC irqentry_extrastack irqentry_extrastack: cli cld pushw %ds // Set %ds:%eax to space on ExtraStack pushl %eax movl $_zonelow_seg, %eax movl %eax, %ds movl StackPos, %eax subl $24, %eax popl 0(%eax) // Backup %eax, %ds, %es, %ecx, %edx popw 4(%eax) movw %es, 6(%eax) movl %ecx, 8(%eax) popl %ecx movl %edx, 12(%eax) movl %esp, 16(%eax) movzwl %sp, %esp movw %ss, 20(%eax) movw %ds, %dx // Setup %ss/%esp and call function movw %dx, %ss movl %eax, %esp calll *%ecx movl %esp, %eax // Restore registers and return movw 20(%eax), %ss movl 16(%eax), %esp movl 12(%eax), %edx movl 8(%eax), %ecx movw 6(%eax), %es pushw 4(%eax) pushl 0(%eax) popl %eax popw %ds iretw // Main entry point for interrupts handled on extra stack DECLFUNC irqentry_arg_extrastack irqentry_arg_extrastack: cli cld pushw %ds // Set %ds:%eax to space on ExtraStack pushl %eax movl $_zonelow_seg, %eax movl %eax, %ds movl StackPos, %eax subl $BREGS_size+8, %eax popl BREGS_eax(%eax) // Backup registers popw BREGS_ds(%eax) movl %edi, BREGS_edi(%eax) movl %esi, BREGS_esi(%eax) movl %ebp, BREGS_ebp(%eax) movl %ebx, BREGS_ebx(%eax) movl %edx, BREGS_edx(%eax) movl %ecx, BREGS_ecx(%eax) popl %ecx movw %es, BREGS_es(%eax) movl %esp, BREGS_size+0(%eax) movzwl %sp, %esp movw %ss, BREGS_size+4(%eax) movl (%esp), %edx movl %edx, BREGS_code(%eax) movw 4(%esp), %dx movw %dx, BREGS_flags(%eax) movw %ds, %dx // Setup %ss/%esp and call function movw %dx, %ss movl %eax, %esp calll *%ecx movl %esp, %eax // Restore registers and return movw BREGS_size+4(%eax), %ss movl BREGS_size+0(%eax), %esp popl %edx popw %dx pushw BREGS_flags(%eax) pushl BREGS_code(%eax) movl BREGS_edi(%eax), %edi movl BREGS_esi(%eax), %esi movl BREGS_ebp(%eax), %ebp movl BREGS_ebx(%eax), %ebx movl BREGS_edx(%eax), %edx movl BREGS_ecx(%eax), %ecx movw BREGS_es(%eax), %es pushw BREGS_ds(%eax) pushl BREGS_eax(%eax) popl %eax popw %ds iretw // Main entry point for interrupts with args DECLFUNC irqentryarg irqentryarg: ENTRY_ARG_ST iretw // Define an entry point for hardware interrupts. .macro IRQ_ENTRY num .global entry_\num entry_\num : pushl $ handle_\num jmp irqentry_extrastack .endm .macro DECL_IRQ_ENTRY num DECLFUNC entry_\num IRQ_ENTRY \num .endm // Define an entry point for an interrupt (can read/modify args). .macro IRQ_ENTRY_ARG num .global entry_\num entry_\num : pushl $ handle_\num #if CONFIG_ENTRY_EXTRASTACK jmp irqentry_arg_extrastack #else jmp irqentryarg #endif .endm .macro DECL_IRQ_ENTRY_ARG num DECLFUNC entry_\num IRQ_ENTRY_ARG \num .endm // Various entry points (that don't require a fixed location). DECL_IRQ_ENTRY_ARG 13 DECL_IRQ_ENTRY 76 DECL_IRQ_ENTRY 70 DECL_IRQ_ENTRY 74 DECL_IRQ_ENTRY 75 DECL_IRQ_ENTRY hwpic1 DECL_IRQ_ENTRY hwpic2 // int 18/19 are special - they reset stack and call into 32bit mode. DECLFUNC entry_19 entry_19: ENTRY_INTO32 _cfunc32flat_handle_19 DECLFUNC entry_18 entry_18: ENTRY_INTO32 _cfunc32flat_handle_18 /**************************************************************** * Fixed position entry points ****************************************************************/ // Specify a location in the fixed part of bios area. .macro ORG addr .section .fixedaddr.\addr .endm ORG 0xe05b entry_post: cmpl $0, %cs:HaveRunPost // Check for resume/reboot jnz entry_resume ENTRY_INTO32 _cfunc32flat_handle_post // Normal entry point ORG 0xe2c3 IRQ_ENTRY 02 ORG 0xe3fe .global entry_13_official entry_13_official: jmp entry_13 // 0xe401 - OldFDPT in disk.c ORG 0xe6f2 .global entry_19_official entry_19_official: jmp entry_19 // 0xe6f5 - BIOS_CONFIG_TABLE in misc.c // 0xe729 - BaudTable in serial.c ORG 0xe739 IRQ_ENTRY_ARG 14 ORG 0xe82e IRQ_ENTRY_ARG 16 ORG 0xe987 IRQ_ENTRY 09 ORG 0xec59 IRQ_ENTRY_ARG 40 ORG 0xef57 IRQ_ENTRY 0e // 0xefc7 - diskette_param_table in floppy.c ORG 0xefd2 IRQ_ENTRY_ARG 17 ORG 0xf045 entry_10_0x0f: // XXX - INT 10 Functions 0-Fh Entry Point iretw ORG 0xf065 IRQ_ENTRY_ARG 10 // 0xf0a4 - VideoParams in misc.c ORG 0xf841 IRQ_ENTRY_ARG 12 ORG 0xf84d IRQ_ENTRY_ARG 11 ORG 0xf859 IRQ_ENTRY_ARG 15 // 0xfa6e - vgafont8 in font.c ORG 0xfe6e .global entry_1a_official entry_1a_official: cmpb $0xb1, %ah je entry_pcibios16 // PCIBIOS calls can be in protected mode IRQ_ENTRY_ARG 1a ORG 0xfea5 IRQ_ENTRY 08 // 0xfef3 - InitVectors in misc.c // 0xff00 - BiosCopyright in misc.c ORG 0xff53 .global entry_iret_official entry_iret_official: iretw ORG 0xff54 IRQ_ENTRY_ARG 05 ORG 0xfff0 // Power-up Entry Point .global reset_vector reset_vector: ljmpw $SEG_BIOS, $entry_post // 0xfff5 - BiosDate in misc.c // 0xfffe - BiosModelId in misc.c // 0xffff - BiosChecksum in misc.c .end tinyvisor/bios/src/acpi-dsdt-pci-crs.dsl0000644006644000001440000000752612172661303020534 0ustar yuichi_xyusers/* PCI CRS (current resources) definition. */ Scope(\_SB.PCI0) { Name(CRES, ResourceTemplate() { WordBusNumber(ResourceProducer, MinFixed, MaxFixed, PosDecode, 0x0000, // Address Space Granularity 0x0000, // Address Range Minimum 0x00FF, // Address Range Maximum 0x0000, // Address Translation Offset 0x0100, // Address Length ,, ) IO(Decode16, 0x0CF8, // Address Range Minimum 0x0CF8, // Address Range Maximum 0x01, // Address Alignment 0x08, // Address Length ) WordIO(ResourceProducer, MinFixed, MaxFixed, PosDecode, EntireRange, 0x0000, // Address Space Granularity 0x0000, // Address Range Minimum 0x0CF7, // Address Range Maximum 0x0000, // Address Translation Offset 0x0CF8, // Address Length ,, , TypeStatic) WordIO(ResourceProducer, MinFixed, MaxFixed, PosDecode, EntireRange, 0x0000, // Address Space Granularity 0x0D00, // Address Range Minimum 0xFFFF, // Address Range Maximum 0x0000, // Address Translation Offset 0xF300, // Address Length ,, , TypeStatic) DWordMemory(ResourceProducer, PosDecode, MinFixed, MaxFixed, Cacheable, ReadWrite, 0x00000000, // Address Space Granularity 0x000A0000, // Address Range Minimum 0x000BFFFF, // Address Range Maximum 0x00000000, // Address Translation Offset 0x00020000, // Address Length ,, , AddressRangeMemory, TypeStatic) DWordMemory(ResourceProducer, PosDecode, MinFixed, MaxFixed, NonCacheable, ReadWrite, 0x00000000, // Address Space Granularity 0xE0000000, // Address Range Minimum 0xFEBFFFFF, // Address Range Maximum 0x00000000, // Address Translation Offset 0x1EC00000, // Address Length ,, PW32, AddressRangeMemory, TypeStatic) }) Name(CR64, ResourceTemplate() { QWordMemory(ResourceProducer, PosDecode, MinFixed, MaxFixed, Cacheable, ReadWrite, 0x00000000, // Address Space Granularity 0x8000000000, // Address Range Minimum 0xFFFFFFFFFF, // Address Range Maximum 0x00000000, // Address Translation Offset 0x8000000000, // Address Length ,, PW64, AddressRangeMemory, TypeStatic) }) Method(_CRS, 0) { /* Fields provided by dynamically created ssdt */ External(P0S, IntObj) External(P0E, IntObj) External(P1V, IntObj) External(P1S, BuffObj) External(P1E, BuffObj) External(P1L, BuffObj) /* fixup 32bit pci io window */ CreateDWordField(CRES, \_SB.PCI0.PW32._MIN, PS32) CreateDWordField(CRES, \_SB.PCI0.PW32._MAX, PE32) CreateDWordField(CRES, \_SB.PCI0.PW32._LEN, PL32) Store(P0S, PS32) Store(P0E, PE32) Store(Add(Subtract(P0E, P0S), 1), PL32) If (LEqual(P1V, Zero)) { Return (CRES) } /* fixup 64bit pci io window */ CreateQWordField(CR64, \_SB.PCI0.PW64._MIN, PS64) CreateQWordField(CR64, \_SB.PCI0.PW64._MAX, PE64) CreateQWordField(CR64, \_SB.PCI0.PW64._LEN, PL64) Store(P1S, PS64) Store(P1E, PE64) Store(P1L, PL64) /* add window and return result */ ConcatenateResTemplate(CRES, CR64, Local0) Return (Local0) } } tinyvisor/bios/src/pmm.c0000644006644000001440000003774512172661303015565 0ustar yuichi_xyusers// Post memory manager (PMM) calls // // Copyright (C) 2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // checksum #include "config.h" // BUILD_BIOS_ADDR #include "memmap.h" // struct e820entry #include "farptr.h" // GET_FARVAR #include "biosvar.h" // GET_BDA #include "optionroms.h" // OPTION_ROM_ALIGN #include "list.h" // hlist_node // Information on a reserved area. struct allocinfo_s { struct hlist_node node; void *data, *dataend, *allocend; }; // Information on a tracked memory allocation. struct allocdetail_s { struct allocinfo_s detailinfo; struct allocinfo_s datainfo; u32 handle; }; // The various memory zones. struct zone_s { struct hlist_head head; }; struct zone_s ZoneLow VARVERIFY32INIT, ZoneHigh VARVERIFY32INIT; struct zone_s ZoneFSeg VARVERIFY32INIT; struct zone_s ZoneTmpLow VARVERIFY32INIT, ZoneTmpHigh VARVERIFY32INIT; static struct zone_s *Zones[] VARVERIFY32INIT = { &ZoneTmpLow, &ZoneLow, &ZoneFSeg, &ZoneTmpHigh, &ZoneHigh }; /**************************************************************** * low-level memory reservations ****************************************************************/ // Find and reserve space from a given zone static void * allocSpace(struct zone_s *zone, u32 size, u32 align, struct allocinfo_s *fill) { struct allocinfo_s *info; hlist_for_each_entry(info, &zone->head, node) { void *dataend = info->dataend; void *allocend = info->allocend; void *newallocend = (void*)ALIGN_DOWN((u32)allocend - size, align); if (newallocend >= dataend && newallocend <= allocend) { // Found space - now reserve it. if (!fill) fill = newallocend; fill->data = newallocend; fill->dataend = newallocend + size; fill->allocend = allocend; info->allocend = newallocend; hlist_add_before(&fill->node, &info->node); return newallocend; } } return NULL; } // Release space allocated with allocSpace() static void freeSpace(struct allocinfo_s *info) { struct allocinfo_s *next = container_of_or_null( info->node.next, struct allocinfo_s, node); if (next && next->allocend == info->data) next->allocend = info->allocend; hlist_del(&info->node); } // Add new memory to a zone static void addSpace(struct zone_s *zone, void *start, void *end) { // Find position to add space struct allocinfo_s *info; struct hlist_node **pprev; hlist_for_each_entry_pprev(info, pprev, &zone->head, node) { if (info->data < start) break; } // Add space using temporary allocation info. struct allocdetail_s tempdetail; tempdetail.datainfo.data = tempdetail.datainfo.dataend = start; tempdetail.datainfo.allocend = end; hlist_add(&tempdetail.datainfo.node, pprev); // Allocate final allocation info. struct allocdetail_s *detail = allocSpace( &ZoneTmpHigh, sizeof(*detail), MALLOC_MIN_ALIGN, NULL); if (!detail) { detail = allocSpace(&ZoneTmpLow, sizeof(*detail) , MALLOC_MIN_ALIGN, NULL); if (!detail) { hlist_del(&tempdetail.datainfo.node); warn_noalloc(); return; } } // Replace temp alloc space with final alloc space pprev = tempdetail.datainfo.node.pprev; hlist_del(&tempdetail.datainfo.node); memcpy(&detail->datainfo, &tempdetail.datainfo, sizeof(detail->datainfo)); detail->handle = PMM_DEFAULT_HANDLE; hlist_add(&detail->datainfo.node, pprev); } // Search all zones for an allocation obtained from allocSpace() static struct allocinfo_s * findAlloc(void *data) { int i; for (i=0; ihead, node) { if (info->data == data) return info; } } return NULL; } // Return the last sentinal node of a zone static struct allocinfo_s * findLast(struct zone_s *zone) { struct allocinfo_s *info, *last = NULL; hlist_for_each_entry(info, &zone->head, node) { last = info; } return last; } /**************************************************************** * tracked memory allocations ****************************************************************/ // Allocate memory from the given zone and track it as a PMM allocation void * __malloc pmm_malloc(struct zone_s *zone, u32 handle, u32 size, u32 align) { ASSERT32FLAT(); if (!size) return NULL; // Find and reserve space for bookkeeping. struct allocdetail_s *detail = allocSpace( &ZoneTmpHigh, sizeof(*detail), MALLOC_MIN_ALIGN, NULL); if (!detail) { detail = allocSpace(&ZoneTmpLow, sizeof(*detail) , MALLOC_MIN_ALIGN, NULL); if (!detail) return NULL; } // Find and reserve space for main allocation void *data = allocSpace(zone, size, align, &detail->datainfo); if (!data) { freeSpace(&detail->detailinfo); return NULL; } dprintf(8, "pmm_malloc zone=%p handle=%x size=%d align=%x" " ret=%p (detail=%p)\n" , zone, handle, size, align , data, detail); detail->handle = handle; return data; } // Free a data block allocated with pmm_malloc int pmm_free(void *data) { ASSERT32FLAT(); struct allocinfo_s *info = findAlloc(data); if (!info || data == (void*)info || data == info->dataend) return -1; struct allocdetail_s *detail = container_of( info, struct allocdetail_s, datainfo); dprintf(8, "pmm_free %p (detail=%p)\n", data, detail); freeSpace(info); freeSpace(&detail->detailinfo); return 0; } // Find the amount of free space in a given zone. static u32 pmm_getspace(struct zone_s *zone) { // XXX - doesn't account for ZoneLow being able to grow. // XXX - results not reliable when CONFIG_THREAD_OPTIONROMS u32 maxspace = 0; struct allocinfo_s *info; hlist_for_each_entry(info, &zone->head, node) { u32 space = info->allocend - info->dataend; if (space > maxspace) maxspace = space; } if (zone != &ZoneTmpHigh && zone != &ZoneTmpLow) return maxspace; // Account for space needed for PMM tracking. u32 reserve = ALIGN(sizeof(struct allocdetail_s), MALLOC_MIN_ALIGN); if (maxspace <= reserve) return 0; return maxspace - reserve; } // Find the data block allocated with pmm_malloc with a given handle. static void * pmm_find(u32 handle) { int i; for (i=0; ihead, node) { if (info->data != (void*)info) continue; struct allocdetail_s *detail = container_of( info, struct allocdetail_s, detailinfo); if (detail->handle == handle) return detail->datainfo.data; } } return NULL; } /**************************************************************** * 0xc0000-0xf0000 management ****************************************************************/ static u32 RomEnd = BUILD_ROM_START; static struct allocinfo_s *RomBase; #define OPROM_HEADER_RESERVE 16 // Return the maximum memory position option roms may use. u32 rom_get_max(void) { return ALIGN_DOWN((u32)RomBase->allocend - OPROM_HEADER_RESERVE , OPTION_ROM_ALIGN); } // Return the end of the last deployed option rom. u32 rom_get_last(void) { return RomEnd; } // Request space for an optionrom in 0xc0000-0xf0000 area. struct rom_header * rom_reserve(u32 size) { u32 newend = ALIGN(RomEnd + size, OPTION_ROM_ALIGN) + OPROM_HEADER_RESERVE; if (newend > (u32)RomBase->allocend) return NULL; if (newend < (u32)zonelow_base + OPROM_HEADER_RESERVE) newend = (u32)zonelow_base + OPROM_HEADER_RESERVE; RomBase->data = RomBase->dataend = (void*)newend; return (void*)RomEnd; } // Confirm space as in use by an optionrom. int rom_confirm(u32 size) { void *new = rom_reserve(size); if (!new) { warn_noalloc(); return -1; } RomEnd = ALIGN(RomEnd + size, OPTION_ROM_ALIGN); return 0; } /**************************************************************** * Setup ****************************************************************/ void malloc_preinit(void) { ASSERT32FLAT(); dprintf(3, "malloc preinit\n"); // Don't declare any memory between 0xa0000 and 0x100000 add_e820(BUILD_LOWRAM_END, BUILD_BIOS_ADDR-BUILD_LOWRAM_END, E820_HOLE); // Mark known areas as reserved. add_e820(BUILD_BIOS_ADDR, BUILD_BIOS_SIZE, E820_RESERVED); // Populate temp high ram u32 highram = 0; int i; for (i=e820_count-1; i>=0; i--) { struct e820entry *en = &e820_list[i]; u64 end = en->start + en->size; if (end < 1024*1024) break; if (en->type != E820_RAM || end > 0xffffffff) continue; u32 s = en->start, e = end; if (!highram) { u32 newe = ALIGN_DOWN(e - BUILD_MAX_HIGHTABLE, MALLOC_MIN_ALIGN); if (newe <= e && newe >= s) { highram = newe; e = newe; } } addSpace(&ZoneTmpHigh, (void*)s, (void*)e); } // Populate regions addSpace(&ZoneTmpLow, (void*)BUILD_STACK_ADDR, (void*)BUILD_EBDA_MINIMUM); if (highram) { addSpace(&ZoneHigh, (void*)highram , (void*)highram + BUILD_MAX_HIGHTABLE); add_e820(highram, BUILD_MAX_HIGHTABLE, E820_RESERVED); } } void csm_malloc_preinit(u32 low_pmm, u32 low_pmm_size, u32 hi_pmm, u32 hi_pmm_size) { ASSERT32FLAT(); if (hi_pmm_size > BUILD_MAX_HIGHTABLE) { void *hi_pmm_end = (void *)hi_pmm + hi_pmm_size; addSpace(&ZoneTmpHigh, (void *)hi_pmm, hi_pmm_end - BUILD_MAX_HIGHTABLE); addSpace(&ZoneHigh, hi_pmm_end - BUILD_MAX_HIGHTABLE, hi_pmm_end); } else { addSpace(&ZoneTmpHigh, (void *)hi_pmm, (void *)hi_pmm + hi_pmm_size); } addSpace(&ZoneTmpLow, (void *)low_pmm, (void *)low_pmm + low_pmm_size); } u32 LegacyRamSize VARFSEG; // Calculate the maximum ramsize (less than 4gig) from e820 map. static void calcRamSize(void) { u32 rs = 0; int i; for (i=e820_count-1; i>=0; i--) { struct e820entry *en = &e820_list[i]; u64 end = en->start + en->size; u32 type = en->type; if (end <= 0xffffffff && (type == E820_ACPI || type == E820_RAM)) { rs = end; break; } } LegacyRamSize = rs >= 1024*1024 ? rs : 1024*1024; } // Update pointers after code relocation. void malloc_init(void) { ASSERT32FLAT(); dprintf(3, "malloc init\n"); if (CONFIG_RELOCATE_INIT) { // Fixup malloc pointers after relocation int i; for (i=0; ihead.first) zone->head.first->pprev = &zone->head.first; } } // Initialize low-memory region extern u8 varlow_start[], varlow_end[], final_varlow_start[]; memmove(final_varlow_start, varlow_start, varlow_end - varlow_start); addSpace(&ZoneLow, zonelow_base + OPROM_HEADER_RESERVE, final_varlow_start); RomBase = findLast(&ZoneLow); // Add space available in f-segment to ZoneFSeg extern u8 zonefseg_start[], zonefseg_end[]; memset(zonefseg_start, 0, zonefseg_end - zonefseg_start); addSpace(&ZoneFSeg, zonefseg_start, zonefseg_end); calcRamSize(); } void malloc_prepboot(void) { ASSERT32FLAT(); dprintf(3, "malloc finalize\n"); // Place an optionrom signature around used low mem area. u32 base = rom_get_max(); struct rom_header *dummyrom = (void*)base; dummyrom->signature = OPTION_ROM_SIGNATURE; int size = (BUILD_BIOS_ADDR - base) / 512; dummyrom->size = (size > 255) ? 255 : size; memset((void*)RomEnd, 0, base-RomEnd); // Clear unused f-seg ram. struct allocinfo_s *info = findLast(&ZoneFSeg); memset(info->dataend, 0, info->allocend - info->dataend); dprintf(1, "Space available for UMB: %x-%x, %x-%x\n" , RomEnd, base, (u32)info->dataend, (u32)info->allocend); // Give back unused high ram. info = findLast(&ZoneHigh); if (info) { u32 giveback = ALIGN_DOWN(info->allocend - info->dataend, PAGE_SIZE); add_e820((u32)info->dataend, giveback, E820_RAM); dprintf(1, "Returned %d bytes of ZoneHigh\n", giveback); } calcRamSize(); } /**************************************************************** * pmm interface ****************************************************************/ struct pmmheader { u32 signature; u8 version; u8 length; u8 checksum; struct segoff_s entry; u8 reserved[5]; } PACKED; extern struct pmmheader PMMHEADER; #define PMM_SIGNATURE 0x4d4d5024 // $PMM #if CONFIG_PMM struct pmmheader PMMHEADER __aligned(16) VARFSEG = { .signature = PMM_SIGNATURE, .version = 0x01, .length = sizeof(PMMHEADER), }; #endif #define PMM_FUNCTION_NOT_SUPPORTED 0xffffffff // PMM - allocate static u32 handle_pmm00(u16 *args) { u32 length = *(u32*)&args[1], handle = *(u32*)&args[3]; u16 flags = args[5]; dprintf(3, "pmm00: length=%x handle=%x flags=%x\n" , length, handle, flags); struct zone_s *lowzone = &ZoneTmpLow, *highzone = &ZoneTmpHigh; if (flags & 8) { // Permanent memory request. lowzone = &ZoneLow; highzone = &ZoneHigh; } if (!length) { // Memory size request switch (flags & 3) { default: case 0: return 0; case 1: return pmm_getspace(lowzone); case 2: return pmm_getspace(highzone); case 3: { u32 spacelow = pmm_getspace(lowzone); u32 spacehigh = pmm_getspace(highzone); if (spacelow > spacehigh) return spacelow; return spacehigh; } } } u32 size = length * 16; if ((s32)size <= 0) return 0; u32 align = MALLOC_MIN_ALIGN; if (flags & 4) { align = 1<<__ffs(size); if (align < MALLOC_MIN_ALIGN) align = MALLOC_MIN_ALIGN; } switch (flags & 3) { default: case 0: return 0; case 1: return (u32)pmm_malloc(lowzone, handle, size, align); case 2: return (u32)pmm_malloc(highzone, handle, size, align); case 3: { void *data = pmm_malloc(lowzone, handle, size, align); if (data) return (u32)data; return (u32)pmm_malloc(highzone, handle, size, align); } } } // PMM - find static u32 handle_pmm01(u16 *args) { u32 handle = *(u32*)&args[1]; dprintf(3, "pmm01: handle=%x\n", handle); if (handle == PMM_DEFAULT_HANDLE) return 0; return (u32)pmm_find(handle); } // PMM - deallocate static u32 handle_pmm02(u16 *args) { u32 buffer = *(u32*)&args[1]; dprintf(3, "pmm02: buffer=%x\n", buffer); int ret = pmm_free((void*)buffer); if (ret) // Error return 1; return 0; } static u32 handle_pmmXX(u16 *args) { return PMM_FUNCTION_NOT_SUPPORTED; } u32 VISIBLE32INIT handle_pmm(u16 *args) { ASSERT32FLAT(); if (! CONFIG_PMM) return PMM_FUNCTION_NOT_SUPPORTED; u16 arg1 = args[0]; dprintf(DEBUG_HDL_pmm, "pmm call arg1=%x\n", arg1); u32 ret; switch (arg1) { case 0x00: ret = handle_pmm00(args); break; case 0x01: ret = handle_pmm01(args); break; case 0x02: ret = handle_pmm02(args); break; default: ret = handle_pmmXX(args); break; } return ret; } void pmm_init(void) { if (! CONFIG_PMM) return; dprintf(3, "init PMM\n"); PMMHEADER.entry = FUNC16(entry_pmm); PMMHEADER.checksum -= checksum(&PMMHEADER, sizeof(PMMHEADER)); } void pmm_prepboot(void) { if (! CONFIG_PMM) return; dprintf(3, "finalize PMM\n"); PMMHEADER.signature = 0; PMMHEADER.entry.segoff = 0; } tinyvisor/bios/src/dev-q35.h0000644006644000001440000000315312172661303016147 0ustar yuichi_xyusers#ifndef __DEV_Q35_H #define __DEV_Q35_H #include "types.h" // u16 #define PCI_DEVICE_ID_INTEL_Q35_MCH 0x29c0 #define Q35_HOST_BRIDGE_PAM0 0x90 #define Q35_HOST_BRIDGE_SMRAM 0x9d #define Q35_HOST_BRIDGE_PCIEXBAR 0x60 #define Q35_HOST_BRIDGE_PCIEXBAR_SIZE (256 * 1024 * 1024) #define Q35_HOST_BRIDGE_PCIEXBAR_ADDR 0xb0000000 #define Q35_HOST_BRIDGE_PCIEXBAREN ((u64)1) #define Q35_HOST_PCIE_PCI_SEGMENT 0 #define Q35_HOST_PCIE_START_BUS_NUMBER 0 #define Q35_HOST_PCIE_END_BUS_NUMBER 255 #define PCI_DEVICE_ID_INTEL_ICH9_LPC 0x2918 #define ICH9_LPC_PMBASE 0x40 #define ICH9_LPC_PMBASE_RTE 0x1 #define ICH9_LPC_ACPI_CTRL 0x44 #define ICH9_LPC_ACPI_CTRL_ACPI_EN 0x80 #define ICH9_LPC_PIRQA_ROUT 0x60 #define ICH9_LPC_PIRQE_ROUT 0x68 #define ICH9_LPC_PIRQ_ROUT_IRQEN 0x80 #define ICH9_LPC_PORT_ELCR1 0x4d0 #define ICH9_LPC_PORT_ELCR2 0x4d1 #define PCI_DEVICE_ID_INTEL_ICH9_SMBUS 0x2930 #define ICH9_SMB_SMB_BASE 0x20 #define ICH9_SMB_HOSTC 0x40 #define ICH9_SMB_HOSTC_HST_EN 0x01 #define ICH9_ACPI_ENABLE 0x2 #define ICH9_ACPI_DISABLE 0x3 /* ICH9 LPC PM I/O registers are 128 ports and 128-aligned */ #define ICH9_PMIO_GPE0_STS 0x20 #define ICH9_PMIO_GPE0_BLK_LEN 0x10 #define ICH9_PMIO_SMI_EN 0x30 #define ICH9_PMIO_SMI_EN_APMC_EN (1 << 5) /* FADT ACPI_ENABLE/ACPI_DISABLE */ #define ICH9_APM_ACPI_ENABLE 0x2 #define ICH9_APM_ACPI_DISABLE 0x3 #endif // dev-q35.h tinyvisor/bios/src/clock.c0000644006644000001440000004656112174763154016074 0ustar yuichi_xyusers// 16bit code to handle system clocks. // // Copyright (C) 2008-2010 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "biosvar.h" // SET_BDA #include "util.h" // debug_enter #include "disk.h" // floppy_tick #include "cmos.h" // inb_cmos #include "pic.h" // eoi_pic1 #include "bregs.h" // struct bregs #include "biosvar.h" // GET_GLOBAL #include "usb-hid.h" // usb_check_event // RTC register flags #define RTC_A_UIP 0x80 #define RTC_B_SET 0x80 #define RTC_B_PIE 0x40 #define RTC_B_AIE 0x20 #define RTC_B_UIE 0x10 #define RTC_B_BIN 0x04 #define RTC_B_24HR 0x02 #define RTC_B_DSE 0x01 // Bits for PORT_PS2_CTRLB #define PPCB_T2GATE (1<<0) #define PPCB_SPKR (1<<1) #define PPCB_T2OUT (1<<5) // Bits for PORT_PIT_MODE #define PM_SEL_TIMER0 (0<<6) #define PM_SEL_TIMER1 (1<<6) #define PM_SEL_TIMER2 (2<<6) #define PM_SEL_READBACK (3<<6) #define PM_ACCESS_LATCH (0<<4) #define PM_ACCESS_LOBYTE (1<<4) #define PM_ACCESS_HIBYTE (2<<4) #define PM_ACCESS_WORD (3<<4) #define PM_MODE0 (0<<1) #define PM_MODE1 (1<<1) #define PM_MODE2 (2<<1) #define PM_MODE3 (3<<1) #define PM_MODE4 (4<<1) #define PM_MODE5 (5<<1) #define PM_CNT_BINARY (0<<0) #define PM_CNT_BCD (1<<0) #define PM_READ_COUNTER0 (1<<1) #define PM_READ_COUNTER1 (1<<2) #define PM_READ_COUNTER2 (1<<3) #define PM_READ_STATUSVALUE (0<<4) #define PM_READ_VALUE (1<<4) #define PM_READ_STATUS (2<<4) /**************************************************************** * TSC timer ****************************************************************/ #define CALIBRATE_COUNT 0x800 // Approx 1.7ms u32 cpu_khz VARFSEG; u8 no_tsc VARFSEG; u16 pmtimer_ioport VARFSEG; u32 pmtimer_wraps VARLOW; u32 pmtimer_last VARLOW; static void calibrate_tsc(void) { u32 eax, ebx, ecx, edx, cpuid_features = 0; if (CONFIG_PMTIMER && GET_GLOBAL(pmtimer_ioport)) { dprintf(3, "pmtimer already configured; will not calibrate TSC\n"); return; } cpuid(0, &eax, &ebx, &ecx, &edx); if (eax > 0) cpuid(1, &eax, &ebx, &ecx, &cpuid_features); if (!(cpuid_features & CPUID_TSC)) { SET_GLOBAL(no_tsc, 1); SET_GLOBAL(cpu_khz, PIT_TICK_RATE / 1000); dprintf(3, "386/486 class CPU. Using TSC emulation\n"); return; } // Setup "timer2" u8 orig = inb(PORT_PS2_CTRLB); outb((orig & ~PPCB_SPKR) | PPCB_T2GATE, PORT_PS2_CTRLB); /* binary, mode 0, LSB/MSB, Ch 2 */ outb(PM_SEL_TIMER2|PM_ACCESS_WORD|PM_MODE0|PM_CNT_BINARY, PORT_PIT_MODE); /* LSB of ticks */ outb(CALIBRATE_COUNT & 0xFF, PORT_PIT_COUNTER2); /* MSB of ticks */ outb(CALIBRATE_COUNT >> 8, PORT_PIT_COUNTER2); u64 start = rdtscll(); while ((inb(PORT_PS2_CTRLB) & PPCB_T2OUT) == 0) ; u64 end = rdtscll(); // Restore PORT_PS2_CTRLB outb(orig, PORT_PS2_CTRLB); // Store calibrated cpu khz. u64 diff = end - start; dprintf(6, "tsc calibrate start=%u end=%u diff=%u\n" , (u32)start, (u32)end, (u32)diff); u32 hz = diff * PIT_TICK_RATE / CALIBRATE_COUNT; SET_GLOBAL(cpu_khz, hz / 1000); dprintf(1, "CPU Mhz=%u\n", hz / 1000000); } /* TSC emulation timekeepers */ u64 TSC_8254 VARLOW; int Last_TSC_8254 VARLOW; static u64 emulate_tsc(void) { /* read timer 0 current count */ u64 ret = GET_LOW(TSC_8254); /* readback mode has slightly shifted registers, works on all * 8254, readback PIT0 latch */ outb(PM_SEL_READBACK | PM_READ_VALUE | PM_READ_COUNTER0, PORT_PIT_MODE); int cnt = (inb(PORT_PIT_COUNTER0) | (inb(PORT_PIT_COUNTER0) << 8)); int d = GET_LOW(Last_TSC_8254) - cnt; /* Determine the ticks count from last invocation of this function */ ret += (d > 0) ? d : (PIT_TICK_INTERVAL + d); SET_LOW(Last_TSC_8254, cnt); SET_LOW(TSC_8254, ret); return ret; } void pmtimer_setup(u16 ioport, u32 khz) { if (!CONFIG_PMTIMER) return; dprintf(1, "Using pmtimer, ioport 0x%x, freq %d kHz\n", ioport, khz); SET_GLOBAL(pmtimer_ioport, ioport); SET_GLOBAL(cpu_khz, khz); } static u64 pmtimer_get(void) { u16 ioport = GET_GLOBAL(pmtimer_ioport); u32 wraps = GET_LOW(pmtimer_wraps); u32 pmtimer = inl(ioport) & 0xffffff; if (pmtimer < GET_LOW(pmtimer_last)) { wraps++; SET_LOW(pmtimer_wraps, wraps); } SET_LOW(pmtimer_last, pmtimer); dprintf(9, "pmtimer: %u:%u\n", wraps, pmtimer); return (u64)wraps << 24 | pmtimer; } static u64 get_tsc(void) { if (unlikely(GET_GLOBAL(no_tsc))) return emulate_tsc(); if (CONFIG_PMTIMER && GET_GLOBAL(pmtimer_ioport)) return pmtimer_get(); return rdtscll(); } int check_tsc(u64 end) { return (s64)(get_tsc() - end) > 0; } static void tscdelay(u64 diff) { u64 start = get_tsc(); u64 end = start + diff; while (!check_tsc(end)) cpu_relax(); } static void tscsleep(u64 diff) { u64 start = get_tsc(); u64 end = start + diff; while (!check_tsc(end)) yield(); } void ndelay(u32 count) { tscdelay(count * GET_GLOBAL(cpu_khz) / 1000000); } void udelay(u32 count) { tscdelay(count * GET_GLOBAL(cpu_khz) / 1000); } void mdelay(u32 count) { tscdelay(count * GET_GLOBAL(cpu_khz)); } void nsleep(u32 count) { tscsleep(count * GET_GLOBAL(cpu_khz) / 1000000); } void usleep(u32 count) { tscsleep(count * GET_GLOBAL(cpu_khz) / 1000); } void msleep(u32 count) { tscsleep(count * GET_GLOBAL(cpu_khz)); } // Return the TSC value that is 'msecs' time in the future. u64 calc_future_tsc(u32 msecs) { u32 khz = GET_GLOBAL(cpu_khz); return get_tsc() + ((u64)khz * msecs); } u64 calc_future_tsc_usec(u32 usecs) { u32 khz = GET_GLOBAL(cpu_khz); return get_tsc() + ((u64)(khz/1000) * usecs); } /**************************************************************** * Init ****************************************************************/ static int rtc_updating(void) { // This function checks to see if the update-in-progress bit // is set in CMOS Status Register A. If not, it returns 0. // If it is set, it tries to wait until there is a transition // to 0, and will return 0 if such a transition occurs. A -1 // is returned only after timing out. The maximum period // that this bit should be set is constrained to (1984+244) // useconds, but we wait for longer just to be sure. if ((inb_cmos(CMOS_STATUS_A) & RTC_A_UIP) == 0) return 0; u64 end = calc_future_tsc(15); for (;;) { if ((inb_cmos(CMOS_STATUS_A) & RTC_A_UIP) == 0) return 0; if (check_tsc(end)) // update-in-progress never transitioned to 0 return -1; yield(); } } static void pit_setup(void) { // timer0: binary count, 16bit count, mode 2 outb(PM_SEL_TIMER0|PM_ACCESS_WORD|PM_MODE2|PM_CNT_BINARY, PORT_PIT_MODE); // maximum count of 0000H = 18.2Hz outb(0x0, PORT_PIT_COUNTER0); outb(0x0, PORT_PIT_COUNTER0); } static void rtc_setup(void) { outb_cmos(0x26, CMOS_STATUS_A); // 32,768Khz src, 976.5625us updates u8 regB = inb_cmos(CMOS_STATUS_B); outb_cmos((regB & RTC_B_DSE) | RTC_B_24HR, CMOS_STATUS_B); inb_cmos(CMOS_STATUS_C); inb_cmos(CMOS_STATUS_D); } static u32 bcd2bin(u8 val) { return (val & 0xf) + ((val >> 4) * 10); } u8 Century VARLOW; void timer_setup(void) { dprintf(3, "init timer\n"); calibrate_tsc(); pit_setup(); rtc_setup(); rtc_updating(); u32 seconds = bcd2bin(inb_cmos(CMOS_RTC_SECONDS)); u32 minutes = bcd2bin(inb_cmos(CMOS_RTC_MINUTES)); u32 hours = bcd2bin(inb_cmos(CMOS_RTC_HOURS)); u32 ticks = (hours * 60 + minutes) * 60 + seconds; ticks = ((u64)ticks * PIT_TICK_RATE) / PIT_TICK_INTERVAL; SET_BDA(timer_counter, ticks); // Setup Century storage if (CONFIG_QEMU) { Century = inb_cmos(CMOS_CENTURY); } else { // Infer current century from the year. u8 year = inb_cmos(CMOS_RTC_YEAR); if (year > 0x80) Century = 0x19; else Century = 0x20; } enable_hwirq(0, FUNC16(entry_08)); enable_hwirq(8, FUNC16(entry_70)); } /**************************************************************** * Standard clock functions ****************************************************************/ #define TICKS_PER_DAY (u32)((u64)60*60*24*PIT_TICK_RATE / PIT_TICK_INTERVAL) // Calculate the timer value at 'count' number of full timer ticks in // the future. u32 calc_future_timer_ticks(u32 count) { return (GET_BDA(timer_counter) + count + 1) % TICKS_PER_DAY; } // Return the timer value that is 'msecs' time in the future. u32 calc_future_timer(u32 msecs) { if (!msecs) return GET_BDA(timer_counter); u32 kticks = DIV_ROUND_UP((u64)msecs * PIT_TICK_RATE, PIT_TICK_INTERVAL); u32 ticks = DIV_ROUND_UP(kticks, 1000); return calc_future_timer_ticks(ticks); } // Check if the given timer value has passed. int check_timer(u32 end) { return (((GET_BDA(timer_counter) + TICKS_PER_DAY - end) % TICKS_PER_DAY) < (TICKS_PER_DAY/2)); } // get current clock count static void handle_1a00(struct bregs *regs) { yield(); u32 ticks = GET_BDA(timer_counter); regs->cx = ticks >> 16; regs->dx = ticks; regs->al = GET_BDA(timer_rollover); SET_BDA(timer_rollover, 0); // reset flag set_success(regs); } // Set Current Clock Count static void handle_1a01(struct bregs *regs) { u32 ticks = (regs->cx << 16) | regs->dx; SET_BDA(timer_counter, ticks); SET_BDA(timer_rollover, 0); // reset flag // XXX - should use set_code_success()? regs->ah = 0; set_success(regs); } // Read CMOS Time static void handle_1a02(struct bregs *regs) { if (rtc_updating()) { set_invalid(regs); return; } regs->dh = inb_cmos(CMOS_RTC_SECONDS); regs->cl = inb_cmos(CMOS_RTC_MINUTES); regs->ch = inb_cmos(CMOS_RTC_HOURS); regs->dl = inb_cmos(CMOS_STATUS_B) & RTC_B_DSE; regs->ah = 0; regs->al = regs->ch; set_success(regs); } // Set CMOS Time static void handle_1a03(struct bregs *regs) { // Using a debugger, I notice the following masking/setting // of bits in Status Register B, by setting Reg B to // a few values and getting its value after INT 1A was called. // // try#1 try#2 try#3 // before 1111 1101 0111 1101 0000 0000 // after 0110 0010 0110 0010 0000 0010 // // Bit4 in try#1 flipped in hardware (forced low) due to bit7=1 // My assumption: RegB = ((RegB & 01100000b) | 00000010b) if (rtc_updating()) { rtc_setup(); // fall through as if an update were not in progress } outb_cmos(regs->dh, CMOS_RTC_SECONDS); outb_cmos(regs->cl, CMOS_RTC_MINUTES); outb_cmos(regs->ch, CMOS_RTC_HOURS); // Set Daylight Savings time enabled bit to requested value u8 val8 = ((inb_cmos(CMOS_STATUS_B) & (RTC_B_PIE|RTC_B_AIE)) | RTC_B_24HR | (regs->dl & RTC_B_DSE)); outb_cmos(val8, CMOS_STATUS_B); regs->ah = 0; regs->al = val8; // val last written to Reg B set_success(regs); } // Read CMOS Date static void handle_1a04(struct bregs *regs) { regs->ah = 0; if (rtc_updating()) { set_invalid(regs); return; } regs->cl = inb_cmos(CMOS_RTC_YEAR); regs->dh = inb_cmos(CMOS_RTC_MONTH); regs->dl = inb_cmos(CMOS_RTC_DAY_MONTH); regs->ch = GET_LOW(Century); regs->al = regs->ch; set_success(regs); } // Set CMOS Date static void handle_1a05(struct bregs *regs) { // Using a debugger, I notice the following masking/setting // of bits in Status Register B, by setting Reg B to // a few values and getting its value after INT 1A was called. // // try#1 try#2 try#3 try#4 // before 1111 1101 0111 1101 0000 0010 0000 0000 // after 0110 1101 0111 1101 0000 0010 0000 0000 // // Bit4 in try#1 flipped in hardware (forced low) due to bit7=1 // My assumption: RegB = (RegB & 01111111b) if (rtc_updating()) { rtc_setup(); set_invalid(regs); return; } outb_cmos(regs->cl, CMOS_RTC_YEAR); outb_cmos(regs->dh, CMOS_RTC_MONTH); outb_cmos(regs->dl, CMOS_RTC_DAY_MONTH); SET_LOW(Century, regs->ch); // clear halt-clock bit u8 val8 = inb_cmos(CMOS_STATUS_B) & ~RTC_B_SET; outb_cmos(val8, CMOS_STATUS_B); regs->ah = 0; regs->al = val8; // AL = val last written to Reg B set_success(regs); } // Set Alarm Time in CMOS static void handle_1a06(struct bregs *regs) { // Using a debugger, I notice the following masking/setting // of bits in Status Register B, by setting Reg B to // a few values and getting its value after INT 1A was called. // // try#1 try#2 try#3 // before 1101 1111 0101 1111 0000 0000 // after 0110 1111 0111 1111 0010 0000 // // Bit4 in try#1 flipped in hardware (forced low) due to bit7=1 // My assumption: RegB = ((RegB & 01111111b) | 00100000b) u8 val8 = inb_cmos(CMOS_STATUS_B); // Get Status Reg B regs->ax = 0; if (val8 & RTC_B_AIE) { // Alarm interrupt enabled already set_invalid(regs); return; } if (rtc_updating()) { rtc_setup(); // fall through as if an update were not in progress } outb_cmos(regs->dh, CMOS_RTC_SECONDS_ALARM); outb_cmos(regs->cl, CMOS_RTC_MINUTES_ALARM); outb_cmos(regs->ch, CMOS_RTC_HOURS_ALARM); // enable Status Reg B alarm bit, clear halt clock bit outb_cmos((val8 & ~RTC_B_SET) | RTC_B_AIE, CMOS_STATUS_B); set_success(regs); } // Turn off Alarm static void handle_1a07(struct bregs *regs) { // Using a debugger, I notice the following masking/setting // of bits in Status Register B, by setting Reg B to // a few values and getting its value after INT 1A was called. // // try#1 try#2 try#3 try#4 // before 1111 1101 0111 1101 0010 0000 0010 0010 // after 0100 0101 0101 0101 0000 0000 0000 0010 // // Bit4 in try#1 flipped in hardware (forced low) due to bit7=1 // My assumption: RegB = (RegB & 01010111b) u8 val8 = inb_cmos(CMOS_STATUS_B); // Get Status Reg B // clear clock-halt bit, disable alarm bit outb_cmos(val8 & ~(RTC_B_SET|RTC_B_AIE), CMOS_STATUS_B); regs->ah = 0; regs->al = val8; // val last written to Reg B set_success(regs); } // Unsupported static void handle_1aXX(struct bregs *regs) { set_unimplemented(regs); } // INT 1Ah Time-of-day Service Entry Point void VISIBLE16 handle_1a(struct bregs *regs) { debug_enter(regs, DEBUG_HDL_1a); switch (regs->ah) { case 0x00: handle_1a00(regs); break; case 0x01: handle_1a01(regs); break; case 0x02: handle_1a02(regs); break; case 0x03: handle_1a03(regs); break; case 0x04: handle_1a04(regs); break; case 0x05: handle_1a05(regs); break; case 0x06: handle_1a06(regs); break; case 0x07: handle_1a07(regs); break; default: handle_1aXX(regs); break; } } // INT 08h System Timer ISR Entry Point void VISIBLE16 handle_08(void) { debug_isr(DEBUG_ISR_08); // Update counter u32 counter = GET_BDA(timer_counter); counter++; // compare to one days worth of timer ticks at 18.2 hz if (counter >= TICKS_PER_DAY) { // there has been a midnight rollover at this point counter = 0; SET_BDA(timer_rollover, GET_BDA(timer_rollover) + 1); } SET_BDA(timer_counter, counter); // Check for internal events. floppy_tick(); usb_check_event(); // chain to user timer tick INT #0x1c struct bregs br; memset(&br, 0, sizeof(br)); br.flags = F_IF; call16_int(0x1c, &br); eoi_pic1(); } /**************************************************************** * Periodic timer ****************************************************************/ int RTCusers VARLOW; void useRTC(void) { int count = GET_LOW(RTCusers); SET_LOW(RTCusers, count+1); if (count) return; // Turn on the Periodic Interrupt timer u8 bRegister = inb_cmos(CMOS_STATUS_B); outb_cmos(bRegister | RTC_B_PIE, CMOS_STATUS_B); } void releaseRTC(void) { int count = GET_LOW(RTCusers); SET_LOW(RTCusers, count-1); if (count != 1) return; // Clear the Periodic Interrupt. u8 bRegister = inb_cmos(CMOS_STATUS_B); outb_cmos(bRegister & ~RTC_B_PIE, CMOS_STATUS_B); } static int set_usertimer(u32 usecs, u16 seg, u16 offset) { if (GET_BDA(rtc_wait_flag) & RWS_WAIT_PENDING) return -1; // Interval not already set. SET_BDA(rtc_wait_flag, RWS_WAIT_PENDING); // Set status byte. SET_BDA(user_wait_complete_flag, SEGOFF(seg, offset)); SET_BDA(user_wait_timeout, usecs); useRTC(); return 0; } static void clear_usertimer(void) { if (!(GET_BDA(rtc_wait_flag) & RWS_WAIT_PENDING)) return; // Turn off status byte. SET_BDA(rtc_wait_flag, 0); releaseRTC(); } #define RET_ECLOCKINUSE 0x83 // Wait for CX:DX microseconds void handle_1586(struct bregs *regs) { u32 count = (regs->cx << 16) | regs->dx; if (CONFIG_USE_TSC_FOR_INT15_86) { udelay(count); set_success(regs); return; } // Use the rtc to wait for the specified time. u8 statusflag = 0; int ret = set_usertimer(count, GET_SEG(SS), (u32)&statusflag); if (ret) { set_code_invalid(regs, RET_ECLOCKINUSE); return; } while (!statusflag) yield_toirq(); set_success(regs); } // Set Interval requested. static void handle_158300(struct bregs *regs) { int ret = set_usertimer((regs->cx << 16) | regs->dx, regs->es, regs->bx); if (ret) // Interval already set. set_code_invalid(regs, RET_EUNSUPPORTED); else set_success(regs); } // Clear interval requested static void handle_158301(struct bregs *regs) { clear_usertimer(); set_success(regs); } static void handle_1583XX(struct bregs *regs) { set_code_unimplemented(regs, RET_EUNSUPPORTED); regs->al--; } void handle_1583(struct bregs *regs) { switch (regs->al) { case 0x00: handle_158300(regs); break; case 0x01: handle_158301(regs); break; default: handle_1583XX(regs); break; } } #define USEC_PER_RTC DIV_ROUND_CLOSEST(1000000, 1024) // int70h: IRQ8 - CMOS RTC void VISIBLE16 handle_70(void) { debug_isr(DEBUG_ISR_70); // Check which modes are enabled and have occurred. u8 registerB = inb_cmos(CMOS_STATUS_B); u8 registerC = inb_cmos(CMOS_STATUS_C); if (!(registerB & (RTC_B_PIE|RTC_B_AIE))) goto done; if (registerC & RTC_B_AIE) { // Handle Alarm Interrupt. struct bregs br; memset(&br, 0, sizeof(br)); br.flags = F_IF; call16_int(0x4a, &br); } if (!(registerC & RTC_B_PIE)) goto done; // Handle Periodic Interrupt. check_preempt(); if (!GET_BDA(rtc_wait_flag)) goto done; // Wait Interval (Int 15, AH=83) active. u32 time = GET_BDA(user_wait_timeout); // Time left in microseconds. if (time < USEC_PER_RTC) { // Done waiting - write to specified flag byte. struct segoff_s segoff = GET_BDA(user_wait_complete_flag); u16 ptr_seg = segoff.seg; u8 *ptr_far = (u8*)(segoff.offset+0); u8 oldval = GET_FARVAR(ptr_seg, *ptr_far); SET_FARVAR(ptr_seg, *ptr_far, oldval | 0x80); clear_usertimer(); } else { // Continue waiting. time -= USEC_PER_RTC; SET_BDA(user_wait_timeout, time); } done: eoi_pic2(); } tinyvisor/bios/src/disk.c0000644006644000001440000006047012172661303015715 0ustar yuichi_xyusers// 16bit code to access hard drives. // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "disk.h" // floppy_13 #include "biosvar.h" // SET_BDA #include "config.h" // CONFIG_* #include "util.h" // debug_enter #include "pic.h" // eoi_pic2 #include "bregs.h" // struct bregs #include "pci.h" // pci_bdf_to_bus #include "ata.h" // ATA_CB_DC /**************************************************************** * Helper functions ****************************************************************/ void __disk_ret(struct bregs *regs, u32 linecode, const char *fname) { u8 code = linecode; if (regs->dl < EXTSTART_HD) SET_BDA(floppy_last_status, code); else SET_BDA(disk_last_status, code); if (code) __set_code_invalid(regs, linecode, fname); else set_code_success(regs); } void __disk_ret_unimplemented(struct bregs *regs, u32 linecode, const char *fname) { u8 code = linecode; if (regs->dl < EXTSTART_HD) SET_BDA(floppy_last_status, code); else SET_BDA(disk_last_status, code); __set_code_unimplemented(regs, linecode, fname); } static void __disk_stub(struct bregs *regs, int lineno, const char *fname) { __warn_unimplemented(regs, lineno, fname); __disk_ret(regs, DISK_RET_SUCCESS | (lineno << 8), fname); } #define DISK_STUB(regs) \ __disk_stub((regs), __LINE__, __func__) // Get the cylinders/heads/sectors for the given drive. static struct chs_s getLCHS(struct drive_s *drive_g) { struct chs_s res = { }; if (CONFIG_CDROM_EMU && drive_g == GLOBALFLAT2GLOBAL(GET_GLOBAL(cdemu_drive_gf))) { // Emulated drive - get info from CDEmu. (It's not possible to // populate the geometry directly in the driveid because the // geometry is only known after the bios segment is made // read-only). res.cylinders = GET_LOW(CDEmu.lchs.cylinders); res.heads = GET_LOW(CDEmu.lchs.heads); res.spt = GET_LOW(CDEmu.lchs.spt); return res; } res.cylinders = GET_GLOBAL(drive_g->lchs.cylinders); res.heads = GET_GLOBAL(drive_g->lchs.heads); res.spt = GET_GLOBAL(drive_g->lchs.spt); return res; } // Perform read/write/verify using old-style chs accesses static void noinline basic_access(struct bregs *regs, struct drive_s *drive_g, u16 command) { struct disk_op_s dop; dop.drive_g = drive_g; dop.command = command; u8 count = regs->al; u16 cylinder = regs->ch | ((((u16)regs->cl) << 2) & 0x300); u16 sector = regs->cl & 0x3f; u16 head = regs->dh; if (count > 128 || count == 0 || sector == 0) { warn_invalid(regs); disk_ret(regs, DISK_RET_EPARAM); return; } dop.count = count; struct chs_s chs = getLCHS(drive_g); u16 nlc=chs.cylinders, nlh=chs.heads, nlspt=chs.spt; // sanity check on cyl heads, sec if (cylinder >= nlc || head >= nlh || sector > nlspt) { warn_invalid(regs); disk_ret(regs, DISK_RET_EPARAM); return; } // translate lchs to lba dop.lba = (((((u32)cylinder * (u32)nlh) + (u32)head) * (u32)nlspt) + (u32)sector - 1); dop.buf_fl = MAKE_FLATPTR(regs->es, regs->bx); int status = send_disk_op(&dop); regs->al = dop.count; disk_ret(regs, status); } // Perform read/write/verify using new-style "int13ext" accesses. static void noinline extended_access(struct bregs *regs, struct drive_s *drive_g, u16 command) { struct disk_op_s dop; struct int13ext_s *param_far = (struct int13ext_s*)(regs->si+0); // Get lba and check. dop.lba = GET_FARVAR(regs->ds, param_far->lba); dop.command = command; dop.drive_g = drive_g; if (dop.lba >= GET_GLOBAL(drive_g->sectors)) { warn_invalid(regs); disk_ret(regs, DISK_RET_EPARAM); return; } dop.buf_fl = SEGOFF_TO_FLATPTR(GET_FARVAR(regs->ds, param_far->data)); dop.count = GET_FARVAR(regs->ds, param_far->count); if (! dop.count) { // Nothing to do. disk_ret(regs, DISK_RET_SUCCESS); return; } int status = send_disk_op(&dop); SET_FARVAR(regs->ds, param_far->count, dop.count); disk_ret(regs, status); } /**************************************************************** * Hard Drive functions ****************************************************************/ // disk controller reset static void disk_1300(struct bregs *regs, struct drive_s *drive_g) { struct disk_op_s dop; dop.drive_g = drive_g; dop.command = CMD_RESET; int status = send_disk_op(&dop); disk_ret(regs, status); } // read disk status static void disk_1301(struct bregs *regs, struct drive_s *drive_g) { u8 v; if (regs->dl < EXTSTART_HD) // Floppy v = GET_BDA(floppy_last_status); else v = GET_BDA(disk_last_status); regs->ah = v; set_cf(regs, v); // XXX - clear disk_last_status? } // read disk sectors static void disk_1302(struct bregs *regs, struct drive_s *drive_g) { basic_access(regs, drive_g, CMD_READ); } // write disk sectors static void disk_1303(struct bregs *regs, struct drive_s *drive_g) { basic_access(regs, drive_g, CMD_WRITE); } // verify disk sectors static void disk_1304(struct bregs *regs, struct drive_s *drive_g) { basic_access(regs, drive_g, CMD_VERIFY); } // format disk track static void noinline disk_1305(struct bregs *regs, struct drive_s *drive_g) { debug_stub(regs); struct chs_s chs = getLCHS(drive_g); u16 nlh=chs.heads, nlspt=chs.spt; u8 num_sectors = regs->al; u8 head = regs->dh; if (head >= nlh || num_sectors == 0 || num_sectors > nlspt) { disk_ret(regs, DISK_RET_EPARAM); return; } struct disk_op_s dop; dop.drive_g = drive_g; dop.command = CMD_FORMAT; dop.lba = head; dop.count = num_sectors; dop.buf_fl = MAKE_FLATPTR(regs->es, regs->bx); int status = send_disk_op(&dop); disk_ret(regs, status); } // read disk drive parameters static void noinline disk_1308(struct bregs *regs, struct drive_s *drive_g) { // Get logical geometry from table struct chs_s chs = getLCHS(drive_g); u16 nlc=chs.cylinders, nlh=chs.heads, nlspt=chs.spt; nlc--; nlh--; u8 count; if (regs->dl < EXTSTART_HD) { // Floppy count = GET_GLOBAL(FloppyCount); if (CONFIG_CDROM_EMU && drive_g == GLOBALFLAT2GLOBAL(GET_GLOBAL(cdemu_drive_gf))) regs->bx = GET_LOW(CDEmu.media) * 2; else regs->bx = GET_GLOBAL(drive_g->floppy_type); // set es & di to point to 11 byte diskette param table in ROM regs->es = SEG_BIOS; regs->di = (u32)&diskette_param_table2; } else if (regs->dl < EXTSTART_CD) { // Hard drive count = GET_BDA(hdcount); nlc--; // last sector reserved } else { // Not supported on CDROM disk_ret(regs, DISK_RET_EPARAM); return; } if (CONFIG_CDROM_EMU && GET_LOW(CDEmu.active)) { u8 emudrive = GET_LOW(CDEmu.emulated_extdrive); if (((emudrive ^ regs->dl) & 0x80) == 0) // Note extra drive due to emulation. count++; if (regs->dl < EXTSTART_HD && count > 2) // Max of two floppy drives. count = 2; } regs->al = 0; regs->ch = nlc & 0xff; regs->cl = ((nlc >> 2) & 0xc0) | (nlspt & 0x3f); regs->dh = nlh; disk_ret(regs, DISK_RET_SUCCESS); regs->dl = count; } // initialize drive parameters static void disk_1309(struct bregs *regs, struct drive_s *drive_g) { DISK_STUB(regs); } // seek to specified cylinder static void disk_130c(struct bregs *regs, struct drive_s *drive_g) { DISK_STUB(regs); } // alternate disk reset static void disk_130d(struct bregs *regs, struct drive_s *drive_g) { DISK_STUB(regs); } // check drive ready static void disk_1310(struct bregs *regs, struct drive_s *drive_g) { // should look at 40:8E also??? struct disk_op_s dop; dop.drive_g = drive_g; dop.command = CMD_ISREADY; int status = send_disk_op(&dop); disk_ret(regs, status); } // recalibrate static void disk_1311(struct bregs *regs, struct drive_s *drive_g) { DISK_STUB(regs); } // controller internal diagnostic static void disk_1314(struct bregs *regs, struct drive_s *drive_g) { DISK_STUB(regs); } // read disk drive size static void noinline disk_1315(struct bregs *regs, struct drive_s *drive_g) { disk_ret(regs, DISK_RET_SUCCESS); if (regs->dl < EXTSTART_HD || regs->dl >= EXTSTART_CD) { // Floppy or cdrom regs->ah = 1; return; } // Hard drive // Get logical geometry from table struct chs_s chs = getLCHS(drive_g); u16 nlc=chs.cylinders, nlh=chs.heads, nlspt=chs.spt; // Compute sector count seen by int13 u32 lba = (u32)(nlc - 1) * (u32)nlh * (u32)nlspt; regs->cx = lba >> 16; regs->dx = lba & 0xffff; regs->ah = 3; // hard disk accessible } static void disk_1316(struct bregs *regs, struct drive_s *drive_g) { if (regs->dl >= EXTSTART_HD) { // Hard drive disk_ret(regs, DISK_RET_EPARAM); return; } disk_ret(regs, DISK_RET_ECHANGED); } // IBM/MS installation check static void disk_1341(struct bregs *regs, struct drive_s *drive_g) { regs->bx = 0xaa55; // install check regs->cx = 0x0007; // ext disk access and edd, removable supported disk_ret(regs, DISK_RET_SUCCESS); regs->ah = 0x30; // EDD 3.0 } // IBM/MS extended read static void disk_1342(struct bregs *regs, struct drive_s *drive_g) { extended_access(regs, drive_g, CMD_READ); } // IBM/MS extended write static void disk_1343(struct bregs *regs, struct drive_s *drive_g) { extended_access(regs, drive_g, CMD_WRITE); } // IBM/MS verify static void disk_1344(struct bregs *regs, struct drive_s *drive_g) { extended_access(regs, drive_g, CMD_VERIFY); } // lock static void disk_134500(struct bregs *regs, struct drive_s *drive_g) { int cdid = regs->dl - EXTSTART_CD; u8 locks = GET_LOW(CDRom_locks[cdid]); if (locks == 0xff) { regs->al = 1; disk_ret(regs, DISK_RET_ETOOMANYLOCKS); return; } SET_LOW(CDRom_locks[cdid], locks + 1); regs->al = 1; disk_ret(regs, DISK_RET_SUCCESS); } // unlock static void disk_134501(struct bregs *regs, struct drive_s *drive_g) { int cdid = regs->dl - EXTSTART_CD; u8 locks = GET_LOW(CDRom_locks[cdid]); if (locks == 0x00) { regs->al = 0; disk_ret(regs, DISK_RET_ENOTLOCKED); return; } locks--; SET_LOW(CDRom_locks[cdid], locks); regs->al = (locks ? 1 : 0); disk_ret(regs, DISK_RET_SUCCESS); } // status static void disk_134502(struct bregs *regs, struct drive_s *drive_g) { int cdid = regs->dl - EXTSTART_CD; u8 locks = GET_LOW(CDRom_locks[cdid]); regs->al = (locks ? 1 : 0); disk_ret(regs, DISK_RET_SUCCESS); } static void disk_1345XX(struct bregs *regs, struct drive_s *drive_g) { disk_ret_unimplemented(regs, DISK_RET_EPARAM); } // IBM/MS lock/unlock drive static void disk_1345(struct bregs *regs, struct drive_s *drive_g) { if (regs->dl < EXTSTART_CD) { // Always success for HD disk_ret(regs, DISK_RET_SUCCESS); return; } switch (regs->al) { case 0x00: disk_134500(regs, drive_g); break; case 0x01: disk_134501(regs, drive_g); break; case 0x02: disk_134502(regs, drive_g); break; default: disk_1345XX(regs, drive_g); break; } } // IBM/MS eject media static void noinline disk_1346(struct bregs *regs, struct drive_s *drive_g) { if (regs->dl < EXTSTART_CD) { // Volume Not Removable disk_ret(regs, DISK_RET_ENOTREMOVABLE); return; } int cdid = regs->dl - EXTSTART_CD; u8 locks = GET_LOW(CDRom_locks[cdid]); if (locks != 0) { disk_ret(regs, DISK_RET_ELOCKED); return; } // FIXME should handle 0x31 no media in device // FIXME should handle 0xb5 valid request failed // Call removable media eject struct bregs br; memset(&br, 0, sizeof(br)); br.ah = 0x52; br.dl = regs->dl; call16_int(0x15, &br); if (br.ah || br.flags & F_CF) { disk_ret(regs, DISK_RET_ELOCKED); return; } disk_ret(regs, DISK_RET_SUCCESS); } // IBM/MS extended seek static void disk_1347(struct bregs *regs, struct drive_s *drive_g) { extended_access(regs, drive_g, CMD_SEEK); } // IBM/MS get drive parameters static void noinline disk_1348(struct bregs *regs, struct drive_s *drive_g) { u16 seg = regs->ds; struct int13dpt_s *param_far = (struct int13dpt_s*)(regs->si+0); u16 size = GET_FARVAR(seg, param_far->size); u16 t13 = size == 74; // Buffer is too small if (size < 26) { disk_ret(regs, DISK_RET_EPARAM); return; } // EDD 1.x u8 type = GET_GLOBAL(drive_g->type); u16 npc = GET_GLOBAL(drive_g->pchs.cylinders); u16 nph = GET_GLOBAL(drive_g->pchs.heads); u16 npspt = GET_GLOBAL(drive_g->pchs.spt); u64 lba = GET_GLOBAL(drive_g->sectors); u16 blksize = GET_GLOBAL(drive_g->blksize); dprintf(DEBUG_HDL_13, "disk_1348 size=%d t=%d chs=%d,%d,%d lba=%d bs=%d\n" , size, type, npc, nph, npspt, (u32)lba, blksize); SET_FARVAR(seg, param_far->size, 26); if (type == DTYPE_ATA_ATAPI) { // 0x74 = removable, media change, lockable, max values SET_FARVAR(seg, param_far->infos, 0x74); SET_FARVAR(seg, param_far->cylinders, 0xffffffff); SET_FARVAR(seg, param_far->heads, 0xffffffff); SET_FARVAR(seg, param_far->spt, 0xffffffff); SET_FARVAR(seg, param_far->sector_count, (u64)-1); } else { if (lba > (u64)npspt*nph*0x3fff) { SET_FARVAR(seg, param_far->infos, 0x00); // geometry is invalid SET_FARVAR(seg, param_far->cylinders, 0x3fff); } else { SET_FARVAR(seg, param_far->infos, 0x02); // geometry is valid SET_FARVAR(seg, param_far->cylinders, (u32)npc); } SET_FARVAR(seg, param_far->heads, (u32)nph); SET_FARVAR(seg, param_far->spt, (u32)npspt); SET_FARVAR(seg, param_far->sector_count, lba); } SET_FARVAR(seg, param_far->blksize, blksize); if (size < 30 || (type != DTYPE_ATA && type != DTYPE_ATA_ATAPI && type != DTYPE_VIRTIO_BLK && type != DTYPE_VIRTIO_SCSI)) { disk_ret(regs, DISK_RET_SUCCESS); return; } // EDD 2.x int bdf; u16 iobase1 = 0; u64 device_path = 0; u8 channel = 0; SET_FARVAR(seg, param_far->size, 30); if (type == DTYPE_ATA || type == DTYPE_ATA_ATAPI) { SET_FARVAR(seg, param_far->dpte, SEGOFF(SEG_LOW, (u32)&DefaultDPTE)); // Fill in dpte struct atadrive_s *adrive_g = container_of( drive_g, struct atadrive_s, drive); struct ata_channel_s *chan_gf = GET_GLOBAL(adrive_g->chan_gf); u8 slave = GET_GLOBAL(adrive_g->slave); u16 iobase2 = GET_GLOBALFLAT(chan_gf->iobase2); u8 irq = GET_GLOBALFLAT(chan_gf->irq); iobase1 = GET_GLOBALFLAT(chan_gf->iobase1); bdf = GET_GLOBALFLAT(chan_gf->pci_bdf); device_path = slave; channel = GET_GLOBALFLAT(chan_gf->chanid); u16 options = 0; if (type == DTYPE_ATA) { u8 translation = GET_GLOBAL(drive_g->translation); if (translation != TRANSLATION_NONE) { options |= 1<<3; // CHS translation if (translation == TRANSLATION_LBA) options |= 1<<9; if (translation == TRANSLATION_RECHS) options |= 3<<9; } } else { // ATAPI options |= 1<<5; // removable device options |= 1<<6; // atapi device } options |= 1<<4; // lba translation if (CONFIG_ATA_PIO32) options |= 1<<7; SET_LOW(DefaultDPTE.iobase1, iobase1); SET_LOW(DefaultDPTE.iobase2, iobase2 + ATA_CB_DC); SET_LOW(DefaultDPTE.prefix, ((slave ? ATA_CB_DH_DEV1 : ATA_CB_DH_DEV0) | ATA_CB_DH_LBA)); SET_LOW(DefaultDPTE.unused, 0xcb); SET_LOW(DefaultDPTE.irq, irq); SET_LOW(DefaultDPTE.blkcount, 1); SET_LOW(DefaultDPTE.dma, 0); SET_LOW(DefaultDPTE.pio, 0); SET_LOW(DefaultDPTE.options, options); SET_LOW(DefaultDPTE.reserved, 0); SET_LOW(DefaultDPTE.revision, 0x11); u8 sum = checksum_far(SEG_LOW, &DefaultDPTE, 15); SET_LOW(DefaultDPTE.checksum, -sum); } else { SET_FARVAR(seg, param_far->dpte.segoff, 0xffffffff); bdf = GET_GLOBAL(drive_g->cntl_id); } if (size < 66) { disk_ret(regs, DISK_RET_SUCCESS); return; } // EDD 3.x SET_FARVAR(seg, param_far->key, 0xbedd); SET_FARVAR(seg, param_far->dpi_length, t13 ? 44 : 36); SET_FARVAR(seg, param_far->reserved1, 0); SET_FARVAR(seg, param_far->reserved2, 0); if (bdf != -1) { SET_FARVAR(seg, param_far->host_bus[0], 'P'); SET_FARVAR(seg, param_far->host_bus[1], 'C'); SET_FARVAR(seg, param_far->host_bus[2], 'I'); SET_FARVAR(seg, param_far->host_bus[3], ' '); u32 path = (pci_bdf_to_bus(bdf) | (pci_bdf_to_dev(bdf) << 8) | (pci_bdf_to_fn(bdf) << 16)); if (t13) path |= channel << 24; SET_FARVAR(seg, param_far->iface_path, path); } else { // ISA SET_FARVAR(seg, param_far->host_bus[0], 'I'); SET_FARVAR(seg, param_far->host_bus[1], 'S'); SET_FARVAR(seg, param_far->host_bus[2], 'A'); SET_FARVAR(seg, param_far->host_bus[3], ' '); SET_FARVAR(seg, param_far->iface_path, iobase1); } if (type != DTYPE_VIRTIO_BLK) { SET_FARVAR(seg, param_far->iface_type[0], 'A'); SET_FARVAR(seg, param_far->iface_type[1], 'T'); SET_FARVAR(seg, param_far->iface_type[2], 'A'); SET_FARVAR(seg, param_far->iface_type[3], ' '); } else { SET_FARVAR(seg, param_far->iface_type[0], 'S'); SET_FARVAR(seg, param_far->iface_type[1], 'C'); SET_FARVAR(seg, param_far->iface_type[2], 'S'); SET_FARVAR(seg, param_far->iface_type[3], 'I'); } SET_FARVAR(seg, param_far->iface_type[4], ' '); SET_FARVAR(seg, param_far->iface_type[5], ' '); SET_FARVAR(seg, param_far->iface_type[6], ' '); SET_FARVAR(seg, param_far->iface_type[7], ' '); if (t13) { SET_FARVAR(seg, param_far->t13.device_path[0], device_path); SET_FARVAR(seg, param_far->t13.device_path[1], 0); SET_FARVAR(seg, param_far->t13.checksum , -checksum_far(seg, (void*)param_far+30, 43)); } else { SET_FARVAR(seg, param_far->phoenix.device_path, device_path); SET_FARVAR(seg, param_far->phoenix.checksum , -checksum_far(seg, (void*)param_far+30, 35)); } disk_ret(regs, DISK_RET_SUCCESS); } // IBM/MS extended media change static void disk_1349(struct bregs *regs, struct drive_s *drive_g) { if (regs->dl < EXTSTART_CD) { // Always success for HD disk_ret(regs, DISK_RET_SUCCESS); return; } set_invalid(regs); // always send changed ?? regs->ah = DISK_RET_ECHANGED; } static void disk_134e01(struct bregs *regs, struct drive_s *drive_g) { disk_ret(regs, DISK_RET_SUCCESS); } static void disk_134e03(struct bregs *regs, struct drive_s *drive_g) { disk_ret(regs, DISK_RET_SUCCESS); } static void disk_134e04(struct bregs *regs, struct drive_s *drive_g) { disk_ret(regs, DISK_RET_SUCCESS); } static void disk_134e06(struct bregs *regs, struct drive_s *drive_g) { disk_ret(regs, DISK_RET_SUCCESS); } static void disk_134eXX(struct bregs *regs, struct drive_s *drive_g) { disk_ret(regs, DISK_RET_EPARAM); } // IBM/MS set hardware configuration static void disk_134e(struct bregs *regs, struct drive_s *drive_g) { switch (regs->al) { case 0x01: disk_134e01(regs, drive_g); break; case 0x03: disk_134e03(regs, drive_g); break; case 0x04: disk_134e04(regs, drive_g); break; case 0x06: disk_134e06(regs, drive_g); break; default: disk_134eXX(regs, drive_g); break; } } static void disk_13XX(struct bregs *regs, struct drive_s *drive_g) { disk_ret_unimplemented(regs, DISK_RET_EPARAM); } static void disk_13(struct bregs *regs, struct drive_s *drive_g) { //debug_stub(regs); // clear completion flag SET_BDA(disk_interrupt_flag, 0); switch (regs->ah) { case 0x00: disk_1300(regs, drive_g); break; case 0x01: disk_1301(regs, drive_g); break; case 0x02: disk_1302(regs, drive_g); break; case 0x03: disk_1303(regs, drive_g); break; case 0x04: disk_1304(regs, drive_g); break; case 0x05: disk_1305(regs, drive_g); break; case 0x08: disk_1308(regs, drive_g); break; case 0x09: disk_1309(regs, drive_g); break; case 0x0c: disk_130c(regs, drive_g); break; case 0x0d: disk_130d(regs, drive_g); break; case 0x10: disk_1310(regs, drive_g); break; case 0x11: disk_1311(regs, drive_g); break; case 0x14: disk_1314(regs, drive_g); break; case 0x15: disk_1315(regs, drive_g); break; case 0x16: disk_1316(regs, drive_g); break; case 0x41: disk_1341(regs, drive_g); break; case 0x42: disk_1342(regs, drive_g); break; case 0x43: disk_1343(regs, drive_g); break; case 0x44: disk_1344(regs, drive_g); break; case 0x45: disk_1345(regs, drive_g); break; case 0x46: disk_1346(regs, drive_g); break; case 0x47: disk_1347(regs, drive_g); break; case 0x48: disk_1348(regs, drive_g); break; case 0x49: disk_1349(regs, drive_g); break; case 0x4e: disk_134e(regs, drive_g); break; default: disk_13XX(regs, drive_g); break; } } static void floppy_13(struct bregs *regs, struct drive_s *drive_g) { // Only limited commands are supported on floppies. switch (regs->ah) { case 0x00: case 0x01: case 0x02: case 0x03: case 0x04: case 0x05: case 0x08: case 0x15: case 0x16: disk_13(regs, drive_g); break; default: disk_13XX(regs, drive_g); break; } } /**************************************************************** * Entry points ****************************************************************/ static void handle_legacy_disk(struct bregs *regs, u8 extdrive) { if (! CONFIG_DRIVES) { // XXX - support handle_1301 anyway? disk_ret(regs, DISK_RET_EPARAM); return; } if (extdrive < EXTSTART_HD) { struct drive_s *drive_g = getDrive(EXTTYPE_FLOPPY, extdrive); if (!drive_g) goto fail; floppy_13(regs, drive_g); return; } struct drive_s *drive_g; if (extdrive >= EXTSTART_CD) drive_g = getDrive(EXTTYPE_CD, extdrive - EXTSTART_CD); else drive_g = getDrive(EXTTYPE_HD, extdrive - EXTSTART_HD); if (!drive_g) goto fail; disk_13(regs, drive_g); return; fail: // XXX - support 1301/1308/1315 anyway? disk_ret(regs, DISK_RET_EPARAM); } void VISIBLE16 handle_40(struct bregs *regs) { debug_enter(regs, DEBUG_HDL_40); handle_legacy_disk(regs, regs->dl); } // INT 13h Fixed Disk Services Entry Point void VISIBLE16 handle_13(struct bregs *regs) { debug_enter(regs, DEBUG_HDL_13); u8 extdrive = regs->dl; if (CONFIG_CDROM_EMU) { if (regs->ah == 0x4b) { cdemu_134b(regs); return; } if (GET_LOW(CDEmu.active)) { u8 emudrive = GET_LOW(CDEmu.emulated_extdrive); if (extdrive == emudrive) { // Access to an emulated drive. struct drive_s *cdemu_g; cdemu_g = GLOBALFLAT2GLOBAL(GET_GLOBAL(cdemu_drive_gf)); if (regs->ah > 0x16) { // Only old-style commands supported. disk_13XX(regs, cdemu_g); return; } disk_13(regs, cdemu_g); return; } if (extdrive < EXTSTART_CD && ((emudrive ^ extdrive) & 0x80) == 0) // Adjust id to make room for emulated drive. extdrive--; } } handle_legacy_disk(regs, extdrive); } // record completion in BIOS task complete flag void VISIBLE16 handle_76(void) { debug_isr(DEBUG_ISR_76); SET_BDA(disk_interrupt_flag, 0xff); eoi_pic2(); } // Old Fixed Disk Parameter Table (newer tables are in the ebda). struct fdpt_s OldFDPT VAR16FIXED(0xe401); tinyvisor/bios/src/jpeg.h0000644006644000001440000000056711733243570015722 0ustar yuichi_xyusers#ifndef __JPEG_H #define __JPEG_H struct jpeg_decdata; struct jpeg_decdata *jpeg_alloc(void); int jpeg_decode(struct jpeg_decdata *jpeg, unsigned char *buf); void jpeg_get_size(struct jpeg_decdata *jpeg, int *width, int *height); int jpeg_show(struct jpeg_decdata *jpeg, unsigned char *pic, int width , int height, int depth, int bytes_per_line_dest); #endif tinyvisor/bios/src/acpi.c0000644006644000001440000006316112174763154015710 0ustar yuichi_xyusers// Support for generating ACPI tables (on emulators) // // Copyright (C) 2008-2010 Kevin O'Connor // Copyright (C) 2006 Fabrice Bellard // // This file may be distributed under the terms of the GNU LGPLv3 license. /* * Copyright (c) 2010-2013 Yuichi Watanabe */ #include "acpi.h" // struct rsdp_descriptor #include "util.h" // memcpy #include "byteorder.h" // cpu_to_le16 #include "pci.h" // pci_find_init_device #include "pci_ids.h" // PCI_VENDOR_ID_INTEL #include "pci_regs.h" // PCI_INTERRUPT_LINE #include "ioport.h" // inl #include "config.h" // CONFIG_* #include "paravirt.h" // RamSize #include "dev-q35.h" #include "acpi-dsdt.hex" #include "config.h" static void build_header(struct acpi_table_header *h, u32 sig, int len, u8 rev) { h->signature = cpu_to_le32(sig); h->length = cpu_to_le32(len); h->revision = rev; memcpy(h->oem_id, BUILD_APPNAME6, 6); memcpy(h->oem_table_id, BUILD_APPNAME4, 4); memcpy(h->oem_table_id + 4, (void*)&sig, 4); h->oem_revision = cpu_to_le32(1); memcpy(h->asl_compiler_id, BUILD_APPNAME4, 4); h->asl_compiler_revision = cpu_to_le32(1); h->checksum -= checksum(h, len); } #define PIIX4_ACPI_ENABLE 0xf1 #define PIIX4_ACPI_DISABLE 0xf0 #define PIIX4_GPE0_BLK 0xafe0 #define PIIX4_GPE0_BLK_LEN 4 #define PIIX4_PM_INTRRUPT 9 // irq 9 static void piix4_fadt_setup(struct pci_device *pci, void *arg) { struct fadt_descriptor_rev4 *fadt = arg; fadt->model = 1; fadt->reserved1 = 0; fadt->sci_int = cpu_to_le16(PIIX4_PM_INTRRUPT); fadt->smi_cmd = cpu_to_le32(PORT_SMI_CMD); fadt->acpi_enable = PIIX4_ACPI_ENABLE; fadt->acpi_disable = PIIX4_ACPI_DISABLE; fadt->pm1a_evt_blk = cpu_to_le32(PORT_ACPI_PM_BASE); dprintf(1, "ACPI PM base 0x%x\n", fadt->pm1a_evt_blk); fadt->pm1a_cnt_blk = cpu_to_le32(PORT_ACPI_PM_BASE + 0x04); fadt->pm_tmr_blk = cpu_to_le32(PORT_ACPI_PM_BASE + 0x08); fadt->gpe0_blk = cpu_to_le32(PIIX4_GPE0_BLK); fadt->pm1_evt_len = 4; fadt->pm1_cnt_len = 2; fadt->pm_tmr_len = 4; fadt->gpe0_blk_len = PIIX4_GPE0_BLK_LEN; fadt->plvl2_lat = cpu_to_le16(0xfff); // C2 state not supported fadt->plvl3_lat = cpu_to_le16(0xfff); // C3 state not supported /* WBINVD + PROC_C1 + SLP_BUTTON + RTC_S4 + USE_PLATFORM_CLOCK */ fadt->flags = cpu_to_le32((1 << 0) | (1 << 2) | (1 << 5) | (1 << 7) | (1 << 15)); #if CONFIG_FORCE_APIC_PHYSICAL_DESTINATION_MODE != 0 fadt->flags |= cpu_to_le32((1 << 19)); #endif } /* PCI_VENDOR_ID_INTEL && PCI_DEVICE_ID_INTEL_ICH9_LPC */ void ich9_lpc_fadt_setup(struct pci_device *dev, void *arg) { struct fadt_descriptor_rev4 *fadt = arg; fadt->model = 1; fadt->reserved1 = 0; fadt->sci_int = cpu_to_le16(9); fadt->smi_cmd = cpu_to_le32(PORT_SMI_CMD); fadt->acpi_enable = ICH9_ACPI_ENABLE; fadt->acpi_disable = ICH9_ACPI_DISABLE; fadt->pm1a_evt_blk = cpu_to_le32(PORT_ACPI_PM_BASE); fadt->pm1a_cnt_blk = cpu_to_le32(PORT_ACPI_PM_BASE + 0x04); fadt->pm_tmr_blk = cpu_to_le32(PORT_ACPI_PM_BASE + 0x08); fadt->gpe0_blk = cpu_to_le32(PORT_ACPI_PM_BASE + ICH9_PMIO_GPE0_STS); fadt->pm1_evt_len = 4; fadt->pm1_cnt_len = 2; fadt->pm_tmr_len = 4; fadt->gpe0_blk_len = ICH9_PMIO_GPE0_BLK_LEN; fadt->plvl2_lat = cpu_to_le16(0xfff); // C2 state not supported fadt->plvl3_lat = cpu_to_le16(0xfff); // C3 state not supported /* WBINVD + PROC_C1 + SLP_BUTTON + FIX_RTC + RTC_S4 */ fadt->flags = cpu_to_le32((1 << 0) | (1 << 2) | (1 << 5) | (1 << 6) | (1 << 7)); } static const struct pci_device_id fadt_init_tbl[] = { /* PIIX4 Power Management device (for ACPI) */ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82371AB_3, piix4_fadt_setup), PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH9_LPC, ich9_lpc_fadt_setup), PCI_DEVICE_END }; static void fill_dsdt(struct fadt_descriptor_rev4 *fadt, void *dsdt) { if (fadt->dsdt) { free((void *)le32_to_cpu(fadt->dsdt)); } fadt->dsdt = cpu_to_le32((u32)dsdt); fadt->checksum -= checksum(fadt, sizeof(*fadt)); dprintf(1, "ACPI DSDT=%p\n", dsdt); } static void * build_fadt(struct pci_device *pci) { struct fadt_descriptor_rev4 *fadt = malloc_high(sizeof(*fadt)); struct facs_descriptor_rev1 *facs = memalign_high(64, sizeof(*facs)); if (!fadt || !facs) { warn_noalloc(); return NULL; } /* FACS */ memset(facs, 0, sizeof(*facs)); facs->signature = cpu_to_le32(FACS_SIGNATURE); facs->length = cpu_to_le32(sizeof(*facs)); /* FADT */ memset(fadt, 0, sizeof(*fadt)); fadt->firmware_ctrl = cpu_to_le32((u32)facs); fadt->dsdt = 0; /* dsdt will be filled later in acpi_setup() by fill_dsdt() */ if (pci_init_device(fadt_init_tbl, pci, fadt) && CONFIG_FORCE_ACPI != 0) { piix4_fadt_setup(NULL, fadt); } build_header((void*)fadt, FACP_SIGNATURE, sizeof(*fadt), 4); return fadt; } static void* build_madt(void) { int madt_size = (sizeof(struct multiple_apic_table) + sizeof(struct madt_processor_apic) * MaxCountCPUs + sizeof(struct madt_io_apic) + sizeof(struct madt_intsrcovr) * 16 + sizeof(struct madt_local_nmi)); struct multiple_apic_table *madt = malloc_high(madt_size); if (!madt) { warn_noalloc(); return NULL; } memset(madt, 0, madt_size); madt->local_apic_address = cpu_to_le32(BUILD_APIC_ADDR); madt->flags = cpu_to_le32(1); struct madt_processor_apic *apic = (void*)&madt[1]; int i; int apic_id = 0; int present; for (i=0; itype = APIC_PROCESSOR; apic->length = sizeof(*apic); apic->processor_id = i; apic->local_apic_id = apic_id; apic->flags = cpu_to_le32(present); apic++; apic_id++; } struct madt_io_apic *io_apic = (void*)apic; io_apic->type = APIC_IO; io_apic->length = sizeof(*io_apic); io_apic->io_apic_id = BUILD_IOAPIC_ID; io_apic->address = cpu_to_le32(BUILD_IOAPIC_ADDR); io_apic->interrupt = cpu_to_le32(0); struct madt_intsrcovr *intsrcovr = (void*)&io_apic[1]; if (CONFIG_IRQ0_OVERRIDE == 1 || romfile_loadint("etc/irq0-override", 0)) { memset(intsrcovr, 0, sizeof(*intsrcovr)); intsrcovr->type = APIC_XRUPT_OVERRIDE; intsrcovr->length = sizeof(*intsrcovr); intsrcovr->source = 0; intsrcovr->gsi = cpu_to_le32(2); intsrcovr->flags = cpu_to_le16(0); /* conforms to bus specifications */ intsrcovr++; } for (i = 1; i < 16; i++) { if (!(BUILD_PCI_IRQS & (1 << i))) /* No need for a INT source override structure. */ continue; memset(intsrcovr, 0, sizeof(*intsrcovr)); intsrcovr->type = APIC_XRUPT_OVERRIDE; intsrcovr->length = sizeof(*intsrcovr); intsrcovr->source = i; intsrcovr->gsi = cpu_to_le32(i); intsrcovr->flags = cpu_to_le16(0xd); /* active high, level triggered */ intsrcovr++; } struct madt_local_nmi *local_nmi = (void*)intsrcovr; local_nmi->type = APIC_LOCAL_NMI; local_nmi->length = sizeof(*local_nmi); local_nmi->processor_id = 0xff; /* all processors */ local_nmi->flags = cpu_to_le16(0); local_nmi->lint = 1; /* LINT1 */ local_nmi++; build_header((void*)madt, APIC_SIGNATURE, (void*)local_nmi - (void*)madt, 1); return madt; } // Encode a hex value static inline char getHex(u32 val) { val &= 0x0f; return (val <= 9) ? ('0' + val) : ('A' + val - 10); } // Encode a length in an SSDT. static u8 * encodeLen(u8 *ssdt_ptr, int length, int bytes) { switch (bytes) { default: case 4: ssdt_ptr[3] = ((length >> 20) & 0xff); case 3: ssdt_ptr[2] = ((length >> 12) & 0xff); case 2: ssdt_ptr[1] = ((length >> 4) & 0xff); ssdt_ptr[0] = (((bytes-1) & 0x3) << 6) | (length & 0x0f); break; case 1: ssdt_ptr[0] = length & 0x3f; } return ssdt_ptr + bytes; } #include "ssdt-proc.hex" /* 0x5B 0x83 ProcessorOp PkgLength NameString ProcID */ #define PROC_OFFSET_CPUHEX (*ssdt_proc_name - *ssdt_proc_start + 2) #define PROC_OFFSET_CPUID1 (*ssdt_proc_name - *ssdt_proc_start + 4) #define PROC_OFFSET_CPUID2 (*ssdt_proc_id - *ssdt_proc_start) #define PROC_SIZEOF (*ssdt_proc_end - *ssdt_proc_start) #define PROC_AML (ssdp_proc_aml + *ssdt_proc_start) /* 0x5B 0x82 DeviceOp PkgLength NameString */ #define PCIHP_OFFSET_HEX (*ssdt_pcihp_name - *ssdt_pcihp_start + 1) #define PCIHP_OFFSET_ID (*ssdt_pcihp_id - *ssdt_pcihp_start) #define PCIHP_OFFSET_ADR (*ssdt_pcihp_adr - *ssdt_pcihp_start) #define PCIHP_OFFSET_EJ0 (*ssdt_pcihp_ej0 - *ssdt_pcihp_start) #define PCIHP_SIZEOF (*ssdt_pcihp_end - *ssdt_pcihp_start) #define PCIHP_AML (ssdp_pcihp_aml + *ssdt_pcihp_start) #define PCI_SLOTS 32 #define SSDT_SIGNATURE 0x54445353 // SSDT #define SSDT_HEADER_LENGTH 36 #include "ssdt-misc.hex" #include "ssdt-pcihp.hex" #define PCI_RMV_BASE 0xae0c static u8* build_notify(u8 *ssdt_ptr, const char *name, int skip, int count, const char *target, int ofs) { count -= skip; *(ssdt_ptr++) = 0x14; // MethodOp ssdt_ptr = encodeLen(ssdt_ptr, 2+5+(12*count), 2); memcpy(ssdt_ptr, name, 4); ssdt_ptr += 4; *(ssdt_ptr++) = 0x02; // MethodOp int i; for (i = skip; count-- > 0; i++) { *(ssdt_ptr++) = 0xA0; // IfOp ssdt_ptr = encodeLen(ssdt_ptr, 11, 1); *(ssdt_ptr++) = 0x93; // LEqualOp *(ssdt_ptr++) = 0x68; // Arg0Op *(ssdt_ptr++) = 0x0A; // BytePrefix *(ssdt_ptr++) = i; *(ssdt_ptr++) = 0x86; // NotifyOp memcpy(ssdt_ptr, target, 4); ssdt_ptr[ofs] = getHex(i >> 4); ssdt_ptr[ofs + 1] = getHex(i); ssdt_ptr += 4; *(ssdt_ptr++) = 0x69; // Arg1Op } return ssdt_ptr; } static void patch_pcihp(int slot, u8 *ssdt_ptr, u32 eject) { ssdt_ptr[PCIHP_OFFSET_HEX] = getHex(slot >> 4); ssdt_ptr[PCIHP_OFFSET_HEX+1] = getHex(slot); ssdt_ptr[PCIHP_OFFSET_ID] = slot; ssdt_ptr[PCIHP_OFFSET_ADR + 2] = slot; /* Runtime patching of EJ0: to disable hotplug for a slot, * replace the method name: _EJ0 by EJ0_. */ /* Sanity check */ if (memcmp(ssdt_ptr + PCIHP_OFFSET_EJ0, "_EJ0", 4)) { warn_internalerror(); } if (!eject) { memcpy(ssdt_ptr + PCIHP_OFFSET_EJ0, "EJ0_", 4); } } static void* build_ssdt(void) { int acpi_cpus = MaxCountCPUs > 0xff ? 0xff : MaxCountCPUs; int length = (sizeof(ssdp_misc_aml) // _S3_ / _S4_ / _S5_ + (1+3+4) // Scope(_SB_) + (acpi_cpus * PROC_SIZEOF) // procs + (1+2+5+(12*acpi_cpus)) // NTFY + (6+2+1+(1*acpi_cpus)) // CPON + (1+3+4) // Scope(PCI0) + ((PCI_SLOTS - 1) * PCIHP_SIZEOF) // slots + (1+2+5+(12*(PCI_SLOTS - 1)))); // PCNT u8 *ssdt = malloc_high(length); if (! ssdt) { warn_noalloc(); return NULL; } u8 *ssdt_ptr = ssdt; // Copy header and encode fwcfg values in the S3_ / S4_ / S5_ packages int sys_state_size; char *sys_states = romfile_loadfile("etc/system-states", &sys_state_size); if (!sys_states || sys_state_size != 6) sys_states = (char[]){128, 0, 0, 129, 128, 128}; memcpy(ssdt_ptr, ssdp_misc_aml, sizeof(ssdp_misc_aml)); if (!(sys_states[3] & 128)) ssdt_ptr[acpi_s3_name[0]] = 'X'; if (!(sys_states[4] & 128)) ssdt_ptr[acpi_s4_name[0]] = 'X'; else ssdt_ptr[acpi_s4_pkg[0] + 1] = ssdt[acpi_s4_pkg[0] + 3] = sys_states[4] & 127; // store pci io windows *(u32*)&ssdt_ptr[acpi_pci32_start[0]] = cpu_to_le32(pcimem_start); *(u32*)&ssdt_ptr[acpi_pci32_end[0]] = cpu_to_le32(pcimem_end - 1); if (pcimem64_start) { ssdt_ptr[acpi_pci64_valid[0]] = 1; *(u64*)&ssdt_ptr[acpi_pci64_start[0]] = cpu_to_le64(pcimem64_start); *(u64*)&ssdt_ptr[acpi_pci64_end[0]] = cpu_to_le64(pcimem64_end - 1); *(u64*)&ssdt_ptr[acpi_pci64_length[0]] = cpu_to_le64( pcimem64_end - pcimem64_start); } else { ssdt_ptr[acpi_pci64_valid[0]] = 0; } int pvpanic_port = romfile_loadint("etc/pvpanic-port", 0x0); *(u16 *)(ssdt_ptr + *ssdt_isa_pest) = pvpanic_port; ssdt_ptr += sizeof(ssdp_misc_aml); // build Scope(_SB_) header *(ssdt_ptr++) = 0x10; // ScopeOp ssdt_ptr = encodeLen(ssdt_ptr, length - (ssdt_ptr - ssdt), 3); *(ssdt_ptr++) = '_'; *(ssdt_ptr++) = 'S'; *(ssdt_ptr++) = 'B'; *(ssdt_ptr++) = '_'; // build Processor object for each processor int i; for (i=0; i> 4); ssdt_ptr[PROC_OFFSET_CPUHEX+1] = getHex(i); ssdt_ptr[PROC_OFFSET_CPUID1] = i; ssdt_ptr[PROC_OFFSET_CPUID2] = i; ssdt_ptr += PROC_SIZEOF; } // build "Method(NTFY, 2) {If (LEqual(Arg0, 0x00)) {Notify(CP00, Arg1)} ...}" // Arg0 = Processor ID = APIC ID ssdt_ptr = build_notify(ssdt_ptr, "NTFY", 0, acpi_cpus, "CP00", 2); // build "Name(CPON, Package() { One, One, ..., Zero, Zero, ... })" *(ssdt_ptr++) = 0x08; // NameOp *(ssdt_ptr++) = 'C'; *(ssdt_ptr++) = 'P'; *(ssdt_ptr++) = 'O'; *(ssdt_ptr++) = 'N'; *(ssdt_ptr++) = 0x12; // PackageOp ssdt_ptr = encodeLen(ssdt_ptr, 2+1+(1*acpi_cpus), 2); *(ssdt_ptr++) = acpi_cpus; int apic_id = 0; int present; for (i=0; i> 16; u32 hpet_period = readl(hpet_base + HPET_PERIOD); if (hpet_vendor == 0 || hpet_vendor == 0xffff || hpet_period == 0 || hpet_period > 100000000) return NULL; hpet = malloc_high(sizeof(*hpet)); if (!hpet) { warn_noalloc(); return NULL; } memset(hpet, 0, sizeof(*hpet)); /* Note timer_block_id value must be kept in sync with value advertised by * emulated hpet */ hpet->timer_block_id = cpu_to_le32(0x8086a201); hpet->addr.address = cpu_to_le64(BUILD_HPET_ADDRESS); build_header((void*)hpet, HPET_SIGNATURE, sizeof(*hpet), 1); return hpet; } static void acpi_build_srat_memory(struct srat_memory_affinity *numamem, u64 base, u64 len, int node, int enabled) { numamem->type = SRAT_MEMORY; numamem->length = sizeof(*numamem); memset(numamem->proximity, 0, 4); numamem->proximity[0] = node; numamem->flags = cpu_to_le32(!!enabled); numamem->base_addr = cpu_to_le64(base); numamem->range_length = cpu_to_le64(len); } static void * build_srat(void) { int numadatasize, numacpusize; u64 *numadata = romfile_loadfile("etc/numa-nodes", &numadatasize); u64 *numacpumap = romfile_loadfile("etc/numa-cpu-map", &numacpusize); if (!numadata || !numacpumap) goto fail; int max_cpu = numacpusize / sizeof(u64); int nb_numa_nodes = numadatasize / sizeof(u64); struct system_resource_affinity_table *srat; int srat_size = sizeof(*srat) + sizeof(struct srat_processor_affinity) * max_cpu + sizeof(struct srat_memory_affinity) * (nb_numa_nodes + 2); srat = malloc_high(srat_size); if (!srat) { warn_noalloc(); goto fail; } memset(srat, 0, srat_size); srat->reserved1=cpu_to_le32(1); struct srat_processor_affinity *core = (void*)(srat + 1); int i; u64 curnode; int apic_id = 0; int present; for (i = 0; i < max_cpu; ++i) { while (apic_id < 0xff && !apic_id_is_present(apic_id)) { apic_id++; } if (apic_id < 0xff) { present = 1; } else { present = 0; } core->type = SRAT_PROCESSOR; core->length = sizeof(*core); core->local_apic_id = apic_id; curnode = *numacpumap++; core->proximity_lo = curnode; memset(core->proximity_hi, 0, 3); core->local_sapic_eid = 0; core->flags = cpu_to_le32(present); core++; apic_id++; } /* the memory map is a bit tricky, it contains at least one hole * from 640k-1M and possibly another one from 3.5G-4G. */ struct srat_memory_affinity *numamem = (void*)core; int slots = 0; u64 mem_len, mem_base, next_base = 0; acpi_build_srat_memory(numamem, 0, 640*1024, 0, 1); next_base = 1024 * 1024; numamem++; slots++; for (i = 1; i < nb_numa_nodes + 1; ++i) { mem_base = next_base; mem_len = *numadata++; if (i == 1) mem_len -= 1024 * 1024; next_base = mem_base + mem_len; /* Cut out the PCI hole */ if (mem_base <= RamSize && next_base > RamSize) { mem_len -= next_base - RamSize; if (mem_len > 0) { acpi_build_srat_memory(numamem, mem_base, mem_len, i-1, 1); numamem++; slots++; } mem_base = 1ULL << 32; mem_len = next_base - RamSize; next_base += (1ULL << 32) - RamSize; } acpi_build_srat_memory(numamem, mem_base, mem_len, i-1, 1); numamem++; slots++; } for (; slots < nb_numa_nodes + 2; slots++) { acpi_build_srat_memory(numamem, 0, 0, 0, 0); numamem++; } build_header((void*)srat, SRAT_SIGNATURE, srat_size, 1); free(numadata); free(numacpumap); return srat; fail: free(numadata); free(numacpumap); return NULL; } static void * build_mcfg_q35(void) { struct acpi_table_mcfg *mcfg; int len = sizeof(*mcfg) + 1 * sizeof(mcfg->allocation[0]); mcfg = malloc_high(len); if (!mcfg) { warn_noalloc(); return NULL; } memset(mcfg, 0, len); mcfg->allocation[0].address = cpu_to_le64(Q35_HOST_BRIDGE_PCIEXBAR_ADDR); mcfg->allocation[0].pci_segment = cpu_to_le16(Q35_HOST_PCIE_PCI_SEGMENT); mcfg->allocation[0].start_bus_number = Q35_HOST_PCIE_START_BUS_NUMBER; mcfg->allocation[0].end_bus_number = Q35_HOST_PCIE_END_BUS_NUMBER; build_header((void *)mcfg, MCFG_SIGNATURE, len, 1); return mcfg; } static const struct pci_device_id acpi_find_tbl[] = { /* PIIX4 Power Management device. */ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82371AB_3, NULL), PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH9_LPC, NULL), PCI_DEVICE_END, }; struct rsdp_descriptor *RsdpAddr; #define MAX_ACPI_TABLES 20 void acpi_setup(void) { if (! CONFIG_ACPI) return; dprintf(3, "init ACPI tables\n"); // This code is hardcoded for PIIX4 Power Management device. struct pci_device *pci = pci_find_init_device(acpi_find_tbl, NULL); if (!pci && CONFIG_FORCE_ACPI == 0) // Device not found return; // Build ACPI tables u32 tables[MAX_ACPI_TABLES], tbl_idx = 0; #define ACPI_INIT_TABLE(X) \ do { \ tables[tbl_idx] = cpu_to_le32((u32)(X)); \ if (le32_to_cpu(tables[tbl_idx])) \ tbl_idx++; \ } while(0) struct fadt_descriptor_rev4 *fadt = build_fadt(pci); ACPI_INIT_TABLE(fadt); ACPI_INIT_TABLE(build_ssdt()); ACPI_INIT_TABLE(build_madt()); ACPI_INIT_TABLE(build_hpet()); ACPI_INIT_TABLE(build_srat()); if (pci && pci->device == PCI_DEVICE_ID_INTEL_ICH9_LPC) ACPI_INIT_TABLE(build_mcfg_q35()); struct romfile_s *file = NULL; for (;;) { file = romfile_findprefix("acpi/", file); if (!file) break; struct acpi_table_header *table = malloc_high(file->size); if (!table) { warn_noalloc(); continue; } int ret = file->copy(file, table, file->size); if (ret <= sizeof(*table)) continue; if (table->signature == DSDT_SIGNATURE) { if (fadt) { fill_dsdt(fadt, table); } } else { ACPI_INIT_TABLE(table); } if (tbl_idx == MAX_ACPI_TABLES) { warn_noalloc(); break; } } if (CONFIG_ACPI_DSDT && fadt && !fadt->dsdt) { /* default DSDT */ void *dsdt = malloc_high(sizeof(AmlCode)); if (!dsdt) { warn_noalloc(); return; } memcpy(dsdt, AmlCode, sizeof(AmlCode)); fill_dsdt(fadt, dsdt); } // Build final rsdt table struct rsdt_descriptor_rev1 *rsdt; size_t rsdt_len = sizeof(*rsdt) + sizeof(u32) * tbl_idx; rsdt = malloc_high(rsdt_len); if (!rsdt) { warn_noalloc(); return; } memset(rsdt, 0, rsdt_len); memcpy(rsdt->table_offset_entry, tables, sizeof(u32) * tbl_idx); build_header((void*)rsdt, RSDT_SIGNATURE, rsdt_len, 1); // Build rsdp pointer table struct rsdp_descriptor *rsdp = malloc_fseg(sizeof(*rsdp)); if (!rsdp) { warn_noalloc(); return; } memset(rsdp, 0, sizeof(*rsdp)); rsdp->signature = cpu_to_le64(RSDP_SIGNATURE); memcpy(rsdp->oem_id, BUILD_APPNAME6, 6); rsdp->rsdt_physical_address = cpu_to_le32((u32)rsdt); rsdp->checksum -= checksum(rsdp, 20); RsdpAddr = rsdp; dprintf(1, "ACPI tables: RSDP=%p RSDT=%p\n", rsdp, rsdt); } static struct fadt_descriptor_rev4 * find_fadt(void) { dprintf(4, "rsdp=%p\n", RsdpAddr); if (!RsdpAddr || RsdpAddr->signature != RSDP_SIGNATURE) return NULL; struct rsdt_descriptor_rev1 *rsdt = (void*)RsdpAddr->rsdt_physical_address; dprintf(4, "rsdt=%p\n", rsdt); if (!rsdt || rsdt->signature != RSDT_SIGNATURE) return NULL; void *end = (void*)rsdt + rsdt->length; int i; for (i=0; (void*)&rsdt->table_offset_entry[i] < end; i++) { struct fadt_descriptor_rev4 *fadt = (void*)rsdt->table_offset_entry[i]; if (!fadt || fadt->signature != FACP_SIGNATURE) continue; dprintf(4, "fadt=%p\n", fadt); return fadt; } dprintf(4, "no fadt found\n"); return NULL; } u32 find_resume_vector(void) { struct fadt_descriptor_rev4 *fadt = find_fadt(); if (!fadt) return 0; struct facs_descriptor_rev1 *facs = (void*)fadt->firmware_ctrl; dprintf(4, "facs=%p\n", facs); if (! facs || facs->signature != FACS_SIGNATURE) return 0; // Found it. dprintf(4, "resume addr=%d\n", facs->firmware_waking_vector); return facs->firmware_waking_vector; } void find_acpi_features(void) { struct fadt_descriptor_rev4 *fadt = find_fadt(); if (!fadt) return; u32 pm_tmr = le32_to_cpu(fadt->pm_tmr_blk); dprintf(4, "pm_tmr_blk=%x\n", pm_tmr); if (pm_tmr) pmtimer_setup(pm_tmr, 3579); // Theoretically we should check the 'reset_reg_sup' flag, but Windows // doesn't and thus nobody seems to *set* it. If the table is large enough // to include it, let the sanity checks in acpi_set_reset_reg() suffice. if (fadt->length >= 129) { void *p = fadt; acpi_set_reset_reg(p + 116, *(u8 *)(p + 128)); } } static struct acpi_20_generic_address acpi_reset_reg; static u8 acpi_reset_val; void acpi_reboot(void) { // Check it passed the sanity checks in acpi_set_reset_reg() and was set if (acpi_reset_reg.register_bit_width != 8) return; u64 addr = le64_to_cpu(acpi_reset_reg.address); dprintf(1, "ACPI hard reset %d:%llx (%x)\n", acpi_reset_reg.address_space_id, addr, acpi_reset_val); switch (acpi_reset_reg.address_space_id) { case 0: // System Memory writeb((void *)(u32)addr, acpi_reset_val); break; case 1: // System I/O outb(acpi_reset_val, addr); break; case 2: // PCI config space pci_config_writeb(acpi_ga_to_bdf(addr), addr & 0xffff, acpi_reset_val); break; } } void acpi_set_reset_reg(struct acpi_20_generic_address *reg, u8 val) { if (!reg || reg->address_space_id > 2 || reg->register_bit_width != 8 || reg->register_bit_offset) return; acpi_reset_reg = *reg; acpi_reset_val = val; } #if CONFIG_GET_ACPI_PM_BASE_FROM_RTC != 0 #include "cmos.h" u16 acpi_pm_base(void) { return (inb_cmos(CMOS_ACPI_PM_BASE) << 8); } #endif tinyvisor/bios/src/bootsplash.c0000644006644000001440000001666212172661303017145 0ustar yuichi_xyusers// Option rom scanning code. // // Copyright (C) 2009-2010 coresystems GmbH // Copyright (C) 2010 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "bregs.h" // struct bregs #include "farptr.h" // FLATPTR_TO_SEG #include "config.h" // CONFIG_* #include "util.h" // dprintf #include "jpeg.h" // splash #include "vbe.h" // struct vbe_info #include "bmp.h" // bmp_alloc #include "smbios.h" // display_uuid /**************************************************************** * Helper functions ****************************************************************/ // Call int10 vga handler. static void call16_int10(struct bregs *br) { br->flags = F_IF; start_preempt(); call16_int(0x10, br); finish_preempt(); } /**************************************************************** * VGA text / graphics console ****************************************************************/ void enable_vga_console(void) { dprintf(1, "Turning on vga text mode console\n"); struct bregs br; /* Enable VGA text mode */ memset(&br, 0, sizeof(br)); br.ax = 0x0003; call16_int10(&br); // Write to screen. printf("SeaBIOS (version %s)\n", VERSION); display_uuid(); } static int find_videomode(struct vbe_info *vesa_info, struct vbe_mode_info *mode_info , int width, int height, int bpp_req) { dprintf(3, "Finding vesa mode with dimensions %d/%d\n", width, height); u16 *videomodes = SEGOFF_TO_FLATPTR(vesa_info->video_mode); for (;; videomodes++) { u16 videomode = *videomodes; if (videomode == 0xffff) { dprintf(1, "Unable to find vesa video mode dimensions %d/%d\n" , width, height); return -1; } struct bregs br; memset(&br, 0, sizeof(br)); br.ax = 0x4f01; br.cx = videomode; br.di = FLATPTR_TO_OFFSET(mode_info); br.es = FLATPTR_TO_SEG(mode_info); call16_int10(&br); if (br.ax != 0x4f) { dprintf(1, "get_mode failed.\n"); continue; } if (mode_info->xres != width || mode_info->yres != height) continue; u8 depth = mode_info->bits_per_pixel; if (bpp_req == 0) { if (depth != 16 && depth != 24 && depth != 32) continue; } else { if (depth != bpp_req) continue; } return videomode; } } static int BootsplashActive; void enable_bootsplash(void) { if (!CONFIG_BOOTSPLASH) return; /* splash picture can be bmp or jpeg file */ dprintf(3, "Checking for bootsplash\n"); u8 type = 0; /* 0 means jpg, 1 means bmp, default is 0=jpg */ int filesize; u8 *filedata = romfile_loadfile("bootsplash.jpg", &filesize); if (!filedata) { filedata = romfile_loadfile("bootsplash.bmp", &filesize); if (!filedata) return; type = 1; } dprintf(3, "start showing bootsplash\n"); u8 *picture = NULL; /* data buff used to be flushed to the video buf */ struct jpeg_decdata *jpeg = NULL; struct bmp_decdata *bmp = NULL; struct vbe_info *vesa_info = malloc_tmplow(sizeof(*vesa_info)); struct vbe_mode_info *mode_info = malloc_tmplow(sizeof(*mode_info)); if (!vesa_info || !mode_info) { warn_noalloc(); goto done; } /* Check whether we have a VESA 2.0 compliant BIOS */ memset(vesa_info, 0, sizeof(struct vbe_info)); vesa_info->signature = VBE2_SIGNATURE; struct bregs br; memset(&br, 0, sizeof(br)); br.ax = 0x4f00; br.di = FLATPTR_TO_OFFSET(vesa_info); br.es = FLATPTR_TO_SEG(vesa_info); call16_int10(&br); if (vesa_info->signature != VESA_SIGNATURE) { dprintf(1,"No VBE2 found.\n"); goto done; } /* Print some debugging information about our card. */ char *vendor = SEGOFF_TO_FLATPTR(vesa_info->oem_vendor_string); char *product = SEGOFF_TO_FLATPTR(vesa_info->oem_product_string); dprintf(3, "VESA %d.%d\nVENDOR: %s\nPRODUCT: %s\n", vesa_info->version>>8, vesa_info->version&0xff, vendor, product); int ret, width, height; int bpp_require = 0; if (type == 0) { jpeg = jpeg_alloc(); if (!jpeg) { warn_noalloc(); goto done; } /* Parse jpeg and get image size. */ dprintf(5, "Decoding bootsplash.jpg\n"); ret = jpeg_decode(jpeg, filedata); if (ret) { dprintf(1, "jpeg_decode failed with return code %d...\n", ret); goto done; } jpeg_get_size(jpeg, &width, &height); } else { bmp = bmp_alloc(); if (!bmp) { warn_noalloc(); goto done; } /* Parse bmp and get image size. */ dprintf(5, "Decoding bootsplash.bmp\n"); ret = bmp_decode(bmp, filedata, filesize); if (ret) { dprintf(1, "bmp_decode failed with return code %d...\n", ret); goto done; } bmp_get_size(bmp, &width, &height); bpp_require = 24; } /* jpeg would use 16 or 24 bpp video mode, BMP use 24bpp mode only */ // Try to find a graphics mode with the corresponding dimensions. int videomode = find_videomode(vesa_info, mode_info, width, height, bpp_require); if (videomode < 0) { dprintf(1, "failed to find a videomode with %dx%d %dbpp (0=any).\n", width, height, bpp_require); goto done; } void *framebuffer = (void *)mode_info->phys_base; int depth = mode_info->bits_per_pixel; dprintf(3, "mode: %04x\n", videomode); dprintf(3, "framebuffer: %p\n", framebuffer); dprintf(3, "bytes per scanline: %d\n", mode_info->bytes_per_scanline); dprintf(3, "bits per pixel: %d\n", depth); // Allocate space for image and decompress it. int imagesize = height * mode_info->bytes_per_scanline; picture = malloc_tmphigh(imagesize); if (!picture) { warn_noalloc(); goto done; } if (type == 0) { dprintf(5, "Decompressing bootsplash.jpg\n"); ret = jpeg_show(jpeg, picture, width, height, depth, mode_info->bytes_per_scanline); if (ret) { dprintf(1, "jpeg_show failed with return code %d...\n", ret); goto done; } } else { dprintf(5, "Decompressing bootsplash.bmp\n"); ret = bmp_show(bmp, picture, width, height, depth, mode_info->bytes_per_scanline); if (ret) { dprintf(1, "bmp_show failed with return code %d...\n", ret); goto done; } } /* Switch to graphics mode */ dprintf(5, "Switching to graphics mode\n"); memset(&br, 0, sizeof(br)); br.ax = 0x4f02; br.bx = videomode | VBE_MODE_LINEAR_FRAME_BUFFER; call16_int10(&br); if (br.ax != 0x4f) { dprintf(1, "set_mode failed.\n"); goto done; } /* Show the picture */ dprintf(5, "Showing bootsplash picture\n"); iomemcpy(framebuffer, picture, imagesize); dprintf(5, "Bootsplash copy complete\n"); BootsplashActive = 1; done: free(filedata); free(picture); free(vesa_info); free(mode_info); free(jpeg); free(bmp); return; } void disable_bootsplash(void) { if (!CONFIG_BOOTSPLASH || !BootsplashActive) return; BootsplashActive = 0; enable_vga_console(); } tinyvisor/bios/src/pic.h0000644006644000001440000000374412172661303015544 0ustar yuichi_xyusers// Helpers for working with i8259 interrupt controller. // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #ifndef __PIC_H #define __PIC_H #include "ioport.h" // PORT_PIC* #include "biosvar.h" // SET_IVT // PORT_PIC1 bitdefs #define PIC1_IRQ0 (1<<0) #define PIC1_IRQ1 (1<<1) #define PIC1_IRQ2 (1<<2) #define PIC1_IRQ5 (1<<5) #define PIC1_IRQ6 (1<<6) // PORT_PIC2 bitdefs #define PIC2_IRQ8 (1<<0) #define PIC2_IRQ12 (1<<4) #define PIC2_IRQ13 (1<<5) #define PIC2_IRQ14 (1<<6) #define BIOS_HWIRQ0_VECTOR 0x08 #define BIOS_HWIRQ8_VECTOR 0x70 static inline void eoi_pic1(void) { // Send eoi (select OCW2 + eoi) outb(0x20, PORT_PIC1_CMD); } static inline void eoi_pic2(void) { // Send eoi (select OCW2 + eoi) outb(0x20, PORT_PIC2_CMD); eoi_pic1(); } static inline void unmask_pic1(u8 irq) { outb(inb(PORT_PIC1_DATA) & ~irq, PORT_PIC1_DATA); } static inline void unmask_pic2(u8 irq) { outb(inb(PORT_PIC2_DATA) & ~irq, PORT_PIC2_DATA); } static inline void mask_pic1(u8 irq) { outb(inb(PORT_PIC1_DATA) | irq, PORT_PIC1_DATA); } static inline void mask_pic2(u8 irq) { outb(inb(PORT_PIC2_DATA) | irq, PORT_PIC2_DATA); } static inline u8 get_pic1_isr(void) { // 0x0b == select OCW1 + read ISR outb(0x0b, PORT_PIC1_CMD); return inb(PORT_PIC1_CMD); } static inline u8 get_pic2_isr(void) { // 0x0b == select OCW1 + read ISR outb(0x0b, PORT_PIC2_CMD); return inb(PORT_PIC2_CMD); } static inline void enable_hwirq(int hwirq, struct segoff_s func) { int vector; if (hwirq < 8) { unmask_pic1(1 << hwirq); vector = BIOS_HWIRQ0_VECTOR + hwirq; } else { unmask_pic2(1 << (hwirq - 8)); vector = BIOS_HWIRQ8_VECTOR + hwirq - 8; } SET_IVT(vector, func); } void set_pics(u8 irq0, u8 irq8); void pic_setup(void); void pic_save_mask(void); void pic_restore_mask(void); #endif // pic.h tinyvisor/bios/src/ioport.h0000644006644000001440000001143012174763154016305 0ustar yuichi_xyusers// Definitions for X86 IO port access. // // Copyright (C) 2008 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. /* * Copyright (c) 2013 Yuichi Watanabe */ #ifndef __IOPORT_H #define __IOPORT_H #include "config.h" #define PORT_DMA_ADDR_2 0x0004 #define PORT_DMA_CNT_2 0x0005 #define PORT_DMA1_MASK_REG 0x000a #define PORT_DMA1_MODE_REG 0x000b #define PORT_DMA1_CLEAR_FF_REG 0x000c #define PORT_DMA1_MASTER_CLEAR 0x000d #define PORT_PIC1_CMD 0x0020 #define PORT_PIC1_DATA 0x0021 #define PORT_PIT_COUNTER0 0x0040 #define PORT_PIT_COUNTER1 0x0041 #define PORT_PIT_COUNTER2 0x0042 #define PORT_PIT_MODE 0x0043 #define PORT_PS2_DATA 0x0060 #define PORT_PS2_CTRLB 0x0061 #define PORT_PS2_STATUS 0x0064 #define PORT_CMOS_INDEX 0x0070 #define PORT_CMOS_DATA 0x0071 #define PORT_DIAG 0x0080 #define PORT_DMA_PAGE_2 0x0081 #define PORT_A20 0x0092 #define PORT_PIC2_CMD 0x00a0 #define PORT_PIC2_DATA 0x00a1 #define PORT_SMI_CMD 0x00b2 #define PORT_SMI_STATUS 0x00b3 #define PORT_DMA2_MASK_REG 0x00d4 #define PORT_DMA2_MODE_REG 0x00d6 #define PORT_DMA2_MASTER_CLEAR 0x00da #define PORT_MATH_CLEAR 0x00f0 #define PORT_ATA2_CMD_BASE 0x0170 #define PORT_ATA1_CMD_BASE 0x01f0 #define PORT_LPT2 0x0278 #define PORT_SERIAL4 0x02e8 #define PORT_SERIAL2 0x02f8 #define PORT_ATA2_CTRL_BASE 0x0374 #define PORT_LPT1 0x0378 #define PORT_SERIAL3 0x03e8 #define PORT_ATA1_CTRL_BASE 0x03f4 #define PORT_FD_BASE 0x03f0 #define PORT_FD_DOR 0x03f2 #define PORT_FD_STATUS 0x03f4 #define PORT_FD_DATA 0x03f5 #define PORT_HD_DATA 0x03f6 #define PORT_FD_DIR 0x03f7 #define PORT_SERIAL1 0x03f8 #define PORT_PCI_CMD 0x0cf8 #define PORT_PCI_REBOOT 0x0cf9 #define PORT_PCI_DATA 0x0cfc #define PORT_BIOS_DEBUG 0x0402 #define PORT_QEMU_CFG_CTL 0x0510 #define PORT_QEMU_CFG_DATA 0x0511 #if CONFIG_GET_ACPI_PM_BASE_FROM_RTC != 0 #ifndef __ASSEMBLY__ #include "types.h" u16 acpi_pm_base(void); #define PORT_ACPI_PM_BASE acpi_pm_base() #endif /* __ASSEMBLY__ */ #else /* CONFIG_GET_ACPI_PM_BASE_FROM_RTC != 0 */ #define PORT_ACPI_PM_BASE 0xb000 #endif /* CONFIG_GET_ACPI_PM_BASE_FROM_RTC != 0 */ #define PORT_SMB_BASE 0xb100 #define PORT_BIOS_APM 0x8900 // Serial port offsets #define SEROFF_DATA 0 #define SEROFF_DLL 0 #define SEROFF_IER 1 #define SEROFF_DLH 1 #define SEROFF_IIR 2 #define SEROFF_LCR 3 #define SEROFF_LSR 5 #define SEROFF_MSR 6 // PORT_A20 bitdefs #define A20_ENABLE_BIT 0x02 // PORT_CMOS_INDEX nmi disable bit #define NMI_DISABLE_BIT 0x80 #ifndef __ASSEMBLY__ #include "types.h" // u8 static inline void outb(u8 value, u16 port) { __asm__ __volatile__("outb %b0, %w1" : : "a"(value), "Nd"(port)); } static inline void outw(u16 value, u16 port) { __asm__ __volatile__("outw %w0, %w1" : : "a"(value), "Nd"(port)); } static inline void outl(u32 value, u16 port) { __asm__ __volatile__("outl %0, %w1" : : "a"(value), "Nd"(port)); } static inline u8 inb(u16 port) { u8 value; __asm__ __volatile__("inb %w1, %b0" : "=a"(value) : "Nd"(port)); return value; } static inline u16 inw(u16 port) { u16 value; __asm__ __volatile__("inw %w1, %w0" : "=a"(value) : "Nd"(port)); return value; } static inline u32 inl(u16 port) { u32 value; __asm__ __volatile__("inl %w1, %0" : "=a"(value) : "Nd"(port)); return value; } static inline void insb(u16 port, u8 *data, u32 count) { asm volatile("rep insb (%%dx), %%es:(%%edi)" : "+c"(count), "+D"(data) : "d"(port) : "memory"); } static inline void insw(u16 port, u16 *data, u32 count) { asm volatile("rep insw (%%dx), %%es:(%%edi)" : "+c"(count), "+D"(data) : "d"(port) : "memory"); } static inline void insl(u16 port, u32 *data, u32 count) { asm volatile("rep insl (%%dx), %%es:(%%edi)" : "+c"(count), "+D"(data) : "d"(port) : "memory"); } // XXX - outs not limited to es segment static inline void outsb(u16 port, u8 *data, u32 count) { asm volatile("rep outsb %%es:(%%esi), (%%dx)" : "+c"(count), "+S"(data) : "d"(port) : "memory"); } static inline void outsw(u16 port, u16 *data, u32 count) { asm volatile("rep outsw %%es:(%%esi), (%%dx)" : "+c"(count), "+S"(data) : "d"(port) : "memory"); } static inline void outsl(u16 port, u32 *data, u32 count) { asm volatile("rep outsl %%es:(%%esi), (%%dx)" : "+c"(count), "+S"(data) : "d"(port) : "memory"); } #endif // !__ASSEMBLY__ #endif // ioport.h tinyvisor/bios/src/pciinit.c0000644006644000001440000006433212174763154016434 0ustar yuichi_xyusers// Initialize PCI devices (on emulators) // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2006 Fabrice Bellard // // This file may be distributed under the terms of the GNU LGPLv3 license. /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include "util.h" // dprintf #include "pci.h" // pci_config_readl #include "pci_ids.h" // PCI_VENDOR_ID_INTEL #include "pci_regs.h" // PCI_COMMAND #include "ioport.h" // PORT_ATA1_CMD_BASE #include "config.h" // CONFIG_* #include "memmap.h" // add_e820 #include "paravirt.h" // RamSize #include "dev-q35.h" // Q35_HOST_BRIDGE_PCIEXBAR_ADDR #include "list.h" // struct hlist_node #include "config.h" /* PM Timer ticks per second (HZ) */ #define PM_TIMER_FREQUENCY 3579545 #define PCI_DEVICE_MEM_MIN 0x1000 #define PCI_BRIDGE_IO_MIN 0x1000 #define PCI_BRIDGE_MEM_MIN 0x100000 enum pci_region_type { PCI_REGION_TYPE_IO, PCI_REGION_TYPE_MEM, PCI_REGION_TYPE_PREFMEM, PCI_REGION_TYPE_COUNT, }; static const char *region_type_name[] = { [ PCI_REGION_TYPE_IO ] = "io", [ PCI_REGION_TYPE_MEM ] = "mem", [ PCI_REGION_TYPE_PREFMEM ] = "prefmem", }; u64 pcimem_start = BUILD_PCIMEM_START; u64 pcimem_end = BUILD_PCIMEM_END; u64 pcimem64_start = BUILD_PCIMEM64_START; u64 pcimem64_end = BUILD_PCIMEM64_END; struct pci_region_entry { struct pci_device *dev; int bar; u64 size; u64 align; int is64; enum pci_region_type type; struct hlist_node node; }; struct pci_region { /* pci region assignments */ u64 base; struct hlist_head list; }; struct pci_bus { struct pci_region r[PCI_REGION_TYPE_COUNT]; struct pci_device *bus_dev; }; static u32 pci_bar(struct pci_device *pci, int region_num) { if (region_num != PCI_ROM_SLOT) { return PCI_BASE_ADDRESS_0 + region_num * 4; } #define PCI_HEADER_TYPE_MULTI_FUNCTION 0x80 u8 type = pci->header_type & ~PCI_HEADER_TYPE_MULTI_FUNCTION; return type == PCI_HEADER_TYPE_BRIDGE ? PCI_ROM_ADDRESS1 : PCI_ROM_ADDRESS; } static void pci_set_io_region_addr(struct pci_device *pci, int bar, u64 addr, int is64) { u32 ofs = pci_bar(pci, bar); pci_config_writel(pci->bdf, ofs, addr); if (is64) pci_config_writel(pci->bdf, ofs + 4, addr >> 32); } /**************************************************************** * Misc. device init ****************************************************************/ /* host irqs corresponding to PCI irqs A-D */ const u8 pci_irqs[4] = { 10, 10, 11, 11 }; static int dummy_pci_slot_get_irq(struct pci_device *pci, int pin) { dprintf(1, "pci_slot_get_irq called with unknown routing\n"); return 0xff; /* PCI defined "unknown" or "no connection" for x86 */ } static int (*pci_slot_get_irq)(struct pci_device *pci, int pin) = dummy_pci_slot_get_irq; // Return the global irq number corresponding to a host bus device irq pin. static int piix_pci_slot_get_irq(struct pci_device *pci, int pin) { int slot_addend = 0; while (pci->parent != NULL) { slot_addend += pci_bdf_to_dev(pci->bdf); pci = pci->parent; } slot_addend += pci_bdf_to_dev(pci->bdf) - 1; return pci_irqs[(pin - 1 + slot_addend) & 3]; } static int mch_pci_slot_get_irq(struct pci_device *pci, int pin) { int irq, slot, pin_addend = 0; while (pci->parent != NULL) { pin_addend += pci_bdf_to_dev(pci->bdf); pci = pci->parent; } slot = pci_bdf_to_dev(pci->bdf); switch (slot) { /* Slots 0-24 rotate slot:pin mapping similar to piix above, but with a different starting index - see q35-acpi-dsdt.dsl */ case 0 ... 24: irq = pci_irqs[(pin - 1 + pin_addend + slot) & 3]; break; /* Slots 25-31 all use LNKA mapping (or LNKE, but A:D = E:H) */ case 25 ... 31: irq = pci_irqs[(pin - 1 + pin_addend) & 3]; break; } return irq; } /* PIIX3/PIIX4 PCI to ISA bridge */ static void piix_isa_bridge_setup(struct pci_device *pci, void *arg) { int i, irq; u8 elcr[2]; elcr[0] = 0x00; elcr[1] = 0x00; for (i = 0; i < 4; i++) { irq = pci_irqs[i]; /* set to trigger level */ elcr[irq >> 3] |= (1 << (irq & 7)); /* activate irq remapping in PIIX */ pci_config_writeb(pci->bdf, 0x60 + i, irq); } outb(elcr[0], 0x4d0); outb(elcr[1], 0x4d1); dprintf(1, "PIIX3/PIIX4 init: elcr=%02x %02x\n", elcr[0], elcr[1]); } /* ICH9 LPC PCI to ISA bridge */ /* PCI_VENDOR_ID_INTEL && PCI_DEVICE_ID_INTEL_ICH9_LPC */ void mch_isa_bridge_setup(struct pci_device *dev, void *arg) { u16 bdf = dev->bdf; int i, irq; u8 elcr[2]; elcr[0] = 0x00; elcr[1] = 0x00; for (i = 0; i < 4; i++) { irq = pci_irqs[i]; /* set to trigger level */ elcr[irq >> 3] |= (1 << (irq & 7)); /* activate irq remapping in LPC */ /* PIRQ[A-D] routing */ pci_config_writeb(bdf, ICH9_LPC_PIRQA_ROUT + i, irq); /* PIRQ[E-H] routing */ pci_config_writeb(bdf, ICH9_LPC_PIRQE_ROUT + i, irq); } outb(elcr[0], ICH9_LPC_PORT_ELCR1); outb(elcr[1], ICH9_LPC_PORT_ELCR2); dprintf(1, "Q35 LPC init: elcr=%02x %02x\n", elcr[0], elcr[1]); /* pm io base */ pci_config_writel(bdf, ICH9_LPC_PMBASE, PORT_ACPI_PM_BASE | ICH9_LPC_PMBASE_RTE); /* acpi enable, SCI: IRQ9 000b = irq9*/ pci_config_writeb(bdf, ICH9_LPC_ACPI_CTRL, ICH9_LPC_ACPI_CTRL_ACPI_EN); pmtimer_setup(PORT_ACPI_PM_BASE + 0x08, PM_TIMER_FREQUENCY / 1000); } static void storage_ide_setup(struct pci_device *pci, void *arg) { /* IDE: we map it as in ISA mode */ pci_set_io_region_addr(pci, 0, PORT_ATA1_CMD_BASE, 0); pci_set_io_region_addr(pci, 1, PORT_ATA1_CTRL_BASE, 0); pci_set_io_region_addr(pci, 2, PORT_ATA2_CMD_BASE, 0); pci_set_io_region_addr(pci, 3, PORT_ATA2_CTRL_BASE, 0); } /* PIIX3/PIIX4 IDE */ static void piix_ide_setup(struct pci_device *pci, void *arg) { u16 bdf = pci->bdf; pci_config_writew(bdf, 0x40, 0x8000); // enable IDE0 pci_config_writew(bdf, 0x42, 0x8000); // enable IDE1 } static void pic_ibm_setup(struct pci_device *pci, void *arg) { /* PIC, IBM, MPIC & MPIC2 */ pci_set_io_region_addr(pci, 0, 0x80800000 + 0x00040000, 0); } static void apple_macio_setup(struct pci_device *pci, void *arg) { /* macio bridge */ pci_set_io_region_addr(pci, 0, 0x80800000, 0); } /* PIIX4 Power Management device (for ACPI) */ static void piix4_pm_setup(struct pci_device *pci, void *arg) { u16 bdf = pci->bdf; // acpi sci is hardwired to 9 pci_config_writeb(bdf, PCI_INTERRUPT_LINE, 9); pci_config_writel(bdf, 0x40, PORT_ACPI_PM_BASE | 1); pci_config_writeb(bdf, 0x80, 0x01); /* enable PM io space */ pci_config_writel(bdf, 0x90, PORT_SMB_BASE | 1); pci_config_writeb(bdf, 0xd2, 0x09); /* enable SMBus io space */ pmtimer_setup(PORT_ACPI_PM_BASE + 0x08, PM_TIMER_FREQUENCY / 1000); } /* ICH9 SMBUS */ /* PCI_VENDOR_ID_INTEL && PCI_DEVICE_ID_INTEL_ICH9_SMBUS */ void ich9_smbus_setup(struct pci_device *dev, void *arg) { u16 bdf = dev->bdf; /* map smbus into io space */ pci_config_writel(bdf, ICH9_SMB_SMB_BASE, PORT_SMB_BASE | PCI_BASE_ADDRESS_SPACE_IO); /* enable SMBus */ pci_config_writeb(bdf, ICH9_SMB_HOSTC, ICH9_SMB_HOSTC_HST_EN); } static const struct pci_device_id pci_device_tbl[] = { /* PIIX3/PIIX4 PCI to ISA bridge */ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82371SB_0, piix_isa_bridge_setup), PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82371AB_0, piix_isa_bridge_setup), PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH9_LPC, mch_isa_bridge_setup), /* STORAGE IDE */ PCI_DEVICE_CLASS(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82371SB_1, PCI_CLASS_STORAGE_IDE, piix_ide_setup), PCI_DEVICE_CLASS(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82371AB, PCI_CLASS_STORAGE_IDE, piix_ide_setup), PCI_DEVICE_CLASS(PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_STORAGE_IDE, storage_ide_setup), /* PIC, IBM, MIPC & MPIC2 */ PCI_DEVICE_CLASS(PCI_VENDOR_ID_IBM, 0x0046, PCI_CLASS_SYSTEM_PIC, pic_ibm_setup), PCI_DEVICE_CLASS(PCI_VENDOR_ID_IBM, 0xFFFF, PCI_CLASS_SYSTEM_PIC, pic_ibm_setup), /* PIIX4 Power Management device (for ACPI) */ PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82371AB_3, piix4_pm_setup), PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH9_SMBUS, ich9_smbus_setup), /* 0xff00 */ PCI_DEVICE_CLASS(PCI_VENDOR_ID_APPLE, 0x0017, 0xff00, apple_macio_setup), PCI_DEVICE_CLASS(PCI_VENDOR_ID_APPLE, 0x0022, 0xff00, apple_macio_setup), PCI_DEVICE_END, }; static void pci_bios_init_device(struct pci_device *pci) { u16 bdf = pci->bdf; dprintf(1, "PCI: init bdf=%02x:%02x.%x id=%04x:%04x\n" , pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf), pci_bdf_to_fn(bdf) , pci->vendor, pci->device); /* map the interrupt */ int pin = pci_config_readb(bdf, PCI_INTERRUPT_PIN); if (pin != 0) pci_config_writeb(bdf, PCI_INTERRUPT_LINE, pci_slot_get_irq(pci, pin)); pci_init_device(pci_device_tbl, pci, NULL); /* enable memory mappings */ pci_config_maskw(bdf, PCI_COMMAND, 0, PCI_COMMAND_IO | PCI_COMMAND_MEMORY | PCI_COMMAND_SERR); } static void pci_bios_init_devices(void) { struct pci_device *pci; foreachpci(pci) { pci_bios_init_device(pci); } } static void pci_enable_default_vga(void) { struct pci_device *pci; foreachpci(pci) { if (is_pci_vga(pci)) { dprintf(1, "PCI: Using %02x:%02x.%x for primary VGA\n", pci_bdf_to_bus(pci->bdf), pci_bdf_to_dev(pci->bdf), pci_bdf_to_fn(pci->bdf)); return; } } pci = pci_find_class(PCI_CLASS_DISPLAY_VGA); if (!pci) { dprintf(1, "PCI: No VGA devices found\n"); return; } dprintf(1, "PCI: Enabling %02x:%02x.%x for primary VGA\n", pci_bdf_to_bus(pci->bdf), pci_bdf_to_dev(pci->bdf), pci_bdf_to_fn(pci->bdf)); pci_config_maskw(pci->bdf, PCI_COMMAND, 0, PCI_COMMAND_IO | PCI_COMMAND_MEMORY); while (pci->parent) { pci = pci->parent; dprintf(1, "PCI: Setting VGA enable on bridge %02x:%02x.%x\n", pci_bdf_to_bus(pci->bdf), pci_bdf_to_dev(pci->bdf), pci_bdf_to_fn(pci->bdf)); pci_config_maskw(pci->bdf, PCI_BRIDGE_CONTROL, 0, PCI_BRIDGE_CTL_VGA); pci_config_maskw(pci->bdf, PCI_COMMAND, 0, PCI_COMMAND_IO | PCI_COMMAND_MEMORY); } } /**************************************************************** * Platform device initialization ****************************************************************/ void i440fx_mem_addr_setup(struct pci_device *dev, void *arg) { if (RamSize <= 0x80000000) pcimem_start = 0x80000000; else if (RamSize <= 0xc0000000) pcimem_start = 0xc0000000; pci_slot_get_irq = piix_pci_slot_get_irq; } void mch_mem_addr_setup(struct pci_device *dev, void *arg) { u64 addr = Q35_HOST_BRIDGE_PCIEXBAR_ADDR; u32 size = Q35_HOST_BRIDGE_PCIEXBAR_SIZE; /* setup mmconfig */ u16 bdf = dev->bdf; u32 upper = addr >> 32; u32 lower = (addr & 0xffffffff) | Q35_HOST_BRIDGE_PCIEXBAREN; pci_config_writel(bdf, Q35_HOST_BRIDGE_PCIEXBAR, 0); pci_config_writel(bdf, Q35_HOST_BRIDGE_PCIEXBAR + 4, upper); pci_config_writel(bdf, Q35_HOST_BRIDGE_PCIEXBAR, lower); add_e820(addr, size, E820_RESERVED); /* setup pci i/o window (above mmconfig) */ pcimem_start = addr + size; pci_slot_get_irq = mch_pci_slot_get_irq; } static const struct pci_device_id pci_platform_tbl[] = { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82441, i440fx_mem_addr_setup), PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_Q35_MCH, mch_mem_addr_setup), PCI_DEVICE_END }; static void pci_bios_init_platform(void) { struct pci_device *pci; foreachpci(pci) { pci_init_device(pci_platform_tbl, pci, NULL); } } /**************************************************************** * Bus initialization ****************************************************************/ static void pci_bios_init_bus_rec(int bus, u8 *pci_bus) { int bdf; u16 class; dprintf(1, "PCI: %s bus = 0x%x\n", __func__, bus); /* prevent accidental access to unintended devices */ foreachbdf(bdf, bus) { class = pci_config_readw(bdf, PCI_CLASS_DEVICE); if (class == PCI_CLASS_BRIDGE_PCI) { pci_config_writeb(bdf, PCI_SECONDARY_BUS, 255); pci_config_writeb(bdf, PCI_SUBORDINATE_BUS, 0); } } foreachbdf(bdf, bus) { class = pci_config_readw(bdf, PCI_CLASS_DEVICE); if (class != PCI_CLASS_BRIDGE_PCI) { continue; } dprintf(1, "PCI: %s bdf = 0x%x\n", __func__, bdf); u8 pribus = pci_config_readb(bdf, PCI_PRIMARY_BUS); if (pribus != bus) { dprintf(1, "PCI: primary bus = 0x%x -> 0x%x\n", pribus, bus); pci_config_writeb(bdf, PCI_PRIMARY_BUS, bus); } else { dprintf(1, "PCI: primary bus = 0x%x\n", pribus); } u8 secbus = pci_config_readb(bdf, PCI_SECONDARY_BUS); (*pci_bus)++; if (*pci_bus != secbus) { dprintf(1, "PCI: secondary bus = 0x%x -> 0x%x\n", secbus, *pci_bus); secbus = *pci_bus; pci_config_writeb(bdf, PCI_SECONDARY_BUS, secbus); } else { dprintf(1, "PCI: secondary bus = 0x%x\n", secbus); } /* set to max for access to all subordinate buses. later set it to accurate value */ u8 subbus = pci_config_readb(bdf, PCI_SUBORDINATE_BUS); pci_config_writeb(bdf, PCI_SUBORDINATE_BUS, 255); pci_bios_init_bus_rec(secbus, pci_bus); if (subbus != *pci_bus) { dprintf(1, "PCI: subordinate bus = 0x%x -> 0x%x\n", subbus, *pci_bus); subbus = *pci_bus; } else { dprintf(1, "PCI: subordinate bus = 0x%x\n", subbus); } pci_config_writeb(bdf, PCI_SUBORDINATE_BUS, subbus); } } static void pci_bios_init_bus(void) { u8 pci_bus = 0; pci_bios_init_bus_rec(0 /* host bus */, &pci_bus); } /**************************************************************** * Bus sizing ****************************************************************/ static void pci_bios_get_bar(struct pci_device *pci, int bar, int *ptype, u64 *psize, int *pis64) { u32 ofs = pci_bar(pci, bar); u16 bdf = pci->bdf; u32 old = pci_config_readl(bdf, ofs); int is64 = 0, type = PCI_REGION_TYPE_MEM; u64 mask; if (bar == PCI_ROM_SLOT) { mask = PCI_ROM_ADDRESS_MASK; pci_config_writel(bdf, ofs, mask); } else { if (old & PCI_BASE_ADDRESS_SPACE_IO) { mask = PCI_BASE_ADDRESS_IO_MASK; type = PCI_REGION_TYPE_IO; } else { mask = PCI_BASE_ADDRESS_MEM_MASK; if (old & PCI_BASE_ADDRESS_MEM_PREFETCH) type = PCI_REGION_TYPE_PREFMEM; is64 = ((old & PCI_BASE_ADDRESS_MEM_TYPE_MASK) == PCI_BASE_ADDRESS_MEM_TYPE_64); } pci_config_writel(bdf, ofs, ~0); } u64 val = pci_config_readl(bdf, ofs); pci_config_writel(bdf, ofs, old); if (is64) { u32 hold = pci_config_readl(bdf, ofs + 4); pci_config_writel(bdf, ofs + 4, ~0); u32 high = pci_config_readl(bdf, ofs + 4); pci_config_writel(bdf, ofs + 4, hold); val |= ((u64)high << 32); mask |= ((u64)0xffffffff << 32); *psize = (~(val & mask)) + 1; } else { *psize = ((~(val & mask)) + 1) & 0xffffffff; } *ptype = type; *pis64 = is64; } static int pci_bios_bridge_region_is64(struct pci_region *r, struct pci_device *pci, int type) { if (type != PCI_REGION_TYPE_PREFMEM) return 0; u32 pmem = pci_config_readl(pci->bdf, PCI_PREF_MEMORY_BASE); if (!pmem) { pci_config_writel(pci->bdf, PCI_PREF_MEMORY_BASE, 0xfff0fff0); pmem = pci_config_readl(pci->bdf, PCI_PREF_MEMORY_BASE); pci_config_writel(pci->bdf, PCI_PREF_MEMORY_BASE, 0x0); } if ((pmem & PCI_PREF_RANGE_TYPE_MASK) != PCI_PREF_RANGE_TYPE_64) return 0; struct pci_region_entry *entry; hlist_for_each_entry(entry, &r->list, node) { if (!entry->is64) return 0; } return 1; } static u64 pci_region_align(struct pci_region *r) { struct pci_region_entry *entry; hlist_for_each_entry(entry, &r->list, node) { // The first entry in the sorted list has the largest alignment return entry->align; } return 1; } static u64 pci_region_sum(struct pci_region *r) { u64 sum = 0; struct pci_region_entry *entry; hlist_for_each_entry(entry, &r->list, node) { sum += entry->size; } return sum; } static void pci_region_migrate_64bit_entries(struct pci_region *from, struct pci_region *to) { struct hlist_node *n, **last = &to->list.first; struct pci_region_entry *entry; hlist_for_each_entry_safe(entry, n, &from->list, node) { if (!entry->is64) continue; // Move from source list to destination list. hlist_del(&entry->node); hlist_add(&entry->node, last); } } static struct pci_region_entry * pci_region_create_entry(struct pci_bus *bus, struct pci_device *dev, int bar, u64 size, u64 align, int type, int is64) { struct pci_region_entry *entry = malloc_tmp(sizeof(*entry)); if (!entry) { warn_noalloc(); return NULL; } memset(entry, 0, sizeof(*entry)); entry->dev = dev; entry->bar = bar; entry->size = size; entry->align = align; entry->is64 = is64; entry->type = type; // Insert into list in sorted order. struct hlist_node **pprev; struct pci_region_entry *pos; hlist_for_each_entry_pprev(pos, pprev, &bus->r[type].list, node) { if (pos->align < align || (pos->align == align && pos->size < size)) break; } hlist_add(&entry->node, pprev); return entry; } static int pci_bios_check_devices(struct pci_bus *busses) { dprintf(1, "PCI: check devices\n"); // Calculate resources needed for regular (non-bus) devices. struct pci_device *pci; foreachpci(pci) { if (pci->class == PCI_CLASS_BRIDGE_PCI) busses[pci->secondary_bus].bus_dev = pci; struct pci_bus *bus = &busses[pci_bdf_to_bus(pci->bdf)]; int i; for (i = 0; i < PCI_NUM_REGIONS; i++) { if ((pci->class == PCI_CLASS_BRIDGE_PCI) && (i >= PCI_BRIDGE_NUM_REGIONS && i < PCI_ROM_SLOT)) continue; int type, is64; u64 size; pci_bios_get_bar(pci, i, &type, &size, &is64); if (size == 0) continue; if (type != PCI_REGION_TYPE_IO && size < PCI_DEVICE_MEM_MIN) size = PCI_DEVICE_MEM_MIN; struct pci_region_entry *entry = pci_region_create_entry( bus, pci, i, size, size, type, is64); if (!entry) return -1; if (is64) i++; } } // Propagate required bus resources to parent busses. int secondary_bus; for (secondary_bus=MaxPCIBus; secondary_bus>0; secondary_bus--) { struct pci_bus *s = &busses[secondary_bus]; if (!s->bus_dev) continue; struct pci_bus *parent = &busses[pci_bdf_to_bus(s->bus_dev->bdf)]; int type; for (type = 0; type < PCI_REGION_TYPE_COUNT; type++) { u64 align = (type == PCI_REGION_TYPE_IO) ? PCI_BRIDGE_IO_MIN : PCI_BRIDGE_MEM_MIN; if (pci_region_align(&s->r[type]) > align) align = pci_region_align(&s->r[type]); u64 sum = pci_region_sum(&s->r[type]); u64 size = ALIGN(sum, align); int is64 = pci_bios_bridge_region_is64(&s->r[type], s->bus_dev, type); // entry->bar is -1 if the entry represents a bridge region struct pci_region_entry *entry = pci_region_create_entry( parent, s->bus_dev, -1, size, align, type, is64); if (!entry) return -1; dprintf(1, "PCI: secondary bus %d size %08llx type %s\n", entry->dev->secondary_bus, size, region_type_name[entry->type]); } } return 0; } /**************************************************************** * BAR assignment ****************************************************************/ // Setup region bases (given the regions' size and alignment) static int pci_bios_init_root_regions(struct pci_bus *bus) { bus->r[PCI_REGION_TYPE_IO].base = 0xc000; struct pci_region *r_end = &bus->r[PCI_REGION_TYPE_PREFMEM]; struct pci_region *r_start = &bus->r[PCI_REGION_TYPE_MEM]; if (pci_region_align(r_start) < pci_region_align(r_end)) { // Swap regions to improve alignment. r_end = r_start; r_start = &bus->r[PCI_REGION_TYPE_PREFMEM]; } u64 sum = pci_region_sum(r_end); u64 align = pci_region_align(r_end); r_end->base = ALIGN_DOWN((pcimem_end - sum), align); sum = pci_region_sum(r_start); align = pci_region_align(r_start); r_start->base = ALIGN_DOWN((r_end->base - sum), align); if ((r_start->base < pcimem_start) || (r_start->base > pcimem_end)) // Memory range requested is larger than available. return -1; return 0; } #define PCI_IO_SHIFT 8 #define PCI_MEMORY_SHIFT 16 #define PCI_PREF_MEMORY_SHIFT 16 static void pci_region_map_one_entry(struct pci_region_entry *entry, u64 addr) { u16 bdf = entry->dev->bdf; if (entry->bar >= 0) { dprintf(1, "PCI: map device bdf=%02x:%02x.%x" " bar %d, addr %08llx, size %08llx [%s]\n", pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf), pci_bdf_to_fn(bdf), entry->bar, addr, entry->size, region_type_name[entry->type]); pci_set_io_region_addr(entry->dev, entry->bar, addr, entry->is64); return; } u64 limit = addr + entry->size - 1; if (entry->type == PCI_REGION_TYPE_IO) { pci_config_writeb(bdf, PCI_IO_BASE, addr >> PCI_IO_SHIFT); pci_config_writew(bdf, PCI_IO_BASE_UPPER16, 0); pci_config_writeb(bdf, PCI_IO_LIMIT, limit >> PCI_IO_SHIFT); pci_config_writew(bdf, PCI_IO_LIMIT_UPPER16, 0); } if (entry->type == PCI_REGION_TYPE_MEM) { pci_config_writew(bdf, PCI_MEMORY_BASE, addr >> PCI_MEMORY_SHIFT); pci_config_writew(bdf, PCI_MEMORY_LIMIT, limit >> PCI_MEMORY_SHIFT); } if (entry->type == PCI_REGION_TYPE_PREFMEM) { pci_config_writew(bdf, PCI_PREF_MEMORY_BASE, addr >> PCI_PREF_MEMORY_SHIFT); pci_config_writew(bdf, PCI_PREF_MEMORY_LIMIT, limit >> PCI_PREF_MEMORY_SHIFT); pci_config_writel(bdf, PCI_PREF_BASE_UPPER32, addr >> 32); pci_config_writel(bdf, PCI_PREF_LIMIT_UPPER32, limit >> 32); } } static void pci_region_map_entries(struct pci_bus *busses, struct pci_region *r) { struct hlist_node *n; struct pci_region_entry *entry; hlist_for_each_entry_safe(entry, n, &r->list, node) { u64 addr = r->base; r->base += entry->size; if (entry->bar == -1) // Update bus base address if entry is a bridge region busses[entry->dev->secondary_bus].r[entry->type].base = addr; pci_region_map_one_entry(entry, addr); hlist_del(&entry->node); free(entry); } } static void pci_bios_map_devices(struct pci_bus *busses) { if (pci_bios_init_root_regions(busses)) { struct pci_region r64_mem, r64_pref; r64_mem.list.first = NULL; r64_pref.list.first = NULL; pci_region_migrate_64bit_entries(&busses[0].r[PCI_REGION_TYPE_MEM], &r64_mem); pci_region_migrate_64bit_entries(&busses[0].r[PCI_REGION_TYPE_PREFMEM], &r64_pref); if (pci_bios_init_root_regions(busses)) panic("PCI: out of 32bit address space\n"); u64 sum_mem = pci_region_sum(&r64_mem); u64 sum_pref = pci_region_sum(&r64_pref); u64 align_mem = pci_region_align(&r64_mem); u64 align_pref = pci_region_align(&r64_pref); r64_mem.base = ALIGN(0x100000000LL + RamSizeOver4G, align_mem); r64_pref.base = ALIGN(r64_mem.base + sum_mem, align_pref); pcimem64_start = r64_mem.base; pcimem64_end = r64_pref.base + sum_pref; pci_region_map_entries(busses, &r64_mem); pci_region_map_entries(busses, &r64_pref); } else { // no bars mapped high -> drop 64bit window (see dsdt) pcimem64_start = 0; } // Map regions on each device. int bus; for (bus = 0; bus<=MaxPCIBus; bus++) { int type; for (type = 0; type < PCI_REGION_TYPE_COUNT; type++) pci_region_map_entries(busses, &busses[bus].r[type]); } } /**************************************************************** * Main setup code ****************************************************************/ void pci_setup(void) { if (!CONFIG_QEMU) return; if (CONFIG_NO_PCI_SETUP) { pci_probe_devices(); return; } dprintf(3, "pci setup\n"); dprintf(1, "=== PCI bus & bridge init ===\n"); if (pci_probe_host() != 0) { return; } pci_bios_init_bus(); dprintf(1, "=== PCI device probing ===\n"); pci_probe_devices(); pcimem_start = RamSize; pci_bios_init_platform(); dprintf(1, "=== PCI new allocation pass #1 ===\n"); struct pci_bus *busses = malloc_tmp(sizeof(*busses) * (MaxPCIBus + 1)); if (!busses) { warn_noalloc(); return; } memset(busses, 0, sizeof(*busses) * (MaxPCIBus + 1)); if (pci_bios_check_devices(busses)) return; dprintf(1, "=== PCI new allocation pass #2 ===\n"); pci_bios_map_devices(busses); pci_bios_init_devices(); free(busses); pci_enable_default_vga(); } tinyvisor/bios/src/system.c0000644006644000001440000002225612172661303016307 0ustar yuichi_xyusers// Handler for int 0x15 "system" calls // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // memcpy_far #include "biosvar.h" // BIOS_CONFIG_TABLE #include "ioport.h" // inb #include "memmap.h" // E820_RAM #include "pic.h" // eoi_pic2 #include "bregs.h" // struct bregs // Use PS2 System Control port A to set A20 enable static inline u8 set_a20(u8 cond) { // get current setting first u8 newval, oldval = inb(PORT_A20); if (cond) newval = oldval | A20_ENABLE_BIT; else newval = oldval & ~A20_ENABLE_BIT; outb(newval, PORT_A20); return (oldval & A20_ENABLE_BIT) != 0; } static void handle_152400(struct bregs *regs) { set_a20(0); set_code_success(regs); } static void handle_152401(struct bregs *regs) { set_a20(1); set_code_success(regs); } static void handle_152402(struct bregs *regs) { regs->al = (inb(PORT_A20) & A20_ENABLE_BIT) != 0; set_code_success(regs); } static void handle_152403(struct bregs *regs) { regs->bx = 3; set_code_success(regs); } static void handle_1524XX(struct bregs *regs) { set_code_unimplemented(regs, RET_EUNSUPPORTED); } static void handle_1524(struct bregs *regs) { switch (regs->al) { case 0x00: handle_152400(regs); break; case 0x01: handle_152401(regs); break; case 0x02: handle_152402(regs); break; case 0x03: handle_152403(regs); break; default: handle_1524XX(regs); break; } } // removable media eject static void handle_1552(struct bregs *regs) { set_code_success(regs); } static void handle_1587(struct bregs *regs) { // +++ should probably have descriptor checks // +++ should have exception handlers u8 prev_a20_enable = set_a20(1); // enable A20 line // 128K max of transfer on 386+ ??? // source == destination ??? // ES:SI points to descriptor table // offset use initially comments // ============================================== // 00..07 Unused zeros Null descriptor // 08..0f GDT zeros filled in by BIOS // 10..17 source ssssssss source of data // 18..1f dest dddddddd destination of data // 20..27 CS zeros filled in by BIOS // 28..2f SS zeros filled in by BIOS // check for access rights of source & dest here // Initialize GDT descriptor u32 si = regs->si; u64 *gdt_far = (void*)si; u16 gdt_seg = regs->es; u32 loc = (u32)MAKE_FLATPTR(gdt_seg, gdt_far); SET_FARVAR(gdt_seg, gdt_far[1], GDT_DATA | GDT_LIMIT((6*sizeof(u64))-1) | GDT_BASE(loc)); // Initialize CS descriptor SET_FARVAR(gdt_seg, gdt_far[4], GDT_CODE | GDT_LIMIT(BUILD_BIOS_SIZE-1) | GDT_BASE(BUILD_BIOS_ADDR)); // Initialize SS descriptor loc = (u32)MAKE_FLATPTR(GET_SEG(SS), 0); SET_FARVAR(gdt_seg, gdt_far[5], GDT_DATA | GDT_LIMIT(0x0ffff) | GDT_BASE(loc)); u16 count = regs->cx; asm volatile( // Load new descriptor tables " lgdtw %%es:(1<<3)(%%si)\n" " lidtw %%cs:pmode_IDT_info\n" // Enable protected mode " movl %%cr0, %%eax\n" " orl $" __stringify(CR0_PE) ", %%eax\n" " movl %%eax, %%cr0\n" // far jump to flush CPU queue after transition to protected mode " ljmpw $(4<<3), $1f\n" // GDT points to valid descriptor table, now load DS, ES "1:movw $(2<<3), %%ax\n" // 2nd descriptor in table, TI=GDT, RPL=00 " movw %%ax, %%ds\n" " movw $(3<<3), %%ax\n" // 3rd descriptor in table, TI=GDT, RPL=00 " movw %%ax, %%es\n" // move CX words from DS:SI to ES:DI " xorw %%si, %%si\n" " xorw %%di, %%di\n" " rep movsw\n" // Restore DS and ES segment limits to 0xffff " movw $(5<<3), %%ax\n" // 5th descriptor in table (SS) " movw %%ax, %%ds\n" " movw %%ax, %%es\n" // Disable protected mode " movl %%cr0, %%eax\n" " andl $~" __stringify(CR0_PE) ", %%eax\n" " movl %%eax, %%cr0\n" // far jump to flush CPU queue after transition to real mode " ljmpw $" __stringify(SEG_BIOS) ", $2f\n" // restore IDT to normal real-mode defaults "2:lidtw %%cs:rmode_IDT_info\n" // Restore %ds (from %ss) " movw %%ss, %%ax\n" " movw %%ax, %%ds\n" : "+c"(count), "+S"(si), "+m" (__segment_ES) : : "eax", "di", "cc"); set_a20(prev_a20_enable); set_code_success(regs); } // Get the amount of extended memory (above 1M) static void handle_1588(struct bregs *regs) { u32 rs = GET_GLOBAL(LegacyRamSize); // According to Ralf Brown's interrupt the limit should be 15M, // but real machines mostly return max. 63M. if (rs > 64*1024*1024) regs->ax = 63 * 1024; else regs->ax = (rs - 1*1024*1024) / 1024; set_success(regs); } // Switch to protected mode static void handle_1589(struct bregs *regs) { set_a20(1); set_pics(regs->bl, regs->bh); u64 *gdt_far = (void*)(regs->si + 0); u16 gdt_seg = regs->es; SET_FARVAR(gdt_seg, gdt_far[7], GDT_CODE | GDT_LIMIT(BUILD_BIOS_SIZE-1) | GDT_BASE(BUILD_BIOS_ADDR)); regs->ds = 3<<3; // 3rd gdt descriptor is %ds regs->es = 4<<3; // 4th gdt descriptor is %es regs->code.seg = 6<<3; // 6th gdt descriptor is %cs set_code_success(regs); asm volatile( // Load new descriptor tables " lgdtw %%es:(1<<3)(%%si)\n" " lidtw %%es:(2<<3)(%%si)\n" // Enable protected mode " movl %%cr0, %%eax\n" " orl $" __stringify(CR0_PE) ", %%eax\n" " movl %%eax, %%cr0\n" // far jump to flush CPU queue after transition to protected mode " ljmpw $(7<<3), $1f\n" // GDT points to valid descriptor table, now load SS "1:movw $(5<<3), %%ax\n" " movw %%ax, %%ds\n" " movw %%ax, %%ss\n" : : "S"(gdt_far), "m" (__segment_ES) : "eax", "cc"); } // Device busy interrupt. Called by Int 16h when no key available static void handle_1590(struct bregs *regs) { } // Interrupt complete. Called by Int 16h when key becomes available static void handle_1591(struct bregs *regs) { } // keyboard intercept static void handle_154f(struct bregs *regs) { set_invalid_silent(regs); } static void handle_15c0(struct bregs *regs) { regs->es = SEG_BIOS; regs->bx = (u32)&BIOS_CONFIG_TABLE; set_code_success(regs); } static void handle_15c1(struct bregs *regs) { regs->es = get_ebda_seg(); set_success(regs); } static void handle_15e801(struct bregs *regs) { // my real system sets ax and bx to 0 // this is confirmed by Ralph Brown list // but syslinux v1.48 is known to behave // strangely if ax is set to 0 // regs.u.r16.ax = 0; // regs.u.r16.bx = 0; u32 rs = GET_GLOBAL(LegacyRamSize); // Get the amount of extended memory (above 1M) if (rs > 16*1024*1024) { // limit to 15M regs->cx = 15*1024; // Get the amount of extended memory above 16M in 64k blocks regs->dx = (rs - 16*1024*1024) / (64*1024); } else { regs->cx = (rs - 1*1024*1024) / 1024; regs->dx = 0; } // Set configured memory equal to extended memory regs->ax = regs->cx; regs->bx = regs->dx; set_success(regs); } static void handle_15e820(struct bregs *regs) { int count = GET_GLOBAL(e820_count); if (regs->edx != 0x534D4150 || regs->bx >= count || regs->ecx < sizeof(e820_list[0])) { set_code_invalid(regs, RET_EUNSUPPORTED); return; } memcpy_far(regs->es, (void*)(regs->di+0) , get_global_seg(), &e820_list[regs->bx] , sizeof(e820_list[0])); if (regs->bx == count-1) regs->ebx = 0; else regs->ebx++; regs->eax = 0x534D4150; regs->ecx = sizeof(e820_list[0]); set_success(regs); } static void handle_15e8XX(struct bregs *regs) { set_code_unimplemented(regs, RET_EUNSUPPORTED); } static void handle_15e8(struct bregs *regs) { switch (regs->al) { case 0x01: handle_15e801(regs); break; case 0x20: handle_15e820(regs); break; default: handle_15e8XX(regs); break; } } static void handle_15XX(struct bregs *regs) { set_code_unimplemented(regs, RET_EUNSUPPORTED); } // INT 15h System Services Entry Point void VISIBLE16 handle_15(struct bregs *regs) { debug_enter(regs, DEBUG_HDL_15); switch (regs->ah) { case 0x24: handle_1524(regs); break; case 0x4f: handle_154f(regs); break; case 0x52: handle_1552(regs); break; case 0x53: handle_1553(regs); break; case 0x5f: handle_155f(regs); break; case 0x83: handle_1583(regs); break; case 0x86: handle_1586(regs); break; case 0x87: handle_1587(regs); break; case 0x88: handle_1588(regs); break; case 0x89: handle_1589(regs); break; case 0x90: handle_1590(regs); break; case 0x91: handle_1591(regs); break; case 0xc0: handle_15c0(regs); break; case 0xc1: handle_15c1(regs); break; case 0xc2: handle_15c2(regs); break; case 0xe8: handle_15e8(regs); break; default: handle_15XX(regs); break; } } tinyvisor/bios/src/ssdt-proc.dsl0000644006644000001440000000324712172661303017240 0ustar yuichi_xyusers/* This file is the basis for the ssdt table generated in src/acpi.c. * It defines the contents of the per-cpu Processor() object. At * runtime, a dynamically generated SSDT will contain one copy of this * AML snippet for every possible cpu in the system. The objects will * be placed in the \_SB_ namespace. * * In addition to the aml code generated from this file, the * src/acpi.c file creates a NTFY method with an entry for each cpu: * Method(NTFY, 2) { * If (LEqual(Arg0, 0x00)) { Notify(CP00, Arg1) } * If (LEqual(Arg0, 0x01)) { Notify(CP01, Arg1) } * ... * } * and a CPON array with the list of active and inactive cpus: * Name(CPON, Package() { One, One, ..., Zero, Zero, ... }) */ ACPI_EXTRACT_ALL_CODE ssdp_proc_aml DefinitionBlock ("ssdt-proc.aml", "SSDT", 0x01, "BXPC", "BXSSDT", 0x1) { ACPI_EXTRACT_PROCESSOR_START ssdt_proc_start ACPI_EXTRACT_PROCESSOR_END ssdt_proc_end ACPI_EXTRACT_PROCESSOR_STRING ssdt_proc_name Processor(CPAA, 0xAA, 0x0000b010, 0x06) { ACPI_EXTRACT_NAME_BYTE_CONST ssdt_proc_id Name(ID, 0xAA) /* * The src/acpi.c code requires the above ACP_EXTRACT tags so that it can update * CPAA and 0xAA with the appropriate CPU id (see * SD_OFFSET_CPUHEX/CPUID1/CPUID2). Don't change the above without * also updating the C code. */ Name(_HID, "ACPI0007") External(CPMA, MethodObj) External(CPST, MethodObj) External(CPEJ, MethodObj) Method(_MAT, 0) { Return (CPMA(ID)) } Method(_STA, 0) { Return (CPST(ID)) } Method(_EJ0, 1, NotSerialized) { CPEJ(ID, Arg0) } } } tinyvisor/bios/src/biostables.c0000644006644000001440000000565112172661303017112 0ustar yuichi_xyusers// Coreboot interface support. // // Copyright (C) 2008,2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "config.h" // CONFIG_* #include "util.h" // dprintf #include "pci.h" // struct pir_header #include "acpi.h" // struct rsdp_descriptor #include "mptable.h" // MPTABLE_SIGNATURE #include "smbios.h" // struct smbios_entry_point static void copy_pir(void *pos) { struct pir_header *p = pos; if (p->signature != PIR_SIGNATURE) return; if (PirAddr) return; if (p->size < sizeof(*p)) return; if (checksum(pos, p->size) != 0) return; void *newpos = malloc_fseg(p->size); if (!newpos) { warn_noalloc(); return; } dprintf(1, "Copying PIR from %p to %p\n", pos, newpos); memcpy(newpos, pos, p->size); PirAddr = newpos; } static void copy_mptable(void *pos) { struct mptable_floating_s *p = pos; if (p->signature != MPTABLE_SIGNATURE) return; if (!p->physaddr) return; if (checksum(pos, sizeof(*p)) != 0) return; u32 length = p->length * 16; u16 mpclength = ((struct mptable_config_s *)p->physaddr)->length; struct mptable_floating_s *newpos = malloc_fseg(length + mpclength); if (!newpos) { warn_noalloc(); return; } dprintf(1, "Copying MPTABLE from %p/%x to %p\n", pos, p->physaddr, newpos); memcpy(newpos, pos, length); newpos->physaddr = (u32)newpos + length; newpos->checksum -= checksum(newpos, sizeof(*newpos)); memcpy((void*)newpos + length, (void*)p->physaddr, mpclength); } static void copy_acpi_rsdp(void *pos) { if (RsdpAddr) return; struct rsdp_descriptor *p = pos; if (p->signature != RSDP_SIGNATURE) return; u32 length = 20; if (checksum(pos, length) != 0) return; if (p->revision > 1) { length = p->length; if (checksum(pos, length) != 0) return; } void *newpos = malloc_fseg(length); if (!newpos) { warn_noalloc(); return; } dprintf(1, "Copying ACPI RSDP from %p to %p\n", pos, newpos); memcpy(newpos, pos, length); RsdpAddr = newpos; } void copy_smbios(void *pos) { if (SMBiosAddr) return; struct smbios_entry_point *p = pos; if (memcmp(p->anchor_string, "_SM_", 4)) return; if (checksum(pos, 0x10) != 0) return; if (memcmp(p->intermediate_anchor_string, "_DMI_", 5)) return; if (checksum(pos+0x10, p->length-0x10) != 0) return; struct smbios_entry_point *newpos = malloc_fseg(p->length); if (!newpos) { warn_noalloc(); return; } dprintf(1, "Copying SMBIOS entry point from %p to %p\n", pos, newpos); memcpy(newpos, pos, p->length); SMBiosAddr = newpos; } void copy_table(void *pos) { copy_pir(pos); copy_mptable(pos); copy_acpi_rsdp(pos); copy_smbios(pos); } tinyvisor/bios/src/kbd.c0000644006644000001440000004201612172661303015517 0ustar yuichi_xyusers// 16bit code to handle keyboard requests. // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "biosvar.h" // GET_BDA #include "util.h" // debug_enter #include "config.h" // CONFIG_* #include "bregs.h" // struct bregs #include "ps2port.h" // ps2_kbd_command #include "usb-hid.h" // usb_kbd_command // Bit definitions for BDA kbd_flag[012] #define KF0_RSHIFT (1<<0) #define KF0_LSHIFT (1<<1) #define KF0_CTRLACTIVE (1<<2) #define KF0_ALTACTIVE (1<<3) #define KF0_SCROLLACTIVE (1<<4) #define KF0_NUMACTIVE (1<<5) #define KF0_CAPSACTIVE (1<<6) #define KF1_LCTRL (1<<0) #define KF1_LALT (1<<1) #define KF1_PAUSEACTIVE (1<<3) #define KF1_SCROLL (1<<4) #define KF1_NUM (1<<5) #define KF1_CAPS (1<<6) #define KF2_LAST_E1 (1<<0) #define KF2_LAST_E0 (1<<1) #define KF2_RCTRL (1<<2) #define KF2_RALT (1<<3) #define KF2_101KBD (1<<4) void kbd_init(void) { dprintf(3, "init keyboard\n"); u16 x = offsetof(struct bios_data_area_s, kbd_buf); SET_BDA(kbd_flag2, KF2_101KBD); SET_BDA(kbd_buf_head, x); SET_BDA(kbd_buf_tail, x); SET_BDA(kbd_buf_start_offset, x); SET_BDA(kbd_buf_end_offset , x + FIELD_SIZEOF(struct bios_data_area_s, kbd_buf)); } static u8 enqueue_key(u8 scan_code, u8 ascii_code) { u16 buffer_start = GET_BDA(kbd_buf_start_offset); u16 buffer_end = GET_BDA(kbd_buf_end_offset); u16 buffer_head = GET_BDA(kbd_buf_head); u16 buffer_tail = GET_BDA(kbd_buf_tail); u16 temp_tail = buffer_tail; buffer_tail += 2; if (buffer_tail >= buffer_end) buffer_tail = buffer_start; if (buffer_tail == buffer_head) return 0; SET_FARVAR(SEG_BDA, *(u8*)(temp_tail+0), ascii_code); SET_FARVAR(SEG_BDA, *(u8*)(temp_tail+1), scan_code); SET_BDA(kbd_buf_tail, buffer_tail); return 1; } static void dequeue_key(struct bregs *regs, int incr, int extended) { yield(); u16 buffer_head; u16 buffer_tail; for (;;) { buffer_head = GET_BDA(kbd_buf_head); buffer_tail = GET_BDA(kbd_buf_tail); if (buffer_head != buffer_tail) break; if (!incr) { regs->flags |= F_ZF; return; } yield_toirq(); } u8 ascii_code = GET_FARVAR(SEG_BDA, *(u8*)(buffer_head+0)); u8 scan_code = GET_FARVAR(SEG_BDA, *(u8*)(buffer_head+1)); if ((ascii_code == 0xF0 && scan_code != 0) || (ascii_code == 0xE0 && !extended)) ascii_code = 0; regs->ax = (scan_code << 8) | ascii_code; if (!incr) { regs->flags &= ~F_ZF; return; } u16 buffer_start = GET_BDA(kbd_buf_start_offset); u16 buffer_end = GET_BDA(kbd_buf_end_offset); buffer_head += 2; if (buffer_head >= buffer_end) buffer_head = buffer_start; SET_BDA(kbd_buf_head, buffer_head); } static int kbd_command(int command, u8 *param) { if (usb_kbd_active()) return stack_hop(command, (u32)param, usb_kbd_command); return stack_hop(command, (u32)param, ps2_kbd_command); } // read keyboard input static void handle_1600(struct bregs *regs) { dequeue_key(regs, 1, 0); } // check keyboard status static void handle_1601(struct bregs *regs) { dequeue_key(regs, 0, 0); } // get shift flag status static void handle_1602(struct bregs *regs) { yield(); regs->al = GET_BDA(kbd_flag0); } // store key-stroke into buffer static void handle_1605(struct bregs *regs) { regs->al = !enqueue_key(regs->ch, regs->cl); } // GET KEYBOARD FUNCTIONALITY static void handle_1609(struct bregs *regs) { // bit Bochs Description // 7 0 reserved // 6 0 INT 16/AH=20h-22h supported (122-key keyboard support) // 5 1 INT 16/AH=10h-12h supported (enhanced keyboard support) // 4 1 INT 16/AH=0Ah supported // 3 0 INT 16/AX=0306h supported // 2 0 INT 16/AX=0305h supported // 1 0 INT 16/AX=0304h supported // 0 0 INT 16/AX=0300h supported // regs->al = 0x30; } // GET KEYBOARD ID static void noinline handle_160a(struct bregs *regs) { u8 param[2]; int ret = kbd_command(ATKBD_CMD_GETID, param); if (ret) { regs->bx = 0; return; } regs->bx = (param[1] << 8) | param[0]; } // read MF-II keyboard input static void handle_1610(struct bregs *regs) { dequeue_key(regs, 1, 1); } // check MF-II keyboard status static void handle_1611(struct bregs *regs) { dequeue_key(regs, 0, 1); } // get extended keyboard status static void handle_1612(struct bregs *regs) { yield(); regs->al = GET_BDA(kbd_flag0); regs->ah = ((GET_BDA(kbd_flag1) & ~(KF2_RCTRL|KF2_RALT)) | (GET_BDA(kbd_flag2) & (KF2_RCTRL|KF2_RALT))); //BX_DEBUG_INT16("int16: func 12 sending %04x\n",AX); } static void handle_166f(struct bregs *regs) { if (regs->al == 0x08) // unsupported, aka normal keyboard regs->ah = 2; } // keyboard capability check called by DOS 5.0+ keyb static void handle_1692(struct bregs *regs) { // function int16 ah=0x10-0x12 supported regs->ah = 0x80; } // 122 keys capability check called by DOS 5.0+ keyb static void handle_16a2(struct bregs *regs) { // don't change AH : function int16 ah=0x20-0x22 NOT supported } static void handle_16XX(struct bregs *regs) { warn_unimplemented(regs); } static void noinline set_leds(void) { u8 shift_flags = (GET_BDA(kbd_flag0) >> 4) & 0x07; u8 kbd_led = GET_BDA(kbd_led); u8 led_flags = kbd_led & 0x07; if (shift_flags == led_flags) return; int ret = kbd_command(ATKBD_CMD_SETLEDS, &shift_flags); if (ret) // Error return; kbd_led = (kbd_led & ~0x07) | shift_flags; SET_BDA(kbd_led, kbd_led); } // INT 16h Keyboard Service Entry Point void VISIBLE16 handle_16(struct bregs *regs) { debug_enter(regs, DEBUG_HDL_16); if (! CONFIG_KEYBOARD) return; // XXX - set_leds should be called from irq handler set_leds(); switch (regs->ah) { case 0x00: handle_1600(regs); break; case 0x01: handle_1601(regs); break; case 0x02: handle_1602(regs); break; case 0x05: handle_1605(regs); break; case 0x09: handle_1609(regs); break; case 0x0a: handle_160a(regs); break; case 0x10: handle_1610(regs); break; case 0x11: handle_1611(regs); break; case 0x12: handle_1612(regs); break; case 0x92: handle_1692(regs); break; case 0xa2: handle_16a2(regs); break; case 0x6f: handle_166f(regs); break; default: handle_16XX(regs); break; } } #define none 0 #define MNUM KF0_NUMACTIVE #define MCAP KF0_CAPSACTIVE static struct scaninfo { u16 normal; u16 shift; u16 control; u16 alt; u8 lock_flags; } scan_to_scanascii[] VAR16 = { { none, none, none, none, none }, { 0x011b, 0x011b, 0x011b, 0x0100, none }, /* escape */ { 0x0231, 0x0221, none, 0x7800, none }, /* 1! */ { 0x0332, 0x0340, 0x0300, 0x7900, none }, /* 2@ */ { 0x0433, 0x0423, none, 0x7a00, none }, /* 3# */ { 0x0534, 0x0524, none, 0x7b00, none }, /* 4$ */ { 0x0635, 0x0625, none, 0x7c00, none }, /* 5% */ { 0x0736, 0x075e, 0x071e, 0x7d00, none }, /* 6^ */ { 0x0837, 0x0826, none, 0x7e00, none }, /* 7& */ { 0x0938, 0x092a, none, 0x7f00, none }, /* 8* */ { 0x0a39, 0x0a28, none, 0x8000, none }, /* 9( */ { 0x0b30, 0x0b29, none, 0x8100, none }, /* 0) */ { 0x0c2d, 0x0c5f, 0x0c1f, 0x8200, none }, /* -_ */ { 0x0d3d, 0x0d2b, none, 0x8300, none }, /* =+ */ { 0x0e08, 0x0e08, 0x0e7f, none, none }, /* backspace */ { 0x0f09, 0x0f00, none, none, none }, /* tab */ { 0x1071, 0x1051, 0x1011, 0x1000, MCAP }, /* Q */ { 0x1177, 0x1157, 0x1117, 0x1100, MCAP }, /* W */ { 0x1265, 0x1245, 0x1205, 0x1200, MCAP }, /* E */ { 0x1372, 0x1352, 0x1312, 0x1300, MCAP }, /* R */ { 0x1474, 0x1454, 0x1414, 0x1400, MCAP }, /* T */ { 0x1579, 0x1559, 0x1519, 0x1500, MCAP }, /* Y */ { 0x1675, 0x1655, 0x1615, 0x1600, MCAP }, /* U */ { 0x1769, 0x1749, 0x1709, 0x1700, MCAP }, /* I */ { 0x186f, 0x184f, 0x180f, 0x1800, MCAP }, /* O */ { 0x1970, 0x1950, 0x1910, 0x1900, MCAP }, /* P */ { 0x1a5b, 0x1a7b, 0x1a1b, none, none }, /* [{ */ { 0x1b5d, 0x1b7d, 0x1b1d, none, none }, /* ]} */ { 0x1c0d, 0x1c0d, 0x1c0a, none, none }, /* Enter */ { none, none, none, none, none }, /* L Ctrl */ { 0x1e61, 0x1e41, 0x1e01, 0x1e00, MCAP }, /* A */ { 0x1f73, 0x1f53, 0x1f13, 0x1f00, MCAP }, /* S */ { 0x2064, 0x2044, 0x2004, 0x2000, MCAP }, /* D */ { 0x2166, 0x2146, 0x2106, 0x2100, MCAP }, /* F */ { 0x2267, 0x2247, 0x2207, 0x2200, MCAP }, /* G */ { 0x2368, 0x2348, 0x2308, 0x2300, MCAP }, /* H */ { 0x246a, 0x244a, 0x240a, 0x2400, MCAP }, /* J */ { 0x256b, 0x254b, 0x250b, 0x2500, MCAP }, /* K */ { 0x266c, 0x264c, 0x260c, 0x2600, MCAP }, /* L */ { 0x273b, 0x273a, none, none, none }, /* ;: */ { 0x2827, 0x2822, none, none, none }, /* '" */ { 0x2960, 0x297e, none, none, none }, /* `~ */ { none, none, none, none, none }, /* L shift */ { 0x2b5c, 0x2b7c, 0x2b1c, none, none }, /* |\ */ { 0x2c7a, 0x2c5a, 0x2c1a, 0x2c00, MCAP }, /* Z */ { 0x2d78, 0x2d58, 0x2d18, 0x2d00, MCAP }, /* X */ { 0x2e63, 0x2e43, 0x2e03, 0x2e00, MCAP }, /* C */ { 0x2f76, 0x2f56, 0x2f16, 0x2f00, MCAP }, /* V */ { 0x3062, 0x3042, 0x3002, 0x3000, MCAP }, /* B */ { 0x316e, 0x314e, 0x310e, 0x3100, MCAP }, /* N */ { 0x326d, 0x324d, 0x320d, 0x3200, MCAP }, /* M */ { 0x332c, 0x333c, none, none, none }, /* ,< */ { 0x342e, 0x343e, none, none, none }, /* .> */ { 0x352f, 0x353f, none, none, none }, /* /? */ { none, none, none, none, none }, /* R Shift */ { 0x372a, 0x372a, none, none, none }, /* * */ { none, none, none, none, none }, /* L Alt */ { 0x3920, 0x3920, 0x3920, 0x3920, none }, /* space */ { none, none, none, none, none }, /* caps lock */ { 0x3b00, 0x5400, 0x5e00, 0x6800, none }, /* F1 */ { 0x3c00, 0x5500, 0x5f00, 0x6900, none }, /* F2 */ { 0x3d00, 0x5600, 0x6000, 0x6a00, none }, /* F3 */ { 0x3e00, 0x5700, 0x6100, 0x6b00, none }, /* F4 */ { 0x3f00, 0x5800, 0x6200, 0x6c00, none }, /* F5 */ { 0x4000, 0x5900, 0x6300, 0x6d00, none }, /* F6 */ { 0x4100, 0x5a00, 0x6400, 0x6e00, none }, /* F7 */ { 0x4200, 0x5b00, 0x6500, 0x6f00, none }, /* F8 */ { 0x4300, 0x5c00, 0x6600, 0x7000, none }, /* F9 */ { 0x4400, 0x5d00, 0x6700, 0x7100, none }, /* F10 */ { none, none, none, none, none }, /* Num Lock */ { none, none, none, none, none }, /* Scroll Lock */ { 0x4700, 0x4737, 0x7700, none, MNUM }, /* 7 Home */ { 0x4800, 0x4838, none, none, MNUM }, /* 8 UP */ { 0x4900, 0x4939, 0x8400, none, MNUM }, /* 9 PgUp */ { 0x4a2d, 0x4a2d, none, none, none }, /* - */ { 0x4b00, 0x4b34, 0x7300, none, MNUM }, /* 4 Left */ { 0x4c00, 0x4c35, none, none, MNUM }, /* 5 */ { 0x4d00, 0x4d36, 0x7400, none, MNUM }, /* 6 Right */ { 0x4e2b, 0x4e2b, none, none, none }, /* + */ { 0x4f00, 0x4f31, 0x7500, none, MNUM }, /* 1 End */ { 0x5000, 0x5032, none, none, MNUM }, /* 2 Down */ { 0x5100, 0x5133, 0x7600, none, MNUM }, /* 3 PgDn */ { 0x5200, 0x5230, none, none, MNUM }, /* 0 Ins */ { 0x5300, 0x532e, none, none, MNUM }, /* Del */ { none, none, none, none, none }, { none, none, none, none, none }, { 0x565c, 0x567c, none, none, none }, /* \| */ { 0x8500, 0x8700, 0x8900, 0x8b00, none }, /* F11 */ { 0x8600, 0x8800, 0x8a00, 0x8c00, none }, /* F12 */ }; // Handle a ps2 style scancode read from the keyboard. static void __process_key(u8 scancode) { u8 flags0 = GET_BDA(kbd_flag0); u8 flags1 = GET_BDA(kbd_flag1); u8 flags2 = GET_BDA(kbd_flag2); if (flags2 & KF2_LAST_E1) { // Part of "pause" key (sequence is e1 1d 45 e1 9d c5) if ((scancode & ~0x80) == 0x1d) // Second key of sequence return; // Third key of sequence - clear flag. flags2 &= ~KF2_LAST_E1; SET_BDA(kbd_flag2, flags2); if (scancode == 0xc5) { // Final key in sequence. // XXX - do actual pause. } return; } // XXX - PrtScr should cause int 0x05 // XXX - Ctrl+Break should cause int 0x1B // XXX - SysReq should cause int 0x15/0x85 switch (scancode) { case 0x00: dprintf(1, "KBD: int09 handler: AL=0\n"); return; case 0x3a: /* Caps Lock press */ flags0 ^= KF0_CAPSACTIVE; flags1 |= KF1_CAPS; break; case 0xba: /* Caps Lock release */ flags1 &= ~KF1_CAPS; break; case 0x2a: /* L Shift press */ flags0 |= KF0_LSHIFT; break; case 0xaa: /* L Shift release */ flags0 &= ~KF0_LSHIFT; break; case 0x36: /* R Shift press */ flags0 |= KF0_RSHIFT; break; case 0xb6: /* R Shift release */ flags0 &= ~KF0_RSHIFT; break; case 0x1d: /* Ctrl press */ flags0 |= KF0_CTRLACTIVE; if (flags2 & KF2_LAST_E0) flags2 |= KF2_RCTRL; else flags1 |= KF1_LCTRL; break; case 0x9d: /* Ctrl release */ flags0 &= ~KF0_CTRLACTIVE; if (flags2 & KF2_LAST_E0) flags2 &= ~KF2_RCTRL; else flags1 &= ~KF1_LCTRL; break; case 0x38: /* Alt press */ flags0 |= KF0_ALTACTIVE; if (flags2 & KF2_LAST_E0) flags2 |= KF2_RALT; else flags1 |= KF1_LALT; break; case 0xb8: /* Alt release */ flags0 &= ~KF0_ALTACTIVE; if (flags2 & KF2_LAST_E0) flags2 &= ~KF2_RALT; else flags1 &= ~KF1_LALT; break; case 0x45: /* Num Lock press */ flags1 |= KF1_NUM; flags0 ^= KF0_NUMACTIVE; break; case 0xc5: /* Num Lock release */ flags1 &= ~KF1_NUM; break; case 0x46: /* Scroll Lock press */ flags1 |= KF1_SCROLL; flags0 ^= KF0_SCROLLACTIVE; break; case 0xc6: /* Scroll Lock release */ flags1 &= ~KF1_SCROLL; break; case 0xe0: // Extended key flags2 |= KF2_LAST_E0; SET_BDA(kbd_flag2, flags2); return; case 0xe1: // Start of pause key sequence flags2 |= KF2_LAST_E1; break; default: if (scancode & 0x80) // toss key releases break; if (scancode == 0x53 && ((flags0 & (KF0_CTRLACTIVE|KF0_ALTACTIVE)) == (KF0_CTRLACTIVE|KF0_ALTACTIVE))) { // Ctrl+alt+del - reset machine. SET_BDA(soft_reset_flag, 0x1234); reset_vector(); } if (scancode >= ARRAY_SIZE(scan_to_scanascii)) { dprintf(1, "KBD: int09h_handler(): unknown scancode read: 0x%02x!\n" , scancode); return; } u8 asciicode; struct scaninfo *info = &scan_to_scanascii[scancode]; if (flags0 & KF0_ALTACTIVE) { asciicode = GET_GLOBAL(info->alt); scancode = GET_GLOBAL(info->alt) >> 8; } else if (flags0 & KF0_CTRLACTIVE) { asciicode = GET_GLOBAL(info->control); scancode = GET_GLOBAL(info->control) >> 8; } else if (flags2 & KF2_LAST_E0 && scancode >= 0x47 && scancode <= 0x53) { /* extended keys handling */ asciicode = 0xe0; scancode = GET_GLOBAL(info->normal) >> 8; } else if (flags0 & (KF0_RSHIFT|KF0_LSHIFT)) { /* check if lock state should be ignored because a SHIFT * key is pressed */ if (flags0 & GET_GLOBAL(info->lock_flags)) { asciicode = GET_GLOBAL(info->normal); scancode = GET_GLOBAL(info->normal) >> 8; } else { asciicode = GET_GLOBAL(info->shift); scancode = GET_GLOBAL(info->shift) >> 8; } } else { /* check if lock is on */ if (flags0 & GET_GLOBAL(info->lock_flags)) { asciicode = GET_GLOBAL(info->shift); scancode = GET_GLOBAL(info->shift) >> 8; } else { asciicode = GET_GLOBAL(info->normal); scancode = GET_GLOBAL(info->normal) >> 8; } } if (scancode==0 && asciicode==0) dprintf(1, "KBD: scancode & asciicode are zero?\n"); enqueue_key(scancode, asciicode); break; } flags2 &= ~KF2_LAST_E0; SET_BDA(kbd_flag0, flags0); SET_BDA(kbd_flag1, flags1); SET_BDA(kbd_flag2, flags2); } void process_key(u8 key) { if (!CONFIG_KEYBOARD) return; if (CONFIG_KBD_CALL_INT15_4F) { // allow for keyboard intercept struct bregs br; memset(&br, 0, sizeof(br)); br.eax = (0x4f << 8) | key; br.flags = F_IF|F_CF; call16_int(0x15, &br); if (!(br.flags & F_CF)) return; key = br.eax; } __process_key(key); } tinyvisor/bios/src/usb.c0000644006644000001440000003255112172661303015553 0ustar yuichi_xyusers// Main code for handling USB controllers and devices. // // Copyright (C) 2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "pci.h" // foreachpci #include "config.h" // CONFIG_* #include "pci_regs.h" // PCI_CLASS_REVISION #include "pci_ids.h" // PCI_CLASS_SERIAL_USB_UHCI #include "usb-uhci.h" // uhci_setup #include "usb-ohci.h" // ohci_setup #include "usb-ehci.h" // ehci_setup #include "usb-hid.h" // usb_keyboard_setup #include "usb-hub.h" // usb_hub_setup #include "usb-msc.h" // usb_msc_setup #include "usb-uas.h" // usb_uas_setup #include "usb.h" // struct usb_s #include "biosvar.h" // GET_GLOBAL /**************************************************************** * Controller function wrappers ****************************************************************/ // Allocate an async pipe (control or bulk). struct usb_pipe * usb_alloc_pipe(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc) { switch (usbdev->hub->cntl->type) { default: case USB_TYPE_UHCI: return uhci_alloc_pipe(usbdev, epdesc); case USB_TYPE_OHCI: return ohci_alloc_pipe(usbdev, epdesc); case USB_TYPE_EHCI: return ehci_alloc_pipe(usbdev, epdesc); } } // Send a message on a control pipe using the default control descriptor. static int send_control(struct usb_pipe *pipe, int dir, const void *cmd, int cmdsize , void *data, int datasize) { ASSERT32FLAT(); switch (pipe->type) { default: case USB_TYPE_UHCI: return uhci_control(pipe, dir, cmd, cmdsize, data, datasize); case USB_TYPE_OHCI: return ohci_control(pipe, dir, cmd, cmdsize, data, datasize); case USB_TYPE_EHCI: return ehci_control(pipe, dir, cmd, cmdsize, data, datasize); } } int usb_send_bulk(struct usb_pipe *pipe_fl, int dir, void *data, int datasize) { switch (GET_LOWFLAT(pipe_fl->type)) { default: case USB_TYPE_UHCI: return uhci_send_bulk(pipe_fl, dir, data, datasize); case USB_TYPE_OHCI: return ohci_send_bulk(pipe_fl, dir, data, datasize); case USB_TYPE_EHCI: return ehci_send_bulk(pipe_fl, dir, data, datasize); } } int usb_poll_intr(struct usb_pipe *pipe_fl, void *data) { switch (GET_LOWFLAT(pipe_fl->type)) { default: case USB_TYPE_UHCI: return uhci_poll_intr(pipe_fl, data); case USB_TYPE_OHCI: return ohci_poll_intr(pipe_fl, data); case USB_TYPE_EHCI: return ehci_poll_intr(pipe_fl, data); } } /**************************************************************** * Helper functions ****************************************************************/ // Send a message to the default control pipe of a device. int send_default_control(struct usb_pipe *pipe, const struct usb_ctrlrequest *req , void *data) { return send_control(pipe, req->bRequestType & USB_DIR_IN , req, sizeof(*req), data, req->wLength); } // Free an allocated control or bulk pipe. void free_pipe(struct usb_pipe *pipe) { ASSERT32FLAT(); if (!pipe) return; // Add to controller's free list. struct usb_s *cntl = pipe->cntl; pipe->freenext = cntl->freelist; cntl->freelist = pipe; } // Check for an available pipe on the freelist. struct usb_pipe * usb_getFreePipe(struct usb_s *cntl, u8 eptype) { struct usb_pipe **pfree = &cntl->freelist; for (;;) { struct usb_pipe *pipe = *pfree; if (!pipe) return NULL; if (pipe->eptype == eptype) { *pfree = pipe->freenext; return pipe; } pfree = &pipe->freenext; } } // Fill "pipe" endpoint info from an endpoint descriptor. void usb_desc2pipe(struct usb_pipe *pipe, struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc) { pipe->cntl = usbdev->hub->cntl; pipe->type = usbdev->hub->cntl->type; pipe->ep = epdesc->bEndpointAddress & USB_ENDPOINT_NUMBER_MASK; pipe->devaddr = usbdev->devaddr; pipe->speed = usbdev->speed; pipe->maxpacket = epdesc->wMaxPacketSize; pipe->eptype = epdesc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; } // Find the exponential period of the requested interrupt end point. int usb_getFrameExp(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc) { int period = epdesc->bInterval; if (usbdev->speed != USB_HIGHSPEED) return (period <= 0) ? 0 : __fls(period); return (period <= 4) ? 0 : period - 4; } // Find the first endpoing of a given type in an interface description. struct usb_endpoint_descriptor * findEndPointDesc(struct usbdevice_s *usbdev, int type, int dir) { struct usb_endpoint_descriptor *epdesc = (void*)&usbdev->iface[1]; for (;;) { if ((void*)epdesc >= (void*)usbdev->iface + usbdev->imax || epdesc->bDescriptorType == USB_DT_INTERFACE) { return NULL; } if (epdesc->bDescriptorType == USB_DT_ENDPOINT && (epdesc->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == dir && (epdesc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == type) return epdesc; epdesc = (void*)epdesc + epdesc->bLength; } } // Get the first 8 bytes of the device descriptor. static int get_device_info8(struct usb_pipe *pipe, struct usb_device_descriptor *dinfo) { struct usb_ctrlrequest req; req.bRequestType = USB_DIR_IN | USB_TYPE_STANDARD | USB_RECIP_DEVICE; req.bRequest = USB_REQ_GET_DESCRIPTOR; req.wValue = USB_DT_DEVICE<<8; req.wIndex = 0; req.wLength = 8; return send_default_control(pipe, &req, dinfo); } static struct usb_config_descriptor * get_device_config(struct usb_pipe *pipe) { struct usb_config_descriptor cfg; struct usb_ctrlrequest req; req.bRequestType = USB_DIR_IN | USB_TYPE_STANDARD | USB_RECIP_DEVICE; req.bRequest = USB_REQ_GET_DESCRIPTOR; req.wValue = USB_DT_CONFIG<<8; req.wIndex = 0; req.wLength = sizeof(cfg); int ret = send_default_control(pipe, &req, &cfg); if (ret) return NULL; void *config = malloc_tmphigh(cfg.wTotalLength); if (!config) return NULL; req.wLength = cfg.wTotalLength; ret = send_default_control(pipe, &req, config); if (ret) return NULL; //hexdump(config, cfg.wTotalLength); return config; } static int set_configuration(struct usb_pipe *pipe, u16 val) { struct usb_ctrlrequest req; req.bRequestType = USB_DIR_OUT | USB_TYPE_STANDARD | USB_RECIP_DEVICE; req.bRequest = USB_REQ_SET_CONFIGURATION; req.wValue = val; req.wIndex = 0; req.wLength = 0; return send_default_control(pipe, &req, NULL); } /**************************************************************** * Initialization and enumeration ****************************************************************/ // Assign an address to a device in the default state on the given // controller. static int usb_set_address(struct usbdevice_s *usbdev) { ASSERT32FLAT(); struct usb_s *cntl = usbdev->hub->cntl; dprintf(3, "set_address %p\n", cntl); if (cntl->maxaddr >= USB_MAXADDR) return -1; // Create a pipe for the default address. struct usb_endpoint_descriptor epdesc = { .wMaxPacketSize = 8, .bmAttributes = USB_ENDPOINT_XFER_CONTROL, }; usbdev->defpipe = usb_alloc_pipe(usbdev, &epdesc); if (!usbdev->defpipe) return -1; msleep(USB_TIME_RSTRCY); // Send set_address command. struct usb_ctrlrequest req; req.bRequestType = USB_DIR_OUT | USB_TYPE_STANDARD | USB_RECIP_DEVICE; req.bRequest = USB_REQ_SET_ADDRESS; req.wValue = cntl->maxaddr + 1; req.wIndex = 0; req.wLength = 0; int ret = send_default_control(usbdev->defpipe, &req, NULL); free_pipe(usbdev->defpipe); if (ret) return -1; msleep(USB_TIME_SETADDR_RECOVERY); cntl->maxaddr++; usbdev->devaddr = cntl->maxaddr; usbdev->defpipe = usb_alloc_pipe(usbdev, &epdesc); if (!usbdev->defpipe) return -1; return 0; } // Called for every found device - see if a driver is available for // this device and do setup if so. static int configure_usb_device(struct usbdevice_s *usbdev) { ASSERT32FLAT(); dprintf(3, "config_usb: %p\n", usbdev->defpipe); // Set the max packet size for endpoint 0 of this device. struct usb_device_descriptor dinfo; int ret = get_device_info8(usbdev->defpipe, &dinfo); if (ret) return 0; dprintf(3, "device rev=%04x cls=%02x sub=%02x proto=%02x size=%02x\n" , dinfo.bcdUSB, dinfo.bDeviceClass, dinfo.bDeviceSubClass , dinfo.bDeviceProtocol, dinfo.bMaxPacketSize0); if (dinfo.bMaxPacketSize0 < 8 || dinfo.bMaxPacketSize0 > 64) return 0; free_pipe(usbdev->defpipe); struct usb_endpoint_descriptor epdesc = { .wMaxPacketSize = dinfo.bMaxPacketSize0, .bmAttributes = USB_ENDPOINT_XFER_CONTROL, }; usbdev->defpipe = usb_alloc_pipe(usbdev, &epdesc); if (!usbdev->defpipe) return -1; // Get configuration struct usb_config_descriptor *config = get_device_config(usbdev->defpipe); if (!config) return 0; // Determine if a driver exists for this device - only look at the // first interface of the first configuration. struct usb_interface_descriptor *iface = (void*)(&config[1]); if (iface->bInterfaceClass != USB_CLASS_HID && iface->bInterfaceClass != USB_CLASS_MASS_STORAGE && iface->bInterfaceClass != USB_CLASS_HUB) // Not a supported device. goto fail; // Set the configuration. ret = set_configuration(usbdev->defpipe, config->bConfigurationValue); if (ret) goto fail; // Configure driver. usbdev->config = config; usbdev->iface = iface; usbdev->imax = (void*)config + config->wTotalLength - (void*)iface; if (iface->bInterfaceClass == USB_CLASS_HUB) ret = usb_hub_setup(usbdev); else if (iface->bInterfaceClass == USB_CLASS_MASS_STORAGE) { if (iface->bInterfaceProtocol == US_PR_BULK) ret = usb_msc_setup(usbdev); if (iface->bInterfaceProtocol == US_PR_UAS) ret = usb_uas_setup(usbdev); } else ret = usb_hid_setup(usbdev); if (ret) goto fail; free(config); return 1; fail: free(config); return 0; } static void usb_hub_port_setup(void *data) { struct usbdevice_s *usbdev = data; struct usbhub_s *hub = usbdev->hub; u32 port = usbdev->port; // Detect if device present (and possibly start reset) int ret = hub->op->detect(hub, port); if (ret) // No device present goto done; // Reset port and determine device speed mutex_lock(&hub->cntl->resetlock); ret = hub->op->reset(hub, port); if (ret < 0) // Reset failed goto resetfail; usbdev->speed = ret; // Set address of port ret = usb_set_address(usbdev); if (ret) { hub->op->disconnect(hub, port); goto resetfail; } mutex_unlock(&hub->cntl->resetlock); // Configure the device int count = configure_usb_device(usbdev); free_pipe(usbdev->defpipe); if (!count) hub->op->disconnect(hub, port); hub->devcount += count; done: hub->threads--; free(usbdev); return; resetfail: mutex_unlock(&hub->cntl->resetlock); goto done; } void usb_enumerate(struct usbhub_s *hub) { u32 portcount = hub->portcount; hub->threads = portcount; // Launch a thread for every port. int i; for (i=0; ihub = hub; usbdev->port = i; run_thread(usb_hub_port_setup, usbdev); } // Wait for threads to complete. while (hub->threads) yield(); } void usb_setup(void) { ASSERT32FLAT(); if (! CONFIG_USB) return; dprintf(3, "init usb\n"); // Look for USB controllers int count = 0; struct pci_device *pci, *ehcipci = NULL; foreachpci(pci) { if (pci->class != PCI_CLASS_SERIAL_USB) continue; if (!ehcipci || pci->bdf >= ehcipci->bdf) { // Check to see if this device has an ehci controller int found = 0; ehcipci = pci; for (;;) { if (pci_classprog(ehcipci) == PCI_CLASS_SERIAL_USB_EHCI) { // Found an ehci controller. int ret = ehci_setup(ehcipci, count++, pci); if (ret) // Error break; count += found; pci = ehcipci; break; } if (ehcipci->class == PCI_CLASS_SERIAL_USB) found++; ehcipci = container_of( ehcipci->node.next, struct pci_device, node); if (!ehcipci || (pci_bdf_to_busdev(ehcipci->bdf) != pci_bdf_to_busdev(pci->bdf))) // No ehci controller found. break; } } if (pci_classprog(pci) == PCI_CLASS_SERIAL_USB_UHCI) uhci_setup(pci, count++); else if (pci_classprog(pci) == PCI_CLASS_SERIAL_USB_OHCI) ohci_setup(pci, count++); } } tinyvisor/bios/src/boot.c0000644006644000001440000004502612172661303015726 0ustar yuichi_xyusers// Code to load disk image and start system boot. // // Copyright (C) 2008-2010 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "config.h" // CONFIG_* #include "disk.h" // cdrom_boot #include "bregs.h" // struct bregs #include "boot.h" // func defs #include "cmos.h" // inb_cmos #include "paravirt.h" // qemu_cfg_show_boot_menu #include "pci.h" // pci_bdf_to_* #include "usb.h" // struct usbdevice_s #include "csm.h" // csm_bootprio_* #include "list.h" // hlist_node /**************************************************************** * Boot priority ordering ****************************************************************/ static char **Bootorder VARVERIFY32INIT; static int BootorderCount; static void loadBootOrder(void) { if (!CONFIG_BOOTORDER) return; char *f = romfile_loadfile("bootorder", NULL); if (!f) return; int i = 0; BootorderCount = 1; while (f[i]) { if (f[i] == '\n') BootorderCount++; i++; } Bootorder = malloc_tmphigh(BootorderCount*sizeof(char*)); if (!Bootorder) { warn_noalloc(); free(f); BootorderCount = 0; return; } dprintf(3, "boot order:\n"); i = 0; do { Bootorder[i] = f; f = strchr(f, '\n'); if (f) *(f++) = '\0'; nullTrailingSpace(Bootorder[i]); dprintf(3, "%d: %s\n", i+1, Bootorder[i]); i++; } while (f); } // See if 'str' starts with 'glob' - if glob contains an '*' character // it will match any number of characters in str that aren't a '/' or // the next glob character. static char * glob_prefix(const char *glob, const char *str) { for (;;) { if (!*glob && (!*str || *str == '/')) return (char*)str; if (*glob == '*') { if (!*str || *str == '/' || *str == glob[1]) glob++; else str++; continue; } if (*glob != *str) return NULL; glob++; str++; } } // Search the bootorder list for the given glob pattern. static int find_prio(const char *glob) { dprintf(1, "Searching bootorder for: %s\n", glob); int i; for (i = 0; i < BootorderCount; i++) if (glob_prefix(glob, Bootorder[i])) return i+1; return -1; } #define FW_PCI_DOMAIN "/pci@i0cf8" static char * build_pci_path(char *buf, int max, const char *devname, struct pci_device *pci) { // Build the string path of a bdf - for example: /pci@i0cf8/isa@1,2 char *p = buf; if (pci->parent) { p = build_pci_path(p, max, "pci-bridge", pci->parent); } else { if (pci->rootbus) p += snprintf(p, max, "/pci-root@%x", pci->rootbus); p += snprintf(p, buf+max-p, "%s", FW_PCI_DOMAIN); } int dev = pci_bdf_to_dev(pci->bdf), fn = pci_bdf_to_fn(pci->bdf); p += snprintf(p, buf+max-p, "/%s@%x", devname, dev); if (fn) p += snprintf(p, buf+max-p, ",%x", fn); return p; } int bootprio_find_pci_device(struct pci_device *pci) { if (CONFIG_CSM) return csm_bootprio_pci(pci); if (!CONFIG_BOOTORDER) return -1; // Find pci device - for example: /pci@i0cf8/ethernet@5 char desc[256]; build_pci_path(desc, sizeof(desc), "*", pci); return find_prio(desc); } int bootprio_find_scsi_device(struct pci_device *pci, int target, int lun) { if (!CONFIG_BOOTORDER) return -1; if (!pci) // support only pci machine for now return -1; // Find scsi drive - for example: /pci@i0cf8/scsi@5/channel@0/disk@1,0 char desc[256], *p; p = build_pci_path(desc, sizeof(desc), "*", pci); snprintf(p, desc+sizeof(desc)-p, "/*@0/*@%d,%d", target, lun); return find_prio(desc); } int bootprio_find_ata_device(struct pci_device *pci, int chanid, int slave) { if (CONFIG_CSM) return csm_bootprio_ata(pci, chanid, slave); if (!CONFIG_BOOTORDER) return -1; if (!pci) // support only pci machine for now return -1; // Find ata drive - for example: /pci@i0cf8/ide@1,1/drive@1/disk@0 char desc[256], *p; p = build_pci_path(desc, sizeof(desc), "*", pci); snprintf(p, desc+sizeof(desc)-p, "/drive@%x/disk@%x", chanid, slave); return find_prio(desc); } int bootprio_find_fdc_device(struct pci_device *pci, int port, int fdid) { if (CONFIG_CSM) return csm_bootprio_fdc(pci, port, fdid); if (!CONFIG_BOOTORDER) return -1; if (!pci) // support only pci machine for now return -1; // Find floppy - for example: /pci@i0cf8/isa@1/fdc@03f1/floppy@0 char desc[256], *p; p = build_pci_path(desc, sizeof(desc), "isa", pci); snprintf(p, desc+sizeof(desc)-p, "/fdc@%04x/floppy@%x", port, fdid); return find_prio(desc); } int bootprio_find_pci_rom(struct pci_device *pci, int instance) { if (!CONFIG_BOOTORDER) return -1; // Find pci rom - for example: /pci@i0cf8/scsi@3:rom2 char desc[256], *p; p = build_pci_path(desc, sizeof(desc), "*", pci); if (instance) snprintf(p, desc+sizeof(desc)-p, ":rom%d", instance); return find_prio(desc); } int bootprio_find_named_rom(const char *name, int instance) { if (!CONFIG_BOOTORDER) return -1; // Find named rom - for example: /rom@genroms/linuxboot.bin char desc[256], *p; p = desc + snprintf(desc, sizeof(desc), "/rom@%s", name); if (instance) snprintf(p, desc+sizeof(desc)-p, ":rom%d", instance); return find_prio(desc); } static char * build_usb_path(char *buf, int max, struct usbhub_s *hub) { if (!hub->usbdev) // Root hub - nothing to add. return buf; char *p = build_usb_path(buf, max, hub->usbdev->hub); p += snprintf(p, buf+max-p, "/hub@%x", hub->usbdev->port+1); return p; } int bootprio_find_usb(struct usbdevice_s *usbdev, int lun) { if (!CONFIG_BOOTORDER) return -1; // Find usb - for example: /pci@i0cf8/usb@1,2/storage@1/channel@0/disk@0,0 char desc[256], *p; p = build_pci_path(desc, sizeof(desc), "usb", usbdev->hub->cntl->pci); p = build_usb_path(p, desc+sizeof(desc)-p, usbdev->hub); snprintf(p, desc+sizeof(desc)-p, "/storage@%x/*@0/*@0,%d" , usbdev->port+1, lun); int ret = find_prio(desc); if (ret >= 0) return ret; // Try usb-host/redir - for example: /pci@i0cf8/usb@1,2/usb-host@1 snprintf(p, desc+sizeof(desc)-p, "/usb-*@%x", usbdev->port+1); return find_prio(desc); } /**************************************************************** * Boot setup ****************************************************************/ static int BootRetryTime; static int CheckFloppySig = 1; #define DEFAULT_PRIO 9999 static int DefaultFloppyPrio = 101; static int DefaultCDPrio = 102; static int DefaultHDPrio = 103; static int DefaultBEVPrio = 104; void boot_init(void) { if (! CONFIG_BOOT) return; if (CONFIG_QEMU) { // On emulators, get boot order from nvram. if (inb_cmos(CMOS_BIOS_BOOTFLAG1) & 1) CheckFloppySig = 0; u32 bootorder = (inb_cmos(CMOS_BIOS_BOOTFLAG2) | ((inb_cmos(CMOS_BIOS_BOOTFLAG1) & 0xf0) << 4)); DefaultFloppyPrio = DefaultCDPrio = DefaultHDPrio = DefaultBEVPrio = DEFAULT_PRIO; int i; for (i=101; i<104; i++) { u32 val = bootorder & 0x0f; bootorder >>= 4; switch (val) { case 1: DefaultFloppyPrio = i; break; case 2: DefaultHDPrio = i; break; case 3: DefaultCDPrio = i; break; case 4: DefaultBEVPrio = i; break; } } } BootRetryTime = romfile_loadint("etc/boot-fail-wait", 60*1000); loadBootOrder(); } /**************************************************************** * BootList handling ****************************************************************/ struct bootentry_s { int type; union { u32 data; struct segoff_s vector; struct drive_s *drive; }; int priority; const char *description; struct hlist_node node; }; static struct hlist_head BootList VARVERIFY32INIT; #define IPL_TYPE_FLOPPY 0x01 #define IPL_TYPE_HARDDISK 0x02 #define IPL_TYPE_CDROM 0x03 #define IPL_TYPE_CBFS 0x20 #define IPL_TYPE_BEV 0x80 #define IPL_TYPE_BCV 0x81 #define IPL_TYPE_HALT 0xf0 static void bootentry_add(int type, int prio, u32 data, const char *desc) { if (! CONFIG_BOOT) return; struct bootentry_s *be = malloc_tmp(sizeof(*be)); if (!be) { warn_noalloc(); return; } be->type = type; be->priority = prio; be->data = data; be->description = desc ?: "?"; dprintf(3, "Registering bootable: %s (type:%d prio:%d data:%x)\n" , be->description, type, prio, data); // Add entry in sorted order. struct hlist_node **pprev; struct bootentry_s *pos; hlist_for_each_entry_pprev(pos, pprev, &BootList, node) { if (be->priority < pos->priority) break; if (be->priority > pos->priority) continue; if (be->type < pos->type) break; if (be->type > pos->type) continue; if (be->type <= IPL_TYPE_CDROM && (be->drive->type < pos->drive->type || (be->drive->type == pos->drive->type && be->drive->cntl_id < pos->drive->cntl_id))) break; } hlist_add(&be->node, pprev); } // Return the given priority if it's set - defaultprio otherwise. static inline int defPrio(int priority, int defaultprio) { return (priority < 0) ? defaultprio : priority; } // Add a BEV vector for a given pnp compatible option rom. void boot_add_bev(u16 seg, u16 bev, u16 desc, int prio) { bootentry_add(IPL_TYPE_BEV, defPrio(prio, DefaultBEVPrio) , SEGOFF(seg, bev).segoff , desc ? MAKE_FLATPTR(seg, desc) : "Unknown"); DefaultBEVPrio = DEFAULT_PRIO; } // Add a bcv entry for an expansion card harddrive or legacy option rom void boot_add_bcv(u16 seg, u16 ip, u16 desc, int prio) { bootentry_add(IPL_TYPE_BCV, defPrio(prio, DefaultHDPrio) , SEGOFF(seg, ip).segoff , desc ? MAKE_FLATPTR(seg, desc) : "Legacy option rom"); } void boot_add_floppy(struct drive_s *drive_g, const char *desc, int prio) { bootentry_add(IPL_TYPE_FLOPPY, defPrio(prio, DefaultFloppyPrio) , (u32)drive_g, desc); } void boot_add_hd(struct drive_s *drive_g, const char *desc, int prio) { bootentry_add(IPL_TYPE_HARDDISK, defPrio(prio, DefaultHDPrio) , (u32)drive_g, desc); } void boot_add_cd(struct drive_s *drive_g, const char *desc, int prio) { bootentry_add(IPL_TYPE_CDROM, defPrio(prio, DefaultCDPrio) , (u32)drive_g, desc); } // Add a CBFS payload entry void boot_add_cbfs(void *data, const char *desc, int prio) { bootentry_add(IPL_TYPE_CBFS, defPrio(prio, DEFAULT_PRIO), (u32)data, desc); } /**************************************************************** * Boot menu and BCV execution ****************************************************************/ #define DEFAULT_BOOTMENU_WAIT 2500 // Show IPL option menu. void interactive_bootmenu(void) { // XXX - show available drives? if (! CONFIG_BOOTMENU || !romfile_loadint("etc/show-boot-menu", 1)) return; while (get_keystroke(0) >= 0) ; printf("\nPress F12 for boot menu.\n\n"); u32 menutime = romfile_loadint("etc/boot-menu-wait", DEFAULT_BOOTMENU_WAIT); enable_bootsplash(); int scan_code = get_keystroke(menutime); disable_bootsplash(); if (scan_code != 0x86) /* not F12 */ return; while (get_keystroke(0) >= 0) ; printf("Select boot device:\n\n"); wait_threads(); // Show menu items int maxmenu = 0; struct bootentry_s *pos; hlist_for_each_entry(pos, &BootList, node) { char desc[60]; maxmenu++; printf("%d. %s\n", maxmenu , strtcpy(desc, pos->description, ARRAY_SIZE(desc))); } // Get key press for (;;) { scan_code = get_keystroke(1000); if (scan_code >= 1 && scan_code <= maxmenu+1) break; } printf("\n"); if (scan_code == 0x01) // ESC return; // Find entry and make top priority. int choice = scan_code - 1; hlist_for_each_entry(pos, &BootList, node) { if (! --choice) break; } hlist_del(&pos->node); pos->priority = 0; hlist_add_head(&pos->node, &BootList); } // BEV (Boot Execution Vector) list struct bev_s { int type; u32 vector; }; static struct bev_s BEV[20]; static int BEVCount; static int HaveHDBoot, HaveFDBoot; static void add_bev(int type, u32 vector) { if (type == IPL_TYPE_HARDDISK && HaveHDBoot++) return; if (type == IPL_TYPE_FLOPPY && HaveFDBoot++) return; if (BEVCount >= ARRAY_SIZE(BEV)) return; struct bev_s *bev = &BEV[BEVCount++]; bev->type = type; bev->vector = vector; } // Prepare for boot - show menu and run bcvs. void bcv_prepboot(void) { if (! CONFIG_BOOT) return; int haltprio = find_prio("HALT"); if (haltprio >= 0) bootentry_add(IPL_TYPE_HALT, haltprio, 0, "HALT"); // Map drives and populate BEV list struct bootentry_s *pos; hlist_for_each_entry(pos, &BootList, node) { switch (pos->type) { case IPL_TYPE_BCV: call_bcv(pos->vector.seg, pos->vector.offset); add_bev(IPL_TYPE_HARDDISK, 0); break; case IPL_TYPE_FLOPPY: map_floppy_drive(pos->drive); add_bev(IPL_TYPE_FLOPPY, 0); break; case IPL_TYPE_HARDDISK: map_hd_drive(pos->drive); add_bev(IPL_TYPE_HARDDISK, 0); break; case IPL_TYPE_CDROM: map_cd_drive(pos->drive); // NO BREAK default: add_bev(pos->type, pos->data); break; } } // If nothing added a floppy/hd boot - add it manually. add_bev(IPL_TYPE_FLOPPY, 0); add_bev(IPL_TYPE_HARDDISK, 0); } /**************************************************************** * Boot code (int 18/19) ****************************************************************/ // Jump to a bootup entry point. static void call_boot_entry(struct segoff_s bootsegip, u8 bootdrv) { dprintf(1, "Booting from %04x:%04x\n", bootsegip.seg, bootsegip.offset); struct bregs br; memset(&br, 0, sizeof(br)); br.flags = F_IF; br.code = bootsegip; // Set the magic number in ax and the boot drive in dl. br.dl = bootdrv; br.ax = 0xaa55; farcall16(&br); } // Boot from a disk (either floppy or harddrive) static void boot_disk(u8 bootdrv, int checksig) { u16 bootseg = 0x07c0; // Read sector struct bregs br; memset(&br, 0, sizeof(br)); br.flags = F_IF; br.dl = bootdrv; br.es = bootseg; br.ah = 2; br.al = 1; br.cl = 1; call16_int(0x13, &br); if (br.flags & F_CF) { printf("Boot failed: could not read the boot disk\n\n"); return; } if (checksig) { struct mbr_s *mbr = (void*)0; if (GET_FARVAR(bootseg, mbr->signature) != MBR_SIGNATURE) { printf("Boot failed: not a bootable disk\n\n"); return; } } /* Canonicalize bootseg:bootip */ u16 bootip = (bootseg & 0x0fff) << 4; bootseg &= 0xf000; call_boot_entry(SEGOFF(bootseg, bootip), bootdrv); } // Boot from a CD-ROM static void boot_cdrom(struct drive_s *drive_g) { if (! CONFIG_CDROM_BOOT) return; printf("Booting from DVD/CD...\n"); int status = cdrom_boot(drive_g); if (status) { printf("Boot failed: Could not read from CDROM (code %04x)\n", status); return; } u8 bootdrv = CDEmu.emulated_extdrive; u16 bootseg = CDEmu.load_segment; /* Canonicalize bootseg:bootip */ u16 bootip = (bootseg & 0x0fff) << 4; bootseg &= 0xf000; call_boot_entry(SEGOFF(bootseg, bootip), bootdrv); } // Boot from a CBFS payload static void boot_cbfs(struct cbfs_file *file) { if (!CONFIG_COREBOOT_FLASH) return; printf("Booting from CBFS...\n"); cbfs_run_payload(file); } // Boot from a BEV entry on an optionrom. static void boot_rom(u32 vector) { printf("Booting from ROM...\n"); struct segoff_s so; so.segoff = vector; call_boot_entry(so, 0); } // Unable to find bootable device - warn user and eventually retry. static void boot_fail(void) { if (BootRetryTime == (u32)-1) printf("No bootable device.\n"); else printf("No bootable device. Retrying in %d seconds.\n" , BootRetryTime/1000); // Wait for 'BootRetryTime' milliseconds and then reboot. u32 end = calc_future_timer(BootRetryTime); for (;;) { if (BootRetryTime != (u32)-1 && check_timer(end)) break; yield_toirq(); } printf("Rebooting.\n"); struct bregs br; memset(&br, 0, sizeof(br)); br.code = SEGOFF(SEG_BIOS, (u32)reset_vector); farcall16big(&br); } // Determine next boot method and attempt a boot using it. static void do_boot(int seq_nr) { if (! CONFIG_BOOT) panic("Boot support not compiled in.\n"); if (seq_nr >= BEVCount) boot_fail(); // Boot the given BEV type. struct bev_s *ie = &BEV[seq_nr]; switch (ie->type) { case IPL_TYPE_FLOPPY: printf("Booting from Floppy...\n"); boot_disk(0x00, CheckFloppySig); break; case IPL_TYPE_HARDDISK: printf("Booting from Hard Disk...\n"); boot_disk(0x80, 1); break; case IPL_TYPE_CDROM: boot_cdrom((void*)ie->vector); break; case IPL_TYPE_CBFS: boot_cbfs((void*)ie->vector); break; case IPL_TYPE_BEV: boot_rom(ie->vector); break; case IPL_TYPE_HALT: boot_fail(); break; } // Boot failed: invoke the boot recovery function struct bregs br; memset(&br, 0, sizeof(br)); br.flags = F_IF; call16_int(0x18, &br); } int BootSequence VARLOW = -1; // Boot Failure recovery: try the next device. void VISIBLE32FLAT handle_18(void) { debug_serial_preinit(); debug_enter(NULL, DEBUG_HDL_18); int seq = BootSequence + 1; BootSequence = seq; do_boot(seq); } // INT 19h Boot Load Service Entry Point void VISIBLE32FLAT handle_19(void) { debug_serial_preinit(); debug_enter(NULL, DEBUG_HDL_19); BootSequence = 0; do_boot(0); } tinyvisor/bios/src/virtio-blk.h0000644006644000001440000000161112172661303017042 0ustar yuichi_xyusers#ifndef _VIRTIO_BLK_H #define _VIRTIO_BLK_H struct virtio_blk_config { u64 capacity; u32 size_max; u32 seg_max; u16 cylinders; u8 heads; u8 sectors; u32 blk_size; u8 physical_block_exp; u8 alignment_offset; u16 min_io_size; u32 opt_io_size; } __attribute__((packed)); #define VIRTIO_BLK_F_BLK_SIZE 6 /* These two define direction. */ #define VIRTIO_BLK_T_IN 0 #define VIRTIO_BLK_T_OUT 1 /* This is the first element of the read scatter-gather list. */ struct virtio_blk_outhdr { /* VIRTIO_BLK_T* */ u32 type; /* io priority. */ u32 ioprio; /* Sector (ie. 512 byte offset) */ u64 sector; }; #define VIRTIO_BLK_S_OK 0 #define VIRTIO_BLK_S_IOERR 1 #define VIRTIO_BLK_S_UNSUPP 2 struct disk_op_s; int process_virtio_blk_op(struct disk_op_s *op); void virtio_blk_setup(void); #endif /* _VIRTIO_BLK_H */ tinyvisor/bios/src/paravirt.c0000644006644000001440000002211612172661303016606 0ustar yuichi_xyusers// Paravirtualization support. // // Copyright (C) 2013 Kevin O'Connor // Copyright (C) 2009 Red Hat Inc. // // Authors: // Gleb Natapov // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "config.h" // CONFIG_QEMU #include "util.h" // dprintf #include "byteorder.h" // be32_to_cpu #include "ioport.h" // outw #include "paravirt.h" // qemu_cfg_preinit #include "smbios.h" // smbios_setup #include "memmap.h" // add_e820 #include "cmos.h" // CMOS_* #include "acpi.h" // acpi_setup #include "mptable.h" // mptable_setup #include "pci.h" // create_pirtable #include "xen.h" // xen_biostable_setup // Amount of continuous ram under 4Gig u32 RamSize; // Amount of continuous ram >4Gig u64 RamSizeOver4G; // Type of emulator platform. int PlatformRunningOn VARFSEG; /* This CPUID returns the signature 'KVMKVMKVM' in ebx, ecx, and edx. It * should be used to determine that a VM is running under KVM. */ #define KVM_CPUID_SIGNATURE 0x40000000 static void kvm_preinit(void) { if (!CONFIG_QEMU) return; unsigned int eax, ebx, ecx, edx; char signature[13]; cpuid(KVM_CPUID_SIGNATURE, &eax, &ebx, &ecx, &edx); memcpy(signature + 0, &ebx, 4); memcpy(signature + 4, &ecx, 4); memcpy(signature + 8, &edx, 4); signature[12] = 0; if (strcmp(signature, "KVMKVMKVM") == 0) { dprintf(1, "Running on KVM\n"); PlatformRunningOn |= PF_KVM; } } void qemu_preinit(void) { if (!CONFIG_QEMU) return; if (runningOnXen()) { xen_ramsize_preinit(); return; } PlatformRunningOn = PF_QEMU; kvm_preinit(); // On emulators, get memory size from nvram. u32 rs = ((inb_cmos(CMOS_MEM_EXTMEM2_LOW) << 16) | (inb_cmos(CMOS_MEM_EXTMEM2_HIGH) << 24)); if (rs) rs += 16 * 1024 * 1024; else rs = (((inb_cmos(CMOS_MEM_EXTMEM_LOW) << 10) | (inb_cmos(CMOS_MEM_EXTMEM_HIGH) << 18)) + 1 * 1024 * 1024); RamSize = rs; add_e820(0, rs, E820_RAM); // Check for memory over 4Gig u64 high = ((inb_cmos(CMOS_MEM_HIGHMEM_LOW) << 16) | ((u32)inb_cmos(CMOS_MEM_HIGHMEM_MID) << 24) | ((u64)inb_cmos(CMOS_MEM_HIGHMEM_HIGH) << 32)); RamSizeOver4G = high; add_e820(0x100000000ull, high, E820_RAM); /* reserve 256KB BIOS area at the end of 4 GB */ add_e820(0xfffc0000, 256*1024, E820_RESERVED); dprintf(1, "Ram Size=0x%08x (0x%016llx high)\n", RamSize, RamSizeOver4G); } void qemu_platform_setup(void) { if (!CONFIG_QEMU) return; if (runningOnXen()) { pci_probe_devices(); xen_hypercall_setup(); xen_biostable_setup(); return; } // Initialize pci pci_setup(); smm_device_setup(); smm_setup(); // Initialize mtrr and smp mtrr_setup(); smp_setup(); // Create bios tables pirtable_setup(); mptable_setup(); smbios_setup(); acpi_setup(); } /**************************************************************** * QEMU firmware config (fw_cfg) interface ****************************************************************/ // List of QEMU fw_cfg entries. DO NOT ADD MORE. (All new content // should be passed via the fw_cfg "file" interface.) #define QEMU_CFG_SIGNATURE 0x00 #define QEMU_CFG_ID 0x01 #define QEMU_CFG_UUID 0x02 #define QEMU_CFG_NUMA 0x0d #define QEMU_CFG_BOOT_MENU 0x0e #define QEMU_CFG_MAX_CPUS 0x0f #define QEMU_CFG_FILE_DIR 0x19 #define QEMU_CFG_ARCH_LOCAL 0x8000 #define QEMU_CFG_ACPI_TABLES (QEMU_CFG_ARCH_LOCAL + 0) #define QEMU_CFG_SMBIOS_ENTRIES (QEMU_CFG_ARCH_LOCAL + 1) #define QEMU_CFG_IRQ0_OVERRIDE (QEMU_CFG_ARCH_LOCAL + 2) #define QEMU_CFG_E820_TABLE (QEMU_CFG_ARCH_LOCAL + 3) static void qemu_cfg_select(u16 f) { outw(f, PORT_QEMU_CFG_CTL); } static void qemu_cfg_read(void *buf, int len) { insb(PORT_QEMU_CFG_DATA, buf, len); } static void qemu_cfg_skip(int len) { while (len--) inb(PORT_QEMU_CFG_DATA); } static void qemu_cfg_read_entry(void *buf, int e, int len) { qemu_cfg_select(e); qemu_cfg_read(buf, len); } struct qemu_romfile_s { struct romfile_s file; int select, skip; }; static int qemu_cfg_read_file(struct romfile_s *file, void *dst, u32 maxlen) { if (file->size > maxlen) return -1; struct qemu_romfile_s *qfile; qfile = container_of(file, struct qemu_romfile_s, file); qemu_cfg_select(qfile->select); qemu_cfg_skip(qfile->skip); qemu_cfg_read(dst, file->size); return file->size; } static void qemu_romfile_add(char *name, int select, int skip, int size) { struct qemu_romfile_s *qfile = malloc_tmp(sizeof(*qfile)); if (!qfile) { warn_noalloc(); return; } memset(qfile, 0, sizeof(*qfile)); strtcpy(qfile->file.name, name, sizeof(qfile->file.name)); qfile->file.size = size; qfile->select = select; qfile->skip = skip; qfile->file.copy = qemu_cfg_read_file; romfile_add(&qfile->file); } struct e820_reservation { u64 address; u64 length; u32 type; }; #define SMBIOS_FIELD_ENTRY 0 #define SMBIOS_TABLE_ENTRY 1 struct qemu_smbios_header { u16 length; u8 headertype; u8 tabletype; u16 fieldoffset; } PACKED; // Populate romfile entries for legacy fw_cfg ports (that predate the // "file" interface). static void qemu_cfg_legacy(void) { if (!CONFIG_QEMU) return; // Misc config items. qemu_romfile_add("etc/show-boot-menu", QEMU_CFG_BOOT_MENU, 0, 2); qemu_romfile_add("etc/irq0-override", QEMU_CFG_IRQ0_OVERRIDE, 0, 1); qemu_romfile_add("etc/max-cpus", QEMU_CFG_MAX_CPUS, 0, 2); // NUMA data u64 numacount; qemu_cfg_read_entry(&numacount, QEMU_CFG_NUMA, sizeof(numacount)); int max_cpu = romfile_loadint("etc/max-cpus", 0); qemu_romfile_add("etc/numa-cpu-map", QEMU_CFG_NUMA, sizeof(numacount) , max_cpu*sizeof(u64)); qemu_romfile_add("etc/numa-nodes", QEMU_CFG_NUMA , sizeof(numacount) + max_cpu*sizeof(u64) , numacount*sizeof(u64)); // e820 data u32 count32; qemu_cfg_read_entry(&count32, QEMU_CFG_E820_TABLE, sizeof(count32)); if (count32) { struct e820_reservation entry; int i; for (i = 0; i < count32; i++) { qemu_cfg_read(&entry, sizeof(entry)); add_e820(entry.address, entry.length, entry.type); } } else if (runningOnKVM()) { // Backwards compatibility - provide hard coded range. // 4 pages before the bios, 3 pages for vmx tss pages, the // other page for EPT real mode pagetable add_e820(0xfffbc000, 4*4096, E820_RESERVED); } // ACPI tables char name[128]; u16 cnt; qemu_cfg_read_entry(&cnt, QEMU_CFG_ACPI_TABLES, sizeof(cnt)); int i, offset = sizeof(cnt); for (i = 0; i < cnt; i++) { u16 len; qemu_cfg_read(&len, sizeof(len)); offset += sizeof(len); snprintf(name, sizeof(name), "acpi/table%d", i); qemu_romfile_add(name, QEMU_CFG_ACPI_TABLES, offset, len); qemu_cfg_skip(len); offset += len; } // SMBIOS info qemu_cfg_read_entry(&cnt, QEMU_CFG_SMBIOS_ENTRIES, sizeof(cnt)); offset = sizeof(cnt); for (i = 0; i < cnt; i++) { struct qemu_smbios_header header; qemu_cfg_read(&header, sizeof(header)); if (header.headertype == SMBIOS_FIELD_ENTRY) { snprintf(name, sizeof(name), "smbios/field%d-%d" , header.tabletype, header.fieldoffset); qemu_romfile_add(name, QEMU_CFG_SMBIOS_ENTRIES , offset + sizeof(header) , header.length - sizeof(header)); } else { snprintf(name, sizeof(name), "smbios/table%d-%d" , header.tabletype, i); qemu_romfile_add(name, QEMU_CFG_SMBIOS_ENTRIES , offset + 3, header.length - 3); } qemu_cfg_skip(header.length - sizeof(header)); offset += header.length; } } struct QemuCfgFile { u32 size; /* file size */ u16 select; /* write this to 0x510 to read it */ u16 reserved; char name[56]; }; void qemu_cfg_init(void) { if (!runningOnQEMU()) return; // Detect fw_cfg interface. qemu_cfg_select(QEMU_CFG_SIGNATURE); char *sig = "QEMU"; int i; for (i = 0; i < 4; i++) if (inb(PORT_QEMU_CFG_DATA) != sig[i]) return; dprintf(1, "Found QEMU fw_cfg\n"); // Populate romfiles for legacy fw_cfg entries qemu_cfg_legacy(); // Load files found in the fw_cfg file directory u32 count; qemu_cfg_read_entry(&count, QEMU_CFG_FILE_DIR, sizeof(count)); count = be32_to_cpu(count); u32 e; for (e = 0; e < count; e++) { struct QemuCfgFile qfile; qemu_cfg_read(&qfile, sizeof(qfile)); qemu_romfile_add(qfile.name, be16_to_cpu(qfile.select) , 0, be32_to_cpu(qfile.size)); } } tinyvisor/bios/src/post.h0000644006644000001440000000031212172661303015742 0ustar yuichi_xyusers#ifndef __POST_H #define __POST_H void interface_init(void); void device_hardware_setup(void); void prepareboot(void); void startBoot(void); void reloc_preinit(void *f, void *arg); #endif // __POST_H tinyvisor/bios/src/floppy.c0000644006644000001440000004616112172661303016275 0ustar yuichi_xyusers// 16bit code to access floppy drives. // // Copyright (C) 2008,2009 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "types.h" // u8 #include "disk.h" // DISK_RET_SUCCESS #include "config.h" // CONFIG_FLOPPY #include "biosvar.h" // SET_BDA #include "util.h" // dprintf #include "cmos.h" // inb_cmos #include "pic.h" // eoi_pic1 #include "bregs.h" // struct bregs #include "boot.h" // boot_add_floppy #include "pci.h" // pci_to_bdf #include "pci_ids.h" // PCI_CLASS_BRIDGE_ISA #define FLOPPY_SIZE_CODE 0x02 // 512 byte sectors #define FLOPPY_DATALEN 0xff // Not used - because size code is 0x02 #define FLOPPY_MOTOR_TICKS 37 // ~2 seconds #define FLOPPY_FILLBYTE 0xf6 #define FLOPPY_GAPLEN 0x1B #define FLOPPY_FORMAT_GAPLEN 0x6c #define FLOPPY_PIO_TIMEOUT 1000 // New diskette parameter table adding 3 parameters from IBM // Since no provisions are made for multiple drive types, most // values in this table are ignored. I set parameters for 1.44M // floppy here struct floppy_ext_dbt_s diskette_param_table2 VARFSEG = { .dbt = { .specify1 = 0xAF, // step rate 12ms, head unload 240ms .specify2 = 0x02, // head load time 4ms, DMA used .shutoff_ticks = FLOPPY_MOTOR_TICKS, // ~2 seconds .bps_code = FLOPPY_SIZE_CODE, .sectors = 18, .interblock_len = FLOPPY_GAPLEN, .data_len = FLOPPY_DATALEN, .gap_len = FLOPPY_FORMAT_GAPLEN, .fill_byte = FLOPPY_FILLBYTE, .settle_time = 0x0F, // 15ms .startup_time = 0x08, // 1 second }, .max_track = 79, // maximum track .data_rate = 0, // data transfer rate .drive_type = 4, // drive type in cmos }; struct floppy_dbt_s diskette_param_table VAR16FIXED(0xefc7); struct floppyinfo_s { struct chs_s chs; u8 floppy_size; u8 data_rate; }; #define FLOPPY_SIZE_525 0x01 #define FLOPPY_SIZE_350 0x02 #define FLOPPY_RATE_500K 0x00 #define FLOPPY_RATE_300K 0x01 #define FLOPPY_RATE_250K 0x02 #define FLOPPY_RATE_1M 0x03 struct floppyinfo_s FloppyInfo[] VARFSEG = { // Unknown { {0, 0, 0}, 0x00, 0x00}, // 1 - 360KB, 5.25" - 2 heads, 40 tracks, 9 sectors { {2, 40, 9}, FLOPPY_SIZE_525, FLOPPY_RATE_300K}, // 2 - 1.2MB, 5.25" - 2 heads, 80 tracks, 15 sectors { {2, 80, 15}, FLOPPY_SIZE_525, FLOPPY_RATE_500K}, // 3 - 720KB, 3.5" - 2 heads, 80 tracks, 9 sectors { {2, 80, 9}, FLOPPY_SIZE_350, FLOPPY_RATE_250K}, // 4 - 1.44MB, 3.5" - 2 heads, 80 tracks, 18 sectors { {2, 80, 18}, FLOPPY_SIZE_350, FLOPPY_RATE_500K}, // 5 - 2.88MB, 3.5" - 2 heads, 80 tracks, 36 sectors { {2, 80, 36}, FLOPPY_SIZE_350, FLOPPY_RATE_1M}, // 6 - 160k, 5.25" - 1 heads, 40 tracks, 8 sectors { {1, 40, 8}, FLOPPY_SIZE_525, FLOPPY_RATE_250K}, // 7 - 180k, 5.25" - 1 heads, 40 tracks, 9 sectors { {1, 40, 9}, FLOPPY_SIZE_525, FLOPPY_RATE_300K}, // 8 - 320k, 5.25" - 2 heads, 40 tracks, 8 sectors { {2, 40, 8}, FLOPPY_SIZE_525, FLOPPY_RATE_250K}, }; struct drive_s * init_floppy(int floppyid, int ftype) { if (ftype <= 0 || ftype >= ARRAY_SIZE(FloppyInfo)) { dprintf(1, "Bad floppy type %d\n", ftype); return NULL; } struct drive_s *drive_g = malloc_fseg(sizeof(*drive_g)); if (!drive_g) { warn_noalloc(); return NULL; } memset(drive_g, 0, sizeof(*drive_g)); drive_g->cntl_id = floppyid; drive_g->type = DTYPE_FLOPPY; drive_g->blksize = DISK_SECTOR_SIZE; drive_g->floppy_type = ftype; drive_g->sectors = (u64)-1; memcpy(&drive_g->lchs, &FloppyInfo[ftype].chs , sizeof(FloppyInfo[ftype].chs)); return drive_g; } static void addFloppy(int floppyid, int ftype) { struct drive_s *drive_g = init_floppy(floppyid, ftype); if (!drive_g) return; char *desc = znprintf(MAXDESCSIZE, "Floppy [drive %c]", 'A' + floppyid); struct pci_device *pci = pci_find_class(PCI_CLASS_BRIDGE_ISA); /* isa-to-pci bridge */ int prio = bootprio_find_fdc_device(pci, PORT_FD_BASE, floppyid); boot_add_floppy(drive_g, desc, prio); } void floppy_setup(void) { memcpy(&diskette_param_table, &diskette_param_table2 , sizeof(diskette_param_table)); SET_IVT(0x1E, SEGOFF(SEG_BIOS , (u32)&diskette_param_table2 - BUILD_BIOS_ADDR)); if (! CONFIG_FLOPPY) return; dprintf(3, "init floppy drives\n"); if (CONFIG_QEMU) { u8 type = inb_cmos(CMOS_FLOPPY_DRIVE_TYPE); if (type & 0xf0) addFloppy(0, type >> 4); if (type & 0x0f) addFloppy(1, type & 0x0f); } else { u8 type = romfile_loadint("etc/floppy0", 0); if (type) addFloppy(0, type); type = romfile_loadint("etc/floppy1", 0); if (type) addFloppy(1, type); } outb(0x02, PORT_DMA1_MASK_REG); enable_hwirq(6, FUNC16(entry_0e)); } // Find a floppy type that matches a given image size. int find_floppy_type(u32 size) { int i; for (i=1; icylinders * c->heads * c->spt * DISK_SECTOR_SIZE == size) return i; } return -1; } /**************************************************************** * Low-level floppy IO ****************************************************************/ static void floppy_disable_controller(void) { outb(inb(PORT_FD_DOR) & ~0x04, PORT_FD_DOR); } static int floppy_wait_irq(void) { u8 frs = GET_BDA(floppy_recalibration_status); SET_BDA(floppy_recalibration_status, frs & ~FRS_IRQ); for (;;) { if (!GET_BDA(floppy_motor_counter)) { floppy_disable_controller(); return DISK_RET_ETIMEOUT; } frs = GET_BDA(floppy_recalibration_status); if (frs & FRS_IRQ) break; // Could use yield_toirq() here, but that causes issues on // bochs, so use yield() instead. yield(); } SET_BDA(floppy_recalibration_status, frs & ~FRS_IRQ); return DISK_RET_SUCCESS; } struct floppy_pio_s { u8 cmdlen; u8 resplen; u8 waitirq; u8 data[9]; }; static int floppy_pio(struct floppy_pio_s *pio) { // Send command to controller. u64 end = calc_future_tsc(FLOPPY_PIO_TIMEOUT); int i = 0; for (;;) { u8 sts = inb(PORT_FD_STATUS); if (!(sts & 0x80)) { if (check_tsc(end)) { floppy_disable_controller(); return DISK_RET_ETIMEOUT; } continue; } if (sts & 0x40) { floppy_disable_controller(); return DISK_RET_ECONTROLLER; } outb(pio->data[i++], PORT_FD_DATA); if (i >= pio->cmdlen) break; } // Wait for command to complete. if (pio->waitirq) { int ret = floppy_wait_irq(); if (ret) return ret; } // Read response from controller. end = calc_future_tsc(FLOPPY_PIO_TIMEOUT); i = 0; for (;;) { u8 sts = inb(PORT_FD_STATUS); if (!(sts & 0x80)) { if (check_tsc(end)) { floppy_disable_controller(); return DISK_RET_ETIMEOUT; } continue; } if (i >= pio->resplen) break; if (!(sts & 0x40)) { floppy_disable_controller(); return DISK_RET_ECONTROLLER; } pio->data[i++] = inb(PORT_FD_DATA); } return DISK_RET_SUCCESS; } static int floppy_enable_controller(void) { outb(inb(PORT_FD_DOR) | 0x04, PORT_FD_DOR); int ret = floppy_wait_irq(); if (ret) return ret; struct floppy_pio_s pio; pio.cmdlen = 1; pio.resplen = 2; pio.waitirq = 0; pio.data[0] = 0x08; // 08: Check Interrupt Status return floppy_pio(&pio); } static int floppy_select_drive(u8 floppyid) { // reset the disk motor timeout value of INT 08 SET_BDA(floppy_motor_counter, FLOPPY_MOTOR_TICKS); // Enable controller if it isn't running. u8 dor = inb(PORT_FD_DOR); if (!(dor & 0x04)) { int ret = floppy_enable_controller(); if (ret) return ret; } // Turn on motor of selected drive, DMA & int enabled, normal operation dor = (floppyid ? 0x20 : 0x10) | 0x0c | floppyid; outb(dor, PORT_FD_DOR); return DISK_RET_SUCCESS; } /**************************************************************** * Floppy media sense ****************************************************************/ static inline void set_diskette_current_cyl(u8 floppyid, u8 cyl) { SET_BDA(floppy_track[floppyid], cyl); } static int floppy_drive_recal(u8 floppyid) { int ret = floppy_select_drive(floppyid); if (ret) return ret; // send Recalibrate command (2 bytes) to controller struct floppy_pio_s pio; pio.cmdlen = 2; pio.resplen = 0; pio.waitirq = 1; pio.data[0] = 0x07; // 07: Recalibrate pio.data[1] = floppyid; // 0=drive0, 1=drive1 ret = floppy_pio(&pio); if (ret) return ret; pio.cmdlen = 1; pio.resplen = 2; pio.waitirq = 0; pio.data[0] = 0x08; // 08: Check Interrupt Status ret = floppy_pio(&pio); if (ret) return ret; u8 frs = GET_BDA(floppy_recalibration_status); SET_BDA(floppy_recalibration_status, frs | (1<floppy_type), stype = ftype; u8 floppyid = GET_GLOBAL(drive_g->cntl_id); u8 data_rate = GET_GLOBAL(FloppyInfo[stype].data_rate); int ret = floppy_drive_readid(floppyid, data_rate, 0); if (ret) { // Attempt media sense. for (stype=1; ; stype++) { if (stype >= ARRAY_SIZE(FloppyInfo)) return DISK_RET_EMEDIA; if (stype==ftype || (GET_GLOBAL(FloppyInfo[stype].floppy_size) != GET_GLOBAL(FloppyInfo[ftype].floppy_size)) || (GET_GLOBAL(FloppyInfo[stype].chs.heads) > GET_GLOBAL(FloppyInfo[ftype].chs.heads)) || (GET_GLOBAL(FloppyInfo[stype].chs.cylinders) > GET_GLOBAL(FloppyInfo[ftype].chs.cylinders)) || (GET_GLOBAL(FloppyInfo[stype].chs.spt) > GET_GLOBAL(FloppyInfo[ftype].chs.spt))) continue; data_rate = GET_GLOBAL(FloppyInfo[stype].data_rate); ret = floppy_drive_readid(floppyid, data_rate, 0); if (!ret) break; } } u8 old_data_rate = GET_BDA(floppy_media_state[floppyid]) >> 6; SET_BDA(floppy_last_data_rate, (old_data_rate<<2) | (data_rate<<6)); u8 media = (stype == 1 ? 0x04 : (stype == 2 ? 0x05 : 0x07)); u8 fms = (data_rate<<6) | FMS_MEDIA_DRIVE_ESTABLISHED | media; if (GET_GLOBAL(FloppyInfo[stype].chs.cylinders) < GET_GLOBAL(FloppyInfo[ftype].chs.cylinders)) fms |= FMS_DOUBLE_STEPPING; SET_BDA(floppy_media_state[floppyid], fms); return DISK_RET_SUCCESS; } static int check_recal_drive(struct drive_s *drive_g) { u8 floppyid = GET_GLOBAL(drive_g->cntl_id); if ((GET_BDA(floppy_recalibration_status) & (1<drive_g); if (ret) return ret; // es:bx = pointer to where to place information from diskette u32 addr = (u32)op->buf_fl; int count = op->count * blocksize; // check for 64K boundary overrun u16 end = count - 1; u32 last_addr = addr + end; if ((addr >> 16) != (last_addr >> 16)) return DISK_RET_EBOUNDARY; u8 mode_register = 0x4a; // single mode, increment, autoinit disable, if (pio->data[0] == 0xe6) // read mode_register = 0x46; //DEBUGF("floppy dma c2\n"); outb(0x06, PORT_DMA1_MASK_REG); outb(0x00, PORT_DMA1_CLEAR_FF_REG); // clear flip-flop outb(addr, PORT_DMA_ADDR_2); outb(addr>>8, PORT_DMA_ADDR_2); outb(0x00, PORT_DMA1_CLEAR_FF_REG); // clear flip-flop outb(end, PORT_DMA_CNT_2); outb(end>>8, PORT_DMA_CNT_2); // port 0b: DMA-1 Mode Register // transfer type=write, channel 2 outb(mode_register, PORT_DMA1_MODE_REG); // port 81: DMA-1 Page Register, channel 2 outb(addr>>16, PORT_DMA_PAGE_2); outb(0x02, PORT_DMA1_MASK_REG); // unmask channel 2 ret = floppy_select_drive(pio->data[1] & 1); if (ret) return ret; pio->resplen = 7; pio->waitirq = 1; ret = floppy_pio(pio); if (ret) return ret; // Populate floppy_return_status in BDA int i; for (i=0; i<7; i++) SET_BDA(floppy_return_status[i], pio->data[i]); if (pio->data[0] & 0xc0) { if (pio->data[1] & 0x02) return DISK_RET_EWRITEPROTECT; dprintf(1, "floppy error: %02x %02x %02x %02x %02x %02x %02x\n" , pio->data[0], pio->data[1], pio->data[2], pio->data[3] , pio->data[4], pio->data[5], pio->data[6]); return DISK_RET_ECONTROLLER; } u8 track = (pio->cmdlen == 9 ? pio->data[3] : 0); set_diskette_current_cyl(pio->data[0] & 1, track); return DISK_RET_SUCCESS; } /**************************************************************** * Floppy handlers ****************************************************************/ static void lba2chs(struct disk_op_s *op, u8 *track, u8 *sector, u8 *head) { u32 lba = op->lba; u32 tmp = lba + 1; u16 nlspt = GET_GLOBAL(op->drive_g->lchs.spt); *sector = tmp % nlspt; tmp /= nlspt; u16 nlh = GET_GLOBAL(op->drive_g->lchs.heads); *head = tmp % nlh; tmp /= nlh; *track = tmp; } // diskette controller reset static int floppy_reset(struct disk_op_s *op) { u8 floppyid = GET_GLOBAL(op->drive_g->cntl_id); SET_BDA(floppy_recalibration_status, 0); SET_BDA(floppy_media_state[0], 0); SET_BDA(floppy_media_state[1], 0); SET_BDA(floppy_track[0], 0); SET_BDA(floppy_track[1], 0); SET_BDA(floppy_last_data_rate, 0); floppy_disable_controller(); return floppy_select_drive(floppyid); } // Read Diskette Sectors static int floppy_read(struct disk_op_s *op) { u8 track, sector, head; lba2chs(op, &track, §or, &head); // send read-normal-data command (9 bytes) to controller u8 floppyid = GET_GLOBAL(op->drive_g->cntl_id); struct floppy_pio_s pio; pio.cmdlen = 9; pio.data[0] = 0xe6; // e6: read normal data pio.data[1] = (head << 2) | floppyid; // HD DR1 DR2 pio.data[2] = track; pio.data[3] = head; pio.data[4] = sector; pio.data[5] = FLOPPY_SIZE_CODE; pio.data[6] = sector + op->count - 1; // last sector to read on track pio.data[7] = FLOPPY_GAPLEN; pio.data[8] = FLOPPY_DATALEN; int res = floppy_cmd(op, DISK_SECTOR_SIZE, &pio); if (res) goto fail; return DISK_RET_SUCCESS; fail: op->count = 0; // no sectors read return res; } // Write Diskette Sectors static int floppy_write(struct disk_op_s *op) { u8 track, sector, head; lba2chs(op, &track, §or, &head); // send write-normal-data command (9 bytes) to controller u8 floppyid = GET_GLOBAL(op->drive_g->cntl_id); struct floppy_pio_s pio; pio.cmdlen = 9; pio.data[0] = 0xc5; // c5: write normal data pio.data[1] = (head << 2) | floppyid; // HD DR1 DR2 pio.data[2] = track; pio.data[3] = head; pio.data[4] = sector; pio.data[5] = FLOPPY_SIZE_CODE; pio.data[6] = sector + op->count - 1; // last sector to write on track pio.data[7] = FLOPPY_GAPLEN; pio.data[8] = FLOPPY_DATALEN; int res = floppy_cmd(op, DISK_SECTOR_SIZE, &pio); if (res) goto fail; return DISK_RET_SUCCESS; fail: op->count = 0; // no sectors read return res; } // Verify Diskette Sectors static int floppy_verify(struct disk_op_s *op) { int res = check_recal_drive(op->drive_g); if (res) goto fail; u8 track, sector, head; lba2chs(op, &track, §or, &head); // ??? should track be new val from return_status[3] ? u8 floppyid = GET_GLOBAL(op->drive_g->cntl_id); set_diskette_current_cyl(floppyid, track); return DISK_RET_SUCCESS; fail: op->count = 0; // no sectors read return res; } // format diskette track static int floppy_format(struct disk_op_s *op) { u8 head = op->lba; // send format-track command (6 bytes) to controller u8 floppyid = GET_GLOBAL(op->drive_g->cntl_id); struct floppy_pio_s pio; pio.cmdlen = 6; pio.data[0] = 0x4d; // 4d: format track pio.data[1] = (head << 2) | floppyid; // HD DR1 DR2 pio.data[2] = FLOPPY_SIZE_CODE; pio.data[3] = op->count; // number of sectors per track pio.data[4] = FLOPPY_FORMAT_GAPLEN; pio.data[5] = FLOPPY_FILLBYTE; return floppy_cmd(op, 4, &pio); } int process_floppy_op(struct disk_op_s *op) { if (!CONFIG_FLOPPY) return 0; switch (op->command) { case CMD_RESET: return floppy_reset(op); case CMD_READ: return floppy_read(op); case CMD_WRITE: return floppy_write(op); case CMD_VERIFY: return floppy_verify(op); case CMD_FORMAT: return floppy_format(op); default: op->count = 0; return DISK_RET_EPARAM; } } /**************************************************************** * HW irqs ****************************************************************/ // INT 0Eh Diskette Hardware ISR Entry Point void VISIBLE16 handle_0e(void) { if (! CONFIG_FLOPPY) return; debug_isr(DEBUG_ISR_0e); // diskette interrupt has occurred u8 frs = GET_BDA(floppy_recalibration_status); SET_BDA(floppy_recalibration_status, frs | FRS_IRQ); eoi_pic1(); } // Called from int08 handler. void floppy_tick(void) { if (! CONFIG_FLOPPY) return; // time to turn off drive(s)? u8 fcount = GET_BDA(floppy_motor_counter); if (fcount) { fcount--; SET_BDA(floppy_motor_counter, fcount); if (fcount == 0) // turn motor(s) off outb(inb(PORT_FD_DOR) & 0xcf, PORT_FD_DOR); } } tinyvisor/bios/src/ahci.h0000644006644000001440000001774411733243570015706 0ustar yuichi_xyusers#ifndef __AHCI_H #define __AHCI_H struct sata_cmd_fis { u8 reg; u8 pmp_type; u8 command; u8 feature; u8 lba_low; u8 lba_mid; u8 lba_high; u8 device; u8 lba_low2; u8 lba_mid2; u8 lba_high2; u8 feature2; u8 sector_count; u8 sector_count2; u8 res_1; u8 control; u8 res_2[64 - 16]; }; struct ahci_ctrl_s { struct pci_device *pci_tmp; u16 pci_bdf; u8 irq; u32 iobase; u32 caps; u32 ports; }; struct ahci_cmd_s { struct sata_cmd_fis fis; u8 atapi[0x20]; u8 res[0x20]; struct { u32 base; u32 baseu; u32 res; u32 flags; } prdt[]; }; /* command list */ struct ahci_list_s { u32 flags; u32 bytes; u32 base; u32 baseu; u32 res[4]; }; struct ahci_fis_s { u8 dsfis[0x1c]; /* dma setup */ u8 res_1[0x04]; u8 psfis[0x14]; /* pio setup */ u8 res_2[0x0c]; u8 rfis[0x14]; /* d2h register */ u8 res_3[0x04]; u8 sdbfis[0x08]; /* set device bits */ u8 ufis[0x40]; /* unknown */ u8 res_4[0x60]; }; struct ahci_port_s { struct drive_s drive; struct ahci_ctrl_s *ctrl; struct ahci_list_s *list; struct ahci_fis_s *fis; struct ahci_cmd_s *cmd; u32 pnr; u32 atapi; char *desc; int prio; }; void ahci_setup(void); int process_ahci_op(struct disk_op_s *op); int ahci_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize); #define AHCI_IRQ_ON_SG (1 << 31) #define AHCI_CMD_ATAPI (1 << 5) #define AHCI_CMD_WRITE (1 << 6) #define AHCI_CMD_PREFETCH (1 << 7) #define AHCI_CMD_RESET (1 << 8) #define AHCI_CMD_CLR_BUSY (1 << 10) #define RX_FIS_D2H_REG 0x40 /* offset of D2H Register FIS data */ #define RX_FIS_SDB 0x58 /* offset of SDB FIS data */ #define RX_FIS_UNK 0x60 /* offset of Unknown FIS data */ /* global controller registers */ #define HOST_CAP 0x00 /* host capabilities */ #define HOST_CTL 0x04 /* global host control */ #define HOST_IRQ_STAT 0x08 /* interrupt status */ #define HOST_PORTS_IMPL 0x0c /* bitmap of implemented ports */ #define HOST_VERSION 0x10 /* AHCI spec. version compliancy */ /* HOST_CTL bits */ #define HOST_CTL_RESET (1 << 0) /* reset controller; self-clear */ #define HOST_CTL_IRQ_EN (1 << 1) /* global IRQ enable */ #define HOST_CTL_AHCI_EN (1 << 31) /* AHCI enabled */ /* HOST_CAP bits */ #define HOST_CAP_SSC (1 << 14) /* Slumber capable */ #define HOST_CAP_AHCI (1 << 18) /* AHCI only */ #define HOST_CAP_CLO (1 << 24) /* Command List Override support */ #define HOST_CAP_SSS (1 << 27) /* Staggered Spin-up */ #define HOST_CAP_NCQ (1 << 30) /* Native Command Queueing */ #define HOST_CAP_64 (1 << 31) /* PCI DAC (64-bit DMA) support */ /* registers for each SATA port */ #define PORT_LST_ADDR 0x00 /* command list DMA addr */ #define PORT_LST_ADDR_HI 0x04 /* command list DMA addr hi */ #define PORT_FIS_ADDR 0x08 /* FIS rx buf addr */ #define PORT_FIS_ADDR_HI 0x0c /* FIS rx buf addr hi */ #define PORT_IRQ_STAT 0x10 /* interrupt status */ #define PORT_IRQ_MASK 0x14 /* interrupt enable/disable mask */ #define PORT_CMD 0x18 /* port command */ #define PORT_TFDATA 0x20 /* taskfile data */ #define PORT_SIG 0x24 /* device TF signature */ #define PORT_SCR_STAT 0x28 /* SATA phy register: SStatus */ #define PORT_SCR_CTL 0x2c /* SATA phy register: SControl */ #define PORT_SCR_ERR 0x30 /* SATA phy register: SError */ #define PORT_SCR_ACT 0x34 /* SATA phy register: SActive */ #define PORT_CMD_ISSUE 0x38 /* command issue */ #define PORT_RESERVED 0x3c /* reserved */ /* PORT_IRQ_{STAT,MASK} bits */ #define PORT_IRQ_COLD_PRES (1 << 31) /* cold presence detect */ #define PORT_IRQ_TF_ERR (1 << 30) /* task file error */ #define PORT_IRQ_HBUS_ERR (1 << 29) /* host bus fatal error */ #define PORT_IRQ_HBUS_DATA_ERR (1 << 28) /* host bus data error */ #define PORT_IRQ_IF_ERR (1 << 27) /* interface fatal error */ #define PORT_IRQ_IF_NONFATAL (1 << 26) /* interface non-fatal error */ #define PORT_IRQ_OVERFLOW (1 << 24) /* xfer exhausted available S/G */ #define PORT_IRQ_BAD_PMP (1 << 23) /* incorrect port multiplier */ #define PORT_IRQ_PHYRDY (1 << 22) /* PhyRdy changed */ #define PORT_IRQ_DEV_ILCK (1 << 7) /* device interlock */ #define PORT_IRQ_CONNECT (1 << 6) /* port connect change status */ #define PORT_IRQ_SG_DONE (1 << 5) /* descriptor processed */ #define PORT_IRQ_UNK_FIS (1 << 4) /* unknown FIS rx'd */ #define PORT_IRQ_SDB_FIS (1 << 3) /* Set Device Bits FIS rx'd */ #define PORT_IRQ_DMAS_FIS (1 << 2) /* DMA Setup FIS rx'd */ #define PORT_IRQ_PIOS_FIS (1 << 1) /* PIO Setup FIS rx'd */ #define PORT_IRQ_D2H_REG_FIS (1 << 0) /* D2H Register FIS rx'd */ #define PORT_IRQ_FREEZE (PORT_IRQ_HBUS_ERR | PORT_IRQ_IF_ERR | \ PORT_IRQ_CONNECT | PORT_IRQ_PHYRDY | \ PORT_IRQ_UNK_FIS) #define PORT_IRQ_ERROR (PORT_IRQ_FREEZE | PORT_IRQ_TF_ERR | \ PORT_IRQ_HBUS_DATA_ERR) #define DEF_PORT_IRQ (PORT_IRQ_ERROR | PORT_IRQ_SG_DONE | \ PORT_IRQ_SDB_FIS | PORT_IRQ_DMAS_FIS | \ PORT_IRQ_PIOS_FIS | PORT_IRQ_D2H_REG_FIS) /* PORT_CMD bits */ #define PORT_CMD_ATAPI (1 << 24) /* Device is ATAPI */ #define PORT_CMD_LIST_ON (1 << 15) /* cmd list DMA engine running */ #define PORT_CMD_FIS_ON (1 << 14) /* FIS DMA engine running */ #define PORT_CMD_FIS_RX (1 << 4) /* Enable FIS receive DMA engine */ #define PORT_CMD_CLO (1 << 3) /* Command list override */ #define PORT_CMD_POWER_ON (1 << 2) /* Power up device */ #define PORT_CMD_SPIN_UP (1 << 1) /* Spin up device */ #define PORT_CMD_START (1 << 0) /* Enable port DMA engine */ #define PORT_CMD_ICC_MASK (0xf << 28) /* i/f ICC state mask */ #define PORT_CMD_ICC_ACTIVE (0x1 << 28) /* Put i/f in active state */ #define PORT_CMD_ICC_PARTIAL (0x2 << 28) /* Put i/f in partial state */ #define PORT_CMD_ICC_SLUMBER (0x6 << 28) /* Put i/f in slumber state */ #define PORT_IRQ_STAT_DHRS (1 << 0) /* Device to Host Register FIS */ #define PORT_IRQ_STAT_PSS (1 << 1) /* PIO Setup FIS */ #define PORT_IRQ_STAT_DSS (1 << 2) /* DMA Setup FIS */ #define PORT_IRQ_STAT_SDBS (1 << 3) /* Set Device Bits */ #define PORT_IRQ_STAT_UFS (1 << 4) /* Unknown FIS */ #define PORT_IRQ_STAT_DPS (1 << 5) /* Descriptor Processed */ #define PORT_IRQ_STAT_PCS (1 << 6) /* Port Connect Change Status */ #define PORT_IRQ_STAT_DMPS (1 << 7) /* Device Mechanical Presence Status */ #define PORT_IRQ_STAT_PRCS (1 << 22) /* File Ready Status */ #define PORT_IRQ_STAT_IPMS (1 << 23) /* Incorrect Port Multiplier Status */ #define PORT_IRQ_STAT_OFS (1 << 24) /* Overflow Status */ #define PORT_IRQ_STAT_INFS (1 << 26) /* Interface Non-Fatal Error Status */ #define PORT_IRQ_STAT_IFS (1 << 27) /* Interface Fatal Error */ #define PORT_IRQ_STAT_HBDS (1 << 28) /* Host Bus Data Error Status */ #define PORT_IRQ_STAT_HBFS (1 << 29) /* Host Bus Fatal Error Status */ #define PORT_IRQ_STAT_TFES (1 << 30) /* Task File Error Status */ #define PORT_IRQ_STAT_CPDS (1 << 31) /* Code Port Detect Status */ #endif // ahci.h tinyvisor/bios/src/mptable.h0000644006644000001440000000240412172661303016405 0ustar yuichi_xyusers#ifndef __MPTABLE_H #define __MPTABLE_H #include "types.h" // u32 #define MPTABLE_SIGNATURE 0x5f504d5f // "_MP_" struct mptable_floating_s { u32 signature; u32 physaddr; u8 length; u8 spec_rev; u8 checksum; u8 feature1; u8 feature2; u8 reserved[3]; }; #define MPCONFIG_SIGNATURE 0x504d4350 // "PCMP" struct mptable_config_s { u32 signature; u16 length; u8 spec; u8 checksum; char oemid[8]; char productid[12]; u32 oemptr; u16 oemsize; u16 entrycount; u32 lapic; u16 exttable_length; u8 exttable_checksum; u8 reserved; } PACKED; #define MPT_TYPE_CPU 0 #define MPT_TYPE_BUS 1 #define MPT_TYPE_IOAPIC 2 #define MPT_TYPE_INTSRC 3 #define MPT_TYPE_LOCAL_INT 4 struct mpt_cpu { u8 type; u8 apicid; u8 apicver; u8 cpuflag; u32 cpusignature; u32 featureflag; u32 reserved[2]; } PACKED; struct mpt_bus { u8 type; u8 busid; char bustype[6]; } PACKED; struct mpt_ioapic { u8 type; u8 apicid; u8 apicver; u8 flags; u32 apicaddr; } PACKED; struct mpt_intsrc { u8 type; u8 irqtype; u16 irqflag; u8 srcbus; u8 srcbusirq; u8 dstapic; u8 dstirq; } PACKED; // mptable.c void mptable_setup(void); #endif // mptable.h tinyvisor/bios/src/ata.h0000644006644000001440000001467112172661303015537 0ustar yuichi_xyusers#ifndef __ATA_H #define __ATA_H #include "types.h" // u8 #include "config.h" // CONFIG_MAX_ATA_INTERFACES #include "disk.h" // struct drive_s struct ata_channel_s { u16 iobase1; u16 iobase2; u16 iomaster; u8 irq; u8 chanid; int pci_bdf; struct pci_device *pci_tmp; }; struct atadrive_s { struct drive_s drive; struct ata_channel_s *chan_gf; u8 slave; }; // ata.c char *ata_extract_model(char *model, u32 size, u16 *buffer); int ata_extract_version(u16 *buffer); int cdrom_read(struct disk_op_s *op); int atapi_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize); void ata_setup(void); int process_ata_op(struct disk_op_s *op); // Global defines -- ATA register and register bits. // command block & control block regs #define ATA_CB_DATA 0 // data reg in/out pio_base_addr1+0 #define ATA_CB_ERR 1 // error in pio_base_addr1+1 #define ATA_CB_FR 1 // feature reg out pio_base_addr1+1 #define ATA_CB_SC 2 // sector count in/out pio_base_addr1+2 #define ATA_CB_SN 3 // sector number in/out pio_base_addr1+3 #define ATA_CB_CL 4 // cylinder low in/out pio_base_addr1+4 #define ATA_CB_CH 5 // cylinder high in/out pio_base_addr1+5 #define ATA_CB_DH 6 // device head in/out pio_base_addr1+6 #define ATA_CB_STAT 7 // primary status in pio_base_addr1+7 #define ATA_CB_CMD 7 // command out pio_base_addr1+7 #define ATA_CB_ASTAT 2 // alternate status in pio_base_addr2+2 #define ATA_CB_DC 2 // device control out pio_base_addr2+2 #define ATA_CB_DA 3 // device address in pio_base_addr2+3 #define ATA_CB_ER_ICRC 0x80 // ATA Ultra DMA bad CRC #define ATA_CB_ER_BBK 0x80 // ATA bad block #define ATA_CB_ER_UNC 0x40 // ATA uncorrected error #define ATA_CB_ER_MC 0x20 // ATA media change #define ATA_CB_ER_IDNF 0x10 // ATA id not found #define ATA_CB_ER_MCR 0x08 // ATA media change request #define ATA_CB_ER_ABRT 0x04 // ATA command aborted #define ATA_CB_ER_NTK0 0x02 // ATA track 0 not found #define ATA_CB_ER_NDAM 0x01 // ATA address mark not found #define ATA_CB_ER_P_SNSKEY 0xf0 // ATAPI sense key (mask) #define ATA_CB_ER_P_MCR 0x08 // ATAPI Media Change Request #define ATA_CB_ER_P_ABRT 0x04 // ATAPI command abort #define ATA_CB_ER_P_EOM 0x02 // ATAPI End of Media #define ATA_CB_ER_P_ILI 0x01 // ATAPI Illegal Length Indication // ATAPI Interrupt Reason bits in the Sector Count reg (CB_SC) #define ATA_CB_SC_P_TAG 0xf8 // ATAPI tag (mask) #define ATA_CB_SC_P_REL 0x04 // ATAPI release #define ATA_CB_SC_P_IO 0x02 // ATAPI I/O #define ATA_CB_SC_P_CD 0x01 // ATAPI C/D // bits 7-4 of the device/head (CB_DH) reg #define ATA_CB_DH_DEV0 0xa0 // select device 0 #define ATA_CB_DH_DEV1 0xb0 // select device 1 #define ATA_CB_DH_LBA 0x40 // use LBA // status reg (CB_STAT and CB_ASTAT) bits #define ATA_CB_STAT_BSY 0x80 // busy #define ATA_CB_STAT_RDY 0x40 // ready #define ATA_CB_STAT_DF 0x20 // device fault #define ATA_CB_STAT_WFT 0x20 // write fault (old name) #define ATA_CB_STAT_SKC 0x10 // seek complete #define ATA_CB_STAT_SERV 0x10 // service #define ATA_CB_STAT_DRQ 0x08 // data request #define ATA_CB_STAT_CORR 0x04 // corrected #define ATA_CB_STAT_IDX 0x02 // index #define ATA_CB_STAT_ERR 0x01 // error (ATA) #define ATA_CB_STAT_CHK 0x01 // check (ATAPI) // device control reg (CB_DC) bits #define ATA_CB_DC_HD15 0x08 // bit should always be set to one #define ATA_CB_DC_SRST 0x04 // soft reset #define ATA_CB_DC_NIEN 0x02 // disable interrupts // Most mandtory and optional ATA commands (from ATA-3), #define ATA_CMD_NOP 0x00 #define ATA_CMD_CFA_REQUEST_EXT_ERR_CODE 0x03 #define ATA_CMD_DEVICE_RESET 0x08 #define ATA_CMD_RECALIBRATE 0x10 #define ATA_CMD_READ_SECTORS 0x20 #define ATA_CMD_READ_SECTORS_EXT 0x24 #define ATA_CMD_READ_DMA_EXT 0x25 #define ATA_CMD_READ_DMA_QUEUED_EXT 0x26 #define ATA_CMD_READ_NATIVE_MAX_ADDRESS_EXT 0x27 #define ATA_CMD_READ_MULTIPLE_EXT 0x29 #define ATA_CMD_READ_LOG_EXT 0x2F #define ATA_CMD_WRITE_SECTORS 0x30 #define ATA_CMD_WRITE_SECTORS_EXT 0x34 #define ATA_CMD_WRITE_DMA_EXT 0x35 #define ATA_CMD_WRITE_DMA_QUEUED_EXT 0x36 #define ATA_CMD_SET_MAX_ADDRESS_EXT 0x37 #define ATA_CMD_CFA_WRITE_SECTORS_WO_ERASE 0x38 #define ATA_CMD_WRITE_MULTIPLE_EXT 0x39 #define ATA_CMD_WRITE_VERIFY 0x3C #define ATA_CMD_WRITE_LOG_EXT 0x3F #define ATA_CMD_READ_VERIFY_SECTORS 0x40 #define ATA_CMD_READ_VERIFY_SECTORS_EXT 0x42 #define ATA_CMD_FORMAT_TRACK 0x50 #define ATA_CMD_SEEK 0x70 #define ATA_CMD_CFA_TRANSLATE_SECTOR 0x87 #define ATA_CMD_EXECUTE_DEVICE_DIAGNOSTIC 0x90 #define ATA_CMD_INITIALIZE_DEVICE_PARAMETERS 0x91 #define ATA_CMD_STANDBY_IMMEDIATE2 0x94 #define ATA_CMD_IDLE_IMMEDIATE2 0x95 #define ATA_CMD_STANDBY2 0x96 #define ATA_CMD_IDLE2 0x97 #define ATA_CMD_CHECK_POWER_MODE2 0x98 #define ATA_CMD_SLEEP2 0x99 #define ATA_CMD_PACKET 0xA0 #define ATA_CMD_IDENTIFY_PACKET_DEVICE 0xA1 #define ATA_CMD_CFA_ERASE_SECTORS 0xC0 #define ATA_CMD_READ_MULTIPLE 0xC4 #define ATA_CMD_WRITE_MULTIPLE 0xC5 #define ATA_CMD_SET_MULTIPLE_MODE 0xC6 #define ATA_CMD_READ_DMA_QUEUED 0xC7 #define ATA_CMD_READ_DMA 0xC8 #define ATA_CMD_WRITE_DMA 0xCA #define ATA_CMD_WRITE_DMA_QUEUED 0xCC #define ATA_CMD_CFA_WRITE_MULTIPLE_WO_ERASE 0xCD #define ATA_CMD_STANDBY_IMMEDIATE 0xE0 #define ATA_CMD_IDLE_IMMEDIATE 0xE1 #define ATA_CMD_STANDBY 0xE2 #define ATA_CMD_IDLE 0xE3 #define ATA_CMD_READ_BUFFER 0xE4 #define ATA_CMD_CHECK_POWER_MODE 0xE5 #define ATA_CMD_SLEEP 0xE6 #define ATA_CMD_FLUSH_CACHE 0xE7 #define ATA_CMD_WRITE_BUFFER 0xE8 #define ATA_CMD_IDENTIFY_DEVICE 0xEC #define ATA_CMD_SET_FEATURES 0xEF #define ATA_CMD_READ_NATIVE_MAX_ADDRESS 0xF8 #define ATA_CMD_SET_MAX 0xF9 #endif // ata.h tinyvisor/bios/src/coreboot.c0000644006644000001440000003114212172661303016571 0ustar yuichi_xyusers// Coreboot interface support. // // Copyright (C) 2008,2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "memmap.h" // add_e820 #include "util.h" // dprintf #include "byteorder.h" // be32_to_cpu #include "lzmadecode.h" // LzmaDecode #include "smbios.h" // smbios_init #include "boot.h" // boot_add_cbfs #include "disk.h" // MAXDESCSIZE #include "config.h" // CONFIG_* #include "acpi.h" // find_acpi_features #include "pci.h" // pci_probe_devices #include "paravirt.h" // PlatformRunningOn /**************************************************************** * Memory map ****************************************************************/ struct cb_header { u32 signature; u32 header_bytes; u32 header_checksum; u32 table_bytes; u32 table_checksum; u32 table_entries; }; #define CB_SIGNATURE 0x4f49424C // "LBIO" struct cb_memory_range { u64 start; u64 size; u32 type; }; #define CB_MEM_TABLE 16 struct cb_memory { u32 tag; u32 size; struct cb_memory_range map[0]; }; #define CB_TAG_MEMORY 0x01 #define MEM_RANGE_COUNT(_rec) \ (((_rec)->size - sizeof(*(_rec))) / sizeof((_rec)->map[0])) struct cb_mainboard { u32 tag; u32 size; u8 vendor_idx; u8 part_idx; char strings[0]; }; #define CB_TAG_MAINBOARD 0x0003 struct cb_forward { u32 tag; u32 size; u64 forward; }; #define CB_TAG_FORWARD 0x11 static u16 ipchksum(char *buf, int count) { u16 *p = (u16*)buf; u32 sum = 0; while (count > 1) { sum += *p++; count -= 2; } if (count) sum += *(u8*)p; sum = (sum >> 16) + (sum & 0xffff); sum += (sum >> 16); return ~sum; } // Try to locate the coreboot header in a given address range. static struct cb_header * find_cb_header(char *addr, int len) { char *end = addr + len; for (; addr < end; addr += 16) { struct cb_header *cbh = (struct cb_header *)addr; if (cbh->signature != CB_SIGNATURE) continue; if (! cbh->table_bytes) continue; if (ipchksum(addr, sizeof(*cbh)) != 0) continue; if (ipchksum(addr + sizeof(*cbh), cbh->table_bytes) != cbh->table_checksum) continue; return cbh; } return NULL; } // Try to find the coreboot memory table in the given coreboot table. static void * find_cb_subtable(struct cb_header *cbh, u32 tag) { char *tbl = (char *)cbh + sizeof(*cbh); int i; for (i=0; itable_entries; i++) { struct cb_memory *cbm = (struct cb_memory *)tbl; tbl += cbm->size; if (cbm->tag == tag) return cbm; } return NULL; } static struct cb_memory *CBMemTable; const char *CBvendor = "", *CBpart = ""; // Populate max ram and e820 map info by scanning for a coreboot table. void coreboot_preinit(void) { if (!CONFIG_COREBOOT) return; dprintf(3, "Attempting to find coreboot table\n"); // Find coreboot table. struct cb_header *cbh = find_cb_header(0, 0x1000); if (!cbh) goto fail; struct cb_forward *cbf = find_cb_subtable(cbh, CB_TAG_FORWARD); if (cbf) { dprintf(3, "Found coreboot table forwarder.\n"); cbh = find_cb_header((char *)((u32)cbf->forward), 0x100); if (!cbh) goto fail; } dprintf(3, "Now attempting to find coreboot memory map\n"); struct cb_memory *cbm = CBMemTable = find_cb_subtable(cbh, CB_TAG_MEMORY); if (!cbm) goto fail; int i, count = MEM_RANGE_COUNT(cbm); for (i=0; imap[i]; u32 type = m->type; if (type == CB_MEM_TABLE) type = E820_RESERVED; add_e820(m->start, m->size, type); } // Ughh - coreboot likes to set a map at 0x0000-0x1000, but this // confuses grub. So, override it. add_e820(0, 16*1024, E820_RAM); struct cb_mainboard *cbmb = find_cb_subtable(cbh, CB_TAG_MAINBOARD); if (cbmb) { CBvendor = &cbmb->strings[cbmb->vendor_idx]; CBpart = &cbmb->strings[cbmb->part_idx]; if (strcmp(CBvendor, "Emulation") == 0 && memcmp(CBpart, "QEMU", 4) == 0) { PlatformRunningOn |= PF_QEMU; } dprintf(1, "Found mainboard %s %s\n", CBvendor, CBpart); } return; fail: // No table found.. Use 16Megs as a dummy value. dprintf(1, "Unable to find coreboot table!\n"); add_e820(0, 16*1024*1024, E820_RAM); return; } /**************************************************************** * BIOS table copying ****************************************************************/ // Attempt to find (and relocate) any standard bios tables found in a // given address range. static void scan_tables(u32 start, u32 size) { void *p = (void*)ALIGN(start, 16); void *end = (void*)start + size; for (; pmap[i]; if (m->type == CB_MEM_TABLE) scan_tables(m->start, m->size); } find_acpi_features(); } /**************************************************************** * ulzma ****************************************************************/ // Uncompress data in flash to an area of memory. static int ulzma(u8 *dst, u32 maxlen, const u8 *src, u32 srclen) { dprintf(3, "Uncompressing data %d@%p to %d@%p\n", srclen, src, maxlen, dst); CLzmaDecoderState state; int ret = LzmaDecodeProperties(&state.Properties, src, LZMA_PROPERTIES_SIZE); if (ret != LZMA_RESULT_OK) { dprintf(1, "LzmaDecodeProperties error - %d\n", ret); return -1; } u8 scratch[15980]; int need = (LzmaGetNumProbs(&state.Properties) * sizeof(CProb)); if (need > sizeof(scratch)) { dprintf(1, "LzmaDecode need %d have %d\n", need, (unsigned int)sizeof(scratch)); return -1; } state.Probs = (CProb *)scratch; u32 dstlen = *(u32*)(src + LZMA_PROPERTIES_SIZE); if (dstlen > maxlen) { dprintf(1, "LzmaDecode too large (max %d need %d)\n", maxlen, dstlen); return -1; } u32 inProcessed, outProcessed; ret = LzmaDecode(&state, src + LZMA_PROPERTIES_SIZE + 8, srclen , &inProcessed, dst, dstlen, &outProcessed); if (ret) { dprintf(1, "LzmaDecode returned %d\n", ret); return -1; } return dstlen; } /**************************************************************** * Coreboot flash format ****************************************************************/ #define CBFS_HEADER_MAGIC 0x4F524243 #define CBFS_HEADPTR_ADDR 0xFFFFFFFc #define CBFS_VERSION1 0x31313131 struct cbfs_header { u32 magic; u32 version; u32 romsize; u32 bootblocksize; u32 align; u32 offset; u32 pad[2]; } PACKED; #define CBFS_FILE_MAGIC 0x455649484352414cLL // LARCHIVE struct cbfs_file { u64 magic; u32 len; u32 type; u32 checksum; u32 offset; char filename[0]; } PACKED; struct cbfs_romfile_s { struct romfile_s file; struct cbfs_file *fhdr; void *data; u32 rawsize, flags; }; // Copy a file to memory (uncompressing if necessary) static int cbfs_copyfile(struct romfile_s *file, void *dst, u32 maxlen) { if (!CONFIG_COREBOOT_FLASH) return -1; struct cbfs_romfile_s *cfile; cfile = container_of(file, struct cbfs_romfile_s, file); u32 size = cfile->rawsize; void *src = cfile->data; if (cfile->flags) { // Compressed - copy to temp ram and uncompress it. void *temp = malloc_tmphigh(size); if (!temp) { warn_noalloc(); return -1; } iomemcpy(temp, src, size); int ret = ulzma(dst, maxlen, temp, size); yield(); free(temp); return ret; } // Not compressed. dprintf(3, "Copying data %d@%p to %d@%p\n", size, src, maxlen, dst); if (size > maxlen) { warn_noalloc(); return -1; } iomemcpy(dst, src, size); return size; } void coreboot_cbfs_init(void) { if (!CONFIG_COREBOOT_FLASH) return; struct cbfs_header *hdr = *(void **)CBFS_HEADPTR_ADDR; if (hdr->magic != cpu_to_be32(CBFS_HEADER_MAGIC)) { dprintf(1, "Unable to find CBFS (ptr=%p; got %x not %x)\n" , hdr, hdr->magic, cpu_to_be32(CBFS_HEADER_MAGIC)); return; } dprintf(1, "Found CBFS header at %p\n", hdr); struct cbfs_file *fhdr = (void *)(0 - be32_to_cpu(hdr->romsize) + be32_to_cpu(hdr->offset)); for (;;) { if (fhdr < (struct cbfs_file *)(0xFFFFFFFF - be32_to_cpu(hdr->romsize))) break; u64 magic = fhdr->magic; if (magic != CBFS_FILE_MAGIC) break; struct cbfs_romfile_s *cfile = malloc_tmp(sizeof(*cfile)); if (!cfile) { warn_noalloc(); break; } memset(cfile, 0, sizeof(*cfile)); strtcpy(cfile->file.name, fhdr->filename, sizeof(cfile->file.name)); cfile->file.size = cfile->rawsize = be32_to_cpu(fhdr->len); cfile->fhdr = fhdr; cfile->file.copy = cbfs_copyfile; cfile->data = (void*)fhdr + be32_to_cpu(fhdr->offset); int len = strlen(cfile->file.name); if (len > 5 && strcmp(&cfile->file.name[len-5], ".lzma") == 0) { // Using compression. cfile->flags = 1; cfile->file.name[len-5] = '\0'; cfile->file.size = *(u32*)(cfile->data + LZMA_PROPERTIES_SIZE); } romfile_add(&cfile->file); fhdr = (void*)ALIGN((u32)cfile->data + cfile->file.size , be32_to_cpu(hdr->align)); } } struct cbfs_payload_segment { u32 type; u32 compression; u32 offset; u64 load_addr; u32 len; u32 mem_len; } PACKED; #define PAYLOAD_SEGMENT_BSS 0x20535342 #define PAYLOAD_SEGMENT_ENTRY 0x52544E45 #define CBFS_COMPRESS_NONE 0 #define CBFS_COMPRESS_LZMA 1 struct cbfs_payload { struct cbfs_payload_segment segments[1]; }; void cbfs_run_payload(struct cbfs_file *fhdr) { if (!CONFIG_COREBOOT_FLASH || !fhdr) return; dprintf(1, "Run %s\n", fhdr->filename); struct cbfs_payload *pay = (void*)fhdr + be32_to_cpu(fhdr->offset); struct cbfs_payload_segment *seg = pay->segments; for (;;) { void *src = (void*)pay + be32_to_cpu(seg->offset); void *dest = (void*)(u32)be64_to_cpu(seg->load_addr); u32 src_len = be32_to_cpu(seg->len); u32 dest_len = be32_to_cpu(seg->mem_len); switch (seg->type) { case PAYLOAD_SEGMENT_BSS: dprintf(3, "BSS segment %d@%p\n", dest_len, dest); memset(dest, 0, dest_len); break; case PAYLOAD_SEGMENT_ENTRY: { dprintf(1, "Calling addr %p\n", dest); void (*func)() = dest; func(); return; } default: dprintf(3, "Segment %x %d@%p -> %d@%p\n" , seg->type, src_len, src, dest_len, dest); if (seg->compression == cpu_to_be32(CBFS_COMPRESS_NONE)) { if (src_len > dest_len) src_len = dest_len; memcpy(dest, src, src_len); } else if (CONFIG_LZMA && seg->compression == cpu_to_be32(CBFS_COMPRESS_LZMA)) { int ret = ulzma(dest, dest_len, src, src_len); if (ret < 0) return; src_len = ret; } else { dprintf(1, "No support for compression type %x\n" , seg->compression); return; } if (dest_len > src_len) memset(dest + src_len, 0, dest_len - src_len); break; } seg++; } } // Register payloads in "img/" directory with boot system. void cbfs_payload_setup(void) { if (!CONFIG_COREBOOT_FLASH) return; struct romfile_s *file = NULL; for (;;) { file = romfile_findprefix("img/", file); if (!file) break; struct cbfs_romfile_s *cfile; cfile = container_of(file, struct cbfs_romfile_s, file); const char *filename = file->name; char *desc = znprintf(MAXDESCSIZE, "Payload [%s]", &filename[4]); boot_add_cbfs(cfile->fhdr, desc, bootprio_find_named_rom(filename, 0)); } } tinyvisor/bios/src/block.c0000644006644000001440000002374712172661303016063 0ustar yuichi_xyusers// Disk setup and access // // Copyright (C) 2008,2009 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "disk.h" // struct ata_s #include "biosvar.h" // GET_GLOBAL #include "cmos.h" // inb_cmos #include "util.h" // dprintf #include "ata.h" // process_ata_op #include "ahci.h" // process_ahci_op #include "virtio-blk.h" // process_virtio_blk_op #include "blockcmd.h" // cdb_* u8 FloppyCount VARFSEG; u8 CDCount; struct drive_s *IDMap[3][BUILD_MAX_EXTDRIVE] VARFSEG; u8 *bounce_buf_fl VARFSEG; struct dpte_s DefaultDPTE VARLOW; struct drive_s * getDrive(u8 exttype, u8 extdriveoffset) { if (extdriveoffset >= ARRAY_SIZE(IDMap[0])) return NULL; struct drive_s *drive_gf = GET_GLOBAL(IDMap[exttype][extdriveoffset]); if (!drive_gf) return NULL; return GLOBALFLAT2GLOBAL(drive_gf); } int getDriveId(u8 exttype, struct drive_s *drive_g) { int i; for (i = 0; i < ARRAY_SIZE(IDMap[0]); i++) if (getDrive(exttype, i) == drive_g) return i; return -1; } int create_bounce_buf(void) { if (bounce_buf_fl) return 0; u8 *buf = malloc_low(CDROM_SECTOR_SIZE); if (!buf) { warn_noalloc(); return -1; } bounce_buf_fl = buf; return 0; } /**************************************************************** * Disk geometry translation ****************************************************************/ static u8 get_translation(struct drive_s *drive_g) { u8 type = GET_GLOBAL(drive_g->type); if (CONFIG_QEMU && type == DTYPE_ATA) { // Emulators pass in the translation info via nvram. u8 ataid = GET_GLOBAL(drive_g->cntl_id); u8 channel = ataid / 2; u8 translation = inb_cmos(CMOS_BIOS_DISKTRANSFLAG + channel/2); translation >>= 2 * (ataid % 4); translation &= 0x03; return translation; } // Otherwise use a heuristic to determine translation type. u16 heads = GET_GLOBAL(drive_g->pchs.heads); u16 cylinders = GET_GLOBAL(drive_g->pchs.cylinders); u16 spt = GET_GLOBAL(drive_g->pchs.spt); u64 sectors = GET_GLOBAL(drive_g->sectors); u64 psectors = (u64)heads * cylinders * spt; if (!heads || !cylinders || !spt || psectors > sectors) // pchs doesn't look valid - use LBA. return TRANSLATION_LBA; if (cylinders <= 1024 && heads <= 16 && spt <= 63) return TRANSLATION_NONE; if (cylinders * heads <= 131072) return TRANSLATION_LARGE; return TRANSLATION_LBA; } static void setup_translation(struct drive_s *drive_g) { u8 translation = get_translation(drive_g); SET_GLOBAL(drive_g->translation, translation); u16 heads = GET_GLOBAL(drive_g->pchs.heads); u16 cylinders = GET_GLOBAL(drive_g->pchs.cylinders); u16 spt = GET_GLOBAL(drive_g->pchs.spt); u64 sectors = GET_GLOBAL(drive_g->sectors); const char *desc = NULL; switch (translation) { default: case TRANSLATION_NONE: desc = "none"; break; case TRANSLATION_LBA: desc = "lba"; spt = 63; if (sectors > 63*255*1024) { heads = 255; cylinders = 1024; break; } u32 sect = (u32)sectors / 63; heads = sect / 1024; if (heads>128) heads = 255; else if (heads>64) heads = 128; else if (heads>32) heads = 64; else if (heads>16) heads = 32; else heads = 16; cylinders = sect / heads; break; case TRANSLATION_RECHS: desc = "r-echs"; // Take care not to overflow if (heads==16) { if (cylinders>61439) cylinders=61439; heads=15; cylinders = (u16)((u32)(cylinders)*16/15); } // then go through the large bitshift process case TRANSLATION_LARGE: if (translation == TRANSLATION_LARGE) desc = "large"; while (cylinders > 1024) { cylinders >>= 1; heads <<= 1; // If we max out the head count if (heads > 127) break; } break; } // clip to 1024 cylinders in lchs if (cylinders > 1024) cylinders = 1024; dprintf(1, "drive %p: PCHS=%u/%d/%d translation=%s LCHS=%d/%d/%d s=%d\n" , drive_g , drive_g->pchs.cylinders, drive_g->pchs.heads, drive_g->pchs.spt , desc , cylinders, heads, spt , (u32)sectors); SET_GLOBAL(drive_g->lchs.heads, heads); SET_GLOBAL(drive_g->lchs.cylinders, cylinders); SET_GLOBAL(drive_g->lchs.spt, spt); } /**************************************************************** * Drive mapping ****************************************************************/ // Fill in Fixed Disk Parameter Table (located in ebda). static void fill_fdpt(struct drive_s *drive_g, int hdid) { if (hdid > 1) return; u16 nlc = GET_GLOBAL(drive_g->lchs.cylinders); u16 nlh = GET_GLOBAL(drive_g->lchs.heads); u16 nlspt = GET_GLOBAL(drive_g->lchs.spt); u16 npc = GET_GLOBAL(drive_g->pchs.cylinders); u16 nph = GET_GLOBAL(drive_g->pchs.heads); u16 npspt = GET_GLOBAL(drive_g->pchs.spt); struct fdpt_s *fdpt = &get_ebda_ptr()->fdpt[hdid]; fdpt->precompensation = 0xffff; fdpt->drive_control_byte = 0xc0 | ((nph > 8) << 3); fdpt->landing_zone = npc; fdpt->cylinders = nlc; fdpt->heads = nlh; fdpt->sectors = nlspt; if (nlc != npc || nlh != nph || nlspt != npspt) { // Logical mapping present - use extended structure. // complies with Phoenix style Translated Fixed Disk Parameter // Table (FDPT) fdpt->phys_cylinders = npc; fdpt->phys_heads = nph; fdpt->phys_sectors = npspt; fdpt->a0h_signature = 0xa0; // Checksum structure. fdpt->checksum -= checksum(fdpt, sizeof(*fdpt)); } if (hdid == 0) SET_IVT(0x41, SEGOFF(get_ebda_seg(), offsetof( struct extended_bios_data_area_s, fdpt[0]))); else SET_IVT(0x46, SEGOFF(get_ebda_seg(), offsetof( struct extended_bios_data_area_s, fdpt[1]))); } // Find spot to add a drive static void add_drive(struct drive_s **idmap, u8 *count, struct drive_s *drive_g) { if (*count >= ARRAY_SIZE(IDMap[0])) { warn_noalloc(); return; } idmap[*count] = drive_g; *count = *count + 1; } // Map a hard drive void map_hd_drive(struct drive_s *drive_g) { ASSERT32FLAT(); struct bios_data_area_s *bda = MAKE_FLATPTR(SEG_BDA, 0); int hdid = bda->hdcount; dprintf(3, "Mapping hd drive %p to %d\n", drive_g, hdid); add_drive(IDMap[EXTTYPE_HD], &bda->hdcount, drive_g); // Setup disk geometry translation. setup_translation(drive_g); // Fill "fdpt" structure. fill_fdpt(drive_g, hdid); } // Map a cd void map_cd_drive(struct drive_s *drive_g) { dprintf(3, "Mapping cd drive %p\n", drive_g); add_drive(IDMap[EXTTYPE_CD], &CDCount, drive_g); } // Map a floppy void map_floppy_drive(struct drive_s *drive_g) { dprintf(3, "Mapping floppy drive %p\n", drive_g); add_drive(IDMap[EXTTYPE_FLOPPY], &FloppyCount, drive_g); // Update equipment word bits for floppy if (FloppyCount == 1) { // 1 drive, ready for boot set_equipment_flags(0x41, 0x01); SET_BDA(floppy_harddisk_info, 0x07); } else if (FloppyCount >= 2) { // 2 drives, ready for boot set_equipment_flags(0x41, 0x41); SET_BDA(floppy_harddisk_info, 0x77); } } /**************************************************************** * 16bit calling interface ****************************************************************/ static int process_scsi_op(struct disk_op_s *op) { switch (op->command) { case CMD_READ: return cdb_read(op); case CMD_WRITE: return cdb_write(op); case CMD_FORMAT: case CMD_RESET: case CMD_ISREADY: case CMD_VERIFY: case CMD_SEEK: return DISK_RET_SUCCESS; default: op->count = 0; return DISK_RET_EPARAM; } } static int process_atapi_op(struct disk_op_s *op) { switch (op->command) { case CMD_WRITE: case CMD_FORMAT: return DISK_RET_EWRITEPROTECT; default: return process_scsi_op(op); } } // Execute a disk_op request. int process_op(struct disk_op_s *op) { ASSERT16(); u8 type = GET_GLOBAL(op->drive_g->type); switch (type) { case DTYPE_FLOPPY: return process_floppy_op(op); case DTYPE_ATA: return process_ata_op(op); case DTYPE_RAMDISK: return process_ramdisk_op(op); case DTYPE_CDEMU: return process_cdemu_op(op); case DTYPE_VIRTIO_BLK: return process_virtio_blk_op(op); case DTYPE_AHCI: return process_ahci_op(op); case DTYPE_ATA_ATAPI: case DTYPE_AHCI_ATAPI: return process_atapi_op(op); case DTYPE_USB: case DTYPE_UAS: case DTYPE_VIRTIO_SCSI: case DTYPE_LSI_SCSI: case DTYPE_ESP_SCSI: case DTYPE_MEGASAS: return process_scsi_op(op); default: op->count = 0; return DISK_RET_EPARAM; } } // Execute a "disk_op_s" request - this runs on the extra stack. static int __send_disk_op(struct disk_op_s *op_far, u16 op_seg) { struct disk_op_s dop; memcpy_far(GET_SEG(SS), &dop , op_seg, op_far , sizeof(dop)); dprintf(DEBUG_HDL_13, "disk_op d=%p lba=%d buf=%p count=%d cmd=%d\n" , dop.drive_g, (u32)dop.lba, dop.buf_fl , dop.count, dop.command); int status = process_op(&dop); // Update count with total sectors transferred. SET_FARVAR(op_seg, op_far->count, dop.count); return status; } // Execute a "disk_op_s" request by jumping to the extra 16bit stack. int send_disk_op(struct disk_op_s *op) { ASSERT16(); if (! CONFIG_DRIVES) return -1; return stack_hop((u32)op, GET_SEG(SS), __send_disk_op); } tinyvisor/bios/src/usb-ehci.c0000644006644000001440000005246312172661303016465 0ustar yuichi_xyusers// Code for handling EHCI USB controllers. // // Copyright (C) 2010 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "pci.h" // pci_bdf_to_bus #include "config.h" // CONFIG_* #include "ioport.h" // outw #include "usb-ehci.h" // struct ehci_qh #include "pci_ids.h" // PCI_CLASS_SERIAL_USB_UHCI #include "pci_regs.h" // PCI_BASE_ADDRESS_0 #include "usb.h" // struct usb_s #include "biosvar.h" // GET_LOWFLAT #include "usb-uhci.h" // uhci_setup #include "usb-ohci.h" // ohci_setup struct usb_ehci_s { struct usb_s usb; struct ehci_caps *caps; struct ehci_regs *regs; struct ehci_qh *async_qh; struct pci_device *companion[8]; int checkports; int legacycount; }; struct ehci_pipe { struct ehci_qh qh; struct ehci_qtd *next_td, *tds; void *data; struct usb_pipe pipe; }; /**************************************************************** * Root hub ****************************************************************/ #define EHCI_TIME_POSTPOWER 20 #define EHCI_TIME_POSTRESET 2 // Check if need companion controllers for full/low speed devices static void ehci_note_port(struct usb_ehci_s *cntl) { if (--cntl->checkports) // Ports still being detected. return; if (! cntl->legacycount) // No full/low speed devices found. return; // Start companion controllers. int i; for (i=0; icompanion); i++) { struct pci_device *pci = cntl->companion[i]; if (!pci) break; // ohci/uhci_setup call pci_config_X - don't run from irq handler. wait_preempt(); if (pci_classprog(pci) == PCI_CLASS_SERIAL_USB_UHCI) uhci_setup(pci, cntl->usb.busid + i); else if (pci_classprog(pci) == PCI_CLASS_SERIAL_USB_OHCI) ohci_setup(pci, cntl->usb.busid + i); } } // Check if device attached to port static int ehci_hub_detect(struct usbhub_s *hub, u32 port) { struct usb_ehci_s *cntl = container_of(hub->cntl, struct usb_ehci_s, usb); u32 *portreg = &cntl->regs->portsc[port]; u32 portsc = readl(portreg); // Power up port. if (!(portsc & PORT_POWER)) { portsc |= PORT_POWER; writel(portreg, portsc); msleep(EHCI_TIME_POSTPOWER); } else { // Port is already powered up, but we don't know how long it // has been powered up, so wait the 20ms. msleep(EHCI_TIME_POSTPOWER); } portsc = readl(portreg); if (!(portsc & PORT_CONNECT)) // No device present goto doneearly; if ((portsc & PORT_LINESTATUS_MASK) == PORT_LINESTATUS_KSTATE) { // low speed device cntl->legacycount++; writel(portreg, portsc | PORT_OWNER); goto doneearly; } // XXX - if just powered up, need to wait for USB_TIME_ATTDB? // Begin reset on port portsc = (portsc & ~PORT_PE) | PORT_RESET; writel(portreg, portsc); msleep(USB_TIME_DRSTR); return 0; doneearly: ehci_note_port(cntl); return -1; } // Reset device on port static int ehci_hub_reset(struct usbhub_s *hub, u32 port) { struct usb_ehci_s *cntl = container_of(hub->cntl, struct usb_ehci_s, usb); u32 *portreg = &cntl->regs->portsc[port]; u32 portsc = readl(portreg); // Finish reset on port portsc &= ~PORT_RESET; writel(portreg, portsc); msleep(EHCI_TIME_POSTRESET); int rv = -1; portsc = readl(portreg); if (!(portsc & PORT_CONNECT)) // No longer connected goto resetfail; if (!(portsc & PORT_PE)) { // full speed device cntl->legacycount++; writel(portreg, portsc | PORT_OWNER); goto resetfail; } rv = USB_HIGHSPEED; resetfail: ehci_note_port(cntl); return rv; } // Disable port static void ehci_hub_disconnect(struct usbhub_s *hub, u32 port) { struct usb_ehci_s *cntl = container_of(hub->cntl, struct usb_ehci_s, usb); u32 *portreg = &cntl->regs->portsc[port]; u32 portsc = readl(portreg); writel(portreg, portsc & ~PORT_PE); } static struct usbhub_op_s ehci_HubOp = { .detect = ehci_hub_detect, .reset = ehci_hub_reset, .disconnect = ehci_hub_disconnect, }; // Find any devices connected to the root hub. static int check_ehci_ports(struct usb_ehci_s *cntl) { ASSERT32FLAT(); struct usbhub_s hub; memset(&hub, 0, sizeof(hub)); hub.cntl = &cntl->usb; hub.portcount = cntl->checkports; hub.op = &ehci_HubOp; usb_enumerate(&hub); return hub.devcount; } /**************************************************************** * Setup ****************************************************************/ // Wait for next USB async frame to start - for ensuring safe memory release. static void ehci_waittick(struct usb_ehci_s *cntl) { if (MODE16) { msleep(10); return; } // Wait for access to "doorbell" barrier(); u32 cmd, sts; u64 end = calc_future_tsc(100); for (;;) { sts = readl(&cntl->regs->usbsts); if (!(sts & STS_IAA)) { cmd = readl(&cntl->regs->usbcmd); if (!(cmd & CMD_IAAD)) break; } if (check_tsc(end)) { warn_timeout(); return; } yield(); } // Ring "doorbell" writel(&cntl->regs->usbcmd, cmd | CMD_IAAD); // Wait for completion for (;;) { sts = readl(&cntl->regs->usbsts); if (sts & STS_IAA) break; if (check_tsc(end)) { warn_timeout(); return; } yield(); } // Ack completion writel(&cntl->regs->usbsts, STS_IAA); } static void ehci_free_pipes(struct usb_ehci_s *cntl) { dprintf(7, "ehci_free_pipes %p\n", cntl); struct ehci_qh *start = cntl->async_qh; struct ehci_qh *pos = start; for (;;) { struct ehci_qh *next = (void*)(pos->next & ~EHCI_PTR_BITS); if (next == start) break; struct ehci_pipe *pipe = container_of(next, struct ehci_pipe, qh); if (pipe->pipe.cntl != &cntl->usb) pos->next = next->next; else pos = next; } ehci_waittick(cntl); for (;;) { struct usb_pipe *usbpipe = cntl->usb.freelist; if (!usbpipe) break; cntl->usb.freelist = usbpipe->freenext; struct ehci_pipe *pipe = container_of(usbpipe, struct ehci_pipe, pipe); free(pipe); } } static void configure_ehci(void *data) { struct usb_ehci_s *cntl = data; // Allocate ram for schedule storage struct ehci_framelist *fl = memalign_high(sizeof(*fl), sizeof(*fl)); struct ehci_qh *intr_qh = memalign_high(EHCI_QH_ALIGN, sizeof(*intr_qh)); struct ehci_qh *async_qh = memalign_high(EHCI_QH_ALIGN, sizeof(*async_qh)); if (!fl || !intr_qh || !async_qh) { warn_noalloc(); goto fail; } // XXX - check for halted? // Reset the HC u32 cmd = readl(&cntl->regs->usbcmd); writel(&cntl->regs->usbcmd, (cmd & ~(CMD_ASE | CMD_PSE)) | CMD_HCRESET); u64 end = calc_future_tsc(250); for (;;) { cmd = readl(&cntl->regs->usbcmd); if (!(cmd & CMD_HCRESET)) break; if (check_tsc(end)) { warn_timeout(); goto fail; } yield(); } // Disable interrupts (just to be safe). writel(&cntl->regs->usbintr, 0); // Set schedule to point to primary intr queue head memset(intr_qh, 0, sizeof(*intr_qh)); intr_qh->next = EHCI_PTR_TERM; intr_qh->info2 = (0x01 << QH_SMASK_SHIFT); intr_qh->token = QTD_STS_HALT; intr_qh->qtd_next = intr_qh->alt_next = EHCI_PTR_TERM; int i; for (i=0; ilinks); i++) fl->links[i] = (u32)intr_qh | EHCI_PTR_QH; writel(&cntl->regs->periodiclistbase, (u32)fl); // Set async list to point to primary async queue head memset(async_qh, 0, sizeof(*async_qh)); async_qh->next = (u32)async_qh | EHCI_PTR_QH; async_qh->info1 = QH_HEAD; async_qh->token = QTD_STS_HALT; async_qh->qtd_next = async_qh->alt_next = EHCI_PTR_TERM; cntl->async_qh = async_qh; writel(&cntl->regs->asynclistbase, (u32)async_qh); // Enable queues writel(&cntl->regs->usbcmd, cmd | CMD_ASE | CMD_PSE | CMD_RUN); // Set default of high speed for root hub. writel(&cntl->regs->configflag, 1); cntl->checkports = readl(&cntl->caps->hcsparams) & HCS_N_PORTS_MASK; // Find devices int count = check_ehci_ports(cntl); ehci_free_pipes(cntl); if (count) // Success return; // No devices found - shutdown and free controller. writel(&cntl->regs->usbcmd, cmd & ~CMD_RUN); msleep(4); // 2ms to stop reading memory - XXX fail: free(fl); free(intr_qh); free(async_qh); free(cntl); } int ehci_setup(struct pci_device *pci, int busid, struct pci_device *comppci) { if (! CONFIG_USB_EHCI) return -1; u16 bdf = pci->bdf; u32 baseaddr = pci_config_readl(bdf, PCI_BASE_ADDRESS_0); struct ehci_caps *caps = (void*)(baseaddr & PCI_BASE_ADDRESS_MEM_MASK); u32 hcc_params = readl(&caps->hccparams); struct usb_ehci_s *cntl = malloc_tmphigh(sizeof(*cntl)); if (!cntl) { warn_noalloc(); return -1; } memset(cntl, 0, sizeof(*cntl)); cntl->usb.busid = busid; cntl->usb.pci = pci; cntl->usb.type = USB_TYPE_EHCI; cntl->caps = caps; cntl->regs = (void*)caps + readb(&caps->caplength); if (hcc_params & HCC_64BIT_ADDR) cntl->regs->ctrldssegment = 0; dprintf(1, "EHCI init on dev %02x:%02x.%x (regs=%p)\n" , pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf) , pci_bdf_to_fn(bdf), cntl->regs); pci_config_maskw(bdf, PCI_COMMAND, 0, PCI_COMMAND_MASTER); // XXX - check for and disable SMM control? // Find companion controllers. int count = 0; for (;;) { if (!comppci || comppci == pci) break; if (pci_classprog(comppci) == PCI_CLASS_SERIAL_USB_UHCI) cntl->companion[count++] = comppci; else if (pci_classprog(comppci) == PCI_CLASS_SERIAL_USB_OHCI) cntl->companion[count++] = comppci; comppci = container_of(comppci->node.next, struct pci_device, node); } run_thread(configure_ehci, cntl); return 0; } /**************************************************************** * End point communication ****************************************************************/ // Setup fields in qh static void ehci_desc2pipe(struct ehci_pipe *pipe, struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc) { usb_desc2pipe(&pipe->pipe, usbdev, epdesc); pipe->qh.info1 = ((pipe->pipe.maxpacket << QH_MAXPACKET_SHIFT) | (pipe->pipe.speed << QH_SPEED_SHIFT) | (pipe->pipe.ep << QH_EP_SHIFT) | (pipe->pipe.devaddr << QH_DEVADDR_SHIFT)); pipe->qh.info2 = (1 << QH_MULT_SHIFT); struct usbdevice_s *hubdev = usbdev->hub->usbdev; if (hubdev) { struct ehci_pipe *hpipe = container_of( hubdev->defpipe, struct ehci_pipe, pipe); if (hpipe->pipe.speed == USB_HIGHSPEED) pipe->qh.info2 |= ((usbdev->port << QH_HUBPORT_SHIFT) | (hpipe->pipe.devaddr << QH_HUBADDR_SHIFT)); else pipe->qh.info2 = hpipe->qh.info2; } u8 eptype = epdesc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; if (eptype == USB_ENDPOINT_XFER_CONTROL) pipe->qh.info1 |= ((pipe->pipe.speed != USB_HIGHSPEED ? QH_CONTROL : 0) | QH_TOGGLECONTROL); else if (eptype == USB_ENDPOINT_XFER_INT) pipe->qh.info2 |= (0x01 << QH_SMASK_SHIFT) | (0x1c << QH_CMASK_SHIFT); } static struct usb_pipe * ehci_alloc_intr_pipe(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc) { struct usb_ehci_s *cntl = container_of( usbdev->hub->cntl, struct usb_ehci_s, usb); int frameexp = usb_getFrameExp(usbdev, epdesc); dprintf(7, "ehci_alloc_intr_pipe %p %d\n", &cntl->usb, frameexp); if (frameexp > 10) frameexp = 10; int maxpacket = epdesc->wMaxPacketSize; // Determine number of entries needed for 2 timer ticks. int ms = 1<next_td = pipe->tds = tds; pipe->data = data; pipe->qh.qtd_next = (u32)tds; int i; for (i=0; iqtd_next = (i==count-1 ? (u32)tds : (u32)&td[1]); td->alt_next = EHCI_PTR_TERM; td->token = (ehci_explen(maxpacket) | QTD_STS_ACTIVE | QTD_PID_IN | ehci_maxerr(3)); td->buf[0] = (u32)data + maxpacket * i; } // Add to interrupt schedule. struct ehci_framelist *fl = (void*)readl(&cntl->regs->periodiclistbase); if (frameexp == 0) { // Add to existing interrupt entry. struct ehci_qh *intr_qh = (void*)(fl->links[0] & ~EHCI_PTR_BITS); pipe->qh.next = intr_qh->next; barrier(); intr_qh->next = (u32)&pipe->qh | EHCI_PTR_QH; } else { int startpos = 1<<(frameexp-1); pipe->qh.next = fl->links[startpos]; barrier(); for (i=startpos; ilinks); i+=ms) fl->links[i] = (u32)&pipe->qh | EHCI_PTR_QH; } return &pipe->pipe; fail: free(pipe); free(tds); free(data); return NULL; } struct usb_pipe * ehci_alloc_pipe(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc) { if (! CONFIG_USB_EHCI) return NULL; u8 eptype = epdesc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; if (eptype == USB_ENDPOINT_XFER_INT) return ehci_alloc_intr_pipe(usbdev, epdesc); struct usb_ehci_s *cntl = container_of( usbdev->hub->cntl, struct usb_ehci_s, usb); dprintf(7, "ehci_alloc_async_pipe %p %d\n", &cntl->usb, eptype); struct usb_pipe *usbpipe = usb_getFreePipe(&cntl->usb, eptype); if (usbpipe) { // Use previously allocated pipe. struct ehci_pipe *pipe = container_of(usbpipe, struct ehci_pipe, pipe); ehci_desc2pipe(pipe, usbdev, epdesc); return usbpipe; } // Allocate a new queue head. struct ehci_pipe *pipe; if (eptype == USB_ENDPOINT_XFER_CONTROL) pipe = memalign_tmphigh(EHCI_QH_ALIGN, sizeof(*pipe)); else pipe = memalign_low(EHCI_QH_ALIGN, sizeof(*pipe)); if (!pipe) { warn_noalloc(); return NULL; } memset(pipe, 0, sizeof(*pipe)); ehci_desc2pipe(pipe, usbdev, epdesc); pipe->qh.qtd_next = pipe->qh.alt_next = EHCI_PTR_TERM; // Add queue head to controller list. struct ehci_qh *async_qh = cntl->async_qh; pipe->qh.next = async_qh->next; barrier(); async_qh->next = (u32)&pipe->qh | EHCI_PTR_QH; return &pipe->pipe; } static void ehci_reset_pipe(struct ehci_pipe *pipe) { SET_LOWFLAT(pipe->qh.qtd_next, EHCI_PTR_TERM); SET_LOWFLAT(pipe->qh.alt_next, EHCI_PTR_TERM); barrier(); SET_LOWFLAT(pipe->qh.token, GET_LOWFLAT(pipe->qh.token) & QTD_TOGGLE); } static int ehci_wait_td(struct ehci_pipe *pipe, struct ehci_qtd *td, int timeout) { u64 end = calc_future_tsc(timeout); u32 status; for (;;) { status = td->token; if (!(status & QTD_STS_ACTIVE)) break; if (check_tsc(end)) { u32 cur = GET_LOWFLAT(pipe->qh.current); u32 tok = GET_LOWFLAT(pipe->qh.token); u32 next = GET_LOWFLAT(pipe->qh.qtd_next); warn_timeout(); dprintf(1, "ehci pipe=%p cur=%08x tok=%08x next=%x td=%p status=%x\n" , pipe, cur, tok, next, td, status); ehci_reset_pipe(pipe); struct usb_ehci_s *cntl = container_of( GET_LOWFLAT(pipe->pipe.cntl), struct usb_ehci_s, usb); ehci_waittick(cntl); return -1; } yield(); } if (status & QTD_STS_HALT) { dprintf(1, "ehci_wait_td error - status=%x\n", status); ehci_reset_pipe(pipe); return -2; } return 0; } static int fillTDbuffer(struct ehci_qtd *td, u16 maxpacket, const void *buf, int bytes) { u32 dest = (u32)buf; u32 *pos = td->buf; while (bytes) { if (pos >= &td->buf[ARRAY_SIZE(td->buf)]) // More data than can transfer in a single qtd - only use // full packets to prevent a babble error. return ALIGN_DOWN(dest - (u32)buf, maxpacket); u32 count = bytes; u32 max = 0x1000 - (dest & 0xfff); if (count > max) count = max; *pos = dest; bytes -= count; dest += count; pos++; } return dest - (u32)buf; } int ehci_control(struct usb_pipe *p, int dir, const void *cmd, int cmdsize , void *data, int datasize) { ASSERT32FLAT(); if (! CONFIG_USB_EHCI) return -1; dprintf(5, "ehci_control %p (dir=%d cmd=%d data=%d)\n" , p, dir, cmdsize, datasize); if (datasize > 4*4096 || cmdsize > 4*4096) { // XXX - should support larger sizes. warn_noalloc(); return -1; } struct ehci_pipe *pipe = container_of(p, struct ehci_pipe, pipe); // Setup transfer descriptors struct ehci_qtd *tds = memalign_tmphigh(EHCI_QTD_ALIGN, sizeof(*tds) * 3); if (!tds) { warn_noalloc(); return -1; } memset(tds, 0, sizeof(*tds) * 3); struct ehci_qtd *td = tds; td->qtd_next = (u32)&td[1]; td->alt_next = EHCI_PTR_TERM; td->token = (ehci_explen(cmdsize) | QTD_STS_ACTIVE | QTD_PID_SETUP | ehci_maxerr(3)); u16 maxpacket = pipe->pipe.maxpacket; fillTDbuffer(td, maxpacket, cmd, cmdsize); td++; if (datasize) { td->qtd_next = (u32)&td[1]; td->alt_next = EHCI_PTR_TERM; td->token = (QTD_TOGGLE | ehci_explen(datasize) | QTD_STS_ACTIVE | (dir ? QTD_PID_IN : QTD_PID_OUT) | ehci_maxerr(3)); fillTDbuffer(td, maxpacket, data, datasize); td++; } td->qtd_next = EHCI_PTR_TERM; td->alt_next = EHCI_PTR_TERM; td->token = (QTD_TOGGLE | QTD_STS_ACTIVE | (dir ? QTD_PID_OUT : QTD_PID_IN) | ehci_maxerr(3)); // Transfer data barrier(); pipe->qh.qtd_next = (u32)tds; int i, ret=0; for (i=0; i<3; i++) { struct ehci_qtd *td = &tds[i]; ret = ehci_wait_td(pipe, td, 500); if (ret) break; } free(tds); return ret; } #define STACKQTDS 4 int ehci_send_bulk(struct usb_pipe *p, int dir, void *data, int datasize) { if (! CONFIG_USB_EHCI) return -1; struct ehci_pipe *pipe = container_of(p, struct ehci_pipe, pipe); dprintf(7, "ehci_send_bulk qh=%p dir=%d data=%p size=%d\n" , &pipe->qh, dir, data, datasize); // Allocate 4 tds on stack (with required alignment) u8 tdsbuf[sizeof(struct ehci_qtd) * STACKQTDS + EHCI_QTD_ALIGN - 1]; struct ehci_qtd *tds = (void*)ALIGN((u32)tdsbuf, EHCI_QTD_ALIGN); memset(tds, 0, sizeof(*tds) * STACKQTDS); barrier(); SET_LOWFLAT(pipe->qh.qtd_next, (u32)MAKE_FLATPTR(GET_SEG(SS), tds)); u16 maxpacket = GET_LOWFLAT(pipe->pipe.maxpacket); int tdpos = 0; while (datasize) { struct ehci_qtd *td = &tds[tdpos++ % STACKQTDS]; int ret = ehci_wait_td(pipe, td, 5000); if (ret) return -1; struct ehci_qtd *nexttd_fl = MAKE_FLATPTR(GET_SEG(SS) , &tds[tdpos % STACKQTDS]); int transfer = fillTDbuffer(td, maxpacket, data, datasize); td->qtd_next = (transfer==datasize ? EHCI_PTR_TERM : (u32)nexttd_fl); td->alt_next = EHCI_PTR_TERM; barrier(); td->token = (ehci_explen(transfer) | QTD_STS_ACTIVE | (dir ? QTD_PID_IN : QTD_PID_OUT) | ehci_maxerr(3)); data += transfer; datasize -= transfer; } int i; for (i=0; inext_td); u32 token = GET_LOWFLAT(td->token); if (token & QTD_STS_ACTIVE) // No intrs found. return -1; // XXX - check for errors. // Copy data. int maxpacket = GET_LOWFLAT(pipe->pipe.maxpacket); int pos = td - GET_LOWFLAT(pipe->tds); void *tddata = GET_LOWFLAT(pipe->data) + maxpacket * pos; memcpy_far(GET_SEG(SS), data, SEG_LOW, LOWFLAT2LOW(tddata), maxpacket); // Reenable this td. struct ehci_qtd *next = (void*)(GET_LOWFLAT(td->qtd_next) & ~EHCI_PTR_BITS); SET_LOWFLAT(pipe->next_td, next); SET_LOWFLAT(td->buf[0], (u32)tddata); barrier(); SET_LOWFLAT(td->token, (ehci_explen(maxpacket) | QTD_STS_ACTIVE | QTD_PID_IN | ehci_maxerr(3))); return 0; } tinyvisor/bios/src/acpi-dsdt-cpu-hotplug.dsl0000644006644000001440000000522012172661303021430 0ustar yuichi_xyusers/**************************************************************** * CPU hotplug ****************************************************************/ Scope(\_SB) { /* Objects filled in by run-time generated SSDT */ External(NTFY, MethodObj) External(CPON, PkgObj) /* Methods called by run-time generated SSDT Processor objects */ Method(CPMA, 1, NotSerialized) { // _MAT method - create an madt apic buffer // Arg0 = Processor ID = Local APIC ID // Local0 = CPON flag for this cpu Store(DerefOf(Index(CPON, Arg0)), Local0) // Local1 = Buffer (in madt apic form) to return Store(Buffer(8) {0x00, 0x08, 0x00, 0x00, 0x00, 0, 0, 0}, Local1) // Update the processor id, lapic id, and enable/disable status Store(Arg0, Index(Local1, 2)) Store(Arg0, Index(Local1, 3)) Store(Local0, Index(Local1, 4)) Return (Local1) } Method(CPST, 1, NotSerialized) { // _STA method - return ON status of cpu // Arg0 = Processor ID = Local APIC ID // Local0 = CPON flag for this cpu Store(DerefOf(Index(CPON, Arg0)), Local0) If (Local0) { Return (0xF) } Else { Return (0x0) } } Method(CPEJ, 2, NotSerialized) { // _EJ0 method - eject callback Sleep(200) } /* CPU hotplug notify method */ OperationRegion(PRST, SystemIO, 0xaf00, 32) Field(PRST, ByteAcc, NoLock, Preserve) { PRS, 256 } Method(PRSC, 0) { // Local5 = active cpu bitmap Store(PRS, Local5) // Local2 = last read byte from bitmap Store(Zero, Local2) // Local0 = Processor ID / APIC ID iterator Store(Zero, Local0) While (LLess(Local0, SizeOf(CPON))) { // Local1 = CPON flag for this cpu Store(DerefOf(Index(CPON, Local0)), Local1) If (And(Local0, 0x07)) { // Shift down previously read bitmap byte ShiftRight(Local2, 1, Local2) } Else { // Read next byte from cpu bitmap Store(DerefOf(Index(Local5, ShiftRight(Local0, 3))), Local2) } // Local3 = active state for this cpu Store(And(Local2, 1), Local3) If (LNotEqual(Local1, Local3)) { // State change - update CPON with new state Store(Local3, Index(CPON, Local0)) // Do CPU notify If (LEqual(Local3, 1)) { NTFY(Local0, 1) } Else { NTFY(Local0, 3) } } Increment(Local0) } } } tinyvisor/bios/src/blockcmd.c0000644006644000001440000002071712172661303016541 0ustar yuichi_xyusers// Support for several common scsi like command data block requests // // Copyright (C) 2010 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "biosvar.h" // GET_GLOBAL #include "util.h" // dprintf #include "byteorder.h" // be32_to_cpu #include "disk.h" // struct disk_op_s #include "blockcmd.h" // struct cdb_request_sense #include "ata.h" // atapi_cmd_data #include "ahci.h" // atapi_cmd_data #include "usb-msc.h" // usb_cmd_data #include "usb-uas.h" // usb_cmd_data #include "virtio-scsi.h" // virtio_scsi_cmd_data #include "lsi-scsi.h" // lsi_scsi_cmd_data #include "esp-scsi.h" // esp_scsi_cmd_data #include "megasas.h" // megasas_cmd_data #include "boot.h" // boot_add_hd // Route command to low-level handler. static int cdb_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize) { u8 type = GET_GLOBAL(op->drive_g->type); switch (type) { case DTYPE_ATA_ATAPI: return atapi_cmd_data(op, cdbcmd, blocksize); case DTYPE_USB: return usb_cmd_data(op, cdbcmd, blocksize); case DTYPE_UAS: return uas_cmd_data(op, cdbcmd, blocksize); case DTYPE_AHCI_ATAPI: return ahci_cmd_data(op, cdbcmd, blocksize); case DTYPE_VIRTIO_SCSI: return virtio_scsi_cmd_data(op, cdbcmd, blocksize); case DTYPE_LSI_SCSI: return lsi_scsi_cmd_data(op, cdbcmd, blocksize); case DTYPE_ESP_SCSI: return esp_scsi_cmd_data(op, cdbcmd, blocksize); case DTYPE_MEGASAS: return megasas_cmd_data(op, cdbcmd, blocksize); default: op->count = 0; return DISK_RET_EPARAM; } } // Determine if the command is a request to pull data from the device int cdb_is_read(u8 *cdbcmd, u16 blocksize) { return blocksize && cdbcmd[0] != CDB_CMD_WRITE_10; } int scsi_is_ready(struct disk_op_s *op) { dprintf(6, "scsi_is_ready (drive=%p)\n", op->drive_g); /* Retry TEST UNIT READY for 5 seconds unless MEDIUM NOT PRESENT is * reported by the device. If the device reports "IN PROGRESS", * 30 seconds is added. */ int in_progress = 0; u64 end = calc_future_tsc(5000); for (;;) { if (check_tsc(end)) { dprintf(1, "test unit ready failed\n"); return -1; } int ret = cdb_test_unit_ready(op); if (!ret) // Success break; struct cdbres_request_sense sense; ret = cdb_get_sense(op, &sense); if (ret) // Error - retry. continue; // Sense succeeded. if (sense.asc == 0x3a) { /* MEDIUM NOT PRESENT */ dprintf(1, "Device reports MEDIUM NOT PRESENT\n"); return -1; } if (sense.asc == 0x04 && sense.ascq == 0x01 && !in_progress) { /* IN PROGRESS OF BECOMING READY */ printf("Waiting for device to detect medium... "); /* Allow 30 seconds more */ end = calc_future_tsc(30000); in_progress = 1; } } return 0; } // Validate drive, find block size / sector count, and register drive. int scsi_drive_setup(struct drive_s *drive, const char *s, int prio) { struct disk_op_s dop; memset(&dop, 0, sizeof(dop)); dop.drive_g = drive; struct cdbres_inquiry data; int ret = cdb_get_inquiry(&dop, &data); if (ret) return ret; char vendor[sizeof(data.vendor)+1], product[sizeof(data.product)+1]; char rev[sizeof(data.rev)+1]; strtcpy(vendor, data.vendor, sizeof(vendor)); nullTrailingSpace(vendor); strtcpy(product, data.product, sizeof(product)); nullTrailingSpace(product); strtcpy(rev, data.rev, sizeof(rev)); nullTrailingSpace(rev); int pdt = data.pdt & 0x1f; int removable = !!(data.removable & 0x80); dprintf(1, "%s vendor='%s' product='%s' rev='%s' type=%d removable=%d\n" , s, vendor, product, rev, pdt, removable); drive->removable = removable; if (pdt == SCSI_TYPE_CDROM) { drive->blksize = CDROM_SECTOR_SIZE; drive->sectors = (u64)-1; char *desc = znprintf(MAXDESCSIZE, "DVD/CD [%s Drive %s %s %s]" , s, vendor, product, rev); boot_add_cd(drive, desc, prio); return 0; } ret = scsi_is_ready(&dop); if (ret) { dprintf(1, "scsi_is_ready returned %d\n", ret); return ret; } struct cdbres_read_capacity capdata; ret = cdb_read_capacity(&dop, &capdata); if (ret) return ret; // READ CAPACITY returns the address of the last block. // We do not bother with READ CAPACITY(16) because BIOS does not support // 64-bit LBA anyway. drive->blksize = be32_to_cpu(capdata.blksize); if (drive->blksize != DISK_SECTOR_SIZE) { dprintf(1, "%s: unsupported block size %d\n", s, drive->blksize); return -1; } drive->sectors = (u64)be32_to_cpu(capdata.sectors) + 1; dprintf(1, "%s blksize=%d sectors=%d\n" , s, drive->blksize, (unsigned)drive->sectors); // We do not recover from USB stalls, so try to be safe and avoid // sending the command if the (obsolete, but still provided by QEMU) // fixed disk geometry page may not be supported. // // We could also send the command only to small disks (e.g. <504MiB) // but some old USB keys only support a very small subset of SCSI which // does not even include the MODE SENSE command! // if (CONFIG_QEMU_HARDWARE && memcmp(vendor, "QEMU", 5) == 0) { struct cdbres_mode_sense_geom geomdata; ret = cdb_mode_sense_geom(&dop, &geomdata); if (ret == 0) { u32 cylinders; cylinders = geomdata.cyl[0] << 16; cylinders |= geomdata.cyl[1] << 8; cylinders |= geomdata.cyl[2]; if (cylinders && geomdata.heads && drive->sectors <= 0xFFFFFFFFULL && ((u32)drive->sectors % (geomdata.heads * cylinders) == 0)) { drive->pchs.cylinders = cylinders; drive->pchs.heads = geomdata.heads; drive->pchs.spt = (u32)drive->sectors / (geomdata.heads * cylinders); } } } char *desc = znprintf(MAXDESCSIZE, "%s Drive %s %s %s" , s, vendor, product, rev); boot_add_hd(drive, desc, prio); return 0; } int cdb_get_inquiry(struct disk_op_s *op, struct cdbres_inquiry *data) { struct cdb_request_sense cmd; memset(&cmd, 0, sizeof(cmd)); cmd.command = CDB_CMD_INQUIRY; cmd.length = sizeof(*data); op->count = 1; op->buf_fl = data; return cdb_cmd_data(op, &cmd, sizeof(*data)); } // Request SENSE int cdb_get_sense(struct disk_op_s *op, struct cdbres_request_sense *data) { struct cdb_request_sense cmd; memset(&cmd, 0, sizeof(cmd)); cmd.command = CDB_CMD_REQUEST_SENSE; cmd.length = sizeof(*data); op->count = 1; op->buf_fl = data; return cdb_cmd_data(op, &cmd, sizeof(*data)); } // Test unit ready int cdb_test_unit_ready(struct disk_op_s *op) { struct cdb_request_sense cmd; memset(&cmd, 0, sizeof(cmd)); cmd.command = CDB_CMD_TEST_UNIT_READY; op->count = 0; op->buf_fl = NULL; return cdb_cmd_data(op, &cmd, 0); } // Request capacity int cdb_read_capacity(struct disk_op_s *op, struct cdbres_read_capacity *data) { struct cdb_read_capacity cmd; memset(&cmd, 0, sizeof(cmd)); cmd.command = CDB_CMD_READ_CAPACITY; op->count = 1; op->buf_fl = data; return cdb_cmd_data(op, &cmd, sizeof(*data)); } // Mode sense, geometry page. int cdb_mode_sense_geom(struct disk_op_s *op, struct cdbres_mode_sense_geom *data) { struct cdb_mode_sense cmd; memset(&cmd, 0, sizeof(cmd)); cmd.command = CDB_CMD_MODE_SENSE; cmd.flags = 8; /* DBD */ cmd.page = MODE_PAGE_HD_GEOMETRY; cmd.count = cpu_to_be16(sizeof(*data)); op->count = 1; op->buf_fl = data; return cdb_cmd_data(op, &cmd, sizeof(*data)); } // Read sectors. int cdb_read(struct disk_op_s *op) { struct cdb_rwdata_10 cmd; memset(&cmd, 0, sizeof(cmd)); cmd.command = CDB_CMD_READ_10; cmd.lba = cpu_to_be32(op->lba); cmd.count = cpu_to_be16(op->count); return cdb_cmd_data(op, &cmd, GET_GLOBAL(op->drive_g->blksize)); } // Write sectors. int cdb_write(struct disk_op_s *op) { struct cdb_rwdata_10 cmd; memset(&cmd, 0, sizeof(cmd)); cmd.command = CDB_CMD_WRITE_10; cmd.lba = cpu_to_be32(op->lba); cmd.count = cpu_to_be16(op->count); return cdb_cmd_data(op, &cmd, GET_GLOBAL(op->drive_g->blksize)); } tinyvisor/bios/src/ssdt-pcihp.dsl0000644006644000001440000000223212172661303017371 0ustar yuichi_xyusersACPI_EXTRACT_ALL_CODE ssdp_pcihp_aml DefinitionBlock ("ssdt-pcihp.aml", "SSDT", 0x01, "BXPC", "BXSSDTPCIHP", 0x1) { /**************************************************************** * PCI hotplug ****************************************************************/ /* Objects supplied by DSDT */ External(\_SB.PCI0, DeviceObj) External(\_SB.PCI0.PCEJ, MethodObj) Scope(\_SB.PCI0) { /* Bulk generated PCI hotplug devices */ ACPI_EXTRACT_DEVICE_START ssdt_pcihp_start ACPI_EXTRACT_DEVICE_END ssdt_pcihp_end ACPI_EXTRACT_DEVICE_STRING ssdt_pcihp_name // Method _EJ0 can be patched by BIOS to EJ0_ // at runtime, if the slot is detected to not support hotplug. // Extract the offset of the address dword and the // _EJ0 name to allow this patching. Device(SAA) { ACPI_EXTRACT_NAME_BYTE_CONST ssdt_pcihp_id Name(_SUN, 0xAA) ACPI_EXTRACT_NAME_DWORD_CONST ssdt_pcihp_adr Name(_ADR, 0xAA0000) ACPI_EXTRACT_METHOD_STRING ssdt_pcihp_ej0 Method(_EJ0, 1) { Return (PCEJ(_SUN)) } } } } tinyvisor/bios/src/usb-uas.h0000644006644000001440000000033512172661303016341 0ustar yuichi_xyusers#ifndef __USB_UAS_H #define __USB_UAS_H struct disk_op_s; int uas_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize); struct usbdevice_s; int usb_uas_setup(struct usbdevice_s *usbdev); #endif /* __USB_UAS_H */ tinyvisor/bios/src/usb-uas.c0000644006644000001440000001601412172661303016335 0ustar yuichi_xyusers// Code for handling usb attached scsi devices. // // only usb 2.0 for now. // // once we have xhci driver with usb 3.0 support this must // be updated to use usb3 streams so booting from usb3 // devices actually works. // // Authors: // Gerd Hoffmann // // based on usb-msc.c which is written by: // Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "config.h" // CONFIG_USB_UAS #include "usb.h" // struct usb_s #include "biosvar.h" // GET_GLOBAL #include "blockcmd.h" // cdb_read #include "disk.h" // DTYPE_UAS #include "boot.h" // bootprio_find_usb #include "usb-uas.h" // usb_uas_init #define UAS_UI_COMMAND 0x01 #define UAS_UI_SENSE 0x03 #define UAS_UI_RESPONSE 0x04 #define UAS_UI_TASK_MGMT 0x05 #define UAS_UI_READ_READY 0x06 #define UAS_UI_WRITE_READY 0x07 #define UAS_PIPE_ID_COMMAND 0x01 #define UAS_PIPE_ID_STATUS 0x02 #define UAS_PIPE_ID_DATA_IN 0x03 #define UAS_PIPE_ID_DATA_OUT 0x04 typedef struct { u8 id; u8 reserved; u16 tag; } PACKED uas_ui_header; typedef struct { u8 prio_taskattr; /* 6:3 priority, 2:0 task attribute */ u8 reserved_1; u8 add_cdb_length; /* 7:2 additional adb length (dwords) */ u8 reserved_2; u8 lun[8]; u8 cdb[16]; u8 add_cdb[]; } PACKED uas_ui_command; typedef struct { u16 status_qualifier; u8 status; u8 reserved[7]; u16 sense_length; u8 sense_data[18]; } PACKED uas_ui_sense; typedef struct { u16 add_response_info; u8 response_code; } PACKED uas_ui_response; typedef struct { u8 function; u8 reserved; u16 task_tag; u8 lun[8]; } PACKED uas_ui_task_mgmt; typedef struct { uas_ui_header hdr; union { uas_ui_command command; uas_ui_sense sense; uas_ui_task_mgmt task; uas_ui_response response; }; } PACKED uas_ui; struct uasdrive_s { struct drive_s drive; struct usb_pipe *command, *status, *data_in, *data_out; int lun; }; int uas_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize) { if (!CONFIG_USB_UAS) return DISK_RET_EBADTRACK; struct uasdrive_s *drive = container_of( op->drive_g, struct uasdrive_s, drive); uas_ui ui; memset(&ui, 0, sizeof(ui)); ui.hdr.id = UAS_UI_COMMAND; ui.hdr.tag = 0xdead; ui.command.lun[1] = drive->lun; memcpy(ui.command.cdb, cdbcmd, sizeof(ui.command.cdb)); int ret = usb_send_bulk(GET_GLOBAL(drive->command), USB_DIR_OUT, MAKE_FLATPTR(GET_SEG(SS), &ui), sizeof(ui.hdr) + sizeof(ui.command)); if (ret) { dprintf(1, "uas: command send fail"); goto fail; } memset(&ui, 0xff, sizeof(ui)); ret = usb_send_bulk(GET_GLOBAL(drive->status), USB_DIR_IN, MAKE_FLATPTR(GET_SEG(SS), &ui), sizeof(ui)); if (ret) { dprintf(1, "uas: status recv fail"); goto fail; } switch (ui.hdr.id) { case UAS_UI_SENSE: goto have_sense; case UAS_UI_READ_READY: ret = usb_send_bulk(GET_GLOBAL(drive->data_in), USB_DIR_IN, op->buf_fl, op->count * blocksize); if (ret) { dprintf(1, "uas: data read fail"); goto fail; } break; case UAS_UI_WRITE_READY: ret = usb_send_bulk(GET_GLOBAL(drive->data_out), USB_DIR_OUT, op->buf_fl, op->count * blocksize); if (ret) { dprintf(1, "uas: data write fail"); goto fail; } break; default: dprintf(1, "uas: unknown status ui id %d", ui.hdr.id); goto fail; } memset(&ui, 0xff, sizeof(ui)); ret = usb_send_bulk(GET_GLOBAL(drive->status), USB_DIR_IN, MAKE_FLATPTR(GET_SEG(SS), &ui), sizeof(ui)); if (ret) { dprintf(1, "uas: status recv fail"); goto fail; } if (ui.hdr.id != UAS_UI_SENSE) { dprintf(1, "uas: expected sense ui, got ui id %d", ui.hdr.id); goto fail; } have_sense: if (ui.sense.status == 0) { return DISK_RET_SUCCESS; } fail: return DISK_RET_EBADTRACK; } static int uas_lun_setup(struct usbdevice_s *usbdev, struct usb_pipe *command, struct usb_pipe *status, struct usb_pipe *data_in, struct usb_pipe *data_out, int lun) { // Allocate drive structure. struct uasdrive_s *drive = malloc_fseg(sizeof(*drive)); if (!drive) { warn_noalloc(); return -1; } memset(drive, 0, sizeof(*drive)); drive->drive.type = DTYPE_UAS; drive->command = command; drive->status = status; drive->data_in = data_in; drive->data_out = data_out; drive->lun = lun; int prio = bootprio_find_usb(usbdev, lun); int ret = scsi_drive_setup(&drive->drive, "USB UAS", prio); if (ret) { free(drive); return -1; } return 0; } int usb_uas_setup(struct usbdevice_s *usbdev) { if (!CONFIG_USB_UAS) return -1; // Verify right kind of device struct usb_interface_descriptor *iface = usbdev->iface; if (iface->bInterfaceSubClass != US_SC_SCSI || iface->bInterfaceProtocol != US_PR_UAS) { dprintf(1, "Unsupported UAS device (subclass=%02x proto=%02x)\n" , iface->bInterfaceSubClass, iface->bInterfaceProtocol); return -1; } /* find & allocate pipes */ struct usb_endpoint_descriptor *ep = NULL; struct usb_pipe *command = NULL; struct usb_pipe *status = NULL; struct usb_pipe *data_in = NULL; struct usb_pipe *data_out = NULL; u8 *desc = (u8*)iface; while (desc) { desc += desc[0]; switch (desc[1]) { case USB_DT_ENDPOINT: ep = (void*)desc; break; case 0x24: switch (desc[2]) { case UAS_PIPE_ID_COMMAND: command = usb_alloc_pipe(usbdev, ep); break; case UAS_PIPE_ID_STATUS: status = usb_alloc_pipe(usbdev, ep); break; case UAS_PIPE_ID_DATA_IN: data_in = usb_alloc_pipe(usbdev, ep); break; case UAS_PIPE_ID_DATA_OUT: data_out = usb_alloc_pipe(usbdev, ep); break; default: goto fail; } break; default: desc = NULL; break; } } if (!command || !status || !data_in || !data_out) goto fail; /* TODO: send REPORT LUNS. For now, only LUN 0 is recognized. */ int ret = uas_lun_setup(usbdev, command, status, data_in, data_out, 0); if (ret < 0) { dprintf(1, "Unable to configure UAS drive.\n"); goto fail; } return 0; fail: free_pipe(command); free_pipe(status); free_pipe(data_in); free_pipe(data_out); return -1; } tinyvisor/bios/src/vbe.h0000644006644000001440000001134511733243570015545 0ustar yuichi_xyusers#ifndef __VBE_H #define __VBE_H #include "types.h" // u8 #include "farptr.h" // struct segoff_s #define VESA_SIGNATURE 0x41534556 // VESA #define VBE2_SIGNATURE 0x32454256 // VBE2 struct vbe_info { u32 signature; u16 version; struct segoff_s oem_string; u32 capabilities; struct segoff_s video_mode; u16 total_memory; u16 oem_revision; struct segoff_s oem_vendor_string; struct segoff_s oem_product_string; struct segoff_s oem_revision_string; u8 reserved[222]; } PACKED; struct vbe_mode_info { /* VBE */ u16 mode_attributes; u8 winA_attributes; u8 winB_attributes; u16 win_granularity; u16 win_size; u16 winA_seg; u16 winB_seg; struct segoff_s win_func_ptr; u16 bytes_per_scanline; /* VBE 1.2 */ u16 xres; u16 yres; u8 xcharsize; u8 ycharsize; u8 planes; u8 bits_per_pixel; u8 banks; u8 mem_model; u8 bank_size; u8 pages; u8 reserved0; /* Direct Color */ u8 red_size; u8 red_pos; u8 green_size; u8 green_pos; u8 blue_size; u8 blue_pos; u8 alpha_size; u8 alpha_pos; u8 directcolor_info; /* VBE 2.0 */ u32 phys_base; u32 reserved1; u16 reserved2; /* VBE 3.0 */ u16 linear_bytes_per_scanline; u8 bank_pages; u8 linear_pages; u8 linear_red_size; u8 linear_red_pos; u8 linear_green_size; u8 linear_green_pos; u8 linear_blue_size; u8 linear_blue_pos; u8 linear_alpha_size; u8 linear_alpha_pos; u32 pixclock_max; u8 reserved[190]; } PACKED; struct vbe_crtc_info { u16 horiz_total; u16 horiz_sync_start; u16 horiz_sync_end; u16 vert_total; u16 vert_sync_start; u16 vert_sync_end; u8 flags; u32 pixclock; u16 refresh_rate; u8 reserved[40]; } PACKED; /* VBE Return Status Info */ /* AL */ #define VBE_RETURN_STATUS_SUPPORTED 0x4F #define VBE_RETURN_STATUS_UNSUPPORTED 0x00 /* AH */ #define VBE_RETURN_STATUS_SUCCESSFULL 0x00 #define VBE_RETURN_STATUS_FAILED 0x01 #define VBE_RETURN_STATUS_NOT_SUPPORTED 0x02 #define VBE_RETURN_STATUS_INVALID 0x03 /* VBE Mode Numbers */ #define VBE_MODE_VESA_DEFINED 0x0100 #define VBE_MODE_REFRESH_RATE_USE_CRTC 0x0800 #define VBE_MODE_LINEAR_FRAME_BUFFER 0x4000 #define VBE_MODE_PRESERVE_DISPLAY_MEMORY 0x8000 #define VBE_VESA_MODE_END_OF_LIST 0xFFFF /* Capabilities */ #define VBE_CAPABILITY_8BIT_DAC 0x0001 #define VBE_CAPABILITY_NOT_VGA_COMPATIBLE 0x0002 #define VBE_CAPABILITY_RAMDAC_USE_BLANK_BIT 0x0004 #define VBE_CAPABILITY_STEREOSCOPIC_SUPPORT 0x0008 #define VBE_CAPABILITY_STEREO_VIA_VESA_EVC 0x0010 /* Mode Attributes */ #define VBE_MODE_ATTRIBUTE_SUPPORTED 0x0001 #define VBE_MODE_ATTRIBUTE_EXTENDED_INFORMATION_AVAILABLE 0x0002 #define VBE_MODE_ATTRIBUTE_TTY_BIOS_SUPPORT 0x0004 #define VBE_MODE_ATTRIBUTE_COLOR_MODE 0x0008 #define VBE_MODE_ATTRIBUTE_GRAPHICS_MODE 0x0010 #define VBE_MODE_ATTRIBUTE_NOT_VGA_COMPATIBLE 0x0020 #define VBE_MODE_ATTRIBUTE_NO_VGA_COMPATIBLE_WINDOW 0x0040 #define VBE_MODE_ATTRIBUTE_LINEAR_FRAME_BUFFER_MODE 0x0080 #define VBE_MODE_ATTRIBUTE_DOUBLE_SCAN_MODE 0x0100 #define VBE_MODE_ATTRIBUTE_INTERLACE_MODE 0x0200 #define VBE_MODE_ATTRIBUTE_HARDWARE_TRIPLE_BUFFER 0x0400 #define VBE_MODE_ATTRIBUTE_HARDWARE_STEREOSCOPIC_DISPLAY 0x0800 #define VBE_MODE_ATTRIBUTE_DUAL_DISPLAY_START_ADDRESS 0x1000 #define VBE_MODE_ATTTRIBUTE_LFB_ONLY ( VBE_MODE_ATTRIBUTE_NO_VGA_COMPATIBLE_WINDOW | VBE_MODE_ATTRIBUTE_LINEAR_FRAME_BUFFER_MODE ) /* Window attributes */ #define VBE_WINDOW_ATTRIBUTE_RELOCATABLE 0x01 #define VBE_WINDOW_ATTRIBUTE_READABLE 0x02 #define VBE_WINDOW_ATTRIBUTE_WRITEABLE 0x04 /* Memory model */ #define VBE_MEMORYMODEL_TEXT_MODE 0x00 #define VBE_MEMORYMODEL_CGA_GRAPHICS 0x01 #define VBE_MEMORYMODEL_HERCULES_GRAPHICS 0x02 #define VBE_MEMORYMODEL_PLANAR 0x03 #define VBE_MEMORYMODEL_PACKED_PIXEL 0x04 #define VBE_MEMORYMODEL_NON_CHAIN_4_256 0x05 #define VBE_MEMORYMODEL_DIRECT_COLOR 0x06 #define VBE_MEMORYMODEL_YUV 0x07 /* DirectColorModeInfo */ #define VBE_DIRECTCOLOR_COLOR_RAMP_PROGRAMMABLE 0x01 #define VBE_DIRECTCOLOR_RESERVED_BITS_AVAILABLE 0x02 #endif tinyvisor/bios/src/misc.c0000644006644000001440000001242312174763154015722 0ustar yuichi_xyusers// Code for misc 16bit handlers and variables. // // Copyright (C) 2008,2009 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include "bregs.h" // struct bregs #include "biosvar.h" // GET_BDA #include "util.h" // debug_enter #include "pic.h" // enable_hwirq /**************************************************************** * Misc 16bit ISRs ****************************************************************/ // INT 12h Memory Size Service Entry Point void VISIBLE16 handle_12(struct bregs *regs) { debug_enter(regs, DEBUG_HDL_12); regs->ax = GET_BDA(mem_size_kb); } // INT 11h Equipment List Service Entry Point void VISIBLE16 handle_11(struct bregs *regs) { debug_enter(regs, DEBUG_HDL_11); regs->ax = GET_BDA(equipment_list_flags); } // INT 05h Print Screen Service Entry Point void VISIBLE16 handle_05(struct bregs *regs) { debug_enter(regs, DEBUG_HDL_05); } // INT 10h Video Support Service Entry Point void VISIBLE16 handle_10(struct bregs *regs) { debug_enter(regs, DEBUG_HDL_10); // dont do anything, since the VGA BIOS handles int10h requests if (regs->ah == 0x0e) { /* Teletype output */ char c; c = regs->al; __dprintf("%c", c); } } // NMI handler void VISIBLE16 handle_02(void) { debug_isr(DEBUG_ISR_02); } void mathcp_setup(void) { dprintf(3, "math cp init\n"); // 80x87 coprocessor installed set_equipment_flags(0x02, 0x02); enable_hwirq(13, FUNC16(entry_75)); } // INT 75 - IRQ13 - MATH COPROCESSOR EXCEPTION void VISIBLE16 handle_75(void) { debug_isr(DEBUG_ISR_75); // clear irq13 outb(0, PORT_MATH_CLEAR); // clear interrupt eoi_pic2(); // legacy nmi call struct bregs br; memset(&br, 0, sizeof(br)); br.flags = F_IF; call16_int(0x02, &br); } /**************************************************************** * BIOS_CONFIG_TABLE ****************************************************************/ // DMA channel 3 used by hard disk BIOS #define CBT_F1_DMA3USED (1<<7) // 2nd interrupt controller (8259) installed #define CBT_F1_2NDPIC (1<<6) // Real-Time Clock installed #define CBT_F1_RTC (1<<5) // INT 15/AH=4Fh called upon INT 09h #define CBT_F1_INT154F (1<<4) // wait for external event (INT 15/AH=41h) supported #define CBT_F1_WAITEXT (1<<3) // extended BIOS area allocated (usually at top of RAM) #define CBT_F1_EBDA (1<<2) // bus is Micro Channel instead of ISA #define CBT_F1_MCA (1<<1) // system has dual bus (Micro Channel + ISA) #define CBT_F1_MCAISA (1<<0) // INT 16/AH=09h (keyboard functionality) supported #define CBT_F2_INT1609 (1<<6) struct bios_config_table_s BIOS_CONFIG_TABLE VAR16FIXED(0xe6f5) = { .size = sizeof(BIOS_CONFIG_TABLE) - 2, .model = BUILD_MODEL_ID, .submodel = BUILD_SUBMODEL_ID, .biosrev = BUILD_BIOS_REVISION, .feature1 = ( CBT_F1_2NDPIC | CBT_F1_RTC | CBT_F1_EBDA | (CONFIG_KBD_CALL_INT15_4F ? CBT_F1_INT154F : 0)), .feature2 = CBT_F2_INT1609, .feature3 = 0, .feature4 = 0, .feature5 = 0, }; /**************************************************************** * GDT and IDT tables ****************************************************************/ // Real mode IDT descriptor struct descloc_s rmode_IDT_info VARFSEG = { .length = sizeof(struct rmode_IVT) - 1, .addr = (u32)MAKE_FLATPTR(SEG_IVT, 0), }; // Dummy IDT that forces a machine shutdown if an irq happens in // protected mode. u8 dummy_IDT VARFSEG; // Protected mode IDT descriptor struct descloc_s pmode_IDT_info VARFSEG = { .length = sizeof(dummy_IDT) - 1, .addr = (u32)&dummy_IDT, }; // GDT u64 rombios32_gdt[] VARFSEG __aligned(8) = { // First entry can't be used. 0x0000000000000000LL, // 32 bit flat code segment (SEG32_MODE32_CS) GDT_GRANLIMIT(0xffffffff) | GDT_CODE | GDT_B, // 32 bit flat data segment (SEG32_MODE32_DS) GDT_GRANLIMIT(0xffffffff) | GDT_DATA | GDT_B, // 16 bit code segment base=0xf0000 limit=0xffff (SEG32_MODE16_CS) GDT_LIMIT(BUILD_BIOS_SIZE-1) | GDT_CODE | GDT_BASE(BUILD_BIOS_ADDR), // 16 bit data segment base=0x0 limit=0xffff (SEG32_MODE16_DS) GDT_LIMIT(0x0ffff) | GDT_DATA, // 16 bit code segment base=0xf0000 limit=0xffffffff (SEG32_MODE16BIG_CS) GDT_GRANLIMIT(0xffffffff) | GDT_CODE | GDT_BASE(BUILD_BIOS_ADDR), // 16 bit data segment base=0 limit=0xffffffff (SEG32_MODE16BIG_DS) GDT_GRANLIMIT(0xffffffff) | GDT_DATA, }; // GDT descriptor struct descloc_s rombios32_gdt_48 VARFSEG = { .length = sizeof(rombios32_gdt) - 1, .addr = (u32)rombios32_gdt, }; /**************************************************************** * Misc fixed vars ****************************************************************/ char BiosCopyright[] VAR16FIXED(0xff00) = "(c) 2002 MandrakeSoft S.A. Written by Kevin Lawton & the Bochs team."; // BIOS build date char BiosDate[] VAR16FIXED(0xfff5) = "06/23/99"; u8 BiosModelId VAR16FIXED(0xfffe) = BUILD_MODEL_ID; u8 BiosChecksum VAR16FIXED(0xffff); // XXX - Initial Interrupt Vector Offsets Loaded by POST u8 InitVectors[13] VAR16FIXED(0xfef3); // XXX - INT 1D - SYSTEM DATA - VIDEO PARAMETER TABLES u8 VideoParams[88] VAR16FIXED(0xf0a4); tinyvisor/bios/src/ata.c0000644006644000001440000007322312172661303015530 0ustar yuichi_xyusers// Low level ATA disk access // // Copyright (C) 2008,2009 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "types.h" // u8 #include "ioport.h" // inb #include "util.h" // dprintf #include "byteorder.h" // be16_to_cpu #include "cmos.h" // inb_cmos #include "pic.h" // enable_hwirq #include "biosvar.h" // GET_GLOBAL #include "pci.h" // foreachpci #include "pci_ids.h" // PCI_CLASS_STORAGE_OTHER #include "pci_regs.h" // PCI_INTERRUPT_LINE #include "boot.h" // boot_add_hd #include "disk.h" // struct ata_s #include "ata.h" // ATA_CB_STAT #include "blockcmd.h" // CDB_CMD_READ_10 #define IDE_TIMEOUT 32000 //32 seconds max for IDE ops /**************************************************************** * Helper functions ****************************************************************/ // Wait for the specified ide state static inline int await_ide(u8 mask, u8 flags, u16 base, u16 timeout) { u64 end = calc_future_tsc(timeout); for (;;) { u8 status = inb(base+ATA_CB_STAT); if ((status & mask) == flags) return status; if (check_tsc(end)) { warn_timeout(); return -1; } yield(); } } // Wait for the device to be not-busy. static int await_not_bsy(u16 base) { return await_ide(ATA_CB_STAT_BSY, 0, base, IDE_TIMEOUT); } // Wait for the device to be ready. static int await_rdy(u16 base) { return await_ide(ATA_CB_STAT_RDY, ATA_CB_STAT_RDY, base, IDE_TIMEOUT); } // Wait for ide state - pauses for one ata cycle first. static inline int pause_await_not_bsy(u16 iobase1, u16 iobase2) { // Wait one PIO transfer cycle. inb(iobase2 + ATA_CB_ASTAT); return await_not_bsy(iobase1); } // Wait for ide state - pause for 400ns first. static inline int ndelay_await_not_bsy(u16 iobase1) { ndelay(400); return await_not_bsy(iobase1); } // Reset a drive static void ata_reset(struct atadrive_s *adrive_g) { struct ata_channel_s *chan_gf = GET_GLOBAL(adrive_g->chan_gf); u8 slave = GET_GLOBAL(adrive_g->slave); u16 iobase1 = GET_GLOBALFLAT(chan_gf->iobase1); u16 iobase2 = GET_GLOBALFLAT(chan_gf->iobase2); dprintf(6, "ata_reset drive=%p\n", &adrive_g->drive); // Pulse SRST outb(ATA_CB_DC_HD15 | ATA_CB_DC_NIEN | ATA_CB_DC_SRST, iobase2+ATA_CB_DC); udelay(5); outb(ATA_CB_DC_HD15 | ATA_CB_DC_NIEN, iobase2+ATA_CB_DC); msleep(2); // wait for device to become not busy. int status = await_not_bsy(iobase1); if (status < 0) goto done; if (slave) { // Change device. u64 end = calc_future_tsc(IDE_TIMEOUT); for (;;) { outb(ATA_CB_DH_DEV1, iobase1 + ATA_CB_DH); status = ndelay_await_not_bsy(iobase1); if (status < 0) goto done; if (inb(iobase1 + ATA_CB_DH) == ATA_CB_DH_DEV1) break; // Change drive request failed to take effect - retry. if (check_tsc(end)) { warn_timeout(); goto done; } } } else { // QEMU doesn't reset dh on reset, so set it explicitly. outb(ATA_CB_DH_DEV0, iobase1 + ATA_CB_DH); } // On a user-reset request, wait for RDY if it is an ATA device. u8 type=GET_GLOBAL(adrive_g->drive.type); if (type == DTYPE_ATA) status = await_rdy(iobase1); done: // Enable interrupts outb(ATA_CB_DC_HD15, iobase2+ATA_CB_DC); dprintf(6, "ata_reset exit status=%x\n", status); } // Check for drive RDY for 16bit interface command. static int isready(struct atadrive_s *adrive_g) { // Read the status from controller struct ata_channel_s *chan_gf = GET_GLOBAL(adrive_g->chan_gf); u16 iobase1 = GET_GLOBALFLAT(chan_gf->iobase1); u8 status = inb(iobase1 + ATA_CB_STAT); if ((status & (ATA_CB_STAT_BSY|ATA_CB_STAT_RDY)) == ATA_CB_STAT_RDY) return DISK_RET_SUCCESS; return DISK_RET_ENOTREADY; } /**************************************************************** * ATA send command ****************************************************************/ struct ata_pio_command { u8 feature; u8 sector_count; u8 lba_low; u8 lba_mid; u8 lba_high; u8 device; u8 command; u8 feature2; u8 sector_count2; u8 lba_low2; u8 lba_mid2; u8 lba_high2; }; // Send an ata command to the drive. static int send_cmd(struct atadrive_s *adrive_g, struct ata_pio_command *cmd) { struct ata_channel_s *chan_gf = GET_GLOBAL(adrive_g->chan_gf); u8 slave = GET_GLOBAL(adrive_g->slave); u16 iobase1 = GET_GLOBALFLAT(chan_gf->iobase1); // Select device int status = await_not_bsy(iobase1); if (status < 0) return status; u8 newdh = ((cmd->device & ~ATA_CB_DH_DEV1) | (slave ? ATA_CB_DH_DEV1 : ATA_CB_DH_DEV0)); u8 olddh = inb(iobase1 + ATA_CB_DH); outb(newdh, iobase1 + ATA_CB_DH); if ((olddh ^ newdh) & (1<<4)) { // Was a device change - wait for device to become not busy. status = ndelay_await_not_bsy(iobase1); if (status < 0) return status; } // Check for ATA_CMD_(READ|WRITE)_(SECTORS|DMA)_EXT commands. if ((cmd->command & ~0x11) == ATA_CMD_READ_SECTORS_EXT) { outb(cmd->feature2, iobase1 + ATA_CB_FR); outb(cmd->sector_count2, iobase1 + ATA_CB_SC); outb(cmd->lba_low2, iobase1 + ATA_CB_SN); outb(cmd->lba_mid2, iobase1 + ATA_CB_CL); outb(cmd->lba_high2, iobase1 + ATA_CB_CH); } outb(cmd->feature, iobase1 + ATA_CB_FR); outb(cmd->sector_count, iobase1 + ATA_CB_SC); outb(cmd->lba_low, iobase1 + ATA_CB_SN); outb(cmd->lba_mid, iobase1 + ATA_CB_CL); outb(cmd->lba_high, iobase1 + ATA_CB_CH); outb(cmd->command, iobase1 + ATA_CB_CMD); return 0; } // Wait for data after calling 'send_cmd'. static int ata_wait_data(u16 iobase1) { int status = ndelay_await_not_bsy(iobase1); if (status < 0) return status; if (status & ATA_CB_STAT_ERR) { dprintf(6, "send_cmd : read error (status=%02x err=%02x)\n" , status, inb(iobase1 + ATA_CB_ERR)); return -4; } if (!(status & ATA_CB_STAT_DRQ)) { dprintf(6, "send_cmd : DRQ not set (status %02x)\n", status); return -5; } return 0; } // Send an ata command that does not transfer any further data. int ata_cmd_nondata(struct atadrive_s *adrive_g, struct ata_pio_command *cmd) { struct ata_channel_s *chan_gf = GET_GLOBAL(adrive_g->chan_gf); u16 iobase1 = GET_GLOBALFLAT(chan_gf->iobase1); u16 iobase2 = GET_GLOBALFLAT(chan_gf->iobase2); // Disable interrupts outb(ATA_CB_DC_HD15 | ATA_CB_DC_NIEN, iobase2 + ATA_CB_DC); int ret = send_cmd(adrive_g, cmd); if (ret) goto fail; ret = ndelay_await_not_bsy(iobase1); if (ret < 0) goto fail; if (ret & ATA_CB_STAT_ERR) { dprintf(6, "nondata cmd : read error (status=%02x err=%02x)\n" , ret, inb(iobase1 + ATA_CB_ERR)); ret = -4; goto fail; } if (ret & ATA_CB_STAT_DRQ) { dprintf(6, "nondata cmd : DRQ set (status %02x)\n", ret); ret = -5; goto fail; } fail: // Enable interrupts outb(ATA_CB_DC_HD15, iobase2+ATA_CB_DC); return ret; } /**************************************************************** * ATA PIO transfers ****************************************************************/ // Transfer 'op->count' blocks (of 'blocksize' bytes) to/from drive // 'op->drive_g'. static int ata_pio_transfer(struct disk_op_s *op, int iswrite, int blocksize) { dprintf(16, "ata_pio_transfer id=%p write=%d count=%d bs=%d buf=%p\n" , op->drive_g, iswrite, op->count, blocksize, op->buf_fl); struct atadrive_s *adrive_g = container_of( op->drive_g, struct atadrive_s, drive); struct ata_channel_s *chan_gf = GET_GLOBAL(adrive_g->chan_gf); u16 iobase1 = GET_GLOBALFLAT(chan_gf->iobase1); u16 iobase2 = GET_GLOBALFLAT(chan_gf->iobase2); int count = op->count; void *buf_fl = op->buf_fl; int status; for (;;) { if (iswrite) { // Write data to controller dprintf(16, "Write sector id=%p dest=%p\n", op->drive_g, buf_fl); if (CONFIG_ATA_PIO32) outsl_fl(iobase1, buf_fl, blocksize / 4); else outsw_fl(iobase1, buf_fl, blocksize / 2); } else { // Read data from controller dprintf(16, "Read sector id=%p dest=%p\n", op->drive_g, buf_fl); if (CONFIG_ATA_PIO32) insl_fl(iobase1, buf_fl, blocksize / 4); else insw_fl(iobase1, buf_fl, blocksize / 2); } buf_fl += blocksize; status = pause_await_not_bsy(iobase1, iobase2); if (status < 0) { // Error op->count -= count; return status; } count--; if (!count) break; status &= (ATA_CB_STAT_BSY | ATA_CB_STAT_DRQ | ATA_CB_STAT_ERR); if (status != ATA_CB_STAT_DRQ) { dprintf(6, "ata_pio_transfer : more sectors left (status %02x)\n" , status); op->count -= count; return -6; } } status &= (ATA_CB_STAT_BSY | ATA_CB_STAT_DF | ATA_CB_STAT_DRQ | ATA_CB_STAT_ERR); if (!iswrite) status &= ~ATA_CB_STAT_DF; if (status != 0) { dprintf(6, "ata_pio_transfer : no sectors left (status %02x)\n", status); return -7; } return 0; } /**************************************************************** * ATA DMA transfers ****************************************************************/ #define BM_CMD 0 #define BM_CMD_MEMWRITE 0x08 #define BM_CMD_START 0x01 #define BM_STATUS 2 #define BM_STATUS_IRQ 0x04 #define BM_STATUS_ERROR 0x02 #define BM_STATUS_ACTIVE 0x01 #define BM_TABLE 4 struct sff_dma_prd { u32 buf_fl; u32 count; }; // Check if DMA available and setup transfer if so. static int ata_try_dma(struct disk_op_s *op, int iswrite, int blocksize) { ASSERT16(); if (! CONFIG_ATA_DMA) return -1; u32 dest = (u32)op->buf_fl; if (dest & 1) // Need minimum alignment of 1. return -1; struct atadrive_s *adrive_g = container_of( op->drive_g, struct atadrive_s, drive); struct ata_channel_s *chan_gf = GET_GLOBAL(adrive_g->chan_gf); u16 iomaster = GET_GLOBALFLAT(chan_gf->iomaster); if (! iomaster) return -1; u32 bytes = op->count * blocksize; if (! bytes) return -1; // Build PRD dma structure. struct sff_dma_prd *dma = MAKE_FLATPTR(SEG_LOW, ExtraStack); struct sff_dma_prd *origdma = dma; while (bytes) { if (dma >= &origdma[16]) // Too many descriptors.. return -1; u32 count = bytes; u32 max = 0x10000 - (dest & 0xffff); if (count > max) count = max; SET_LOWFLAT(dma->buf_fl, dest); bytes -= count; if (!bytes) // Last descriptor. count |= 1<<31; dprintf(16, "dma@%p: %08x %08x\n", dma, dest, count); dest += count; SET_LOWFLAT(dma->count, count); dma++; } // Program bus-master controller. outl((u32)origdma, iomaster + BM_TABLE); u8 oldcmd = inb(iomaster + BM_CMD) & ~(BM_CMD_MEMWRITE|BM_CMD_START); outb(oldcmd | (iswrite ? 0x00 : BM_CMD_MEMWRITE), iomaster + BM_CMD); outb(BM_STATUS_ERROR|BM_STATUS_IRQ, iomaster + BM_STATUS); return 0; } // Transfer data using DMA. static int ata_dma_transfer(struct disk_op_s *op) { if (! CONFIG_ATA_DMA) return -1; dprintf(16, "ata_dma_transfer id=%p buf=%p\n", op->drive_g, op->buf_fl); struct atadrive_s *adrive_g = container_of( op->drive_g, struct atadrive_s, drive); struct ata_channel_s *chan_gf = GET_GLOBAL(adrive_g->chan_gf); u16 iomaster = GET_GLOBALFLAT(chan_gf->iomaster); // Start bus-master controller. u8 oldcmd = inb(iomaster + BM_CMD); outb(oldcmd | BM_CMD_START, iomaster + BM_CMD); u64 end = calc_future_tsc(IDE_TIMEOUT); u8 status; for (;;) { status = inb(iomaster + BM_STATUS); if (status & BM_STATUS_IRQ) break; // Transfer in progress if (check_tsc(end)) { // Timeout. warn_timeout(); break; } yield(); } outb(oldcmd & ~BM_CMD_START, iomaster + BM_CMD); u16 iobase1 = GET_GLOBALFLAT(chan_gf->iobase1); u16 iobase2 = GET_GLOBALFLAT(chan_gf->iobase2); int idestatus = pause_await_not_bsy(iobase1, iobase2); if ((status & (BM_STATUS_IRQ|BM_STATUS_ACTIVE)) == BM_STATUS_IRQ && idestatus >= 0x00 && (idestatus & (ATA_CB_STAT_BSY | ATA_CB_STAT_DF | ATA_CB_STAT_DRQ | ATA_CB_STAT_ERR)) == 0x00) // Success. return 0; dprintf(6, "IDE DMA error (dma=%x ide=%x/%x/%x)\n", status, idestatus , inb(iobase2 + ATA_CB_ASTAT), inb(iobase1 + ATA_CB_ERR)); op->count = 0; return -1; } /**************************************************************** * ATA hard drive functions ****************************************************************/ // Transfer data to harddrive using PIO protocol. static int ata_pio_cmd_data(struct disk_op_s *op, int iswrite, struct ata_pio_command *cmd) { struct atadrive_s *adrive_g = container_of( op->drive_g, struct atadrive_s, drive); struct ata_channel_s *chan_gf = GET_GLOBAL(adrive_g->chan_gf); u16 iobase1 = GET_GLOBALFLAT(chan_gf->iobase1); u16 iobase2 = GET_GLOBALFLAT(chan_gf->iobase2); // Disable interrupts outb(ATA_CB_DC_HD15 | ATA_CB_DC_NIEN, iobase2 + ATA_CB_DC); int ret = send_cmd(adrive_g, cmd); if (ret) goto fail; ret = ata_wait_data(iobase1); if (ret) goto fail; ret = ata_pio_transfer(op, iswrite, DISK_SECTOR_SIZE); fail: // Enable interrupts outb(ATA_CB_DC_HD15, iobase2+ATA_CB_DC); return ret; } // Transfer data to harddrive using DMA protocol. static int ata_dma_cmd_data(struct disk_op_s *op, struct ata_pio_command *cmd) { if (! CONFIG_ATA_DMA) return -1; struct atadrive_s *adrive_g = container_of( op->drive_g, struct atadrive_s, drive); int ret = send_cmd(adrive_g, cmd); if (ret) return ret; return ata_dma_transfer(op); } // Read/write count blocks from a harddrive. static int ata_readwrite(struct disk_op_s *op, int iswrite) { u64 lba = op->lba; int usepio = ata_try_dma(op, iswrite, DISK_SECTOR_SIZE); struct ata_pio_command cmd; memset(&cmd, 0, sizeof(cmd)); if (op->count >= (1<<8) || lba + op->count >= (1<<28)) { cmd.sector_count2 = op->count >> 8; cmd.lba_low2 = lba >> 24; cmd.lba_mid2 = lba >> 32; cmd.lba_high2 = lba >> 40; lba &= 0xffffff; if (usepio) cmd.command = (iswrite ? ATA_CMD_WRITE_SECTORS_EXT : ATA_CMD_READ_SECTORS_EXT); else cmd.command = (iswrite ? ATA_CMD_WRITE_DMA_EXT : ATA_CMD_READ_DMA_EXT); } else { if (usepio) cmd.command = (iswrite ? ATA_CMD_WRITE_SECTORS : ATA_CMD_READ_SECTORS); else cmd.command = (iswrite ? ATA_CMD_WRITE_DMA : ATA_CMD_READ_DMA); } cmd.sector_count = op->count; cmd.lba_low = lba; cmd.lba_mid = lba >> 8; cmd.lba_high = lba >> 16; cmd.device = ((lba >> 24) & 0xf) | ATA_CB_DH_LBA; int ret; if (usepio) ret = ata_pio_cmd_data(op, iswrite, &cmd); else ret = ata_dma_cmd_data(op, &cmd); if (ret) return DISK_RET_EBADTRACK; return DISK_RET_SUCCESS; } // 16bit command demuxer for ATA harddrives. int process_ata_op(struct disk_op_s *op) { if (!CONFIG_ATA) return 0; struct atadrive_s *adrive_g = container_of( op->drive_g, struct atadrive_s, drive); switch (op->command) { case CMD_READ: return ata_readwrite(op, 0); case CMD_WRITE: return ata_readwrite(op, 1); case CMD_RESET: ata_reset(adrive_g); return DISK_RET_SUCCESS; case CMD_ISREADY: return isready(adrive_g); case CMD_FORMAT: case CMD_VERIFY: case CMD_SEEK: return DISK_RET_SUCCESS; default: op->count = 0; return DISK_RET_EPARAM; } } /**************************************************************** * ATAPI functions ****************************************************************/ #define CDROM_CDB_SIZE 12 // Low-level atapi command transmit function. int atapi_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize) { if (! CONFIG_ATA) return 0; struct atadrive_s *adrive_g = container_of( op->drive_g, struct atadrive_s, drive); struct ata_channel_s *chan_gf = GET_GLOBAL(adrive_g->chan_gf); u16 iobase1 = GET_GLOBALFLAT(chan_gf->iobase1); u16 iobase2 = GET_GLOBALFLAT(chan_gf->iobase2); struct ata_pio_command cmd; memset(&cmd, 0, sizeof(cmd)); cmd.lba_mid = blocksize; cmd.lba_high = blocksize >> 8; cmd.command = ATA_CMD_PACKET; // Disable interrupts outb(ATA_CB_DC_HD15 | ATA_CB_DC_NIEN, iobase2 + ATA_CB_DC); int ret = send_cmd(adrive_g, &cmd); if (ret) goto fail; ret = ata_wait_data(iobase1); if (ret) goto fail; // Send command to device outsw_fl(iobase1, MAKE_FLATPTR(GET_SEG(SS), cdbcmd), CDROM_CDB_SIZE / 2); int status = pause_await_not_bsy(iobase1, iobase2); if (status < 0) { ret = status; goto fail; } if (status & ATA_CB_STAT_ERR) { u8 err = inb(iobase1 + ATA_CB_ERR); // skip "Not Ready" if (err != 0x20) dprintf(6, "send_atapi_cmd : read error (status=%02x err=%02x)\n" , status, err); ret = -2; goto fail; } if (blocksize) { if (!(status & ATA_CB_STAT_DRQ)) { dprintf(6, "send_atapi_cmd : DRQ not set (status %02x)\n", status); ret = -3; goto fail; } ret = ata_pio_transfer(op, 0, blocksize); } fail: // Enable interrupts outb(ATA_CB_DC_HD15, iobase2+ATA_CB_DC); if (ret) return DISK_RET_EBADTRACK; return DISK_RET_SUCCESS; } /**************************************************************** * ATA detect and init ****************************************************************/ // Send an identify device or identify device packet command. static int send_ata_identity(struct atadrive_s *adrive_g, u16 *buffer, int command) { memset(buffer, 0, DISK_SECTOR_SIZE); struct disk_op_s dop; memset(&dop, 0, sizeof(dop)); dop.drive_g = &adrive_g->drive; dop.count = 1; dop.lba = 1; dop.buf_fl = MAKE_FLATPTR(GET_SEG(SS), buffer); struct ata_pio_command cmd; memset(&cmd, 0, sizeof(cmd)); cmd.command = command; return ata_pio_cmd_data(&dop, 0, &cmd); } // Extract the ATA/ATAPI version info. int ata_extract_version(u16 *buffer) { // Extract ATA/ATAPI version. u16 ataversion = buffer[80]; u8 version; for (version=15; version>0; version--) if (ataversion & (1<chan_gf = dummy->chan_gf; adrive_g->slave = dummy->slave; adrive_g->drive.cntl_id = adrive_g->chan_gf->chanid * 2 + dummy->slave; adrive_g->drive.removable = (buffer[0] & 0x80) ? 1 : 0; return adrive_g; } // Detect if the given drive is an atapi - initialize it if so. static struct atadrive_s * init_drive_atapi(struct atadrive_s *dummy, u16 *buffer) { // Send an IDENTIFY_DEVICE_PACKET command to device int ret = send_ata_identity(dummy, buffer, ATA_CMD_IDENTIFY_PACKET_DEVICE); if (ret) return NULL; // Success - setup as ATAPI. struct atadrive_s *adrive_g = init_atadrive(dummy, buffer); if (!adrive_g) return NULL; adrive_g->drive.type = DTYPE_ATA_ATAPI; adrive_g->drive.blksize = CDROM_SECTOR_SIZE; adrive_g->drive.sectors = (u64)-1; u8 iscd = ((buffer[0] >> 8) & 0x1f) == 0x05; char model[MAXMODEL+1]; char *desc = znprintf(MAXDESCSIZE , "DVD/CD [ata%d-%d: %s ATAPI-%d %s]" , adrive_g->chan_gf->chanid, adrive_g->slave , ata_extract_model(model, MAXMODEL, buffer) , ata_extract_version(buffer) , (iscd ? "DVD/CD" : "Device")); dprintf(1, "%s\n", desc); // fill cdidmap if (iscd) { int prio = bootprio_find_ata_device(adrive_g->chan_gf->pci_tmp, adrive_g->chan_gf->chanid, adrive_g->slave); boot_add_cd(&adrive_g->drive, desc, prio); } return adrive_g; } // Detect if the given drive is a regular ata drive - initialize it if so. static struct atadrive_s * init_drive_ata(struct atadrive_s *dummy, u16 *buffer) { // Send an IDENTIFY_DEVICE command to device int ret = send_ata_identity(dummy, buffer, ATA_CMD_IDENTIFY_DEVICE); if (ret) return NULL; // Success - setup as ATA. struct atadrive_s *adrive_g = init_atadrive(dummy, buffer); if (!adrive_g) return NULL; adrive_g->drive.type = DTYPE_ATA; adrive_g->drive.blksize = DISK_SECTOR_SIZE; adrive_g->drive.pchs.cylinders = buffer[1]; adrive_g->drive.pchs.heads = buffer[3]; adrive_g->drive.pchs.spt = buffer[6]; u64 sectors; if (buffer[83] & (1 << 10)) // word 83 - lba48 support sectors = *(u64*)&buffer[100]; // word 100-103 else sectors = *(u32*)&buffer[60]; // word 60 and word 61 adrive_g->drive.sectors = sectors; u64 adjsize = sectors >> 11; char adjprefix = 'M'; if (adjsize >= (1 << 16)) { adjsize >>= 10; adjprefix = 'G'; } char model[MAXMODEL+1]; char *desc = znprintf(MAXDESCSIZE , "ata%d-%d: %s ATA-%d Hard-Disk (%u %ciBytes)" , adrive_g->chan_gf->chanid, adrive_g->slave , ata_extract_model(model, MAXMODEL, buffer) , ata_extract_version(buffer) , (u32)adjsize, adjprefix); dprintf(1, "%s\n", desc); int prio = bootprio_find_ata_device(adrive_g->chan_gf->pci_tmp, adrive_g->chan_gf->chanid, adrive_g->slave); // Register with bcv system. boot_add_hd(&adrive_g->drive, desc, prio); return adrive_g; } static u64 SpinupEnd; // Wait for non-busy status and check for "floating bus" condition. static int powerup_await_non_bsy(u16 base) { u8 orstatus = 0; u8 status; for (;;) { status = inb(base+ATA_CB_STAT); if (!(status & ATA_CB_STAT_BSY)) break; orstatus |= status; if (orstatus == 0xff) { dprintf(4, "powerup IDE floating\n"); return orstatus; } if (check_tsc(SpinupEnd)) { warn_timeout(); return -1; } yield(); } dprintf(6, "powerup iobase=%x st=%x\n", base, status); return status; } // Detect any drives attached to a given controller. static void ata_detect(void *data) { struct ata_channel_s *chan_gf = data; struct atadrive_s dummy; memset(&dummy, 0, sizeof(dummy)); dummy.chan_gf = chan_gf; // Device detection int didreset = 0; u8 slave; for (slave=0; slave<=1; slave++) { // Wait for not-bsy. u16 iobase1 = chan_gf->iobase1; int status = powerup_await_non_bsy(iobase1); if (status < 0) continue; u8 newdh = slave ? ATA_CB_DH_DEV1 : ATA_CB_DH_DEV0; outb(newdh, iobase1+ATA_CB_DH); ndelay(400); status = powerup_await_non_bsy(iobase1); if (status < 0) continue; // Check if ioport registers look valid. outb(newdh, iobase1+ATA_CB_DH); u8 dh = inb(iobase1+ATA_CB_DH); outb(0x55, iobase1+ATA_CB_SC); outb(0xaa, iobase1+ATA_CB_SN); u8 sc = inb(iobase1+ATA_CB_SC); u8 sn = inb(iobase1+ATA_CB_SN); dprintf(6, "ata_detect ata%d-%d: sc=%x sn=%x dh=%x\n" , chan_gf->chanid, slave, sc, sn, dh); if (sc != 0x55 || sn != 0xaa || dh != newdh) continue; // Prepare new drive. dummy.slave = slave; // reset the channel if (!didreset) { ata_reset(&dummy); didreset = 1; } // check for ATAPI u16 buffer[256]; struct atadrive_s *adrive_g = init_drive_atapi(&dummy, buffer); if (!adrive_g) { // Didn't find an ATAPI drive - look for ATA drive. u8 st = inb(iobase1+ATA_CB_STAT); if (!st) // Status not set - can't be a valid drive. continue; // Wait for RDY. int ret = await_rdy(iobase1); if (ret < 0) continue; // check for ATA. adrive_g = init_drive_ata(&dummy, buffer); if (!adrive_g) // No ATA drive found continue; } u16 resetresult = buffer[93]; dprintf(6, "ata_detect resetresult=%04x\n", resetresult); if (!slave && (resetresult & 0xdf61) == 0x4041) // resetresult looks valid and device 0 is responding to // device 1 requests - device 1 must not be present - skip // detection. break; } } // Initialize an ata controller and detect its drives. static void init_controller(struct pci_device *pci, int irq , u32 port1, u32 port2, u32 master) { static int chanid = 0; struct ata_channel_s *chan_gf = malloc_fseg(sizeof(*chan_gf)); if (!chan_gf) { warn_noalloc(); return; } chan_gf->chanid = chanid++; chan_gf->irq = irq; chan_gf->pci_bdf = pci ? pci->bdf : -1; chan_gf->pci_tmp = pci; chan_gf->iobase1 = port1; chan_gf->iobase2 = port2; chan_gf->iomaster = master; dprintf(1, "ATA controller %d at %x/%x/%x (irq %d dev %x)\n" , chanid, port1, port2, master, irq, chan_gf->pci_bdf); run_thread(ata_detect, chan_gf); } #define IRQ_ATA1 14 #define IRQ_ATA2 15 // Handle controllers on an ATA PCI device. static void init_pciata(struct pci_device *pci, u8 prog_if) { pci->have_driver = 1; u16 bdf = pci->bdf; u8 pciirq = pci_config_readb(bdf, PCI_INTERRUPT_LINE); int master = 0; if (CONFIG_ATA_DMA && prog_if & 0x80) { // Check for bus-mastering. u32 bar = pci_config_readl(bdf, PCI_BASE_ADDRESS_4); if (bar & PCI_BASE_ADDRESS_SPACE_IO) { master = bar & PCI_BASE_ADDRESS_IO_MASK; pci_config_maskw(bdf, PCI_COMMAND, 0, PCI_COMMAND_MASTER); } } u32 port1, port2, irq; if (prog_if & 1) { port1 = (pci_config_readl(bdf, PCI_BASE_ADDRESS_0) & PCI_BASE_ADDRESS_IO_MASK); port2 = (pci_config_readl(bdf, PCI_BASE_ADDRESS_1) & PCI_BASE_ADDRESS_IO_MASK); irq = pciirq; } else { port1 = PORT_ATA1_CMD_BASE; port2 = PORT_ATA1_CTRL_BASE; irq = IRQ_ATA1; } init_controller(pci, irq, port1, port2, master); if (prog_if & 4) { port1 = (pci_config_readl(bdf, PCI_BASE_ADDRESS_2) & PCI_BASE_ADDRESS_IO_MASK); port2 = (pci_config_readl(bdf, PCI_BASE_ADDRESS_3) & PCI_BASE_ADDRESS_IO_MASK); irq = pciirq; } else { port1 = PORT_ATA2_CMD_BASE; port2 = PORT_ATA2_CTRL_BASE; irq = IRQ_ATA2; } init_controller(pci, irq, port1, port2, master ? master + 8 : 0); } static void found_genericata(struct pci_device *pci, void *arg) { init_pciata(pci, pci->prog_if); } static void found_compatibleahci(struct pci_device *pci, void *arg) { if (CONFIG_AHCI) // Already handled directly via native ahci interface. return; init_pciata(pci, 0x8f); } static const struct pci_device_id pci_ata_tbl[] = { PCI_DEVICE_CLASS(PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_STORAGE_IDE , found_genericata), PCI_DEVICE(PCI_VENDOR_ID_ATI, 0x4391, found_compatibleahci), PCI_DEVICE_END, }; // Locate and init ata controllers. static void ata_scan(void) { if (CONFIG_QEMU && hlist_empty(&PCIDevices)) { // No PCI devices found - probably a QEMU "-M isapc" machine. // Try using ISA ports for ATA controllers. init_controller(NULL, IRQ_ATA1 , PORT_ATA1_CMD_BASE, PORT_ATA1_CTRL_BASE, 0); init_controller(NULL, IRQ_ATA2 , PORT_ATA2_CMD_BASE, PORT_ATA2_CTRL_BASE, 0); return; } // Scan PCI bus for ATA adapters struct pci_device *pci; foreachpci(pci) { pci_init_device(pci_ata_tbl, pci, NULL); } } void ata_setup(void) { ASSERT32FLAT(); if (!CONFIG_ATA) return; dprintf(3, "init hard drives\n"); SpinupEnd = calc_future_tsc(IDE_TIMEOUT); ata_scan(); SET_BDA(disk_control_byte, 0xc0); enable_hwirq(14, FUNC16(entry_76)); } tinyvisor/bios/src/acpi-dsdt.dsl0000644006644000001440000002474012172661303017173 0ustar yuichi_xyusers/* * Bochs/QEMU ACPI DSDT ASL definition * * Copyright (c) 2006 Fabrice Bellard * * This library is free software; you can redistribute it and/or * modify it under the terms of the GNU Lesser General Public * License version 2 as published by the Free Software Foundation. * * This library 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 * Lesser General Public License for more details. * * You should have received a copy of the GNU Lesser General Public * License along with this library; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA */ ACPI_EXTRACT_ALL_CODE AmlCode DefinitionBlock ( "acpi-dsdt.aml", // Output Filename "DSDT", // Signature 0x01, // DSDT Compliance Revision "BXPC", // OEMID "BXDSDT", // TABLE ID 0x1 // OEM Revision ) { #include "acpi-dsdt-dbug.dsl" /**************************************************************** * PCI Bus definition ****************************************************************/ Scope(\_SB) { Device(PCI0) { Name(_HID, EisaId("PNP0A03")) Name(_ADR, 0x00) Name(_UID, 1) } } #include "acpi-dsdt-pci-crs.dsl" #include "acpi-dsdt-hpet.dsl" /**************************************************************** * VGA ****************************************************************/ Scope(\_SB.PCI0) { Device(VGA) { Name(_ADR, 0x00020000) OperationRegion(PCIC, PCI_Config, Zero, 0x4) Field(PCIC, DWordAcc, NoLock, Preserve) { VEND, 32 } Method(_S1D, 0, NotSerialized) { Return (0x00) } Method(_S2D, 0, NotSerialized) { Return (0x00) } Method(_S3D, 0, NotSerialized) { If (LEqual(VEND, 0x1001b36)) { Return (0x03) // QXL } Else { Return (0x00) } } } } /**************************************************************** * PIIX4 PM ****************************************************************/ Scope(\_SB.PCI0) { Device(PX13) { Name(_ADR, 0x00010003) OperationRegion(P13C, PCI_Config, 0x00, 0xff) } } /**************************************************************** * PIIX3 ISA bridge ****************************************************************/ Scope(\_SB.PCI0) { Device(ISA) { Name(_ADR, 0x00010000) /* PIIX PCI to ISA irq remapping */ OperationRegion(P40C, PCI_Config, 0x60, 0x04) /* enable bits */ Field(\_SB.PCI0.PX13.P13C, AnyAcc, NoLock, Preserve) { Offset(0x5f), , 7, LPEN, 1, // LPT Offset(0x67), , 3, CAEN, 1, // COM1 , 3, CBEN, 1, // COM2 } Name(FDEN, 1) } } #include "acpi-dsdt-isa.dsl" /**************************************************************** * PCI hotplug ****************************************************************/ Scope(\_SB.PCI0) { OperationRegion(PCST, SystemIO, 0xae00, 0x08) Field(PCST, DWordAcc, NoLock, WriteAsZeros) { PCIU, 32, PCID, 32, } OperationRegion(SEJ, SystemIO, 0xae08, 0x04) Field(SEJ, DWordAcc, NoLock, WriteAsZeros) { B0EJ, 32, } /* Methods called by bulk generated PCI devices below */ /* Methods called by hotplug devices */ Method(PCEJ, 1, NotSerialized) { // _EJ0 method - eject callback Store(ShiftLeft(1, Arg0), B0EJ) Return (0x0) } /* Hotplug notification method supplied by SSDT */ External(\_SB.PCI0.PCNT, MethodObj) /* PCI hotplug notify method */ Method(PCNF, 0) { // Local0 = iterator Store(Zero, Local0) While (LLess(Local0, 31)) { Increment(Local0) If (And(PCIU, ShiftLeft(1, Local0))) { PCNT(Local0, 1) } If (And(PCID, ShiftLeft(1, Local0))) { PCNT(Local0, 3) } } } } /**************************************************************** * PCI IRQs ****************************************************************/ Scope(\_SB) { Scope(PCI0) { Name(_PRT, Package() { /* PCI IRQ routing table, example from ACPI 2.0a specification, section 6.2.8.1 */ /* Note: we provide the same info as the PCI routing table of the Bochs BIOS */ #define prt_slot(nr, lnk0, lnk1, lnk2, lnk3) \ Package() { nr##ffff, 0, lnk0, 0 }, \ Package() { nr##ffff, 1, lnk1, 0 }, \ Package() { nr##ffff, 2, lnk2, 0 }, \ Package() { nr##ffff, 3, lnk3, 0 } #define prt_slot0(nr) prt_slot(nr, LNKD, LNKA, LNKB, LNKC) #define prt_slot1(nr) prt_slot(nr, LNKA, LNKB, LNKC, LNKD) #define prt_slot2(nr) prt_slot(nr, LNKB, LNKC, LNKD, LNKA) #define prt_slot3(nr) prt_slot(nr, LNKC, LNKD, LNKA, LNKB) prt_slot0(0x0000), /* Device 1 is power mgmt device, and can only use irq 9 */ prt_slot(0x0001, LNKS, LNKB, LNKC, LNKD), prt_slot2(0x0002), prt_slot3(0x0003), prt_slot0(0x0004), prt_slot1(0x0005), prt_slot2(0x0006), prt_slot3(0x0007), prt_slot0(0x0008), prt_slot1(0x0009), prt_slot2(0x000a), prt_slot3(0x000b), prt_slot0(0x000c), prt_slot1(0x000d), prt_slot2(0x000e), prt_slot3(0x000f), prt_slot0(0x0010), prt_slot1(0x0011), prt_slot2(0x0012), prt_slot3(0x0013), prt_slot0(0x0014), prt_slot1(0x0015), prt_slot2(0x0016), prt_slot3(0x0017), prt_slot0(0x0018), prt_slot1(0x0019), prt_slot2(0x001a), prt_slot3(0x001b), prt_slot0(0x001c), prt_slot1(0x001d), prt_slot2(0x001e), prt_slot3(0x001f), }) } Field(PCI0.ISA.P40C, ByteAcc, NoLock, Preserve) { PRQ0, 8, PRQ1, 8, PRQ2, 8, PRQ3, 8 } Method(IQST, 1, NotSerialized) { // _STA method - get status If (And(0x80, Arg0)) { Return (0x09) } Return (0x0B) } Method(IQCR, 1, NotSerialized) { // _CRS method - get current settings Name(PRR0, ResourceTemplate() { Interrupt(, Level, ActiveHigh, Shared) { 0 } }) CreateDWordField(PRR0, 0x05, PRRI) If (LLess(Arg0, 0x80)) { Store(Arg0, PRRI) } Return (PRR0) } #define define_link(link, uid, reg) \ Device(link) { \ Name(_HID, EISAID("PNP0C0F")) \ Name(_UID, uid) \ Name(_PRS, ResourceTemplate() { \ Interrupt(, Level, ActiveHigh, Shared) { \ 5, 10, 11 \ } \ }) \ Method(_STA, 0, NotSerialized) { \ Return (IQST(reg)) \ } \ Method(_DIS, 0, NotSerialized) { \ Or(reg, 0x80, reg) \ } \ Method(_CRS, 0, NotSerialized) { \ Return (IQCR(reg)) \ } \ Method(_SRS, 1, NotSerialized) { \ CreateDWordField(Arg0, 0x05, PRRI) \ Store(PRRI, reg) \ } \ } define_link(LNKA, 0, PRQ0) define_link(LNKB, 1, PRQ1) define_link(LNKC, 2, PRQ2) define_link(LNKD, 3, PRQ3) Device(LNKS) { Name(_HID, EISAID("PNP0C0F")) Name(_UID, 4) Name(_PRS, ResourceTemplate() { Interrupt(, Level, ActiveHigh, Shared) { 9 } }) // The SCI cannot be disabled and is always attached to GSI 9, // so these are no-ops. We only need this link to override the // polarity to active high and match the content of the MADT. Method(_STA, 0, NotSerialized) { Return (0x0b) } Method(_DIS, 0, NotSerialized) { } Method(_CRS, 0, NotSerialized) { Return (_PRS) } Method(_SRS, 1, NotSerialized) { } } } #include "acpi-dsdt-cpu-hotplug.dsl" /**************************************************************** * General purpose events ****************************************************************/ Scope(\_GPE) { Name(_HID, "ACPI0006") Method(_L00) { } Method(_E01) { // PCI hotplug event \_SB.PCI0.PCNF() } Method(_E02) { // CPU hotplug event \_SB.PRSC() } Method(_L03) { } Method(_L04) { } Method(_L05) { } Method(_L06) { } Method(_L07) { } Method(_L08) { } Method(_L09) { } Method(_L0A) { } Method(_L0B) { } Method(_L0C) { } Method(_L0D) { } Method(_L0E) { } Method(_L0F) { } } } tinyvisor/bios/src/mptable.c0000644006644000001440000001470412174763154016417 0ustar yuichi_xyusers// MPTable generation (on emulators) // // Copyright (C) 2008-2010 Kevin O'Connor // Copyright (C) 2006 Fabrice Bellard // // This file may be distributed under the terms of the GNU LGPLv3 license. /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include "util.h" // dprintf #include "config.h" // CONFIG_* #include "mptable.h" // MPTABLE_SIGNATURE #include "pci.h" #include "pci_regs.h" void mptable_setup(void) { if (! CONFIG_MPTABLE) return; dprintf(3, "init MPTable\n"); // Config structure in temp area. struct mptable_config_s *config = malloc_tmp(32*1024); if (!config) { warn_noalloc(); return; } memset(config, 0, sizeof(*config)); config->signature = MPCONFIG_SIGNATURE; config->spec = 4; memcpy(config->oemid, BUILD_CPUNAME8, sizeof(config->oemid)); memcpy(config->productid, "0.1 ", sizeof(config->productid)); config->lapic = BUILD_APIC_ADDR; // Detect cpu info u32 cpuid_signature, ebx, ecx, cpuid_features; cpuid(1, &cpuid_signature, &ebx, &ecx, &cpuid_features); if (! cpuid_signature) { // Use default values. cpuid_signature = 0x600; cpuid_features = 0x201; } u8 apic_version = readl((u8*)BUILD_APIC_ADDR + 0x30) & 0xff; // CPU definitions. struct mpt_cpu *cpus = (void*)&config[1], *cpu = cpus; int i; u8 apic_id = 0; int present; for (i = 0; i < MaxCountCPUs; i++) { while (apic_id < 0xff && !apic_id_is_present(apic_id)) { apic_id++; } if (apic_id < 0xff) { present = 1; } else { present = 0; } memset(cpu, 0, sizeof(*cpu)); cpu->type = MPT_TYPE_CPU; cpu->apicid = apic_id; cpu->apicver = apic_version; /* cpu flags: enabled, bootstrap cpu */ cpu->cpuflag = ((icpusignature = cpuid_signature; cpu->featureflag = cpuid_features; cpu++; apic_id++; } int entrycount = cpu - cpus; // PCI bus struct mpt_bus *buses = (void*)cpu, *bus = buses; if (!hlist_empty(&PCIDevices)) { memset(bus, 0, sizeof(*bus)); bus->type = MPT_TYPE_BUS; bus->busid = 0; memcpy(bus->bustype, "PCI ", sizeof(bus->bustype)); bus++; entrycount++; } /* isa bus */ int isabusid = bus - buses; memset(bus, 0, sizeof(*bus)); bus->type = MPT_TYPE_BUS; bus->busid = isabusid; memcpy(bus->bustype, "ISA ", sizeof(bus->bustype)); bus++; entrycount++; /* ioapic */ u8 ioapic_id = BUILD_IOAPIC_ID; struct mpt_ioapic *ioapic = (void*)bus; memset(ioapic, 0, sizeof(*ioapic)); ioapic->type = MPT_TYPE_IOAPIC; ioapic->apicid = ioapic_id; ioapic->apicver = 0x11; ioapic->flags = 1; // enable ioapic->apicaddr = BUILD_IOAPIC_ADDR; entrycount++; /* irqs */ struct mpt_intsrc *intsrcs = (void*)&ioapic[1], *intsrc = intsrcs; int dev = -1; unsigned short pinmask = 0; struct pci_device *pci; foreachpci(pci) { u16 bdf = pci->bdf; if (pci_bdf_to_bus(bdf) != 0) break; int pin = pci_config_readb(bdf, PCI_INTERRUPT_PIN); int irq = pci_config_readb(bdf, PCI_INTERRUPT_LINE); if (pin == 0) continue; if (dev != pci_bdf_to_busdev(bdf)) { dev = pci_bdf_to_busdev(bdf); pinmask = 0; } if (pinmask & (1 << pin)) /* pin was seen already */ continue; pinmask |= (1 << pin); memset(intsrc, 0, sizeof(*intsrc)); intsrc->type = MPT_TYPE_INTSRC; intsrc->irqtype = 0; /* INT */ intsrc->irqflag = 1; /* active high */ intsrc->srcbus = pci_bdf_to_bus(bdf); /* PCI bus */ intsrc->srcbusirq = (pci_bdf_to_dev(bdf) << 2) | (pin - 1); intsrc->dstapic = ioapic_id; intsrc->dstirq = irq; intsrc++; } int irq0_override = romfile_loadint("etc/irq0-override", CONFIG_IRQ0_OVERRIDE); for (i = 0; i < 16; i++) { memset(intsrc, 0, sizeof(*intsrc)); if (BUILD_PCI_IRQS & (1 << i)) continue; intsrc->type = MPT_TYPE_INTSRC; intsrc->irqtype = 0; /* INT */ intsrc->irqflag = 0; /* conform to bus spec */ intsrc->srcbus = isabusid; /* ISA bus */ intsrc->srcbusirq = i; intsrc->dstapic = ioapic_id; intsrc->dstirq = i; if (irq0_override) { /* Destination 2 is covered by irq0->inti2 override (i == 0). Source IRQ 2 is unused */ if (i == 0) intsrc->dstirq = 2; else if (i == 2) intsrc--; } intsrc++; } /* Local interrupt assignment */ intsrc->type = MPT_TYPE_LOCAL_INT; intsrc->irqtype = 3; /* ExtINT */ intsrc->irqflag = 0; /* PO, EL default */ intsrc->srcbus = isabusid; /* ISA */ intsrc->srcbusirq = 0; intsrc->dstapic = 0; /* BSP == APIC #0 */ intsrc->dstirq = 0; /* LINTIN0 */ intsrc++; intsrc->type = MPT_TYPE_LOCAL_INT; intsrc->irqtype = 1; /* NMI */ intsrc->irqflag = 0; /* PO, EL default */ intsrc->srcbus = isabusid; /* ISA */ intsrc->srcbusirq = 0; intsrc->dstapic = 0xff; /* to all local APICs */ intsrc->dstirq = 1; /* LINTIN1 */ intsrc++; entrycount += intsrc - intsrcs; // Finalize config structure. int length = (void*)intsrc - (void*)config; config->entrycount = entrycount; config->length = length; config->checksum -= checksum(config, length); // Allocate final memory locations. (In theory the config // structure can go in high memory, but Linux kernels before // v2.6.30 crash with that.) struct mptable_config_s *finalconfig = malloc_fseg(length); struct mptable_floating_s *floating = malloc_fseg(sizeof(*floating)); if (!finalconfig || !floating) { warn_noalloc(); free(config); free(finalconfig); free(floating); return; } memcpy(finalconfig, config, length); free(config); /* floating pointer structure */ memset(floating, 0, sizeof(*floating)); floating->signature = MPTABLE_SIGNATURE; floating->physaddr = (u32)finalconfig; floating->length = 1; floating->spec_rev = 4; floating->checksum -= checksum(floating, sizeof(*floating)); dprintf(1, "MP table addr=%p MPC table addr=%p size=%d\n", floating, finalconfig, length); } tinyvisor/bios/src/list.h0000644006644000001440000000417512172661303015743 0ustar yuichi_xyusers#ifndef __LIST_H #define __LIST_H #include "types.h" // container_of /**************************************************************** * hlist - Double linked lists with a single pointer list head ****************************************************************/ struct hlist_node { struct hlist_node *next, **pprev; }; struct hlist_head { struct hlist_node *first; }; static inline int hlist_empty(const struct hlist_head *h) { return !h->first; } static inline void hlist_del(struct hlist_node *n) { struct hlist_node *next = n->next; struct hlist_node **pprev = n->pprev; *pprev = next; if (next) next->pprev = pprev; } static inline void hlist_add(struct hlist_node *n, struct hlist_node **pprev) { struct hlist_node *next = *pprev; n->pprev = pprev; n->next = next; if (next) next->pprev = &n->next; *pprev = n; } static inline void hlist_add_head(struct hlist_node *n, struct hlist_head *h) { hlist_add(n, &h->first); } static inline void hlist_add_before(struct hlist_node *n, struct hlist_node *next) { hlist_add(n, next->pprev); } static inline void hlist_add_after(struct hlist_node *n, struct hlist_node *prev) { hlist_add(n, &prev->next); } #define hlist_for_each_entry(pos, head, member) \ for (pos = container_of((head)->first, typeof(*pos), member) \ ; pos != container_of(NULL, typeof(*pos), member) \ ; pos = container_of(pos->member.next, typeof(*pos), member)) #define hlist_for_each_entry_safe(pos, n, head, member) \ for (pos = container_of((head)->first, typeof(*pos), member) \ ; pos != container_of(NULL, typeof(*pos), member) \ && ({ n = pos->member.next; 1; }) \ ; pos = container_of(n, typeof(*pos), member)) #define hlist_for_each_entry_pprev(pos, pprev, head, member) \ for (pprev = &(head)->first \ ; *pprev && ({ pos=container_of(*pprev, typeof(*pos), member); 1; }) \ ; pprev = &(*pprev)->next) #endif // list.h tinyvisor/bios/src/farptr.h0000644006644000001440000002211712172661303016262 0ustar yuichi_xyusers// Code to access multiple segments within gcc. // // Copyright (C) 2008,2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #ifndef __FARPTR_H #define __FARPTR_H #include "ioport.h" // insb // Dummy definitions used to make sure gcc understands dependencies // between SET_SEG and GET/READ/WRITE_SEG macros. extern u16 __segment_ES, __segment_CS, __segment_DS, __segment_SS; extern u16 __segment_FS, __segment_GS; // Low level macros for reading/writing memory via a segment selector. #define READ8_SEG(prefix, SEG, value, var) \ __asm__(prefix "movb %%" #SEG ":%1, %b0" : "=Qi"(value) \ : "m"(var), "m"(__segment_ ## SEG)) #define READ16_SEG(prefix, SEG, value, var) \ __asm__(prefix "movw %%" #SEG ":%1, %w0" : "=ri"(value) \ : "m"(var), "m"(__segment_ ## SEG)) #define READ32_SEG(prefix, SEG, value, var) \ __asm__(prefix "movl %%" #SEG ":%1, %0" : "=ri"(value) \ : "m"(var), "m"(__segment_ ## SEG)) #define READ64_SEG(prefix, SEG, value, var) do { \ union u64_u32_u __value; \ union u64_u32_u *__r64_ptr = (union u64_u32_u *)&(var); \ READ32_SEG(prefix, SEG, __value.lo, __r64_ptr->lo); \ READ32_SEG(prefix, SEG, __value.hi, __r64_ptr->hi); \ *(u64*)&(value) = __value.val; \ } while (0) #define WRITE8_SEG(prefix, SEG, var, value) \ __asm__(prefix "movb %b1, %%" #SEG ":%0" : "=m"(var) \ : "Q"(value), "m"(__segment_ ## SEG)) #define WRITE16_SEG(prefix, SEG, var, value) \ __asm__(prefix "movw %w1, %%" #SEG ":%0" : "=m"(var) \ : "r"(value), "m"(__segment_ ## SEG)) #define WRITE32_SEG(prefix, SEG, var, value) \ __asm__(prefix "movl %1, %%" #SEG ":%0" : "=m"(var) \ : "r"(value), "m"(__segment_ ## SEG)) #define WRITE64_SEG(prefix, SEG, var, value) do { \ union u64_u32_u __value; \ union u64_u32_u *__w64_ptr = (union u64_u32_u *)&(var); \ typeof(var) __value_tmp = (value); \ __value.val = *(u64*)&__value_tmp; \ WRITE32_SEG(prefix, SEG, __w64_ptr->lo, __value.lo); \ WRITE32_SEG(prefix, SEG, __w64_ptr->hi, __value.hi); \ } while (0) // Macros for automatically choosing the appropriate memory size // access method. extern void __force_link_error__unknown_type(void); #define __GET_VAR(prefix, seg, var) ({ \ typeof(var) __val; \ if (sizeof(__val) == 1) \ READ8_SEG(prefix, seg, __val, var); \ else if (sizeof(__val) == 2) \ READ16_SEG(prefix, seg, __val, var); \ else if (sizeof(__val) == 4) \ READ32_SEG(prefix, seg, __val, var); \ else if (sizeof(__val) == 8) \ READ64_SEG(prefix, seg, __val, var); \ else \ __force_link_error__unknown_type(); \ __val; }) #define __SET_VAR(prefix, seg, var, val) do { \ if (sizeof(var) == 1) \ WRITE8_SEG(prefix, seg, var, (val)); \ else if (sizeof(var) == 2) \ WRITE16_SEG(prefix, seg, var, (val)); \ else if (sizeof(var) == 4) \ WRITE32_SEG(prefix, seg, var, (val)); \ else if (sizeof(var) == 8) \ WRITE64_SEG(prefix, seg, var, (val)); \ else \ __force_link_error__unknown_type(); \ } while (0) #define DECL_SEGFUNCS(SEG) \ static inline void __set_seg_##SEG(u16 seg) { \ __asm__("movw %w1, %%" #SEG : "=m"(__segment_##SEG) \ : "rm"(seg)); \ } \ static inline u16 __get_seg_##SEG(void) { \ u16 res; \ __asm__("movw %%" #SEG ", %w0" : "=rm"(res) \ : "m"(__segment_##SEG)); \ return res; \ } DECL_SEGFUNCS(CS) DECL_SEGFUNCS(DS) DECL_SEGFUNCS(ES) DECL_SEGFUNCS(FS) DECL_SEGFUNCS(GS) DECL_SEGFUNCS(SS) // Low level macros for getting/setting a segment register. #define __SET_SEG(SEG, value) \ __set_seg_##SEG(value) #define __GET_SEG(SEG) \ __get_seg_##SEG() // Macros for accessing a variable in another segment. (They // automatically update the %es segment and then make the appropriate // access.) #define __GET_FARVAR(seg, var) ({ \ SET_SEG(ES, (seg)); \ GET_VAR(ES, (var)); }) #define __SET_FARVAR(seg, var, val) do { \ typeof(var) __sfv_val = (val); \ SET_SEG(ES, (seg)); \ SET_VAR(ES, (var), __sfv_val); \ } while (0) // Macros for accesssing a 32bit flat mode pointer from 16bit real // mode. (They automatically update the %es segment, break the // pointer into segment/offset, and then make the access.) #define __GET_FLATPTR(ptr) ({ \ typeof(&(ptr)) __ptr = &(ptr); \ GET_FARVAR(FLATPTR_TO_SEG(__ptr) \ , *(typeof(__ptr))FLATPTR_TO_OFFSET(__ptr)); }) #define __SET_FLATPTR(ptr, val) do { \ typeof (&(ptr)) __ptr = &(ptr); \ SET_FARVAR(FLATPTR_TO_SEG(__ptr) \ , *(typeof(__ptr))FLATPTR_TO_OFFSET(__ptr) \ , (val)); \ } while (0) // Macros for converting to/from 32bit flat mode pointers to their // equivalent 16bit segment/offset values. #define FLATPTR_TO_SEG(p) (((u32)(p)) >> 4) #define FLATPTR_TO_OFFSET(p) (((u32)(p)) & 0xf) #define MAKE_FLATPTR(seg,off) ((void*)(((u32)(seg)<<4)+(u32)(off))) #if MODESEGMENT == 1 // Definitions when using segmented mode. #define GET_FARVAR(seg, var) __GET_FARVAR((seg), (var)) #define SET_FARVAR(seg, var, val) __SET_FARVAR((seg), (var), (val)) #define GET_VAR(seg, var) __GET_VAR("", seg, (var)) #define SET_VAR(seg, var, val) __SET_VAR("", seg, (var), (val)) #define SET_SEG(SEG, value) __SET_SEG(SEG, (value)) #define GET_SEG(SEG) __GET_SEG(SEG) #define GET_FLATPTR(ptr) __GET_FLATPTR(ptr) #define SET_FLATPTR(ptr, val) __SET_FLATPTR((ptr), (val)) static inline void insb_fl(u16 port, void *ptr_fl, u16 count) { SET_SEG(ES, FLATPTR_TO_SEG(ptr_fl)); insb(port, (u8*)FLATPTR_TO_OFFSET(ptr_fl), count); } static inline void insw_fl(u16 port, void *ptr_fl, u16 count) { SET_SEG(ES, FLATPTR_TO_SEG(ptr_fl)); insw(port, (u16*)FLATPTR_TO_OFFSET(ptr_fl), count); } static inline void insl_fl(u16 port, void *ptr_fl, u16 count) { SET_SEG(ES, FLATPTR_TO_SEG(ptr_fl)); insl(port, (u32*)FLATPTR_TO_OFFSET(ptr_fl), count); } static inline void outsb_fl(u16 port, void *ptr_fl, u16 count) { SET_SEG(ES, FLATPTR_TO_SEG(ptr_fl)); outsb(port, (u8*)FLATPTR_TO_OFFSET(ptr_fl), count); } static inline void outsw_fl(u16 port, void *ptr_fl, u16 count) { SET_SEG(ES, FLATPTR_TO_SEG(ptr_fl)); outsw(port, (u16*)FLATPTR_TO_OFFSET(ptr_fl), count); } static inline void outsl_fl(u16 port, void *ptr_fl, u16 count) { SET_SEG(ES, FLATPTR_TO_SEG(ptr_fl)); outsl(port, (u32*)FLATPTR_TO_OFFSET(ptr_fl), count); } #else // In 32-bit flat mode there is no need to mess with the segments. #define GET_FARVAR(seg, var) \ (*((typeof(&(var)))MAKE_FLATPTR((seg), &(var)))) #define SET_FARVAR(seg, var, val) \ do { GET_FARVAR((seg), (var)) = (val); } while (0) #define GET_VAR(seg, var) (var) #define SET_VAR(seg, var, val) do { (var) = (val); } while (0) #define SET_SEG(SEG, value) ((void)(value)) #define GET_SEG(SEG) 0 #define GET_FLATPTR(ptr) (ptr) #define SET_FLATPTR(ptr, val) do { (ptr) = (val); } while (0) #define insb_fl(port, ptr_fl, count) insb(port, ptr_fl, count) #define insw_fl(port, ptr_fl, count) insw(port, ptr_fl, count) #define insl_fl(port, ptr_fl, count) insl(port, ptr_fl, count) #define outsb_fl(port, ptr_fl, count) outsb(port, ptr_fl, count) #define outsw_fl(port, ptr_fl, count) outsw(port, ptr_fl, count) #define outsl_fl(port, ptr_fl, count) outsl(port, ptr_fl, count) #endif // Definition for common 16bit segment/offset pointers. struct segoff_s { union { struct { u16 offset; u16 seg; }; u32 segoff; }; }; #define SEGOFF(s,o) ({struct segoff_s __so; __so.offset=(o); __so.seg=(s); __so;}) static inline struct segoff_s FLATPTR_TO_SEGOFF(void *p) { return SEGOFF(FLATPTR_TO_SEG(p), FLATPTR_TO_OFFSET(p)); } static inline void *SEGOFF_TO_FLATPTR(struct segoff_s so) { return MAKE_FLATPTR(so.seg, so.offset); } #endif // farptr.h tinyvisor/bios/src/pirtable.c0000644006644000001440000000642712172661303016567 0ustar yuichi_xyusers// PIR table generation (for emulators) // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "pci.h" // struct pir_header #include "config.h" // CONFIG_* #include "util.h" // checksum struct pir_header *PirAddr VARFSEG; struct pir_table { struct pir_header pir; struct pir_slot slots[6]; } PACKED; extern struct pir_table PIR_TABLE; #if CONFIG_PIRTABLE struct pir_table PIR_TABLE __aligned(16) VARFSEG = { .pir = { .version = 0x0100, .size = sizeof(struct pir_table), .router_devfunc = 0x08, .compatible_devid = 0x122e8086, }, .slots = { { // first slot entry PCI-to-ISA (embedded) .dev = 1<<3, .links = { {.link = 0x60, .bitmap = 0xdef8}, // INTA# {.link = 0x61, .bitmap = 0xdef8}, // INTB# {.link = 0x62, .bitmap = 0xdef8}, // INTC# {.link = 0x63, .bitmap = 0xdef8}, // INTD# }, .slot_nr = 0, // embedded }, { // second slot entry: 1st PCI slot .dev = 2<<3, .links = { {.link = 0x61, .bitmap = 0xdef8}, // INTA# {.link = 0x62, .bitmap = 0xdef8}, // INTB# {.link = 0x63, .bitmap = 0xdef8}, // INTC# {.link = 0x60, .bitmap = 0xdef8}, // INTD# }, .slot_nr = 1, }, { // third slot entry: 2nd PCI slot .dev = 3<<3, .links = { {.link = 0x62, .bitmap = 0xdef8}, // INTA# {.link = 0x63, .bitmap = 0xdef8}, // INTB# {.link = 0x60, .bitmap = 0xdef8}, // INTC# {.link = 0x61, .bitmap = 0xdef8}, // INTD# }, .slot_nr = 2, }, { // 4th slot entry: 3rd PCI slot .dev = 4<<3, .links = { {.link = 0x63, .bitmap = 0xdef8}, // INTA# {.link = 0x60, .bitmap = 0xdef8}, // INTB# {.link = 0x61, .bitmap = 0xdef8}, // INTC# {.link = 0x62, .bitmap = 0xdef8}, // INTD# }, .slot_nr = 3, }, { // 5th slot entry: 4rd PCI slot .dev = 5<<3, .links = { {.link = 0x60, .bitmap = 0xdef8}, // INTA# {.link = 0x61, .bitmap = 0xdef8}, // INTB# {.link = 0x62, .bitmap = 0xdef8}, // INTC# {.link = 0x63, .bitmap = 0xdef8}, // INTD# }, .slot_nr = 4, }, { // 6th slot entry: 5rd PCI slot .dev = 6<<3, .links = { {.link = 0x61, .bitmap = 0xdef8}, // INTA# {.link = 0x62, .bitmap = 0xdef8}, // INTB# {.link = 0x63, .bitmap = 0xdef8}, // INTC# {.link = 0x60, .bitmap = 0xdef8}, // INTD# }, .slot_nr = 5, }, } }; #endif // CONFIG_PIRTABLE void pirtable_setup(void) { if (! CONFIG_PIRTABLE) return; dprintf(3, "init PIR table\n"); PIR_TABLE.pir.signature = PIR_SIGNATURE; PIR_TABLE.pir.checksum -= checksum(&PIR_TABLE, sizeof(PIR_TABLE)); PirAddr = &PIR_TABLE.pir; } tinyvisor/bios/src/cmos.h0000644006644000001440000000445412174763154015742 0ustar yuichi_xyusers// Definitions for X86 CMOS non-volatile memory access. // // Copyright (C) 2008 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. /* * Copyright (c) 2013 Yuichi Watanabe */ #ifndef __CMOS_H #define __CMOS_H // Standard BIOS RTC chip entries #define CMOS_RTC_SECONDS 0x00 #define CMOS_RTC_SECONDS_ALARM 0x01 #define CMOS_RTC_MINUTES 0x02 #define CMOS_RTC_MINUTES_ALARM 0x03 #define CMOS_RTC_HOURS 0x04 #define CMOS_RTC_HOURS_ALARM 0x05 #define CMOS_RTC_DAY_WEEK 0x06 #define CMOS_RTC_DAY_MONTH 0x07 #define CMOS_RTC_MONTH 0x08 #define CMOS_RTC_YEAR 0x09 #define CMOS_STATUS_A 0x0a #define CMOS_STATUS_B 0x0b #define CMOS_STATUS_C 0x0c #define CMOS_STATUS_D 0x0d #define CMOS_RESET_CODE 0x0f // QEMU cmos config fields. DO NOT ADD MORE. (All new content should // be passed via the fw_cfg "file" interface.) #define CMOS_FLOPPY_DRIVE_TYPE 0x10 #define CMOS_DISK_DATA 0x12 #define CMOS_EQUIPMENT_INFO 0x14 #define CMOS_DISK_DRIVE1_TYPE 0x19 #define CMOS_DISK_DRIVE2_TYPE 0x1a #define CMOS_DISK_DRIVE1_CYL 0x1b #define CMOS_DISK_DRIVE2_CYL 0x24 #define CMOS_MEM_EXTMEM_LOW 0x30 #define CMOS_MEM_EXTMEM_HIGH 0x31 #define CMOS_CENTURY 0x32 #define CMOS_MEM_EXTMEM2_LOW 0x34 #define CMOS_MEM_EXTMEM2_HIGH 0x35 #define CMOS_BIOS_BOOTFLAG1 0x38 #define CMOS_BIOS_DISKTRANSFLAG 0x39 #define CMOS_BIOS_BOOTFLAG2 0x3d #define CMOS_MEM_HIGHMEM_LOW 0x5b #define CMOS_MEM_HIGHMEM_MID 0x5c #define CMOS_MEM_HIGHMEM_HIGH 0x5d #define CMOS_BIOS_SMP_COUNT 0x5f #if CONFIG_GET_ACPI_PM_BASE_FROM_RTC != 0 #define CMOS_ACPI_PM_BASE 0x60 #endif // CMOS_FLOPPY_DRIVE_TYPE bitdefs #define CFD_NO_DRIVE 0 #define CFD_360KB 1 #define CFD_12MB 2 #define CFD_720KB 3 #define CFD_144MB 4 #define CFD_288MB 5 #ifndef __ASSEMBLY__ #include "ioport.h" // inb, outb static inline u8 inb_cmos(u8 reg) { reg |= NMI_DISABLE_BIT; outb(reg, PORT_CMOS_INDEX); return inb(PORT_CMOS_DATA); } static inline void outb_cmos(u8 val, u8 reg) { reg |= NMI_DISABLE_BIT; outb(reg, PORT_CMOS_INDEX); outb(val, PORT_CMOS_DATA); } #endif // !__ASSEMBLY__ #endif // cmos.h tinyvisor/bios/src/virtio-blk.c0000644006644000001440000001137112172661303017041 0ustar yuichi_xyusers// Virtio block boot support. // // Copyright (C) 2010 Red Hat Inc. // // Authors: // Gleb Natapov // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "pci.h" // foreachpci #include "config.h" // CONFIG_* #include "biosvar.h" // GET_GLOBAL #include "pci_ids.h" // PCI_DEVICE_ID_VIRTIO_BLK #include "pci_regs.h" // PCI_VENDOR_ID #include "boot.h" // boot_add_hd #include "virtio-pci.h" #include "virtio-ring.h" #include "virtio-blk.h" #include "disk.h" struct virtiodrive_s { struct drive_s drive; struct vring_virtqueue *vq; u16 ioaddr; }; static int virtio_blk_op(struct disk_op_s *op, int write) { struct virtiodrive_s *vdrive_g = container_of(op->drive_g, struct virtiodrive_s, drive); struct vring_virtqueue *vq = GET_GLOBAL(vdrive_g->vq); struct virtio_blk_outhdr hdr = { .type = write ? VIRTIO_BLK_T_OUT : VIRTIO_BLK_T_IN, .ioprio = 0, .sector = op->lba, }; u8 status = VIRTIO_BLK_S_UNSUPP; struct vring_list sg[] = { { .addr = MAKE_FLATPTR(GET_SEG(SS), &hdr), .length = sizeof(hdr), }, { .addr = op->buf_fl, .length = GET_GLOBAL(vdrive_g->drive.blksize) * op->count, }, { .addr = MAKE_FLATPTR(GET_SEG(SS), &status), .length = sizeof(status), }, }; /* Add to virtqueue and kick host */ if (write) vring_add_buf(vq, sg, 2, 1, 0, 0); else vring_add_buf(vq, sg, 1, 2, 0, 0); vring_kick(GET_GLOBAL(vdrive_g->ioaddr), vq, 1); /* Wait for reply */ while (!vring_more_used(vq)) usleep(5); /* Reclaim virtqueue element */ vring_get_buf(vq, NULL); /* Clear interrupt status register. Avoid leaving interrupts stuck if * VRING_AVAIL_F_NO_INTERRUPT was ignored and interrupts were raised. */ vp_get_isr(GET_GLOBAL(vdrive_g->ioaddr)); return status == VIRTIO_BLK_S_OK ? DISK_RET_SUCCESS : DISK_RET_EBADTRACK; } int process_virtio_blk_op(struct disk_op_s *op) { if (! CONFIG_VIRTIO_BLK) return 0; switch (op->command) { case CMD_READ: return virtio_blk_op(op, 0); case CMD_WRITE: return virtio_blk_op(op, 1); case CMD_FORMAT: case CMD_RESET: case CMD_ISREADY: case CMD_VERIFY: case CMD_SEEK: return DISK_RET_SUCCESS; default: op->count = 0; return DISK_RET_EPARAM; } } static void init_virtio_blk(struct pci_device *pci) { u16 bdf = pci->bdf; dprintf(1, "found virtio-blk at %x:%x\n", pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf)); struct virtiodrive_s *vdrive_g = malloc_fseg(sizeof(*vdrive_g)); if (!vdrive_g) { warn_noalloc(); return; } memset(vdrive_g, 0, sizeof(*vdrive_g)); vdrive_g->drive.type = DTYPE_VIRTIO_BLK; vdrive_g->drive.cntl_id = bdf; u16 ioaddr = vp_init_simple(bdf); vdrive_g->ioaddr = ioaddr; if (vp_find_vq(ioaddr, 0, &vdrive_g->vq) < 0 ) { dprintf(1, "fail to find vq for virtio-blk %x:%x\n", pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf)); goto fail; } struct virtio_blk_config cfg; vp_get(ioaddr, 0, &cfg, sizeof(cfg)); u32 f = vp_get_features(ioaddr); vdrive_g->drive.blksize = (f & (1 << VIRTIO_BLK_F_BLK_SIZE)) ? cfg.blk_size : DISK_SECTOR_SIZE; vdrive_g->drive.sectors = cfg.capacity; dprintf(3, "virtio-blk %x:%x blksize=%d sectors=%u\n", pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf), vdrive_g->drive.blksize, (u32)vdrive_g->drive.sectors); if (vdrive_g->drive.blksize != DISK_SECTOR_SIZE) { dprintf(1, "virtio-blk %x:%x block size %d is unsupported\n", pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf), vdrive_g->drive.blksize); goto fail; } vdrive_g->drive.pchs.cylinders = cfg.cylinders; vdrive_g->drive.pchs.heads = cfg.heads; vdrive_g->drive.pchs.spt = cfg.sectors; char *desc = znprintf(MAXDESCSIZE, "Virtio disk PCI:%x:%x", pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf)); boot_add_hd(&vdrive_g->drive, desc, bootprio_find_pci_device(pci)); vp_set_status(ioaddr, VIRTIO_CONFIG_S_ACKNOWLEDGE | VIRTIO_CONFIG_S_DRIVER | VIRTIO_CONFIG_S_DRIVER_OK); return; fail: free(vdrive_g->vq); free(vdrive_g); } void virtio_blk_setup(void) { ASSERT32FLAT(); if (! CONFIG_VIRTIO_BLK) return; dprintf(3, "init virtio-blk\n"); struct pci_device *pci; foreachpci(pci) { if (pci->vendor != PCI_VENDOR_ID_REDHAT_QUMRANET || pci->device != PCI_DEVICE_ID_VIRTIO_BLK) continue; init_virtio_blk(pci); } } tinyvisor/bios/src/usb-ohci.c0000644006644000001440000003532312172661303016473 0ustar yuichi_xyusers// Code for handling OHCI USB controllers. // // Copyright (C) 2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "pci.h" // pci_bdf_to_bus #include "config.h" // CONFIG_* #include "usb-ohci.h" // struct ohci_hcca #include "pci_regs.h" // PCI_BASE_ADDRESS_0 #include "usb.h" // struct usb_s #include "biosvar.h" // GET_LOWFLAT #define FIT (1 << 31) struct usb_ohci_s { struct usb_s usb; struct ohci_regs *regs; }; struct ohci_pipe { struct ohci_ed ed; struct usb_pipe pipe; void *data; int count; struct ohci_td *tds; }; /**************************************************************** * Root hub ****************************************************************/ // Check if device attached to port static int ohci_hub_detect(struct usbhub_s *hub, u32 port) { struct usb_ohci_s *cntl = container_of(hub->cntl, struct usb_ohci_s, usb); u32 sts = readl(&cntl->regs->roothub_portstatus[port]); if (!(sts & RH_PS_CCS)) // No device. return -1; // XXX - need to wait for USB_TIME_ATTDB if just powered up? return 0; } // Disable port static void ohci_hub_disconnect(struct usbhub_s *hub, u32 port) { struct usb_ohci_s *cntl = container_of(hub->cntl, struct usb_ohci_s, usb); writel(&cntl->regs->roothub_portstatus[port], RH_PS_CCS|RH_PS_LSDA); } // Reset device on port static int ohci_hub_reset(struct usbhub_s *hub, u32 port) { struct usb_ohci_s *cntl = container_of(hub->cntl, struct usb_ohci_s, usb); writel(&cntl->regs->roothub_portstatus[port], RH_PS_PRS); u32 sts; u64 end = calc_future_tsc(USB_TIME_DRSTR * 2); for (;;) { sts = readl(&cntl->regs->roothub_portstatus[port]); if (!(sts & RH_PS_PRS)) // XXX - need to ensure USB_TIME_DRSTR time in reset? break; if (check_tsc(end)) { // Timeout. warn_timeout(); ohci_hub_disconnect(hub, port); return -1; } yield(); } if ((sts & (RH_PS_CCS|RH_PS_PES)) != (RH_PS_CCS|RH_PS_PES)) // Device no longer present return -1; return !!(sts & RH_PS_LSDA); } static struct usbhub_op_s ohci_HubOp = { .detect = ohci_hub_detect, .reset = ohci_hub_reset, .disconnect = ohci_hub_disconnect, }; // Find any devices connected to the root hub. static int check_ohci_ports(struct usb_ohci_s *cntl) { ASSERT32FLAT(); // Turn on power for all devices on roothub. u32 rha = readl(&cntl->regs->roothub_a); rha &= ~(RH_A_PSM | RH_A_OCPM); writel(&cntl->regs->roothub_status, RH_HS_LPSC); writel(&cntl->regs->roothub_b, RH_B_PPCM); msleep((rha >> 24) * 2); // XXX - need to sleep for USB_TIME_SIGATT if just powered up? struct usbhub_s hub; memset(&hub, 0, sizeof(hub)); hub.cntl = &cntl->usb; hub.portcount = rha & RH_A_NDP; hub.op = &ohci_HubOp; usb_enumerate(&hub); return hub.devcount; } /**************************************************************** * Setup ****************************************************************/ // Wait for next USB frame to start - for ensuring safe memory release. static void ohci_waittick(struct usb_ohci_s *cntl) { barrier(); struct ohci_hcca *hcca = (void*)cntl->regs->hcca; u32 startframe = hcca->frame_no; u64 end = calc_future_tsc(1000 * 5); for (;;) { if (hcca->frame_no != startframe) break; if (check_tsc(end)) { warn_timeout(); return; } yield(); } } static void ohci_free_pipes(struct usb_ohci_s *cntl) { dprintf(7, "ohci_free_pipes %p\n", cntl); u32 creg = readl(&cntl->regs->control); if (creg & (OHCI_CTRL_CLE|OHCI_CTRL_BLE)) { writel(&cntl->regs->control, creg & ~(OHCI_CTRL_CLE|OHCI_CTRL_BLE)); ohci_waittick(cntl); } u32 *pos = &cntl->regs->ed_controlhead; for (;;) { struct ohci_ed *next = (void*)*pos; if (!next) break; struct ohci_pipe *pipe = container_of(next, struct ohci_pipe, ed); if (pipe->pipe.cntl != &cntl->usb) { *pos = next->hwNextED; free(pipe); } else { pos = &next->hwNextED; } } writel(&cntl->regs->ed_controlcurrent, 0); writel(&cntl->regs->ed_bulkcurrent, 0); writel(&cntl->regs->control, creg); cntl->usb.freelist = NULL; } static int start_ohci(struct usb_ohci_s *cntl, struct ohci_hcca *hcca) { u32 oldfminterval = readl(&cntl->regs->fminterval); u32 oldrwc = readl(&cntl->regs->control) & OHCI_CTRL_RWC; // XXX - check if already running? // Do reset writel(&cntl->regs->control, OHCI_USB_RESET | oldrwc); readl(&cntl->regs->control); // flush writes msleep(USB_TIME_DRSTR); // Do software init (min 10us, max 2ms) u64 end = calc_future_tsc_usec(10); writel(&cntl->regs->cmdstatus, OHCI_HCR); for (;;) { u32 status = readl(&cntl->regs->cmdstatus); if (! status & OHCI_HCR) break; if (check_tsc(end)) { warn_timeout(); return -1; } } // Init memory writel(&cntl->regs->ed_controlhead, 0); writel(&cntl->regs->ed_bulkhead, 0); writel(&cntl->regs->hcca, (u32)hcca); // Init fminterval u32 fi = oldfminterval & 0x3fff; writel(&cntl->regs->fminterval , (((oldfminterval & FIT) ^ FIT) | fi | (((6 * (fi - 210)) / 7) << 16))); writel(&cntl->regs->periodicstart, ((9 * fi) / 10) & 0x3fff); readl(&cntl->regs->control); // flush writes // XXX - verify that fminterval was setup correctly. // Go into operational state writel(&cntl->regs->control , (OHCI_CTRL_CBSR | OHCI_CTRL_CLE | OHCI_CTRL_PLE | OHCI_USB_OPER | oldrwc)); readl(&cntl->regs->control); // flush writes return 0; } static void stop_ohci(struct usb_ohci_s *cntl) { u32 oldrwc = readl(&cntl->regs->control) & OHCI_CTRL_RWC; writel(&cntl->regs->control, oldrwc); readl(&cntl->regs->control); // flush writes } static void configure_ohci(void *data) { struct usb_ohci_s *cntl = data; // Allocate memory struct ohci_hcca *hcca = memalign_high(256, sizeof(*hcca)); struct ohci_ed *intr_ed = malloc_high(sizeof(*intr_ed)); if (!hcca || !intr_ed) { warn_noalloc(); goto free; } memset(hcca, 0, sizeof(*hcca)); memset(intr_ed, 0, sizeof(*intr_ed)); intr_ed->hwINFO = ED_SKIP; int i; for (i=0; iint_table); i++) hcca->int_table[i] = (u32)intr_ed; int ret = start_ohci(cntl, hcca); if (ret) goto err; int count = check_ohci_ports(cntl); ohci_free_pipes(cntl); if (! count) goto err; return; err: stop_ohci(cntl); free: free(hcca); free(intr_ed); } void ohci_setup(struct pci_device *pci, int busid) { if (! CONFIG_USB_OHCI) return; struct usb_ohci_s *cntl = malloc_tmphigh(sizeof(*cntl)); if (!cntl) { warn_noalloc(); return; } memset(cntl, 0, sizeof(*cntl)); cntl->usb.busid = busid; cntl->usb.pci = pci; cntl->usb.type = USB_TYPE_OHCI; u16 bdf = pci->bdf; u32 baseaddr = pci_config_readl(bdf, PCI_BASE_ADDRESS_0); cntl->regs = (void*)(baseaddr & PCI_BASE_ADDRESS_MEM_MASK); dprintf(1, "OHCI init on dev %02x:%02x.%x (regs=%p)\n" , pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf) , pci_bdf_to_fn(bdf), cntl->regs); // Enable bus mastering and memory access. pci_config_maskw(bdf, PCI_COMMAND , 0, PCI_COMMAND_MASTER|PCI_COMMAND_MEMORY); // XXX - check for and disable SMM control? // Disable interrupts writel(&cntl->regs->intrdisable, ~0); writel(&cntl->regs->intrstatus, ~0); run_thread(configure_ohci, cntl); } /**************************************************************** * End point communication ****************************************************************/ // Setup fields in ed static void ohci_desc2pipe(struct ohci_pipe *pipe, struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc) { usb_desc2pipe(&pipe->pipe, usbdev, epdesc); pipe->ed.hwINFO = (ED_SKIP | usbdev->devaddr | (pipe->pipe.ep << 7) | (epdesc->wMaxPacketSize << 16) | (usbdev->speed ? ED_LOWSPEED : 0)); } static struct usb_pipe * ohci_alloc_intr_pipe(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc) { struct usb_ohci_s *cntl = container_of( usbdev->hub->cntl, struct usb_ohci_s, usb); int frameexp = usb_getFrameExp(usbdev, epdesc); dprintf(7, "ohci_alloc_intr_pipe %p %d\n", &cntl->usb, frameexp); if (frameexp > 5) frameexp = 5; int maxpacket = epdesc->wMaxPacketSize; // Determine number of entries needed for 2 timer ticks. int ms = 1<ed.hwINFO &= ~ED_SKIP; pipe->data = data; pipe->count = count; pipe->tds = tds; struct ohci_ed *ed = &pipe->ed; ed->hwHeadP = (u32)&tds[0]; ed->hwTailP = (u32)&tds[count-1]; int i; for (i=0; iregs->hcca; if (frameexp == 0) { // Add to existing interrupt entry. struct ohci_ed *intr_ed = (void*)hcca->int_table[0]; ed->hwNextED = intr_ed->hwNextED; barrier(); intr_ed->hwNextED = (u32)ed; } else { int startpos = 1<<(frameexp-1); ed->hwNextED = hcca->int_table[startpos]; barrier(); for (i=startpos; iint_table); i+=ms) hcca->int_table[i] = (u32)ed; } return &pipe->pipe; err: free(pipe); free(tds); free(data); return NULL; } struct usb_pipe * ohci_alloc_pipe(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc) { if (! CONFIG_USB_OHCI) return NULL; u8 eptype = epdesc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; if (eptype == USB_ENDPOINT_XFER_INT) return ohci_alloc_intr_pipe(usbdev, epdesc); if (eptype != USB_ENDPOINT_XFER_CONTROL) { dprintf(1, "OHCI Bulk transfers not supported.\n"); return NULL; } struct usb_ohci_s *cntl = container_of( usbdev->hub->cntl, struct usb_ohci_s, usb); dprintf(7, "ohci_alloc_async_pipe %p\n", &cntl->usb); struct usb_pipe *usbpipe = usb_getFreePipe(&cntl->usb, eptype); if (usbpipe) { // Use previously allocated pipe. struct ohci_pipe *pipe = container_of(usbpipe, struct ohci_pipe, pipe); ohci_desc2pipe(pipe, usbdev, epdesc); return usbpipe; } // Allocate a new queue head. struct ohci_pipe *pipe = malloc_tmphigh(sizeof(*pipe)); if (!pipe) { warn_noalloc(); return NULL; } memset(pipe, 0, sizeof(*pipe)); ohci_desc2pipe(pipe, usbdev, epdesc); // Add queue head to controller list. pipe->ed.hwNextED = cntl->regs->ed_controlhead; barrier(); cntl->regs->ed_controlhead = (u32)&pipe->ed; return &pipe->pipe; } static int wait_ed(struct ohci_ed *ed) { // XXX - 500ms just a guess u64 end = calc_future_tsc(500); for (;;) { if (ed->hwHeadP == ed->hwTailP) return 0; if (check_tsc(end)) { warn_timeout(); return -1; } yield(); } } int ohci_control(struct usb_pipe *p, int dir, const void *cmd, int cmdsize , void *data, int datasize) { if (! CONFIG_USB_OHCI) return -1; dprintf(5, "ohci_control %p\n", p); if (datasize > 4096) { // XXX - should support larger sizes. warn_noalloc(); return -1; } struct ohci_pipe *pipe = container_of(p, struct ohci_pipe, pipe); struct usb_ohci_s *cntl = container_of( pipe->pipe.cntl, struct usb_ohci_s, usb); // Setup transfer descriptors struct ohci_td *tds = malloc_tmphigh(sizeof(*tds) * 3); if (!tds) { warn_noalloc(); return -1; } struct ohci_td *td = tds; td->hwINFO = TD_DP_SETUP | TD_T_DATA0 | TD_CC; td->hwCBP = (u32)cmd; td->hwNextTD = (u32)&td[1]; td->hwBE = (u32)cmd + cmdsize - 1; td++; if (datasize) { td->hwINFO = (dir ? TD_DP_IN : TD_DP_OUT) | TD_T_DATA1 | TD_CC; td->hwCBP = (u32)data; td->hwNextTD = (u32)&td[1]; td->hwBE = (u32)data + datasize - 1; td++; } td->hwINFO = (dir ? TD_DP_OUT : TD_DP_IN) | TD_T_DATA1 | TD_CC; td->hwCBP = 0; td->hwNextTD = (u32)&td[1]; td->hwBE = 0; td++; // Transfer data pipe->ed.hwHeadP = (u32)tds; pipe->ed.hwTailP = (u32)td; barrier(); pipe->ed.hwINFO &= ~ED_SKIP; writel(&cntl->regs->cmdstatus, OHCI_CLF); int ret = wait_ed(&pipe->ed); pipe->ed.hwINFO |= ED_SKIP; if (ret) ohci_waittick(cntl); free(tds); return ret; } int ohci_send_bulk(struct usb_pipe *p, int dir, void *data, int datasize) { return -1; } int ohci_poll_intr(struct usb_pipe *p, void *data) { ASSERT16(); if (! CONFIG_USB_OHCI) return -1; struct ohci_pipe *pipe = container_of(p, struct ohci_pipe, pipe); struct ohci_td *tds = GET_LOWFLAT(pipe->tds); struct ohci_td *head = (void*)(GET_LOWFLAT(pipe->ed.hwHeadP) & ~(ED_C|ED_H)); struct ohci_td *tail = (void*)GET_LOWFLAT(pipe->ed.hwTailP); int count = GET_LOWFLAT(pipe->count); int pos = (tail - tds + 1) % count; struct ohci_td *next = &tds[pos]; if (head == next) // No intrs found. return -1; // XXX - check for errors. // Copy data. int maxpacket = GET_LOWFLAT(pipe->pipe.maxpacket); void *pipedata = GET_LOWFLAT((pipe->data)); void *intrdata = pipedata + maxpacket * pos; memcpy_far(GET_SEG(SS), data, SEG_LOW, LOWFLAT2LOW(intrdata), maxpacket); // Reenable this td. SET_LOWFLAT(tail->hwINFO, TD_DP_IN | TD_T_TOGGLE | TD_CC); intrdata = pipedata + maxpacket * (tail-tds); SET_LOWFLAT(tail->hwCBP, (u32)intrdata); SET_LOWFLAT(tail->hwNextTD, (u32)next); SET_LOWFLAT(tail->hwBE, (u32)intrdata + maxpacket - 1); barrier(); SET_LOWFLAT(pipe->ed.hwTailP, (u32)next); return 0; } tinyvisor/bios/src/usb.h0000644006644000001440000001523512172661303015560 0ustar yuichi_xyusers// USB functions and data. #ifndef __USB_H #define __USB_H #include "util.h" // struct mutex_s // Information on a USB end point. struct usb_pipe { union { struct usb_s *cntl; struct usb_pipe *freenext; }; u8 type; u8 ep; u8 devaddr; u8 speed; u16 maxpacket; u8 eptype; }; // Common information for usb devices. struct usbdevice_s { struct usbhub_s *hub; struct usb_pipe *defpipe; u32 port; struct usb_config_descriptor *config; struct usb_interface_descriptor *iface; int imax; u8 speed; u8 devaddr; }; // Common information for usb controllers. struct usb_s { struct usb_pipe *freelist; struct mutex_s resetlock; struct pci_device *pci; int busid; u8 type; u8 maxaddr; }; // Information for enumerating USB hubs struct usbhub_s { struct usbhub_op_s *op; struct usbdevice_s *usbdev; struct usb_s *cntl; struct mutex_s lock; u32 powerwait; u32 port; u32 threads; u32 portcount; u32 devcount; }; // Hub callback (32bit) info struct usbhub_op_s { int (*detect)(struct usbhub_s *hub, u32 port); int (*reset)(struct usbhub_s *hub, u32 port); void (*disconnect)(struct usbhub_s *hub, u32 port); }; #define USB_TYPE_UHCI 1 #define USB_TYPE_OHCI 2 #define USB_TYPE_EHCI 3 #define USB_FULLSPEED 0 #define USB_LOWSPEED 1 #define USB_HIGHSPEED 2 #define USB_MAXADDR 127 /**************************************************************** * usb structs and flags ****************************************************************/ // USB mandated timings (in ms) #define USB_TIME_SIGATT 100 #define USB_TIME_ATTDB 100 #define USB_TIME_DRST 10 #define USB_TIME_DRSTR 50 #define USB_TIME_RSTRCY 10 #define USB_TIME_SETADDR_RECOVERY 2 #define USB_PID_OUT 0xe1 #define USB_PID_IN 0x69 #define USB_PID_SETUP 0x2d #define USB_DIR_OUT 0 /* to device */ #define USB_DIR_IN 0x80 /* to host */ #define USB_TYPE_MASK (0x03 << 5) #define USB_TYPE_STANDARD (0x00 << 5) #define USB_TYPE_CLASS (0x01 << 5) #define USB_TYPE_VENDOR (0x02 << 5) #define USB_TYPE_RESERVED (0x03 << 5) #define USB_RECIP_MASK 0x1f #define USB_RECIP_DEVICE 0x00 #define USB_RECIP_INTERFACE 0x01 #define USB_RECIP_ENDPOINT 0x02 #define USB_RECIP_OTHER 0x03 #define USB_REQ_GET_STATUS 0x00 #define USB_REQ_CLEAR_FEATURE 0x01 #define USB_REQ_SET_FEATURE 0x03 #define USB_REQ_SET_ADDRESS 0x05 #define USB_REQ_GET_DESCRIPTOR 0x06 #define USB_REQ_SET_DESCRIPTOR 0x07 #define USB_REQ_GET_CONFIGURATION 0x08 #define USB_REQ_SET_CONFIGURATION 0x09 #define USB_REQ_GET_INTERFACE 0x0A #define USB_REQ_SET_INTERFACE 0x0B #define USB_REQ_SYNCH_FRAME 0x0C struct usb_ctrlrequest { u8 bRequestType; u8 bRequest; u16 wValue; u16 wIndex; u16 wLength; } PACKED; #define USB_DT_DEVICE 0x01 #define USB_DT_CONFIG 0x02 #define USB_DT_STRING 0x03 #define USB_DT_INTERFACE 0x04 #define USB_DT_ENDPOINT 0x05 #define USB_DT_DEVICE_QUALIFIER 0x06 #define USB_DT_OTHER_SPEED_CONFIG 0x07 struct usb_device_descriptor { u8 bLength; u8 bDescriptorType; u16 bcdUSB; u8 bDeviceClass; u8 bDeviceSubClass; u8 bDeviceProtocol; u8 bMaxPacketSize0; u16 idVendor; u16 idProduct; u16 bcdDevice; u8 iManufacturer; u8 iProduct; u8 iSerialNumber; u8 bNumConfigurations; } PACKED; #define USB_CLASS_PER_INTERFACE 0 /* for DeviceClass */ #define USB_CLASS_AUDIO 1 #define USB_CLASS_COMM 2 #define USB_CLASS_HID 3 #define USB_CLASS_PHYSICAL 5 #define USB_CLASS_STILL_IMAGE 6 #define USB_CLASS_PRINTER 7 #define USB_CLASS_MASS_STORAGE 8 #define USB_CLASS_HUB 9 struct usb_config_descriptor { u8 bLength; u8 bDescriptorType; u16 wTotalLength; u8 bNumInterfaces; u8 bConfigurationValue; u8 iConfiguration; u8 bmAttributes; u8 bMaxPower; } PACKED; struct usb_interface_descriptor { u8 bLength; u8 bDescriptorType; u8 bInterfaceNumber; u8 bAlternateSetting; u8 bNumEndpoints; u8 bInterfaceClass; u8 bInterfaceSubClass; u8 bInterfaceProtocol; u8 iInterface; } PACKED; struct usb_endpoint_descriptor { u8 bLength; u8 bDescriptorType; u8 bEndpointAddress; u8 bmAttributes; u16 wMaxPacketSize; u8 bInterval; } PACKED; #define USB_ENDPOINT_NUMBER_MASK 0x0f /* in bEndpointAddress */ #define USB_ENDPOINT_DIR_MASK 0x80 #define USB_ENDPOINT_XFERTYPE_MASK 0x03 /* in bmAttributes */ #define USB_ENDPOINT_XFER_CONTROL 0 #define USB_ENDPOINT_XFER_ISOC 1 #define USB_ENDPOINT_XFER_BULK 2 #define USB_ENDPOINT_XFER_INT 3 #define USB_ENDPOINT_MAX_ADJUSTABLE 0x80 /**************************************************************** * usb mass storage flags ****************************************************************/ #define US_SC_ATAPI_8020 0x02 #define US_SC_ATAPI_8070 0x05 #define US_SC_SCSI 0x06 #define US_PR_BULK 0x50 /* bulk-only transport */ #define US_PR_UAS 0x62 /* usb attached scsi */ /**************************************************************** * function defs ****************************************************************/ // usb.c struct usb_pipe *usb_alloc_pipe(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc); int usb_send_bulk(struct usb_pipe *pipe, int dir, void *data, int datasize); int usb_poll_intr(struct usb_pipe *pipe, void *data); int send_default_control(struct usb_pipe *pipe, const struct usb_ctrlrequest *req , void *data); void free_pipe(struct usb_pipe *pipe); struct usb_pipe *usb_getFreePipe(struct usb_s *cntl, u8 eptype); void usb_desc2pipe(struct usb_pipe *pipe, struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc); int usb_getFrameExp(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc); struct usb_endpoint_descriptor *findEndPointDesc(struct usbdevice_s *usbdev , int type, int dir); void usb_enumerate(struct usbhub_s *hub); void usb_setup(void); #endif // usb.h tinyvisor/bios/src/vgahooks.c0000644006644000001440000001551012172661303016577 0ustar yuichi_xyusers// Hooks for via vgabios calls into main bios. // // Copyright (C) 2008 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "bregs.h" // set_code_invalid #include "biosvar.h" // GET_GLOBAL #include "pci.h" // pci_find_device #include "pci_regs.h" // PCI_VENDOR_ID #include "pci_ids.h" // PCI_VENDOR_ID_VIA #include "util.h" // handle_155f #include "config.h" // CONFIG_* #define VH_VIA 1 #define VH_INTEL 2 int VGAHookHandlerType VARFSEG; static void handle_155fXX(struct bregs *regs) { set_code_unimplemented(regs, RET_EUNSUPPORTED); } /**************************************************************** * Via hooks ****************************************************************/ int ViaFBsize VARFSEG, ViaRamSpeed VARFSEG; static void via_155f01(struct bregs *regs) { regs->eax = 0x5f; regs->cl = 2; // panel type = 2 = 1024 * 768 set_success(regs); dprintf(1, "Warning: VGA panel type is hardcoded\n"); } static void via_155f02(struct bregs *regs) { regs->eax = 0x5f; regs->bx = 2; regs->cx = 0x401; // PAL + crt only regs->dx = 0; // TV Layout - default set_success(regs); dprintf(1, "Warning: VGA TV/CRT output type is hardcoded\n"); } static void via_155f18(struct bregs *regs) { int fbsize = GET_GLOBAL(ViaFBsize), ramspeed = GET_GLOBAL(ViaRamSpeed); if (fbsize < 0 || ramspeed < 0) { set_code_invalid(regs, RET_EUNSUPPORTED); return; } regs->eax = 0x5f; regs->ebx = 0x500 | (ramspeed << 4) | fbsize; regs->ecx = 0x060; set_success(regs); } static void via_155f19(struct bregs *regs) { set_invalid_silent(regs); } static void via_155f(struct bregs *regs) { switch (regs->al) { case 0x01: via_155f01(regs); break; case 0x02: via_155f02(regs); break; case 0x18: via_155f18(regs); break; case 0x19: via_155f19(regs); break; default: handle_155fXX(regs); break; } } static int getFBSize(struct pci_device *pci) { /* FB config */ u8 reg = pci_config_readb(pci->bdf, 0xa1); /* GFX disabled ? */ if (!(reg & 0x80)) return -1; static u8 mem_power[] = {0, 3, 4, 5, 6, 7, 8, 9}; return mem_power[(reg >> 4) & 0x7]; } static int getViaRamSpeed(struct pci_device *pci) { return (pci_config_readb(pci->bdf, 0x90) & 0x07) + 3; } static int getAMDRamSpeed(void) { struct pci_device *pci = pci_find_device(PCI_VENDOR_ID_AMD , PCI_DEVICE_ID_AMD_K8_NB_MEMCTL); if (!pci) return -1; /* mem clk 0 = DDR2 400 */ return (pci_config_readb(pci->bdf, 0x94) & 0x7) + 6; } /* int 0x15 - 5f18 ECX = unknown/dont care EBX[3..0] Frame Buffer Size 2^N MiB EBX[7..4] Memory speed: 0: SDR 66Mhz 1: SDR 100Mhz 2: SDR 133Mhz 3: DDR 100Mhz (PC1600 or DDR200) 4: DDR 133Mhz (PC2100 or DDR266) 5: DDR 166Mhz (PC2700 or DDR333) 6: DDR 200Mhz (PC3200 or DDR400) 7: DDR2 133Mhz (DDR2 533) 8: DDR2 166Mhz (DDR2 667) 9: DDR2 200Mhz (DDR2 800) A: DDR2 233Mhz (DDR2 1066) B: and above: Unknown EBX[?..8] Total memory size? EAX = 0x5f for success */ #define PCI_DEVICE_ID_VIA_K8M890CE_3 0x3336 #define PCI_DEVICE_ID_VIA_VX855_MEMCTRL 0x3409 static void via_setup(struct pci_device *pci) { VGAHookHandlerType = VH_VIA; struct pci_device *d = pci_find_device(PCI_VENDOR_ID_VIA , PCI_DEVICE_ID_VIA_K8M890CE_3); if (d) { ViaFBsize = getFBSize(d); ViaRamSpeed = getAMDRamSpeed(); return; } d = pci_find_device(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_VX855_MEMCTRL); if (d) { ViaFBsize = getFBSize(d); ViaRamSpeed = getViaRamSpeed(d); return; } dprintf(1, "Warning: VGA memory size and speed is hardcoded\n"); ViaFBsize = 5; // 32M frame buffer ViaRamSpeed = 4; // MCLK = DDR266 } /**************************************************************** * Intel VGA hooks ****************************************************************/ u8 IntelDisplayType VARFSEG, IntelDisplayId VARFSEG; static void intel_155f35(struct bregs *regs) { regs->ax = 0x005f; regs->cl = GET_GLOBAL(IntelDisplayType); set_success(regs); } static void intel_155f40(struct bregs *regs) { regs->ax = 0x005f; regs->cl = GET_GLOBAL(IntelDisplayId); set_success(regs); } static void intel_155f50(struct bregs *regs) { /* Mandatory hook on some Dell laptops */ regs->ax = 0x005f; set_success(regs); } static void intel_155f(struct bregs *regs) { switch (regs->al) { case 0x35: intel_155f35(regs); break; case 0x40: intel_155f40(regs); break; case 0x50: intel_155f50(regs); break; default: handle_155fXX(regs); break; } } #define BOOT_DISPLAY_DEFAULT (0) #define BOOT_DISPLAY_CRT (1 << 0) #define BOOT_DISPLAY_TV (1 << 1) #define BOOT_DISPLAY_EFP (1 << 2) #define BOOT_DISPLAY_LCD (1 << 3) #define BOOT_DISPLAY_CRT2 (1 << 4) #define BOOT_DISPLAY_TV2 (1 << 5) #define BOOT_DISPLAY_EFP2 (1 << 6) #define BOOT_DISPLAY_LCD2 (1 << 7) static void intel_setup(struct pci_device *pci) { VGAHookHandlerType = VH_INTEL; IntelDisplayType = BOOT_DISPLAY_DEFAULT; IntelDisplayId = 3; } static void roda_setup(struct pci_device *pci) { VGAHookHandlerType = VH_INTEL; // IntelDisplayType = BOOT_DISPLAY_DEFAULT; IntelDisplayType = BOOT_DISPLAY_LCD; // IntelDisplayId = inb(0x60f) & 0x0f; // Correct according to Crete IntelDisplayId = 3; // Correct according to empirical studies } static void kontron_setup(struct pci_device *pci) { VGAHookHandlerType = VH_INTEL; IntelDisplayType = BOOT_DISPLAY_CRT; IntelDisplayId = 3; } static void getac_setup(struct pci_device *pci) { } /**************************************************************** * Entry and setup ****************************************************************/ // Main 16bit entry point void handle_155f(struct bregs *regs) { if (!CONFIG_VGAHOOKS) { handle_155fXX(regs); return; } int htype = GET_GLOBAL(VGAHookHandlerType); switch (htype) { case VH_VIA: via_155f(regs); break; case VH_INTEL: intel_155f(regs); break; default: handle_155fXX(regs); break; } } // Setup void vgahook_setup(struct pci_device *pci) { if (!CONFIG_VGAHOOKS) return; if (strcmp(CBvendor, "KONTRON") == 0 && strcmp(CBpart, "986LCD-M") == 0) kontron_setup(pci); else if (strcmp(CBvendor, "GETAC") == 0 && strcmp(CBpart, "P470") == 0) getac_setup(pci); else if (strcmp(CBvendor, "RODA") == 0 && strcmp(CBpart, "RK886EX") == 0) roda_setup(pci); else if (pci->vendor == PCI_VENDOR_ID_VIA) via_setup(pci); else if (pci->vendor == PCI_VENDOR_ID_INTEL) intel_setup(pci); } tinyvisor/bios/src/util.h0000644006644000001440000003252612172661303015746 0ustar yuichi_xyusers// Basic x86 asm functions and function defs. // // Copyright (C) 2008-2010 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #ifndef __UTIL_H #define __UTIL_H #include "types.h" // u32 static inline void irq_disable(void) { asm volatile("cli": : :"memory"); } static inline void irq_enable(void) { asm volatile("sti": : :"memory"); } static inline u32 save_flags(void) { u32 flags; asm volatile("pushfl ; popl %0" : "=rm" (flags)); return flags; } static inline void restore_flags(u32 flags) { asm volatile("pushl %0 ; popfl" : : "g" (flags) : "memory", "cc"); } static inline void cpu_relax(void) { asm volatile("rep ; nop": : :"memory"); } static inline void nop(void) { asm volatile("nop"); } static inline void hlt(void) { asm volatile("hlt": : :"memory"); } static inline void wbinvd(void) { asm volatile("wbinvd": : :"memory"); } #define CPUID_TSC (1 << 4) #define CPUID_MSR (1 << 5) #define CPUID_APIC (1 << 9) #define CPUID_MTRR (1 << 12) static inline void __cpuid(u32 index, u32 *eax, u32 *ebx, u32 *ecx, u32 *edx) { asm("cpuid" : "=a" (*eax), "=b" (*ebx), "=c" (*ecx), "=d" (*edx) : "0" (index)); } static inline u32 getcr0(void) { u32 cr0; asm("movl %%cr0, %0" : "=r"(cr0)); return cr0; } static inline void setcr0(u32 cr0) { asm("movl %0, %%cr0" : : "r"(cr0)); } static inline u64 rdmsr(u32 index) { u64 ret; asm ("rdmsr" : "=A"(ret) : "c"(index)); return ret; } static inline void wrmsr(u32 index, u64 val) { asm volatile ("wrmsr" : : "c"(index), "A"(val)); } static inline u64 rdtscll(void) { u64 val; asm volatile("rdtsc" : "=A" (val)); return val; } static inline u32 __ffs(u32 word) { asm("bsf %1,%0" : "=r" (word) : "rm" (word)); return word; } static inline u32 __fls(u32 word) { asm("bsr %1,%0" : "=r" (word) : "rm" (word)); return word; } static inline u32 getesp(void) { u32 esp; asm("movl %%esp, %0" : "=rm"(esp)); return esp; } static inline void writel(void *addr, u32 val) { *(volatile u32 *)addr = val; } static inline void writew(void *addr, u16 val) { *(volatile u16 *)addr = val; } static inline void writeb(void *addr, u8 val) { *(volatile u8 *)addr = val; } static inline u32 readl(const void *addr) { return *(volatile const u32 *)addr; } static inline u16 readw(const void *addr) { return *(volatile const u16 *)addr; } static inline u8 readb(const void *addr) { return *(volatile const u8 *)addr; } // GDT bits #define GDT_CODE (0x9bULL << 40) // Code segment - P,R,A bits also set #define GDT_DATA (0x93ULL << 40) // Data segment - W,A bits also set #define GDT_B (0x1ULL << 54) // Big flag #define GDT_G (0x1ULL << 55) // Granularity flag // GDT bits for segment base #define GDT_BASE(v) ((((u64)(v) & 0xff000000) << 32) \ | (((u64)(v) & 0x00ffffff) << 16)) // GDT bits for segment limit (0-1Meg) #define GDT_LIMIT(v) ((((u64)(v) & 0x000f0000) << 32) \ | (((u64)(v) & 0x0000ffff) << 0)) // GDT bits for segment limit (0-4Gig in 4K chunks) #define GDT_GRANLIMIT(v) (GDT_G | GDT_LIMIT((v) >> 12)) struct descloc_s { u16 length; u32 addr; } PACKED; // util.c void cpuid(u32 index, u32 *eax, u32 *ebx, u32 *ecx, u32 *edx); u8 checksum_far(u16 buf_seg, void *buf_far, u32 len); u8 checksum(void *buf, u32 len); size_t strlen(const char *s); int memcmp(const void *s1, const void *s2, size_t n); int strcmp(const char *s1, const char *s2); inline void memset_far(u16 d_seg, void *d_far, u8 c, size_t len); inline void memset16_far(u16 d_seg, void *d_far, u16 c, size_t len); void *memset(void *s, int c, size_t n); void memset_fl(void *ptr, u8 val, size_t size); inline void memcpy_far(u16 d_seg, void *d_far , u16 s_seg, const void *s_far, size_t len); void memcpy_fl(void *d_fl, const void *s_fl, size_t len); void *memcpy(void *d1, const void *s1, size_t len); #if MODESEGMENT == 0 #define memcpy __builtin_memcpy #endif void iomemcpy(void *d, const void *s, u32 len); void *memmove(void *d, const void *s, size_t len); char *strtcpy(char *dest, const char *src, size_t len); char *strchr(const char *s, int c); void nullTrailingSpace(char *buf); int get_keystroke(int msec); // stacks.c extern u8 ExtraStack[], *StackPos; u32 stack_hop(u32 eax, u32 edx, void *func); u32 stack_hop_back(u32 eax, u32 edx, void *func); u32 call32(void *func, u32 eax, u32 errret); struct bregs; inline void farcall16(struct bregs *callregs); inline void farcall16big(struct bregs *callregs); inline void __call16_int(struct bregs *callregs, u16 offset); #define call16_int(nr, callregs) do { \ extern void irq_trampoline_ ##nr (); \ __call16_int((callregs), (u32)&irq_trampoline_ ##nr ); \ } while (0) extern struct thread_info MainThread; struct thread_info *getCurThread(void); void yield(void); void yield_toirq(void); void run_thread(void (*func)(void*), void *data); void wait_threads(void); struct mutex_s { u32 isLocked; }; void mutex_lock(struct mutex_s *mutex); void mutex_unlock(struct mutex_s *mutex); void start_preempt(void); void finish_preempt(void); int wait_preempt(void); void check_preempt(void); // output.c extern u16 DebugOutputPort; void debug_serial_preinit(void); void panic(const char *fmt, ...) __attribute__ ((format (printf, 1, 2))) __noreturn; void printf(const char *fmt, ...) __attribute__ ((format (printf, 1, 2))); int snprintf(char *str, size_t size, const char *fmt, ...) __attribute__ ((format (printf, 3, 4))); char * znprintf(size_t size, const char *fmt, ...) __attribute__ ((format (printf, 2, 3))); void __dprintf(const char *fmt, ...) __attribute__ ((format (printf, 1, 2))); void __debug_enter(struct bregs *regs, const char *fname); void __debug_isr(const char *fname); void __debug_stub(struct bregs *regs, int lineno, const char *fname); void __warn_invalid(struct bregs *regs, int lineno, const char *fname); void __warn_unimplemented(struct bregs *regs, int lineno, const char *fname); void __warn_internalerror(int lineno, const char *fname); void __warn_noalloc(int lineno, const char *fname); void __warn_timeout(int lineno, const char *fname); void __set_invalid(struct bregs *regs, int lineno, const char *fname); void __set_unimplemented(struct bregs *regs, int lineno, const char *fname); void __set_code_invalid(struct bregs *regs, u32 linecode, const char *fname); void __set_code_unimplemented(struct bregs *regs, u32 linecode , const char *fname); void hexdump(const void *d, int len); #define dprintf(lvl, fmt, args...) do { \ if (CONFIG_DEBUG_LEVEL && (lvl) <= CONFIG_DEBUG_LEVEL) \ __dprintf((fmt) , ##args ); \ } while (0) #define debug_enter(regs, lvl) do { \ if ((lvl) && (lvl) <= CONFIG_DEBUG_LEVEL) \ __debug_enter((regs), __func__); \ } while (0) #define debug_isr(lvl) do { \ if ((lvl) && (lvl) <= CONFIG_DEBUG_LEVEL) \ __debug_isr(__func__); \ } while (0) #define debug_stub(regs) \ __debug_stub((regs), __LINE__, __func__) #define warn_invalid(regs) \ __warn_invalid((regs), __LINE__, __func__) #define warn_unimplemented(regs) \ __warn_unimplemented((regs), __LINE__, __func__) #define warn_internalerror() \ __warn_internalerror(__LINE__, __func__) #define warn_noalloc() \ __warn_noalloc(__LINE__, __func__) #define warn_timeout() \ __warn_timeout(__LINE__, __func__) #define set_invalid(regs) \ __set_invalid((regs), __LINE__, __func__) #define set_code_invalid(regs, code) \ __set_code_invalid((regs), (code) | (__LINE__ << 8), __func__) #define set_unimplemented(regs) \ __set_unimplemented((regs), __LINE__, __func__) #define set_code_unimplemented(regs, code) \ __set_code_unimplemented((regs), (code) | (__LINE__ << 8), __func__) // kbd.c void kbd_init(void); void handle_15c2(struct bregs *regs); void process_key(u8 key); // mouse.c void mouse_init(void); void process_mouse(u8 data); // serial.c void serial_setup(void); void lpt_setup(void); // clock.c #define PIT_TICK_RATE 1193180 // Underlying HZ of PIT #define PIT_TICK_INTERVAL 65536 // Default interval for 18.2Hz timer void pmtimer_setup(u16 ioport, u32 khz); int check_tsc(u64 end); void timer_setup(void); void ndelay(u32 count); void udelay(u32 count); void mdelay(u32 count); void nsleep(u32 count); void usleep(u32 count); void msleep(u32 count); u64 calc_future_tsc(u32 msecs); u64 calc_future_tsc_usec(u32 usecs); u32 calc_future_timer_ticks(u32 count); u32 calc_future_timer(u32 msecs); int check_timer(u32 end); void handle_1583(struct bregs *regs); void handle_1586(struct bregs *regs); void useRTC(void); void releaseRTC(void); // apm.c void apm_shutdown(void); void handle_1553(struct bregs *regs); // pcibios.c void handle_1ab1(struct bregs *regs); void bios32_init(void); // shadow.c void make_bios_writable(void); void make_bios_readonly(void); void qemu_prep_reset(void); // pciinit.c extern const u8 pci_irqs[4]; void pci_setup(void); // smm.c void smm_device_setup(void); void smm_setup(void); // smp.c extern u32 CountCPUs; extern u32 MaxCountCPUs; void wrmsr_smp(u32 index, u64 val); void smp_setup(void); int apic_id_is_present(u8 apic_id); // coreboot.c extern const char *CBvendor, *CBpart; struct cbfs_file; void cbfs_run_payload(struct cbfs_file *file); void coreboot_platform_setup(void); void cbfs_payload_setup(void); void coreboot_preinit(void); void coreboot_cbfs_init(void); // biostable.c void copy_smbios(void *pos); void copy_table(void *pos); // vgahooks.c void handle_155f(struct bregs *regs); struct pci_device; void vgahook_setup(struct pci_device *pci); // optionroms.c void call_bcv(u16 seg, u16 ip); int is_pci_vga(struct pci_device *pci); void optionrom_setup(void); void vgarom_setup(void); void s3_resume_vga(void); extern int ScreenAndDebug; // bootsplash.c void enable_vga_console(void); void enable_bootsplash(void); void disable_bootsplash(void); // resume.c extern int HaveRunPost; void dma_setup(void); // pnpbios.c #define PNP_SIGNATURE 0x506e5024 // $PnP u16 get_pnp_offset(void); void pnp_init(void); // pmm.c extern struct zone_s ZoneLow, ZoneHigh, ZoneFSeg, ZoneTmpLow, ZoneTmpHigh; u32 rom_get_max(void); u32 rom_get_last(void); struct rom_header *rom_reserve(u32 size); int rom_confirm(u32 size); void csm_malloc_preinit(u32 low_pmm, u32 low_pmm_size, u32 hi_pmm, u32 hi_pmm_size); void malloc_preinit(void); extern u32 LegacyRamSize; void malloc_init(void); void malloc_prepboot(void); void *pmm_malloc(struct zone_s *zone, u32 handle, u32 size, u32 align); int pmm_free(void *data); void pmm_init(void); void pmm_prepboot(void); #define PMM_DEFAULT_HANDLE 0xFFFFFFFF // Minimum alignment of malloc'd memory #define MALLOC_MIN_ALIGN 16 // Helper functions for memory allocation. static inline void *malloc_low(u32 size) { return pmm_malloc(&ZoneLow, PMM_DEFAULT_HANDLE, size, MALLOC_MIN_ALIGN); } static inline void *malloc_high(u32 size) { return pmm_malloc(&ZoneHigh, PMM_DEFAULT_HANDLE, size, MALLOC_MIN_ALIGN); } static inline void *malloc_fseg(u32 size) { return pmm_malloc(&ZoneFSeg, PMM_DEFAULT_HANDLE, size, MALLOC_MIN_ALIGN); } static inline void *malloc_tmplow(u32 size) { return pmm_malloc(&ZoneTmpLow, PMM_DEFAULT_HANDLE, size, MALLOC_MIN_ALIGN); } static inline void *malloc_tmphigh(u32 size) { return pmm_malloc(&ZoneTmpHigh, PMM_DEFAULT_HANDLE, size, MALLOC_MIN_ALIGN); } static inline void *malloc_tmp(u32 size) { void *ret = malloc_tmphigh(size); if (ret) return ret; return malloc_tmplow(size); } static inline void *memalign_low(u32 align, u32 size) { return pmm_malloc(&ZoneLow, PMM_DEFAULT_HANDLE, size, align); } static inline void *memalign_high(u32 align, u32 size) { return pmm_malloc(&ZoneHigh, PMM_DEFAULT_HANDLE, size, align); } static inline void *memalign_tmplow(u32 align, u32 size) { return pmm_malloc(&ZoneTmpLow, PMM_DEFAULT_HANDLE, size, align); } static inline void *memalign_tmphigh(u32 align, u32 size) { return pmm_malloc(&ZoneTmpHigh, PMM_DEFAULT_HANDLE, size, align); } static inline void *memalign_tmp(u32 align, u32 size) { void *ret = memalign_tmphigh(align, size); if (ret) return ret; return memalign_tmplow(align, size); } static inline void free(void *data) { pmm_free(data); } // mtrr.c void mtrr_setup(void); // romfile.c struct romfile_s { struct romfile_s *next; char name[128]; u32 size; int (*copy)(struct romfile_s *file, void *dest, u32 maxlen); }; void romfile_add(struct romfile_s *file); struct romfile_s *romfile_findprefix(const char *prefix, struct romfile_s *prev); struct romfile_s *romfile_find(const char *name); void *romfile_loadfile(const char *name, int *psize); u64 romfile_loadint(const char *name, u64 defval); // romlayout.S void reset_vector(void) __noreturn; // misc.c void mathcp_setup(void); extern u8 BiosChecksum; // version (auto generated file out/version.c) extern const char VERSION[]; #endif // util.h tinyvisor/bios/src/byteorder.h0000644006644000001440000000311512172661303016760 0ustar yuichi_xyusers#ifndef __BYTEORDER_H #define __BYTEORDER_H static inline u16 __swab16_constant(u16 val) { return (val<<8) | (val>>8); } static inline u32 __swab32_constant(u32 val) { return (val<<24) | ((val&0xff00)<<8) | ((val&0xff0000)>>8) | (val>>24); } static inline u64 __swab64_constant(u64 val) { return ((u64)__swab32_constant(val) << 32) | __swab32_constant(val>>32); } static inline u32 __swab32(u32 val) { asm("bswapl %0" : "+r"(val)); return val; } static inline u64 __swab64(u64 val) { union u64_u32_u i, o; i.val = val; o.lo = __swab32(i.hi); o.hi = __swab32(i.lo); return o.val; } #define swab16(x) __swab16_constant(x) #define swab32(x) (__builtin_constant_p((u32)(x)) \ ? __swab32_constant(x) : __swab32(x)) #define swab64(x) (__builtin_constant_p((u64)(x)) \ ? __swab64_constant(x) : __swab64(x)) static inline u16 cpu_to_le16(u16 x) { return x; } static inline u32 cpu_to_le32(u32 x) { return x; } static inline u64 cpu_to_le64(u64 x) { return x; } static inline u16 le16_to_cpu(u16 x) { return x; } static inline u32 le32_to_cpu(u32 x) { return x; } static inline u64 le64_to_cpu(u64 x) { return x; } static inline u16 cpu_to_be16(u16 x) { return swab16(x); } static inline u32 cpu_to_be32(u32 x) { return swab32(x); } static inline u64 cpu_to_be64(u64 x) { return swab64(x); } static inline u16 be16_to_cpu(u16 x) { return swab16(x); } static inline u32 be32_to_cpu(u32 x) { return swab32(x); } static inline u64 be64_to_cpu(u64 x) { return swab64(x); } #endif // byteorder.h tinyvisor/bios/src/lsi-scsi.c0000644006644000001440000001335212172661303016506 0ustar yuichi_xyusers// (qemu-emulated) lsi53c895a boot support. // // Copyright (C) 2012 Red Hat Inc. // // Authors: // Gerd Hoffmann // // based on virtio-scsi.c which is written by: // Paolo Bonzini // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "pci.h" // foreachpci #include "config.h" // CONFIG_* #include "biosvar.h" // GET_GLOBAL #include "pci_ids.h" // PCI_DEVICE_ID_VIRTIO_BLK #include "pci_regs.h" // PCI_VENDOR_ID #include "boot.h" // bootprio_find_scsi_device #include "blockcmd.h" // scsi_drive_setup #include "paravirt.h" // runningOnQEMU #include "disk.h" #define LSI_REG_DSTAT 0x0c #define LSI_REG_ISTAT0 0x14 #define LSI_REG_DSP0 0x2c #define LSI_REG_DSP1 0x2d #define LSI_REG_DSP2 0x2e #define LSI_REG_DSP3 0x2f #define LSI_REG_SIST0 0x42 #define LSI_REG_SIST1 0x43 #define LSI_ISTAT0_DIP 0x01 #define LSI_ISTAT0_SIP 0x02 #define LSI_ISTAT0_INTF 0x04 #define LSI_ISTAT0_CON 0x08 #define LSI_ISTAT0_SEM 0x10 #define LSI_ISTAT0_SIGP 0x20 #define LSI_ISTAT0_SRST 0x40 #define LSI_ISTAT0_ABRT 0x80 struct lsi_lun_s { struct drive_s drive; struct pci_device *pci; u32 iobase; u8 target; u8 lun; }; static int lsi_scsi_cmd(struct lsi_lun_s *llun, struct disk_op_s *op, void *cdbcmd, u16 target, u16 lun, u16 blocksize) { u32 iobase = GET_GLOBAL(llun->iobase); u32 dma = ((cdb_is_read(cdbcmd, blocksize) ? 0x01000000 : 0x00000000) | (op->count * blocksize)); u8 msgout[] = { 0x80 | lun, // select lun 0x08, }; u8 status = 0xff; u8 msgin_tmp[2]; u8 msgin = 0xff; u32 script[] = { /* select target, send scsi command */ 0x40000000 | target << 16, // select target 0x00000000, 0x06000001, // msgout (u32)MAKE_FLATPTR(GET_SEG(SS), &msgout), 0x02000010, // scsi command (u32)MAKE_FLATPTR(GET_SEG(SS), cdbcmd), /* handle disconnect */ 0x87820000, // phase == msgin ? 0x00000018, 0x07000002, // msgin (u32)MAKE_FLATPTR(GET_SEG(SS), &msgin_tmp), 0x50000000, // re-select 0x00000000, 0x07000002, // msgin (u32)MAKE_FLATPTR(GET_SEG(SS), &msgin_tmp), /* dma data, get status, raise irq */ dma, // dma data (u32)op->buf_fl, 0x03000001, // status (u32)MAKE_FLATPTR(GET_SEG(SS), &status), 0x07000001, // msgin (u32)MAKE_FLATPTR(GET_SEG(SS), &msgin), 0x98080000, // dma irq 0x00000000, }; u32 dsp = (u32)MAKE_FLATPTR(GET_SEG(SS), &script); outb(dsp & 0xff, iobase + LSI_REG_DSP0); outb((dsp >> 8) & 0xff, iobase + LSI_REG_DSP1); outb((dsp >> 16) & 0xff, iobase + LSI_REG_DSP2); outb((dsp >> 24) & 0xff, iobase + LSI_REG_DSP3); for (;;) { u8 dstat = inb(iobase + LSI_REG_DSTAT); u8 sist0 = inb(iobase + LSI_REG_SIST0); u8 sist1 = inb(iobase + LSI_REG_SIST1); if (sist0 || sist1) { goto fail; } if (dstat & 0x04) { break; } usleep(5); } if (msgin == 0 && status == 0) { return DISK_RET_SUCCESS; } fail: return DISK_RET_EBADTRACK; } int lsi_scsi_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize) { if (!CONFIG_LSI_SCSI) return DISK_RET_EBADTRACK; struct lsi_lun_s *llun = container_of(op->drive_g, struct lsi_lun_s, drive); return lsi_scsi_cmd(llun, op, cdbcmd, GET_GLOBAL(llun->target), GET_GLOBAL(llun->lun), blocksize); } static int lsi_scsi_add_lun(struct pci_device *pci, u32 iobase, u8 target, u8 lun) { struct lsi_lun_s *llun = malloc_fseg(sizeof(*llun)); if (!llun) { warn_noalloc(); return -1; } memset(llun, 0, sizeof(*llun)); llun->drive.type = DTYPE_LSI_SCSI; llun->drive.cntl_id = pci->bdf; llun->pci = pci; llun->target = target; llun->lun = lun; llun->iobase = iobase; char *name = znprintf(16, "lsi %02x:%02x.%x %d:%d", pci_bdf_to_bus(pci->bdf), pci_bdf_to_dev(pci->bdf), pci_bdf_to_fn(pci->bdf), target, lun); int prio = bootprio_find_scsi_device(pci, target, lun); int ret = scsi_drive_setup(&llun->drive, name, prio); free(name); if (ret) goto fail; return 0; fail: free(llun); return -1; } static void lsi_scsi_scan_target(struct pci_device *pci, u32 iobase, u8 target) { /* TODO: send REPORT LUNS. For now, only LUN 0 is recognized. */ lsi_scsi_add_lun(pci, iobase, target, 0); } static void init_lsi_scsi(struct pci_device *pci) { u16 bdf = pci->bdf; u32 iobase = pci_config_readl(pci->bdf, PCI_BASE_ADDRESS_0) & PCI_BASE_ADDRESS_IO_MASK; pci_config_maskw(bdf, PCI_COMMAND, 0, PCI_COMMAND_MASTER); dprintf(1, "found lsi53c895a at %02x:%02x.%x, io @ %x\n", pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf), pci_bdf_to_fn(bdf), iobase); // reset outb(LSI_ISTAT0_SRST, iobase + LSI_REG_ISTAT0); int i; for (i = 0; i < 7; i++) lsi_scsi_scan_target(pci, iobase, i); return; } void lsi_scsi_setup(void) { ASSERT32FLAT(); if (!CONFIG_LSI_SCSI || !runningOnQEMU()) return; dprintf(3, "init lsi53c895a\n"); struct pci_device *pci; foreachpci(pci) { if (pci->vendor != PCI_VENDOR_ID_LSI_LOGIC || pci->device != PCI_DEVICE_ID_LSI_53C895A) continue; init_lsi_scsi(pci); } } tinyvisor/bios/src/acpi-dsdt-dbug.dsl0000644006644000001440000000146512172661303020111 0ustar yuichi_xyusers/**************************************************************** * Debugging ****************************************************************/ Scope(\) { /* Debug Output */ OperationRegion(DBG, SystemIO, 0x0402, 0x01) Field(DBG, ByteAcc, NoLock, Preserve) { DBGB, 8, } /* Debug method - use this method to send output to the QEMU * BIOS debug port. This method handles strings, integers, * and buffers. For example: DBUG("abc") DBUG(0x123) */ Method(DBUG, 1) { ToHexString(Arg0, Local0) ToBuffer(Local0, Local0) Subtract(SizeOf(Local0), 1, Local1) Store(Zero, Local2) While (LLess(Local2, Local1)) { Store(DerefOf(Index(Local0, Local2)), DBGB) Increment(Local2) } Store(0x0A, DBGB) } } tinyvisor/bios/src/util.c0000644006644000001440000001425712172661303015742 0ustar yuichi_xyusers// Misc utility functions. // // Copyright (C) 2008,2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // call16 #include "bregs.h" // struct bregs #include "config.h" // BUILD_STACK_ADDR void cpuid(u32 index, u32 *eax, u32 *ebx, u32 *ecx, u32 *edx) { // Check for cpu id u32 origflags = save_flags(); restore_flags(origflags ^ F_ID); u32 newflags = save_flags(); restore_flags(origflags); if (((origflags ^ newflags) & F_ID) != F_ID) // no cpuid *eax = *ebx = *ecx = *edx = 0; else __cpuid(index, eax, ebx, ecx, edx); } /**************************************************************** * String ops ****************************************************************/ // Sum the bytes in the specified area. u8 checksum_far(u16 buf_seg, void *buf_far, u32 len) { SET_SEG(ES, buf_seg); u32 i; u8 sum = 0; for (i=0; i 3) { u32 copylen = len; if (copylen > 2048) copylen = 2048; copylen /= 4; len -= copylen * 4; asm volatile( "rep movsl (%%esi),%%es:(%%edi)" : "+c"(copylen), "+S"(s), "+D"(d) : : "cc", "memory"); yield(); } if (len) // Copy any remaining bytes. memcpy(d, s, len); } void * memmove(void *d, const void *s, size_t len) { if (s >= d) return memcpy(d, s, len); d += len-1; s += len-1; while (len--) { *(char*)d = *(char*)s; d--; s--; } return d; } // Copy a string - truncating it if necessary. char * strtcpy(char *dest, const char *src, size_t len) { char *d = dest; while (--len && *src != '\0') *d++ = *src++; *d = '\0'; return dest; } // locate first occurance of character c in the string s char * strchr(const char *s, int c) { for (; *s; s++) if (*s == c) return (char*)s; return NULL; } // Remove any trailing blank characters (spaces, new lines, carriage returns) void nullTrailingSpace(char *buf) { int len = strlen(buf); char *end = &buf[len-1]; while (end >= buf && *end <= ' ') *(end--) = '\0'; } /**************************************************************** * Keyboard calls ****************************************************************/ // See if a keystroke is pending in the keyboard buffer. static int check_for_keystroke(void) { struct bregs br; memset(&br, 0, sizeof(br)); br.flags = F_IF|F_ZF; br.ah = 1; call16_int(0x16, &br); return !(br.flags & F_ZF); } // Return a keystroke - waiting forever if necessary. static int get_raw_keystroke(void) { struct bregs br; memset(&br, 0, sizeof(br)); br.flags = F_IF; call16_int(0x16, &br); return br.ah; } // Read a keystroke - waiting up to 'msec' milliseconds. int get_keystroke(int msec) { u32 end = calc_future_timer(msec); for (;;) { if (check_for_keystroke()) return get_raw_keystroke(); if (check_timer(end)) return -1; yield_toirq(); } } tinyvisor/bios/src/shadow.c0000644006644000001440000001175412172661303016251 0ustar yuichi_xyusers// Support for enabling/disabling BIOS ram shadowing. // // Copyright (C) 2008-2010 Kevin O'Connor // Copyright (C) 2006 Fabrice Bellard // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // memcpy #include "pci.h" // pci_config_writeb #include "config.h" // CONFIG_* #include "pci_ids.h" // PCI_VENDOR_ID_INTEL #include "pci_regs.h" // PCI_VENDOR_ID #include "paravirt.h" // runningOnXen #include "dev-q35.h" // PCI_VENDOR_ID_INTEL // On the emulators, the bios at 0xf0000 is also at 0xffff0000 #define BIOS_SRC_OFFSET 0xfff00000 #define I440FX_PAM0 0x59 // Enable shadowing and copy bios. static void __make_bios_writable_intel(u16 bdf, u32 pam0) { // Make ram from 0xc0000-0xf0000 writable int clear = 0; int i; for (i=0; i<6; i++) { u32 pam = pam0 + 1 + i; int reg = pci_config_readb(bdf, pam); if (CONFIG_OPTIONROMS_DEPLOYED && (reg & 0x11) != 0x11) { // Need to copy optionroms to work around qemu implementation void *mem = (void*)(BUILD_ROM_START + i * 32*1024); memcpy((void*)BUILD_BIOS_TMP_ADDR, mem, 32*1024); pci_config_writeb(bdf, pam, 0x33); memcpy(mem, (void*)BUILD_BIOS_TMP_ADDR, 32*1024); clear = 1; } else { pci_config_writeb(bdf, pam, 0x33); } } if (clear) memset((void*)BUILD_BIOS_TMP_ADDR, 0, 32*1024); // Make ram from 0xf0000-0x100000 writable int reg = pci_config_readb(bdf, pam0); pci_config_writeb(bdf, pam0, 0x30); if (reg & 0x10) // Ram already present. return; // Copy bios. extern u8 code32flat_start[], code32flat_end[]; memcpy(code32flat_start, code32flat_start + BIOS_SRC_OFFSET , code32flat_end - code32flat_start); } static void make_bios_writable_intel(u16 bdf, u32 pam0) { int reg = pci_config_readb(bdf, pam0); if (!(reg & 0x10)) { // QEMU doesn't fully implement the piix shadow capabilities - // if ram isn't backing the bios segment when shadowing is // disabled, the code itself wont be in memory. So, run the // code from the high-memory flash location. u32 pos = (u32)__make_bios_writable_intel + BIOS_SRC_OFFSET; void (*func)(u16 bdf, u32 pam0) = (void*)pos; func(bdf, pam0); return; } // Ram already present - just enable writes __make_bios_writable_intel(bdf, pam0); } static void make_bios_readonly_intel(u16 bdf, u32 pam0) { // Flush any pending writes before locking memory. wbinvd(); // Write protect roms from 0xc0000-0xf0000 u32 romend = rom_get_last(), romtop = rom_get_max(); int i; for (i=0; i<6; i++) { u32 mem = BUILD_ROM_START + i * 32*1024; u32 pam = pam0 + 1 + i; if (romend <= mem + 16*1024 || romtop <= mem + 32*1024) { if (romend > mem && romtop > mem + 16*1024) pci_config_writeb(bdf, pam, 0x31); break; } pci_config_writeb(bdf, pam, 0x11); } // Write protect 0xf0000-0x100000 pci_config_writeb(bdf, pam0, 0x10); } static int ShadowBDF = -1; // Make the 0xc0000-0x100000 area read/writable. void make_bios_writable(void) { if (!CONFIG_QEMU || runningOnXen()) return; dprintf(3, "enabling shadow ram\n"); // At this point, statically allocated variables can't be written, // so do this search manually. int bdf; foreachbdf(bdf, 0) { u32 vendev = pci_config_readl(bdf, PCI_VENDOR_ID); u16 vendor = vendev & 0xffff, device = vendev >> 16; if (vendor == PCI_VENDOR_ID_INTEL && device == PCI_DEVICE_ID_INTEL_82441) { make_bios_writable_intel(bdf, I440FX_PAM0); ShadowBDF = bdf; return; } if (vendor == PCI_VENDOR_ID_INTEL && device == PCI_DEVICE_ID_INTEL_Q35_MCH) { make_bios_writable_intel(bdf, Q35_HOST_BRIDGE_PAM0); ShadowBDF = bdf; return; } } dprintf(1, "Unable to unlock ram - bridge not found\n"); } // Make the BIOS code segment area (0xf0000) read-only. void make_bios_readonly(void) { if (!CONFIG_QEMU || runningOnXen()) return; dprintf(3, "locking shadow ram\n"); if (ShadowBDF < 0) { dprintf(1, "Unable to lock ram - bridge not found\n"); return; } u16 device = pci_config_readw(ShadowBDF, PCI_DEVICE_ID); if (device == PCI_DEVICE_ID_INTEL_82441) make_bios_readonly_intel(ShadowBDF, I440FX_PAM0); else make_bios_readonly_intel(ShadowBDF, Q35_HOST_BRIDGE_PAM0); } void qemu_prep_reset(void) { if (!CONFIG_QEMU || runningOnXen()) return; // QEMU doesn't map 0xc0000-0xfffff back to the original rom on a // reset, so do that manually before invoking a hard reset. make_bios_writable(); extern u8 code32flat_start[], code32flat_end[]; memcpy(code32flat_start, code32flat_start + BIOS_SRC_OFFSET , code32flat_end - code32flat_start); } tinyvisor/bios/src/smm.c0000644006644000001440000001316012175143074015554 0ustar yuichi_xyusers// System Management Mode support (on emulators) // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2006 Fabrice Bellard // // This file may be distributed under the terms of the GNU LGPLv3 license. #if CONFIG_USE_SMM != 0 #include "pci.h" // pci_config_writel #include "pci_regs.h" // PCI_DEVICE_ID #include "util.h" // wbinvd #include "config.h" // CONFIG_* #include "ioport.h" // outb #include "pci_ids.h" // PCI_VENDOR_ID_INTEL #include "dev-q35.h" ASM32FLAT( ".global smm_relocation_start\n" ".global smm_relocation_end\n" ".global smm_code_start\n" ".global smm_code_end\n" " .code16\n" /* code to relocate SMBASE to 0xa0000 */ "smm_relocation_start:\n" " mov $" __stringify(BUILD_SMM_INIT_ADDR) " + 0x7efc, %ebx\n" " addr32 mov (%ebx), %al\n" /* revision ID to see if x86_64 or x86 */ " cmp $0x64, %al\n" " je 1f\n" " mov $" __stringify(BUILD_SMM_INIT_ADDR) " + 0x7ef8, %ebx\n" " jmp 2f\n" "1:\n" " mov $" __stringify(BUILD_SMM_INIT_ADDR) " + 0x7f00, %ebx\n" "2:\n" " movl $" __stringify(BUILD_SMM_ADDR) " - 0x8000, %eax\n" " addr32 movl %eax, (%ebx)\n" /* indicate to the BIOS that the SMM code was executed */ " mov $0x00, %al\n" " movw $" __stringify(PORT_SMI_STATUS) ", %dx\n" " outb %al, %dx\n" " rsm\n" "smm_relocation_end:\n" /* minimal SMM code to enable or disable ACPI */ "smm_code_start:\n" " movw $" __stringify(PORT_SMI_CMD) ", %dx\n" " inb %dx, %al\n" " cmp $0xf0, %al\n" " jne 1f\n" /* ACPI disable */ " mov $" __stringify(PORT_ACPI_PM_BASE) " + 0x04, %dx\n" /* PMCNTRL */ " inw %dx, %ax\n" " andw $~1, %ax\n" " outw %ax, %dx\n" " jmp 2f\n" "1:\n" " cmp $0xf1, %al\n" " jne 2f\n" /* ACPI enable */ " mov $" __stringify(PORT_ACPI_PM_BASE) " + 0x04, %dx\n" /* PMCNTRL */ " inw %dx, %ax\n" " orw $1, %ax\n" " outw %ax, %dx\n" "2:\n" " rsm\n" "smm_code_end:\n" " .code32\n" ); extern u8 smm_relocation_start, smm_relocation_end; extern u8 smm_code_start, smm_code_end; static void smm_save_and_copy(void) { /* save original memory content */ memcpy((void *)BUILD_SMM_ADDR, (void *)BUILD_SMM_INIT_ADDR, BUILD_SMM_SIZE); /* copy the SMM relocation code */ memcpy((void *)BUILD_SMM_INIT_ADDR, &smm_relocation_start, &smm_relocation_end - &smm_relocation_start); } static void smm_relocate_and_restore(void) { /* init APM status port */ outb(0x01, PORT_SMI_STATUS); /* raise an SMI interrupt */ outb(0x00, PORT_SMI_CMD); /* wait until SMM code executed */ while (inb(PORT_SMI_STATUS) != 0x00) ; /* restore original memory content */ memcpy((void *)BUILD_SMM_INIT_ADDR, (void *)BUILD_SMM_ADDR, BUILD_SMM_SIZE); /* copy the SMM code */ memcpy((void *)BUILD_SMM_ADDR, &smm_code_start , &smm_code_end - &smm_code_start); wbinvd(); } #define I440FX_SMRAM 0x72 #define PIIX_DEVACTB 0x58 #define PIIX_APMC_EN (1 << 25) // This code is hardcoded for PIIX4 Power Management device. static void piix4_apmc_smm_setup(int isabdf, int i440_bdf) { /* check if SMM init is already done */ u32 value = pci_config_readl(isabdf, PIIX_DEVACTB); if (value & PIIX_APMC_EN) return; /* enable the SMM memory window */ pci_config_writeb(i440_bdf, I440FX_SMRAM, 0x02 | 0x48); smm_save_and_copy(); /* enable SMI generation when writing to the APMC register */ pci_config_writel(isabdf, PIIX_DEVACTB, value | PIIX_APMC_EN); smm_relocate_and_restore(); /* close the SMM memory window and enable normal SMM */ pci_config_writeb(i440_bdf, I440FX_SMRAM, 0x02 | 0x08); } /* PCI_VENDOR_ID_INTEL && PCI_DEVICE_ID_INTEL_ICH9_LPC */ void ich9_lpc_apmc_smm_setup(int isabdf, int mch_bdf) { /* check if SMM init is already done */ u32 value = inl(PORT_ACPI_PM_BASE + ICH9_PMIO_SMI_EN); if (value & ICH9_PMIO_SMI_EN_APMC_EN) return; /* enable the SMM memory window */ pci_config_writeb(mch_bdf, Q35_HOST_BRIDGE_SMRAM, 0x02 | 0x48); smm_save_and_copy(); /* enable SMI generation when writing to the APMC register */ outl(value | ICH9_PMIO_SMI_EN_APMC_EN, PORT_ACPI_PM_BASE + ICH9_PMIO_SMI_EN); smm_relocate_and_restore(); /* close the SMM memory window and enable normal SMM */ pci_config_writeb(mch_bdf, Q35_HOST_BRIDGE_SMRAM, 0x02 | 0x08); } static int SMMISADeviceBDF = -1, SMMPMDeviceBDF = -1; void smm_device_setup(void) { if (!CONFIG_USE_SMM) return; struct pci_device *isapci, *pmpci; isapci = pci_find_device(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82371AB_3); pmpci = pci_find_device(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_82441); if (isapci && pmpci) { SMMISADeviceBDF = isapci->bdf; SMMPMDeviceBDF = pmpci->bdf; return; } isapci = pci_find_device(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_ICH9_LPC); pmpci = pci_find_device(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_Q35_MCH); if (isapci && pmpci) { SMMISADeviceBDF = isapci->bdf; SMMPMDeviceBDF = pmpci->bdf; } } void smm_setup(void) { if (!CONFIG_USE_SMM || SMMISADeviceBDF < 0) return; dprintf(3, "init smm\n"); u16 device = pci_config_readw(SMMISADeviceBDF, PCI_DEVICE_ID); if (device == PCI_DEVICE_ID_INTEL_82371AB_3) piix4_apmc_smm_setup(SMMISADeviceBDF, SMMPMDeviceBDF); else ich9_lpc_apmc_smm_setup(SMMISADeviceBDF, SMMPMDeviceBDF); } #else /* CONFIG_USE_SMM != 0 */ void smm_device_setup(void) { return; } void smm_setup(void) { return; } #endif /* CONFIG_USE_SMM != 0 */ tinyvisor/bios/src/pci_regs.h0000644006644000001440000006560011733243570016567 0ustar yuichi_xyusers/* * pci_regs.h * * PCI standard defines * Copyright 1994, Drew Eckhardt * Copyright 1997--1999 Martin Mares * * For more information, please consult the following manuals (look at * http://www.pcisig.com/ for how to get them): * * PCI BIOS Specification * PCI Local Bus Specification * PCI to PCI Bridge Specification * PCI System Design Guide * * For hypertransport information, please consult the following manuals * from http://www.hypertransport.org * * The Hypertransport I/O Link Specification */ #ifndef LINUX_PCI_REGS_H #define LINUX_PCI_REGS_H /* * Under PCI, each device has 256 bytes of configuration address space, * of which the first 64 bytes are standardized as follows: */ #define PCI_VENDOR_ID 0x00 /* 16 bits */ #define PCI_DEVICE_ID 0x02 /* 16 bits */ #define PCI_COMMAND 0x04 /* 16 bits */ #define PCI_COMMAND_IO 0x1 /* Enable response in I/O space */ #define PCI_COMMAND_MEMORY 0x2 /* Enable response in Memory space */ #define PCI_COMMAND_MASTER 0x4 /* Enable bus mastering */ #define PCI_COMMAND_SPECIAL 0x8 /* Enable response to special cycles */ #define PCI_COMMAND_INVALIDATE 0x10 /* Use memory write and invalidate */ #define PCI_COMMAND_VGA_PALETTE 0x20 /* Enable palette snooping */ #define PCI_COMMAND_PARITY 0x40 /* Enable parity checking */ #define PCI_COMMAND_WAIT 0x80 /* Enable address/data stepping */ #define PCI_COMMAND_SERR 0x100 /* Enable SERR */ #define PCI_COMMAND_FAST_BACK 0x200 /* Enable back-to-back writes */ #define PCI_COMMAND_INTX_DISABLE 0x400 /* INTx Emulation Disable */ #define PCI_STATUS 0x06 /* 16 bits */ #define PCI_STATUS_CAP_LIST 0x10 /* Support Capability List */ #define PCI_STATUS_66MHZ 0x20 /* Support 66 Mhz PCI 2.1 bus */ #define PCI_STATUS_UDF 0x40 /* Support User Definable Features [obsolete] */ #define PCI_STATUS_FAST_BACK 0x80 /* Accept fast-back to back */ #define PCI_STATUS_PARITY 0x100 /* Detected parity error */ #define PCI_STATUS_DEVSEL_MASK 0x600 /* DEVSEL timing */ #define PCI_STATUS_DEVSEL_FAST 0x000 #define PCI_STATUS_DEVSEL_MEDIUM 0x200 #define PCI_STATUS_DEVSEL_SLOW 0x400 #define PCI_STATUS_SIG_TARGET_ABORT 0x800 /* Set on target abort */ #define PCI_STATUS_REC_TARGET_ABORT 0x1000 /* Master ack of " */ #define PCI_STATUS_REC_MASTER_ABORT 0x2000 /* Set on master abort */ #define PCI_STATUS_SIG_SYSTEM_ERROR 0x4000 /* Set when we drive SERR */ #define PCI_STATUS_DETECTED_PARITY 0x8000 /* Set on parity error */ #define PCI_CLASS_REVISION 0x08 /* High 24 bits are class, low 8 revision */ #define PCI_REVISION_ID 0x08 /* Revision ID */ #define PCI_CLASS_PROG 0x09 /* Reg. Level Programming Interface */ #define PCI_CLASS_DEVICE 0x0a /* Device class */ #define PCI_CACHE_LINE_SIZE 0x0c /* 8 bits */ #define PCI_LATENCY_TIMER 0x0d /* 8 bits */ #define PCI_HEADER_TYPE 0x0e /* 8 bits */ #define PCI_HEADER_TYPE_NORMAL 0 #define PCI_HEADER_TYPE_BRIDGE 1 #define PCI_HEADER_TYPE_CARDBUS 2 #define PCI_BIST 0x0f /* 8 bits */ #define PCI_BIST_CODE_MASK 0x0f /* Return result */ #define PCI_BIST_START 0x40 /* 1 to start BIST, 2 secs or less */ #define PCI_BIST_CAPABLE 0x80 /* 1 if BIST capable */ /* * Base addresses specify locations in memory or I/O space. * Decoded size can be determined by writing a value of * 0xffffffff to the register, and reading it back. Only * 1 bits are decoded. */ #define PCI_BASE_ADDRESS_0 0x10 /* 32 bits */ #define PCI_BASE_ADDRESS_1 0x14 /* 32 bits [htype 0,1 only] */ #define PCI_BASE_ADDRESS_2 0x18 /* 32 bits [htype 0 only] */ #define PCI_BASE_ADDRESS_3 0x1c /* 32 bits */ #define PCI_BASE_ADDRESS_4 0x20 /* 32 bits */ #define PCI_BASE_ADDRESS_5 0x24 /* 32 bits */ #define PCI_BASE_ADDRESS_SPACE 0x01 /* 0 = memory, 1 = I/O */ #define PCI_BASE_ADDRESS_SPACE_IO 0x01 #define PCI_BASE_ADDRESS_SPACE_MEMORY 0x00 #define PCI_BASE_ADDRESS_MEM_TYPE_MASK 0x06 #define PCI_BASE_ADDRESS_MEM_TYPE_32 0x00 /* 32 bit address */ #define PCI_BASE_ADDRESS_MEM_TYPE_1M 0x02 /* Below 1M [obsolete] */ #define PCI_BASE_ADDRESS_MEM_TYPE_64 0x04 /* 64 bit address */ #define PCI_BASE_ADDRESS_MEM_PREFETCH 0x08 /* prefetchable? */ #define PCI_BASE_ADDRESS_MEM_MASK (~0x0fUL) #define PCI_BASE_ADDRESS_IO_MASK (~0x03UL) /* bit 1 is reserved if address_space = 1 */ /* Header type 0 (normal devices) */ #define PCI_CARDBUS_CIS 0x28 #define PCI_SUBSYSTEM_VENDOR_ID 0x2c #define PCI_SUBSYSTEM_ID 0x2e #define PCI_ROM_ADDRESS 0x30 /* Bits 31..11 are address, 10..1 reserved */ #define PCI_ROM_ADDRESS_ENABLE 0x01 #define PCI_ROM_ADDRESS_MASK (~0x7ffUL) #define PCI_CAPABILITY_LIST 0x34 /* Offset of first capability list entry */ /* 0x35-0x3b are reserved */ #define PCI_INTERRUPT_LINE 0x3c /* 8 bits */ #define PCI_INTERRUPT_PIN 0x3d /* 8 bits */ #define PCI_MIN_GNT 0x3e /* 8 bits */ #define PCI_MAX_LAT 0x3f /* 8 bits */ /* Header type 1 (PCI-to-PCI bridges) */ #define PCI_PRIMARY_BUS 0x18 /* Primary bus number */ #define PCI_SECONDARY_BUS 0x19 /* Secondary bus number */ #define PCI_SUBORDINATE_BUS 0x1a /* Highest bus number behind the bridge */ #define PCI_SEC_LATENCY_TIMER 0x1b /* Latency timer for secondary interface */ #define PCI_IO_BASE 0x1c /* I/O range behind the bridge */ #define PCI_IO_LIMIT 0x1d #define PCI_IO_RANGE_TYPE_MASK 0x0fUL /* I/O bridging type */ #define PCI_IO_RANGE_TYPE_16 0x00 #define PCI_IO_RANGE_TYPE_32 0x01 #define PCI_IO_RANGE_MASK (~0x0fUL) #define PCI_SEC_STATUS 0x1e /* Secondary status register, only bit 14 used */ #define PCI_MEMORY_BASE 0x20 /* Memory range behind */ #define PCI_MEMORY_LIMIT 0x22 #define PCI_MEMORY_RANGE_TYPE_MASK 0x0fUL #define PCI_MEMORY_RANGE_MASK (~0x0fUL) #define PCI_PREF_MEMORY_BASE 0x24 /* Prefetchable memory range behind */ #define PCI_PREF_MEMORY_LIMIT 0x26 #define PCI_PREF_RANGE_TYPE_MASK 0x0fUL #define PCI_PREF_RANGE_TYPE_32 0x00 #define PCI_PREF_RANGE_TYPE_64 0x01 #define PCI_PREF_RANGE_MASK (~0x0fUL) #define PCI_PREF_BASE_UPPER32 0x28 /* Upper half of prefetchable memory range */ #define PCI_PREF_LIMIT_UPPER32 0x2c #define PCI_IO_BASE_UPPER16 0x30 /* Upper half of I/O addresses */ #define PCI_IO_LIMIT_UPPER16 0x32 /* 0x34 same as for htype 0 */ /* 0x35-0x3b is reserved */ #define PCI_ROM_ADDRESS1 0x38 /* Same as PCI_ROM_ADDRESS, but for htype 1 */ /* 0x3c-0x3d are same as for htype 0 */ #define PCI_BRIDGE_CONTROL 0x3e #define PCI_BRIDGE_CTL_PARITY 0x01 /* Enable parity detection on secondary interface */ #define PCI_BRIDGE_CTL_SERR 0x02 /* The same for SERR forwarding */ #define PCI_BRIDGE_CTL_ISA 0x04 /* Enable ISA mode */ #define PCI_BRIDGE_CTL_VGA 0x08 /* Forward VGA addresses */ #define PCI_BRIDGE_CTL_MASTER_ABORT 0x20 /* Report master aborts */ #define PCI_BRIDGE_CTL_BUS_RESET 0x40 /* Secondary bus reset */ #define PCI_BRIDGE_CTL_FAST_BACK 0x80 /* Fast Back2Back enabled on secondary interface */ /* Header type 2 (CardBus bridges) */ #define PCI_CB_CAPABILITY_LIST 0x14 /* 0x15 reserved */ #define PCI_CB_SEC_STATUS 0x16 /* Secondary status */ #define PCI_CB_PRIMARY_BUS 0x18 /* PCI bus number */ #define PCI_CB_CARD_BUS 0x19 /* CardBus bus number */ #define PCI_CB_SUBORDINATE_BUS 0x1a /* Subordinate bus number */ #define PCI_CB_LATENCY_TIMER 0x1b /* CardBus latency timer */ #define PCI_CB_MEMORY_BASE_0 0x1c #define PCI_CB_MEMORY_LIMIT_0 0x20 #define PCI_CB_MEMORY_BASE_1 0x24 #define PCI_CB_MEMORY_LIMIT_1 0x28 #define PCI_CB_IO_BASE_0 0x2c #define PCI_CB_IO_BASE_0_HI 0x2e #define PCI_CB_IO_LIMIT_0 0x30 #define PCI_CB_IO_LIMIT_0_HI 0x32 #define PCI_CB_IO_BASE_1 0x34 #define PCI_CB_IO_BASE_1_HI 0x36 #define PCI_CB_IO_LIMIT_1 0x38 #define PCI_CB_IO_LIMIT_1_HI 0x3a #define PCI_CB_IO_RANGE_MASK (~0x03UL) /* 0x3c-0x3d are same as for htype 0 */ #define PCI_CB_BRIDGE_CONTROL 0x3e #define PCI_CB_BRIDGE_CTL_PARITY 0x01 /* Similar to standard bridge control register */ #define PCI_CB_BRIDGE_CTL_SERR 0x02 #define PCI_CB_BRIDGE_CTL_ISA 0x04 #define PCI_CB_BRIDGE_CTL_VGA 0x08 #define PCI_CB_BRIDGE_CTL_MASTER_ABORT 0x20 #define PCI_CB_BRIDGE_CTL_CB_RESET 0x40 /* CardBus reset */ #define PCI_CB_BRIDGE_CTL_16BIT_INT 0x80 /* Enable interrupt for 16-bit cards */ #define PCI_CB_BRIDGE_CTL_PREFETCH_MEM0 0x100 /* Prefetch enable for both memory regions */ #define PCI_CB_BRIDGE_CTL_PREFETCH_MEM1 0x200 #define PCI_CB_BRIDGE_CTL_POST_WRITES 0x400 #define PCI_CB_SUBSYSTEM_VENDOR_ID 0x40 #define PCI_CB_SUBSYSTEM_ID 0x42 #define PCI_CB_LEGACY_MODE_BASE 0x44 /* 16-bit PC Card legacy mode base address (ExCa) */ /* 0x48-0x7f reserved */ /* Capability lists */ #define PCI_CAP_LIST_ID 0 /* Capability ID */ #define PCI_CAP_ID_PM 0x01 /* Power Management */ #define PCI_CAP_ID_AGP 0x02 /* Accelerated Graphics Port */ #define PCI_CAP_ID_VPD 0x03 /* Vital Product Data */ #define PCI_CAP_ID_SLOTID 0x04 /* Slot Identification */ #define PCI_CAP_ID_MSI 0x05 /* Message Signalled Interrupts */ #define PCI_CAP_ID_CHSWP 0x06 /* CompactPCI HotSwap */ #define PCI_CAP_ID_PCIX 0x07 /* PCI-X */ #define PCI_CAP_ID_HT 0x08 /* HyperTransport */ #define PCI_CAP_ID_VNDR 0x09 /* Vendor specific */ #define PCI_CAP_ID_DBG 0x0A /* Debug port */ #define PCI_CAP_ID_CCRC 0x0B /* CompactPCI Central Resource Control */ #define PCI_CAP_ID_SHPC 0x0C /* PCI Standard Hot-Plug Controller */ #define PCI_CAP_ID_SSVID 0x0D /* Bridge subsystem vendor/device ID */ #define PCI_CAP_ID_AGP3 0x0E /* AGP Target PCI-PCI bridge */ #define PCI_CAP_ID_EXP 0x10 /* PCI Express */ #define PCI_CAP_ID_MSIX 0x11 /* MSI-X */ #define PCI_CAP_LIST_NEXT 1 /* Next capability in the list */ #define PCI_CAP_FLAGS 2 /* Capability defined flags (16 bits) */ #define PCI_CAP_SIZEOF 4 /* Power Management Registers */ #define PCI_PM_PMC 2 /* PM Capabilities Register */ #define PCI_PM_CAP_VER_MASK 0x0007 /* Version */ #define PCI_PM_CAP_PME_CLOCK 0x0008 /* PME clock required */ #define PCI_PM_CAP_RESERVED 0x0010 /* Reserved field */ #define PCI_PM_CAP_DSI 0x0020 /* Device specific initialization */ #define PCI_PM_CAP_AUX_POWER 0x01C0 /* Auxilliary power support mask */ #define PCI_PM_CAP_D1 0x0200 /* D1 power state support */ #define PCI_PM_CAP_D2 0x0400 /* D2 power state support */ #define PCI_PM_CAP_PME 0x0800 /* PME pin supported */ #define PCI_PM_CAP_PME_MASK 0xF800 /* PME Mask of all supported states */ #define PCI_PM_CAP_PME_D0 0x0800 /* PME# from D0 */ #define PCI_PM_CAP_PME_D1 0x1000 /* PME# from D1 */ #define PCI_PM_CAP_PME_D2 0x2000 /* PME# from D2 */ #define PCI_PM_CAP_PME_D3 0x4000 /* PME# from D3 (hot) */ #define PCI_PM_CAP_PME_D3cold 0x8000 /* PME# from D3 (cold) */ #define PCI_PM_CAP_PME_SHIFT 11 /* Start of the PME Mask in PMC */ #define PCI_PM_CTRL 4 /* PM control and status register */ #define PCI_PM_CTRL_STATE_MASK 0x0003 /* Current power state (D0 to D3) */ #define PCI_PM_CTRL_NO_SOFT_RESET 0x0004 /* No reset for D3hot->D0 */ #define PCI_PM_CTRL_PME_ENABLE 0x0100 /* PME pin enable */ #define PCI_PM_CTRL_DATA_SEL_MASK 0x1e00 /* Data select (??) */ #define PCI_PM_CTRL_DATA_SCALE_MASK 0x6000 /* Data scale (??) */ #define PCI_PM_CTRL_PME_STATUS 0x8000 /* PME pin status */ #define PCI_PM_PPB_EXTENSIONS 6 /* PPB support extensions (??) */ #define PCI_PM_PPB_B2_B3 0x40 /* Stop clock when in D3hot (??) */ #define PCI_PM_BPCC_ENABLE 0x80 /* Bus power/clock control enable (??) */ #define PCI_PM_DATA_REGISTER 7 /* (??) */ #define PCI_PM_SIZEOF 8 /* AGP registers */ #define PCI_AGP_VERSION 2 /* BCD version number */ #define PCI_AGP_RFU 3 /* Rest of capability flags */ #define PCI_AGP_STATUS 4 /* Status register */ #define PCI_AGP_STATUS_RQ_MASK 0xff000000 /* Maximum number of requests - 1 */ #define PCI_AGP_STATUS_SBA 0x0200 /* Sideband addressing supported */ #define PCI_AGP_STATUS_64BIT 0x0020 /* 64-bit addressing supported */ #define PCI_AGP_STATUS_FW 0x0010 /* FW transfers supported */ #define PCI_AGP_STATUS_RATE4 0x0004 /* 4x transfer rate supported */ #define PCI_AGP_STATUS_RATE2 0x0002 /* 2x transfer rate supported */ #define PCI_AGP_STATUS_RATE1 0x0001 /* 1x transfer rate supported */ #define PCI_AGP_COMMAND 8 /* Control register */ #define PCI_AGP_COMMAND_RQ_MASK 0xff000000 /* Master: Maximum number of requests */ #define PCI_AGP_COMMAND_SBA 0x0200 /* Sideband addressing enabled */ #define PCI_AGP_COMMAND_AGP 0x0100 /* Allow processing of AGP transactions */ #define PCI_AGP_COMMAND_64BIT 0x0020 /* Allow processing of 64-bit addresses */ #define PCI_AGP_COMMAND_FW 0x0010 /* Force FW transfers */ #define PCI_AGP_COMMAND_RATE4 0x0004 /* Use 4x rate */ #define PCI_AGP_COMMAND_RATE2 0x0002 /* Use 2x rate */ #define PCI_AGP_COMMAND_RATE1 0x0001 /* Use 1x rate */ #define PCI_AGP_SIZEOF 12 /* Vital Product Data */ #define PCI_VPD_ADDR 2 /* Address to access (15 bits!) */ #define PCI_VPD_ADDR_MASK 0x7fff /* Address mask */ #define PCI_VPD_ADDR_F 0x8000 /* Write 0, 1 indicates completion */ #define PCI_VPD_DATA 4 /* 32-bits of data returned here */ /* Slot Identification */ #define PCI_SID_ESR 2 /* Expansion Slot Register */ #define PCI_SID_ESR_NSLOTS 0x1f /* Number of expansion slots available */ #define PCI_SID_ESR_FIC 0x20 /* First In Chassis Flag */ #define PCI_SID_CHASSIS_NR 3 /* Chassis Number */ /* Message Signalled Interrupts registers */ #define PCI_MSI_FLAGS 2 /* Various flags */ #define PCI_MSI_FLAGS_64BIT 0x80 /* 64-bit addresses allowed */ #define PCI_MSI_FLAGS_QSIZE 0x70 /* Message queue size configured */ #define PCI_MSI_FLAGS_QMASK 0x0e /* Maximum queue size available */ #define PCI_MSI_FLAGS_ENABLE 0x01 /* MSI feature enabled */ #define PCI_MSI_FLAGS_MASKBIT 0x100 /* 64-bit mask bits allowed */ #define PCI_MSI_RFU 3 /* Rest of capability flags */ #define PCI_MSI_ADDRESS_LO 4 /* Lower 32 bits */ #define PCI_MSI_ADDRESS_HI 8 /* Upper 32 bits (if PCI_MSI_FLAGS_64BIT set) */ #define PCI_MSI_DATA_32 8 /* 16 bits of data for 32-bit devices */ #define PCI_MSI_DATA_64 12 /* 16 bits of data for 64-bit devices */ #define PCI_MSI_MASK_BIT 16 /* Mask bits register */ /* MSI-X registers (these are at offset PCI_MSIX_FLAGS) */ #define PCI_MSIX_FLAGS 2 #define PCI_MSIX_FLAGS_QSIZE 0x7FF #define PCI_MSIX_FLAGS_ENABLE (1 << 15) #define PCI_MSIX_FLAGS_MASKALL (1 << 14) #define PCI_MSIX_FLAGS_BIRMASK (7 << 0) #define PCI_MSIX_FLAGS_BITMASK (1 << 0) /* CompactPCI Hotswap Register */ #define PCI_CHSWP_CSR 2 /* Control and Status Register */ #define PCI_CHSWP_DHA 0x01 /* Device Hiding Arm */ #define PCI_CHSWP_EIM 0x02 /* ENUM# Signal Mask */ #define PCI_CHSWP_PIE 0x04 /* Pending Insert or Extract */ #define PCI_CHSWP_LOO 0x08 /* LED On / Off */ #define PCI_CHSWP_PI 0x30 /* Programming Interface */ #define PCI_CHSWP_EXT 0x40 /* ENUM# status - extraction */ #define PCI_CHSWP_INS 0x80 /* ENUM# status - insertion */ /* PCI-X registers */ #define PCI_X_CMD 2 /* Modes & Features */ #define PCI_X_CMD_DPERR_E 0x0001 /* Data Parity Error Recovery Enable */ #define PCI_X_CMD_ERO 0x0002 /* Enable Relaxed Ordering */ #define PCI_X_CMD_READ_512 0x0000 /* 512 byte maximum read byte count */ #define PCI_X_CMD_READ_1K 0x0004 /* 1Kbyte maximum read byte count */ #define PCI_X_CMD_READ_2K 0x0008 /* 2Kbyte maximum read byte count */ #define PCI_X_CMD_READ_4K 0x000c /* 4Kbyte maximum read byte count */ #define PCI_X_CMD_MAX_READ 0x000c /* Max Memory Read Byte Count */ /* Max # of outstanding split transactions */ #define PCI_X_CMD_SPLIT_1 0x0000 /* Max 1 */ #define PCI_X_CMD_SPLIT_2 0x0010 /* Max 2 */ #define PCI_X_CMD_SPLIT_3 0x0020 /* Max 3 */ #define PCI_X_CMD_SPLIT_4 0x0030 /* Max 4 */ #define PCI_X_CMD_SPLIT_8 0x0040 /* Max 8 */ #define PCI_X_CMD_SPLIT_12 0x0050 /* Max 12 */ #define PCI_X_CMD_SPLIT_16 0x0060 /* Max 16 */ #define PCI_X_CMD_SPLIT_32 0x0070 /* Max 32 */ #define PCI_X_CMD_MAX_SPLIT 0x0070 /* Max Outstanding Split Transactions */ #define PCI_X_CMD_VERSION(x) (((x) >> 12) & 3) /* Version */ #define PCI_X_STATUS 4 /* PCI-X capabilities */ #define PCI_X_STATUS_DEVFN 0x000000ff /* A copy of devfn */ #define PCI_X_STATUS_BUS 0x0000ff00 /* A copy of bus nr */ #define PCI_X_STATUS_64BIT 0x00010000 /* 64-bit device */ #define PCI_X_STATUS_133MHZ 0x00020000 /* 133 MHz capable */ #define PCI_X_STATUS_SPL_DISC 0x00040000 /* Split Completion Discarded */ #define PCI_X_STATUS_UNX_SPL 0x00080000 /* Unexpected Split Completion */ #define PCI_X_STATUS_COMPLEX 0x00100000 /* Device Complexity */ #define PCI_X_STATUS_MAX_READ 0x00600000 /* Designed Max Memory Read Count */ #define PCI_X_STATUS_MAX_SPLIT 0x03800000 /* Designed Max Outstanding Split Transactions */ #define PCI_X_STATUS_MAX_CUM 0x1c000000 /* Designed Max Cumulative Read Size */ #define PCI_X_STATUS_SPL_ERR 0x20000000 /* Rcvd Split Completion Error Msg */ #define PCI_X_STATUS_266MHZ 0x40000000 /* 266 MHz capable */ #define PCI_X_STATUS_533MHZ 0x80000000 /* 533 MHz capable */ /* PCI Express capability registers */ #define PCI_EXP_FLAGS 2 /* Capabilities register */ #define PCI_EXP_FLAGS_VERS 0x000f /* Capability version */ #define PCI_EXP_FLAGS_TYPE 0x00f0 /* Device/Port type */ #define PCI_EXP_TYPE_ENDPOINT 0x0 /* Express Endpoint */ #define PCI_EXP_TYPE_LEG_END 0x1 /* Legacy Endpoint */ #define PCI_EXP_TYPE_ROOT_PORT 0x4 /* Root Port */ #define PCI_EXP_TYPE_UPSTREAM 0x5 /* Upstream Port */ #define PCI_EXP_TYPE_DOWNSTREAM 0x6 /* Downstream Port */ #define PCI_EXP_TYPE_PCI_BRIDGE 0x7 /* PCI/PCI-X Bridge */ #define PCI_EXP_FLAGS_SLOT 0x0100 /* Slot implemented */ #define PCI_EXP_FLAGS_IRQ 0x3e00 /* Interrupt message number */ #define PCI_EXP_DEVCAP 4 /* Device capabilities */ #define PCI_EXP_DEVCAP_PAYLOAD 0x07 /* Max_Payload_Size */ #define PCI_EXP_DEVCAP_PHANTOM 0x18 /* Phantom functions */ #define PCI_EXP_DEVCAP_EXT_TAG 0x20 /* Extended tags */ #define PCI_EXP_DEVCAP_L0S 0x1c0 /* L0s Acceptable Latency */ #define PCI_EXP_DEVCAP_L1 0xe00 /* L1 Acceptable Latency */ #define PCI_EXP_DEVCAP_ATN_BUT 0x1000 /* Attention Button Present */ #define PCI_EXP_DEVCAP_ATN_IND 0x2000 /* Attention Indicator Present */ #define PCI_EXP_DEVCAP_PWR_IND 0x4000 /* Power Indicator Present */ #define PCI_EXP_DEVCAP_RBER 0x8000 /* Role-Based Error Reporting */ #define PCI_EXP_DEVCAP_PWR_VAL 0x3fc0000 /* Slot Power Limit Value */ #define PCI_EXP_DEVCAP_PWR_SCL 0xc000000 /* Slot Power Limit Scale */ #define PCI_EXP_DEVCAP_FLR 0x10000000 /* Function Level Reset */ #define PCI_EXP_DEVCTL 8 /* Device Control */ #define PCI_EXP_DEVCTL_CERE 0x0001 /* Correctable Error Reporting En. */ #define PCI_EXP_DEVCTL_NFERE 0x0002 /* Non-Fatal Error Reporting Enable */ #define PCI_EXP_DEVCTL_FERE 0x0004 /* Fatal Error Reporting Enable */ #define PCI_EXP_DEVCTL_URRE 0x0008 /* Unsupported Request Reporting En. */ #define PCI_EXP_DEVCTL_RELAX_EN 0x0010 /* Enable relaxed ordering */ #define PCI_EXP_DEVCTL_PAYLOAD 0x00e0 /* Max_Payload_Size */ #define PCI_EXP_DEVCTL_EXT_TAG 0x0100 /* Extended Tag Field Enable */ #define PCI_EXP_DEVCTL_PHANTOM 0x0200 /* Phantom Functions Enable */ #define PCI_EXP_DEVCTL_AUX_PME 0x0400 /* Auxiliary Power PM Enable */ #define PCI_EXP_DEVCTL_NOSNOOP_EN 0x0800 /* Enable No Snoop */ #define PCI_EXP_DEVCTL_READRQ 0x7000 /* Max_Read_Request_Size */ #define PCI_EXP_DEVCTL_BCR_FLR 0x8000 /* Bridge Configuration Retry / FLR */ #define PCI_EXP_DEVSTA 10 /* Device Status */ #define PCI_EXP_DEVSTA_CED 0x01 /* Correctable Error Detected */ #define PCI_EXP_DEVSTA_NFED 0x02 /* Non-Fatal Error Detected */ #define PCI_EXP_DEVSTA_FED 0x04 /* Fatal Error Detected */ #define PCI_EXP_DEVSTA_URD 0x08 /* Unsupported Request Detected */ #define PCI_EXP_DEVSTA_AUXPD 0x10 /* AUX Power Detected */ #define PCI_EXP_DEVSTA_TRPND 0x20 /* Transactions Pending */ #define PCI_EXP_LNKCAP 12 /* Link Capabilities */ #define PCI_EXP_LNKCAP_ASPMS 0xc00 /* ASPM Support */ #define PCI_EXP_LNKCAP_L0SEL 0x7000 /* L0s Exit Latency */ #define PCI_EXP_LNKCAP_L1EL 0x38000 /* L1 Exit Latency */ #define PCI_EXP_LNKCAP_CLKPM 0x40000 /* L1 Clock Power Management */ #define PCI_EXP_LNKCTL 16 /* Link Control */ #define PCI_EXP_LNKCTL_RL 0x20 /* Retrain Link */ #define PCI_EXP_LNKCTL_CCC 0x40 /* Common Clock COnfiguration */ #define PCI_EXP_LNKCTL_CLKREQ_EN 0x100 /* Enable clkreq */ #define PCI_EXP_LNKSTA 18 /* Link Status */ #define PCI_EXP_LNKSTA_LT 0x800 /* Link Training */ #define PCI_EXP_LNKSTA_SLC 0x1000 /* Slot Clock Configuration */ #define PCI_EXP_SLTCAP 20 /* Slot Capabilities */ #define PCI_EXP_SLTCTL 24 /* Slot Control */ #define PCI_EXP_SLTSTA 26 /* Slot Status */ #define PCI_EXP_RTCTL 28 /* Root Control */ #define PCI_EXP_RTCTL_SECEE 0x01 /* System Error on Correctable Error */ #define PCI_EXP_RTCTL_SENFEE 0x02 /* System Error on Non-Fatal Error */ #define PCI_EXP_RTCTL_SEFEE 0x04 /* System Error on Fatal Error */ #define PCI_EXP_RTCTL_PMEIE 0x08 /* PME Interrupt Enable */ #define PCI_EXP_RTCTL_CRSSVE 0x10 /* CRS Software Visibility Enable */ #define PCI_EXP_RTCAP 30 /* Root Capabilities */ #define PCI_EXP_RTSTA 32 /* Root Status */ #define PCI_EXP_DEVCAP2 36 /* Device Capabilities 2 */ #define PCI_EXP_DEVCAP2_ARI 0x20 /* Alternative Routing-ID */ #define PCI_EXP_DEVCTL2 40 /* Device Control 2 */ #define PCI_EXP_DEVCTL2_ARI 0x20 /* Alternative Routing-ID */ /* Extended Capabilities (PCI-X 2.0 and Express) */ #define PCI_EXT_CAP_ID(header) (header & 0x0000ffff) #define PCI_EXT_CAP_VER(header) ((header >> 16) & 0xf) #define PCI_EXT_CAP_NEXT(header) ((header >> 20) & 0xffc) #define PCI_EXT_CAP_ID_ERR 1 #define PCI_EXT_CAP_ID_VC 2 #define PCI_EXT_CAP_ID_DSN 3 #define PCI_EXT_CAP_ID_PWR 4 #define PCI_EXT_CAP_ID_ARI 14 /* Advanced Error Reporting */ #define PCI_ERR_UNCOR_STATUS 4 /* Uncorrectable Error Status */ #define PCI_ERR_UNC_TRAIN 0x00000001 /* Training */ #define PCI_ERR_UNC_DLP 0x00000010 /* Data Link Protocol */ #define PCI_ERR_UNC_POISON_TLP 0x00001000 /* Poisoned TLP */ #define PCI_ERR_UNC_FCP 0x00002000 /* Flow Control Protocol */ #define PCI_ERR_UNC_COMP_TIME 0x00004000 /* Completion Timeout */ #define PCI_ERR_UNC_COMP_ABORT 0x00008000 /* Completer Abort */ #define PCI_ERR_UNC_UNX_COMP 0x00010000 /* Unexpected Completion */ #define PCI_ERR_UNC_RX_OVER 0x00020000 /* Receiver Overflow */ #define PCI_ERR_UNC_MALF_TLP 0x00040000 /* Malformed TLP */ #define PCI_ERR_UNC_ECRC 0x00080000 /* ECRC Error Status */ #define PCI_ERR_UNC_UNSUP 0x00100000 /* Unsupported Request */ #define PCI_ERR_UNCOR_MASK 8 /* Uncorrectable Error Mask */ /* Same bits as above */ #define PCI_ERR_UNCOR_SEVER 12 /* Uncorrectable Error Severity */ /* Same bits as above */ #define PCI_ERR_COR_STATUS 16 /* Correctable Error Status */ #define PCI_ERR_COR_RCVR 0x00000001 /* Receiver Error Status */ #define PCI_ERR_COR_BAD_TLP 0x00000040 /* Bad TLP Status */ #define PCI_ERR_COR_BAD_DLLP 0x00000080 /* Bad DLLP Status */ #define PCI_ERR_COR_REP_ROLL 0x00000100 /* REPLAY_NUM Rollover */ #define PCI_ERR_COR_REP_TIMER 0x00001000 /* Replay Timer Timeout */ #define PCI_ERR_COR_MASK 20 /* Correctable Error Mask */ /* Same bits as above */ #define PCI_ERR_CAP 24 /* Advanced Error Capabilities */ #define PCI_ERR_CAP_FEP(x) ((x) & 31) /* First Error Pointer */ #define PCI_ERR_CAP_ECRC_GENC 0x00000020 /* ECRC Generation Capable */ #define PCI_ERR_CAP_ECRC_GENE 0x00000040 /* ECRC Generation Enable */ #define PCI_ERR_CAP_ECRC_CHKC 0x00000080 /* ECRC Check Capable */ #define PCI_ERR_CAP_ECRC_CHKE 0x00000100 /* ECRC Check Enable */ #define PCI_ERR_HEADER_LOG 28 /* Header Log Register (16 bytes) */ #define PCI_ERR_ROOT_COMMAND 44 /* Root Error Command */ /* Correctable Err Reporting Enable */ #define PCI_ERR_ROOT_CMD_COR_EN 0x00000001 /* Non-fatal Err Reporting Enable */ #define PCI_ERR_ROOT_CMD_NONFATAL_EN 0x00000002 /* Fatal Err Reporting Enable */ #define PCI_ERR_ROOT_CMD_FATAL_EN 0x00000004 #define PCI_ERR_ROOT_STATUS 48 #define PCI_ERR_ROOT_COR_RCV 0x00000001 /* ERR_COR Received */ /* Multi ERR_COR Received */ #define PCI_ERR_ROOT_MULTI_COR_RCV 0x00000002 /* ERR_FATAL/NONFATAL Recevied */ #define PCI_ERR_ROOT_UNCOR_RCV 0x00000004 /* Multi ERR_FATAL/NONFATAL Recevied */ #define PCI_ERR_ROOT_MULTI_UNCOR_RCV 0x00000008 #define PCI_ERR_ROOT_FIRST_FATAL 0x00000010 /* First Fatal */ #define PCI_ERR_ROOT_NONFATAL_RCV 0x00000020 /* Non-Fatal Received */ #define PCI_ERR_ROOT_FATAL_RCV 0x00000040 /* Fatal Received */ #define PCI_ERR_ROOT_COR_SRC 52 #define PCI_ERR_ROOT_SRC 54 /* Virtual Channel */ #define PCI_VC_PORT_REG1 4 #define PCI_VC_PORT_REG2 8 #define PCI_VC_PORT_CTRL 12 #define PCI_VC_PORT_STATUS 14 #define PCI_VC_RES_CAP 16 #define PCI_VC_RES_CTRL 20 #define PCI_VC_RES_STATUS 26 /* Power Budgeting */ #define PCI_PWR_DSR 4 /* Data Select Register */ #define PCI_PWR_DATA 8 /* Data Register */ #define PCI_PWR_DATA_BASE(x) ((x) & 0xff) /* Base Power */ #define PCI_PWR_DATA_SCALE(x) (((x) >> 8) & 3) /* Data Scale */ #define PCI_PWR_DATA_PM_SUB(x) (((x) >> 10) & 7) /* PM Sub State */ #define PCI_PWR_DATA_PM_STATE(x) (((x) >> 13) & 3) /* PM State */ #define PCI_PWR_DATA_TYPE(x) (((x) >> 15) & 7) /* Type */ #define PCI_PWR_DATA_RAIL(x) (((x) >> 18) & 7) /* Power Rail */ #define PCI_PWR_CAP 12 /* Capability */ #define PCI_PWR_CAP_BUDGET(x) ((x) & 1) /* Included in system budget */ /* * Hypertransport sub capability types * * Unfortunately there are both 3 bit and 5 bit capability types defined * in the HT spec, catering for that is a little messy. You probably don't * want to use these directly, just use pci_find_ht_capability() and it * will do the right thing for you. */ #define HT_3BIT_CAP_MASK 0xE0 #define HT_CAPTYPE_SLAVE 0x00 /* Slave/Primary link configuration */ #define HT_CAPTYPE_HOST 0x20 /* Host/Secondary link configuration */ #define HT_5BIT_CAP_MASK 0xF8 #define HT_CAPTYPE_IRQ 0x80 /* IRQ Configuration */ #define HT_CAPTYPE_REMAPPING_40 0xA0 /* 40 bit address remapping */ #define HT_CAPTYPE_REMAPPING_64 0xA2 /* 64 bit address remapping */ #define HT_CAPTYPE_UNITID_CLUMP 0x90 /* Unit ID clumping */ #define HT_CAPTYPE_EXTCONF 0x98 /* Extended Configuration Space Access */ #define HT_CAPTYPE_MSI_MAPPING 0xA8 /* MSI Mapping Capability */ #define HT_MSI_FLAGS 0x02 /* Offset to flags */ #define HT_MSI_FLAGS_ENABLE 0x1 /* Mapping enable */ #define HT_MSI_FLAGS_FIXED 0x2 /* Fixed mapping only */ #define HT_MSI_FIXED_ADDR 0x00000000FEE00000ULL /* Fixed addr */ #define HT_MSI_ADDR_LO 0x04 /* Offset to low addr bits */ #define HT_MSI_ADDR_LO_MASK 0xFFF00000 /* Low address bit mask */ #define HT_MSI_ADDR_HI 0x08 /* Offset to high addr bits */ #define HT_CAPTYPE_DIRECT_ROUTE 0xB0 /* Direct routing configuration */ #define HT_CAPTYPE_VCSET 0xB8 /* Virtual Channel configuration */ #define HT_CAPTYPE_ERROR_RETRY 0xC0 /* Retry on error configuration */ #define HT_CAPTYPE_GEN3 0xD0 /* Generation 3 hypertransport configuration */ #define HT_CAPTYPE_PM 0xE0 /* Hypertransport powermanagement configuration */ /* Alternative Routing-ID Interpretation */ #define PCI_ARI_CAP 0x04 /* ARI Capability Register */ #define PCI_ARI_CAP_MFVC 0x0001 /* MFVC Function Groups Capability */ #define PCI_ARI_CAP_ACS 0x0002 /* ACS Function Groups Capability */ #define PCI_ARI_CAP_NFN(x) (((x) >> 8) & 0xff) /* Next Function Number */ #define PCI_ARI_CTRL 0x06 /* ARI Control Register */ #define PCI_ARI_CTRL_MFVC 0x0001 /* MFVC Function Groups Enable */ #define PCI_ARI_CTRL_ACS 0x0002 /* ACS Function Groups Enable */ #define PCI_ARI_CTRL_FG(x) (((x) >> 4) & 7) /* Function Group */ #endif /* LINUX_PCI_REGS_H */ tinyvisor/bios/src/pcibios.c0000644006644000001440000001337512172661303016415 0ustar yuichi_xyusers// PCI BIOS (int 1a/b1) calls // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "types.h" // u32 #include "util.h" // handle_1ab1 #include "pci.h" // pci_config_readl #include "bregs.h" // struct bregs #include "biosvar.h" // GET_GLOBAL #include "pci_regs.h" // PCI_VENDOR_ID // romlayout.S extern void entry_bios32(void); extern void entry_pcibios32(void); #define RET_FUNC_NOT_SUPPORTED 0x81 #define RET_BAD_VENDOR_ID 0x83 #define RET_DEVICE_NOT_FOUND 0x86 #define RET_BUFFER_TOO_SMALL 0x89 // installation check static void handle_1ab101(struct bregs *regs) { regs->al = 0x01; // Flags - "Config Mechanism #1" supported. regs->bx = 0x0210; // PCI version 2.10 regs->cl = GET_GLOBAL(MaxPCIBus); regs->edx = 0x20494350; // "PCI " regs->edi = (u32)entry_pcibios32 + BUILD_BIOS_ADDR; set_code_success(regs); } // find pci device static void handle_1ab102(struct bregs *regs) { u32 id = (regs->cx << 16) | regs->dx; int count = regs->si; int bus = -1; while (bus < GET_GLOBAL(MaxPCIBus)) { bus++; int bdf; foreachbdf(bdf, bus) { u32 v = pci_config_readl(bdf, PCI_VENDOR_ID); if (v != id) continue; if (count--) continue; regs->bx = bdf; set_code_success(regs); return; } } set_code_invalid(regs, RET_DEVICE_NOT_FOUND); } // find class code static void handle_1ab103(struct bregs *regs) { int count = regs->si; u32 classprog = regs->ecx; int bus = -1; while (bus < GET_GLOBAL(MaxPCIBus)) { bus++; int bdf; foreachbdf(bdf, bus) { u32 v = pci_config_readl(bdf, PCI_CLASS_REVISION); if ((v>>8) != classprog) continue; if (count--) continue; regs->bx = bdf; set_code_success(regs); return; } } set_code_invalid(regs, RET_DEVICE_NOT_FOUND); } // read configuration byte static void handle_1ab108(struct bregs *regs) { regs->cl = pci_config_readb(regs->bx, regs->di); set_code_success(regs); } // read configuration word static void handle_1ab109(struct bregs *regs) { regs->cx = pci_config_readw(regs->bx, regs->di); set_code_success(regs); } // read configuration dword static void handle_1ab10a(struct bregs *regs) { regs->ecx = pci_config_readl(regs->bx, regs->di); set_code_success(regs); } // write configuration byte static void handle_1ab10b(struct bregs *regs) { pci_config_writeb(regs->bx, regs->di, regs->cl); set_code_success(regs); } // write configuration word static void handle_1ab10c(struct bregs *regs) { pci_config_writew(regs->bx, regs->di, regs->cx); set_code_success(regs); } // write configuration dword static void handle_1ab10d(struct bregs *regs) { pci_config_writel(regs->bx, regs->di, regs->ecx); set_code_success(regs); } // get irq routing options static void handle_1ab10e(struct bregs *regs) { struct pir_header *pirtable_gf = GET_GLOBAL(PirAddr); if (! pirtable_gf) { set_code_invalid(regs, RET_FUNC_NOT_SUPPORTED); return; } struct pir_header *pirtable_g = GLOBALFLAT2GLOBAL(pirtable_gf); struct param_s { u16 size; u16 buf_off; u16 buf_seg; } *param_far = (void*)(regs->di+0); // Validate and update size. u16 bufsize = GET_FARVAR(regs->es, param_far->size); u16 pirsize = GET_GLOBAL(pirtable_g->size) - sizeof(struct pir_header); SET_FARVAR(regs->es, param_far->size, pirsize); if (bufsize < pirsize) { set_code_invalid(regs, RET_BUFFER_TOO_SMALL); return; } // Get dest buffer. void *buf_far = (void*)(GET_FARVAR(regs->es, param_far->buf_off)+0); u16 buf_seg = GET_FARVAR(regs->es, param_far->buf_seg); // Memcpy pir table slots to dest buffer. memcpy_far(buf_seg, buf_far , get_global_seg() , (void*)(pirtable_g->slots) + get_global_offset() , pirsize); // XXX - bochs bios sets bx to (1 << 9) | (1 << 11) regs->bx = GET_GLOBAL(pirtable_g->exclusive_irqs); set_code_success(regs); } static void handle_1ab1XX(struct bregs *regs) { set_code_unimplemented(regs, RET_FUNC_NOT_SUPPORTED); } void handle_1ab1(struct bregs *regs) { //debug_stub(regs); if (! CONFIG_PCIBIOS) { set_invalid(regs); return; } switch (regs->al) { case 0x01: handle_1ab101(regs); break; case 0x02: handle_1ab102(regs); break; case 0x03: handle_1ab103(regs); break; case 0x08: handle_1ab108(regs); break; case 0x09: handle_1ab109(regs); break; case 0x0a: handle_1ab10a(regs); break; case 0x0b: handle_1ab10b(regs); break; case 0x0c: handle_1ab10c(regs); break; case 0x0d: handle_1ab10d(regs); break; case 0x0e: handle_1ab10e(regs); break; default: handle_1ab1XX(regs); break; } } // Entry point for pci bios functions. void VISIBLE16 VISIBLE32SEG handle_pcibios(struct bregs *regs) { debug_enter(regs, DEBUG_HDL_pcibios); handle_1ab1(regs); } /**************************************************************** * 32bit interface ****************************************************************/ struct bios32_s { u32 signature; u32 entry; u8 version; u8 length; u8 checksum; u8 reserved[5]; } PACKED; struct bios32_s BIOS32HEADER __aligned(16) VARFSEG = { .signature = 0x5f32335f, // _32_ .length = sizeof(BIOS32HEADER) / 16, }; void bios32_init(void) { dprintf(3, "init bios32\n"); BIOS32HEADER.entry = (u32)entry_bios32; BIOS32HEADER.checksum -= checksum(&BIOS32HEADER, sizeof(BIOS32HEADER)); } tinyvisor/bios/src/acpi.h0000644006644000001440000002420012174763154015704 0ustar yuichi_xyusers#ifndef __ACPI_H #define __ACPI_H #include "types.h" // u32 /* * ACPI 2.0 Generic Address Space definition. */ struct acpi_20_generic_address { u8 address_space_id; u8 register_bit_width; u8 register_bit_offset; u8 reserved; u64 address; } PACKED; #define acpi_ga_to_bdf(addr) pci_to_bdf(0, (addr >> 32) & 0xffff, (addr >> 16) & 0xffff) void acpi_setup(void); u32 find_resume_vector(void); void find_acpi_features(void); void acpi_set_reset_reg(struct acpi_20_generic_address *reg, u8 val); void acpi_reboot(void); #define RSDP_SIGNATURE 0x2052545020445352LL // "RSD PTR " struct rsdp_descriptor { /* Root System Descriptor Pointer */ u64 signature; /* ACPI signature, contains "RSD PTR " */ u8 checksum; /* To make sum of struct == 0 */ u8 oem_id [6]; /* OEM identification */ u8 revision; /* Must be 0 for 1.0, 2 for 2.0 */ u32 rsdt_physical_address; /* 32-bit physical address of RSDT */ u32 length; /* XSDT Length in bytes including hdr */ u64 xsdt_physical_address; /* 64-bit physical address of XSDT */ u8 extended_checksum; /* Checksum of entire table */ u8 reserved [3]; /* Reserved field must be 0 */ }; extern struct rsdp_descriptor *RsdpAddr; /* Table structure from Linux kernel (the ACPI tables are under the BSD license) */ #define ACPI_TABLE_HEADER_DEF /* ACPI common table header */ \ u32 signature; /* ACPI signature (4 ASCII characters) */ \ u32 length; /* Length of table, in bytes, including header */ \ u8 revision; /* ACPI Specification minor version # */ \ u8 checksum; /* To make sum of entire table == 0 */ \ u8 oem_id [6]; /* OEM identification */ \ u8 oem_table_id [8]; /* OEM table identification */ \ u32 oem_revision; /* OEM revision number */ \ u8 asl_compiler_id [4]; /* ASL compiler vendor ID */ \ u32 asl_compiler_revision; /* ASL compiler revision number */ /* * ACPI 1.0 Fixed ACPI Description Table (FADT) */ #define FACP_SIGNATURE 0x50434146 // FACP struct fadt_descriptor_rev4 { ACPI_TABLE_HEADER_DEF /* ACPI common table header */ u32 firmware_ctrl; /* Physical address of FACS */ u32 dsdt; /* Physical address of DSDT */ u8 model; /* System Interrupt Model */ u8 preferred_pm_profile; u16 sci_int; /* System vector of SCI interrupt */ u32 smi_cmd; /* Port address of SMI command port */ u8 acpi_enable; /* Value to write to smi_cmd to enable ACPI */ u8 acpi_disable; /* Value to write to smi_cmd to disable ACPI */ u8 S4bios_req; /* Value to write to SMI CMD to enter S4BIOS state */ u8 pstate_cnt; u32 pm1a_evt_blk; /* Port address of Power Mgt 1a acpi_event Reg Blk */ u32 pm1b_evt_blk; /* Port address of Power Mgt 1b acpi_event Reg Blk */ u32 pm1a_cnt_blk; /* Port address of Power Mgt 1a Control Reg Blk */ u32 pm1b_cnt_blk; /* Port address of Power Mgt 1b Control Reg Blk */ u32 pm2_cnt_blk; /* Port address of Power Mgt 2 Control Reg Blk */ u32 pm_tmr_blk; /* Port address of Power Mgt Timer Ctrl Reg Blk */ u32 gpe0_blk; /* Port addr of General Purpose acpi_event 0 Reg Blk */ u32 gpe1_blk; /* Port addr of General Purpose acpi_event 1 Reg Blk */ u8 pm1_evt_len; /* Byte length of ports at pm1_x_evt_blk */ u8 pm1_cnt_len; /* Byte length of ports at pm1_x_cnt_blk */ u8 pm2_cnt_len; /* Byte Length of ports at pm2_cnt_blk */ u8 pm_tmr_len; /* Byte Length of ports at pm_tm_blk */ u8 gpe0_blk_len; /* Byte Length of ports at gpe0_blk */ u8 gpe1_blk_len; /* Byte Length of ports at gpe1_blk */ u8 gpe1_base; /* Offset in gpe model where gpe1 events start */ u8 cst_cnt; u16 plvl2_lat; /* Worst case HW latency to enter/exit C2 state */ u16 plvl3_lat; /* Worst case HW latency to enter/exit C3 state */ u16 flush_size; /* Size of area read to flush caches */ u16 flush_stride; /* Stride used in flushing caches */ u8 duty_offset; /* Bit location of duty cycle field in p_cnt reg */ u8 duty_width; /* Bit width of duty cycle field in p_cnt reg */ u8 day_alrm; /* Index to day-of-month alarm in RTC CMOS RAM */ u8 mon_alrm; /* Index to month-of-year alarm in RTC CMOS RAM */ u8 century; /* Index to century in RTC CMOS RAM */ u8 iapc_boot_arch_low; u8 iapc_boot_arch_high; u8 reserved1; /* Reserved */ u32 flags; u32 reset_reg_low; u32 reset_reg_mid; u32 reset_reg_high; u8 reset_value; u8 reserved2a; u8 reserved2b; u8 reserved2c; u64 x_firmwaer_ctrl; u64 x_dsdt; u32 x_pm1a_evt_blk_low; u32 x_pm1a_evt_blk_mid; u32 x_pm1a_evt_blk_high; u32 x_pm1b_evt_blk_low; u32 x_pm1b_evt_blk_mid; u32 x_pm1b_evt_blk_high; u32 x_pm1a_cnt_blk_low; u32 x_pm1a_cnt_blk_mid; u32 x_pm1a_cnt_blk_high; u32 x_pm1b_cnt_blk_low; u32 x_pm1b_cnt_blk_mid; u32 x_pm1b_cnt_blk_high; u32 x_pm2_cnt_blk_low; u32 x_pm2_cnt_blk_mid; u32 x_pm2_cnt_blk_high; u32 x_pm_tmr_blk_low; u32 x_pm_tmr_blk_mid; u32 x_pm_tmr_blk_high; u32 x_gpe0_blk_low; u32 x_gpe0_blk_mid; u32 x_gpe0_blk_high; u32 x_gpe1_blk_low; u32 x_gpe1_blk_mid; u32 x_gpe1_blk_high; } PACKED; struct acpi_table_header /* ACPI common table header */ { ACPI_TABLE_HEADER_DEF } PACKED; /* * ACPI 1.0 Root System Description Table (RSDT) */ #define RSDT_SIGNATURE 0x54445352 // RSDT struct rsdt_descriptor_rev1 { ACPI_TABLE_HEADER_DEF /* ACPI common table header */ u32 table_offset_entry[0]; /* Array of pointers to other */ /* ACPI tables */ } PACKED; /* * ACPI 1.0 Firmware ACPI Control Structure (FACS) */ #define FACS_SIGNATURE 0x53434146 // FACS struct facs_descriptor_rev1 { u32 signature; /* ACPI Signature */ u32 length; /* Length of structure, in bytes */ u32 hardware_signature; /* Hardware configuration signature */ u32 firmware_waking_vector; /* ACPI OS waking vector */ u32 global_lock; /* Global Lock */ u32 flags; u8 resverved3 [40]; /* Reserved - must be zero */ } PACKED; /* * Differentiated System Description Table (DSDT) */ #define DSDT_SIGNATURE 0x54445344 // DSDT /* * MADT values and structures */ /* Values for MADT PCATCompat */ #define DUAL_PIC 0 #define MULTIPLE_APIC 1 /* Master MADT */ #define APIC_SIGNATURE 0x43495041 // APIC struct multiple_apic_table { ACPI_TABLE_HEADER_DEF /* ACPI common table header */ u32 local_apic_address; /* Physical address of local APIC */ u32 flags; } PACKED; /* Values for Type in APIC sub-headers */ #define APIC_PROCESSOR 0 #define APIC_IO 1 #define APIC_XRUPT_OVERRIDE 2 #define APIC_NMI 3 #define APIC_LOCAL_NMI 4 #define APIC_ADDRESS_OVERRIDE 5 #define APIC_IO_SAPIC 6 #define APIC_LOCAL_SAPIC 7 #define APIC_XRUPT_SOURCE 8 #define APIC_RESERVED 9 /* 9 and greater are reserved */ /* * MADT sub-structures (Follow MULTIPLE_APIC_DESCRIPTION_TABLE) */ #define ACPI_SUB_HEADER_DEF /* Common ACPI sub-structure header */\ u8 type; \ u8 length; /* Sub-structures for MADT */ struct madt_processor_apic { ACPI_SUB_HEADER_DEF u8 processor_id; /* ACPI processor id */ u8 local_apic_id; /* Processor's local APIC id */ u32 flags; } PACKED; struct madt_io_apic { ACPI_SUB_HEADER_DEF u8 io_apic_id; /* I/O APIC ID */ u8 reserved; /* Reserved - must be zero */ u32 address; /* APIC physical address */ u32 interrupt; /* Global system interrupt where INTI * lines start */ } PACKED; struct madt_intsrcovr { ACPI_SUB_HEADER_DEF u8 bus; u8 source; u32 gsi; u16 flags; } PACKED; struct madt_local_nmi { ACPI_SUB_HEADER_DEF u8 processor_id; /* ACPI processor id */ u16 flags; /* MPS INTI flags */ u8 lint; /* Local APIC LINT# */ } PACKED; /* * HPET Description Table */ #define HPET_SIGNATURE 0x54455048 // HPET struct acpi_20_hpet { ACPI_TABLE_HEADER_DEF /* ACPI common table header */ u32 timer_block_id; struct acpi_20_generic_address addr; u8 hpet_number; u16 min_tick; u8 page_protect; } PACKED; /* * SRAT (NUMA topology description) table */ #define SRAT_SIGNATURE 0x54415253 // SRAT struct system_resource_affinity_table { ACPI_TABLE_HEADER_DEF u32 reserved1; u32 reserved2[2]; } PACKED; #define SRAT_PROCESSOR 0 #define SRAT_MEMORY 1 struct srat_processor_affinity { ACPI_SUB_HEADER_DEF u8 proximity_lo; u8 local_apic_id; u32 flags; u8 local_sapic_eid; u8 proximity_hi[3]; u32 reserved; } PACKED; struct srat_memory_affinity { ACPI_SUB_HEADER_DEF u8 proximity[4]; u16 reserved1; u64 base_addr; u64 range_length; u32 reserved2; u32 flags; u32 reserved3[2]; } PACKED; /* PCI fw r3.0 MCFG table. */ /* Subtable */ struct acpi_mcfg_allocation { u64 address; /* Base address, processor-relative */ u16 pci_segment; /* PCI segment group number */ u8 start_bus_number; /* Starting PCI Bus number */ u8 end_bus_number; /* Final PCI Bus number */ u32 reserved; } PACKED; #define MCFG_SIGNATURE 0x4746434d // MCFG struct acpi_table_mcfg { ACPI_TABLE_HEADER_DEF; u8 reserved[8]; struct acpi_mcfg_allocation allocation[0]; } PACKED; #endif // acpi.h tinyvisor/bios/src/q35-acpi-dsdt.dsl0000644006644000001440000003712612172661303017603 0ustar yuichi_xyusers/* * Bochs/QEMU ACPI DSDT ASL definition * * Copyright (c) 2006 Fabrice Bellard * * This library is free software; you can redistribute it and/or * modify it under the terms of the GNU Lesser General Public * License version 2 as published by the Free Software Foundation. * * This library 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 * Lesser General Public License for more details. * * You should have received a copy of the GNU Lesser General Public * License along with this library; if not, write to the Free Software * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA */ /* * Copyright (c) 2010 Isaku Yamahata * yamahata at valinux co jp * Based on acpi-dsdt.dsl, but heavily modified for q35 chipset. */ DefinitionBlock ( "q35-acpi-dsdt.aml",// Output Filename "DSDT", // Signature 0x01, // DSDT Compliance Revision "BXPC", // OEMID "BXDSDT", // TABLE ID 0x2 // OEM Revision ) { #include "acpi-dsdt-dbug.dsl" Scope(\_SB) { OperationRegion(PCST, SystemIO, 0xae00, 0x0c) OperationRegion(PCSB, SystemIO, 0xae0c, 0x01) Field(PCSB, AnyAcc, NoLock, WriteAsZeros) { PCIB, 8, } } /**************************************************************** * PCI Bus definition ****************************************************************/ Scope(\_SB) { Device(PCI0) { Name(_HID, EisaId("PNP0A08")) Name(_CID, EisaId("PNP0A03")) Name(_ADR, 0x00) Name(_UID, 1) // _OSC: based on sample of ACPI3.0b spec Name(SUPP, 0) // PCI _OSC Support Field value Name(CTRL, 0) // PCI _OSC Control Field value Method(_OSC, 4) { // Create DWORD-addressable fields from the Capabilities Buffer CreateDWordField(Arg3, 0, CDW1) // Check for proper UUID If (LEqual(Arg0, ToUUID("33DB4D5B-1FF7-401C-9657-7441C03DD766"))) { // Create DWORD-addressable fields from the Capabilities Buffer CreateDWordField(Arg3, 4, CDW2) CreateDWordField(Arg3, 8, CDW3) // Save Capabilities DWORD2 & 3 Store(CDW2, SUPP) Store(CDW3, CTRL) // Always allow native PME, AER (no dependencies) // Never allow SHPC (no SHPC controller in this system) And(CTRL, 0x1D, CTRL) #if 0 // For now, nothing to do If (Not(And(CDW1, 1))) { // Query flag clear? // Disable GPEs for features granted native control. If (And(CTRL, 0x01)) { // Hot plug control granted? Store(0, HPCE) // clear the hot plug SCI enable bit Store(1, HPCS) // clear the hot plug SCI status bit } If (And(CTRL, 0x04)) { // PME control granted? Store(0, PMCE) // clear the PME SCI enable bit Store(1, PMCS) // clear the PME SCI status bit } If (And(CTRL, 0x10)) { // OS restoring PCI Express cap structure? // Set status to not restore PCI Express cap structure // upon resume from S3 Store(1, S3CR) } } #endif If (LNotEqual(Arg1, One)) { // Unknown revision Or(CDW1, 0x08, CDW1) } If (LNotEqual(CDW3, CTRL)) { // Capabilities bits were masked Or(CDW1, 0x10, CDW1) } // Update DWORD3 in the buffer Store(CTRL, CDW3) } Else { Or(CDW1, 4, CDW1) // Unrecognized UUID } Return (Arg3) } } } #include "acpi-dsdt-pci-crs.dsl" #include "acpi-dsdt-hpet.dsl" /**************************************************************** * VGA ****************************************************************/ Scope(\_SB.PCI0) { Device(VGA) { Name(_ADR, 0x00010000) Method(_S1D, 0, NotSerialized) { Return (0x00) } Method(_S2D, 0, NotSerialized) { Return (0x00) } Method(_S3D, 0, NotSerialized) { Return (0x00) } } } /**************************************************************** * LPC ISA bridge ****************************************************************/ Scope(\_SB.PCI0) { /* PCI D31:f0 LPC ISA bridge */ Device(ISA) { /* PCI D31:f0 */ Name(_ADR, 0x001f0000) /* ICH9 PCI to ISA irq remapping */ OperationRegion(PIRQ, PCI_Config, 0x60, 0x0C) OperationRegion(LPCD, PCI_Config, 0x80, 0x2) Field(LPCD, AnyAcc, NoLock, Preserve) { COMA, 3, , 1, COMB, 3, Offset(0x01), LPTD, 2, , 2, FDCD, 2 } OperationRegion(LPCE, PCI_Config, 0x82, 0x2) Field(LPCE, AnyAcc, NoLock, Preserve) { CAEN, 1, CBEN, 1, LPEN, 1, FDEN, 1 } } } #include "acpi-dsdt-isa.dsl" /**************************************************************** * PCI IRQs ****************************************************************/ /* Zero => PIC mode, One => APIC Mode */ Name(\PICF, Zero) Method(\_PIC, 1, NotSerialized) { Store(Arg0, \PICF) } Scope(\_SB) { Scope(PCI0) { #define prt_slot_lnk(nr, lnk0, lnk1, lnk2, lnk3) \ Package() { nr##ffff, 0, lnk0, 0 }, \ Package() { nr##ffff, 1, lnk1, 0 }, \ Package() { nr##ffff, 2, lnk2, 0 }, \ Package() { nr##ffff, 3, lnk3, 0 } #define prt_slot_lnkA(nr) prt_slot_lnk(nr, LNKA, LNKB, LNKC, LNKD) #define prt_slot_lnkB(nr) prt_slot_lnk(nr, LNKB, LNKC, LNKD, LNKA) #define prt_slot_lnkC(nr) prt_slot_lnk(nr, LNKC, LNKD, LNKA, LNKB) #define prt_slot_lnkD(nr) prt_slot_lnk(nr, LNKD, LNKA, LNKB, LNKC) #define prt_slot_lnkE(nr) prt_slot_lnk(nr, LNKE, LNKF, LNKG, LNKH) #define prt_slot_lnkF(nr) prt_slot_lnk(nr, LNKF, LNKG, LNKH, LNKE) #define prt_slot_lnkG(nr) prt_slot_lnk(nr, LNKG, LNKH, LNKE, LNKF) #define prt_slot_lnkH(nr) prt_slot_lnk(nr, LNKH, LNKE, LNKF, LNKG) Name(PRTP, package() { prt_slot_lnkE(0x0000), prt_slot_lnkF(0x0001), prt_slot_lnkG(0x0002), prt_slot_lnkH(0x0003), prt_slot_lnkE(0x0004), prt_slot_lnkF(0x0005), prt_slot_lnkG(0x0006), prt_slot_lnkH(0x0007), prt_slot_lnkE(0x0008), prt_slot_lnkF(0x0009), prt_slot_lnkG(0x000a), prt_slot_lnkH(0x000b), prt_slot_lnkE(0x000c), prt_slot_lnkF(0x000d), prt_slot_lnkG(0x000e), prt_slot_lnkH(0x000f), prt_slot_lnkE(0x0010), prt_slot_lnkF(0x0011), prt_slot_lnkG(0x0012), prt_slot_lnkH(0x0013), prt_slot_lnkE(0x0014), prt_slot_lnkF(0x0015), prt_slot_lnkG(0x0016), prt_slot_lnkH(0x0017), prt_slot_lnkE(0x0018), /* INTA -> PIRQA for slot 25 - 31 see the default value of DIR */ prt_slot_lnkA(0x0019), prt_slot_lnkA(0x001a), prt_slot_lnkA(0x001b), prt_slot_lnkA(0x001c), prt_slot_lnkA(0x001d), /* PCIe->PCI bridge. use PIRQ[E-H] */ prt_slot_lnkE(0x001e), prt_slot_lnkA(0x001f) }) #define prt_slot_gsi(nr, gsi0, gsi1, gsi2, gsi3) \ Package() { nr##ffff, 0, gsi0, 0 }, \ Package() { nr##ffff, 1, gsi1, 0 }, \ Package() { nr##ffff, 2, gsi2, 0 }, \ Package() { nr##ffff, 3, gsi3, 0 } #define prt_slot_gsiA(nr) prt_slot_gsi(nr, GSIA, GSIB, GSIC, GSID) #define prt_slot_gsiB(nr) prt_slot_gsi(nr, GSIB, GSIC, GSID, GSIA) #define prt_slot_gsiC(nr) prt_slot_gsi(nr, GSIC, GSID, GSIA, GSIB) #define prt_slot_gsiD(nr) prt_slot_gsi(nr, GSID, GSIA, GSIB, GSIC) #define prt_slot_gsiE(nr) prt_slot_gsi(nr, GSIE, GSIF, GSIG, GSIH) #define prt_slot_gsiF(nr) prt_slot_gsi(nr, GSIF, GSIG, GSIH, GSIE) #define prt_slot_gsiG(nr) prt_slot_gsi(nr, GSIG, GSIH, GSIE, GSIF) #define prt_slot_gsiH(nr) prt_slot_gsi(nr, GSIH, GSIE, GSIF, GSIG) Name(PRTA, package() { prt_slot_gsiE(0x0000), prt_slot_gsiF(0x0001), prt_slot_gsiG(0x0002), prt_slot_gsiH(0x0003), prt_slot_gsiE(0x0004), prt_slot_gsiF(0x0005), prt_slot_gsiG(0x0006), prt_slot_gsiH(0x0007), prt_slot_gsiE(0x0008), prt_slot_gsiF(0x0009), prt_slot_gsiG(0x000a), prt_slot_gsiH(0x000b), prt_slot_gsiE(0x000c), prt_slot_gsiF(0x000d), prt_slot_gsiG(0x000e), prt_slot_gsiH(0x000f), prt_slot_gsiE(0x0010), prt_slot_gsiF(0x0011), prt_slot_gsiG(0x0012), prt_slot_gsiH(0x0013), prt_slot_gsiE(0x0014), prt_slot_gsiF(0x0015), prt_slot_gsiG(0x0016), prt_slot_gsiH(0x0017), prt_slot_gsiE(0x0018), /* INTA -> PIRQA for slot 25 - 31, but 30 see the default value of DIR */ prt_slot_gsiA(0x0019), prt_slot_gsiA(0x001a), prt_slot_gsiA(0x001b), prt_slot_gsiA(0x001c), prt_slot_gsiA(0x001d), /* PCIe->PCI bridge. use PIRQ[E-H] */ prt_slot_gsiE(0x001e), prt_slot_gsiA(0x001f) }) Method(_PRT, 0, NotSerialized) { /* PCI IRQ routing table, example from ACPI 2.0a specification, section 6.2.8.1 */ /* Note: we provide the same info as the PCI routing table of the Bochs BIOS */ If (LEqual(\PICF, Zero)) { Return (PRTP) } Else { Return (PRTA) } } } Field(PCI0.ISA.PIRQ, ByteAcc, NoLock, Preserve) { PRQA, 8, PRQB, 8, PRQC, 8, PRQD, 8, Offset(0x08), PRQE, 8, PRQF, 8, PRQG, 8, PRQH, 8 } Method(IQST, 1, NotSerialized) { // _STA method - get status If (And(0x80, Arg0)) { Return (0x09) } Return (0x0B) } Method(IQCR, 1, NotSerialized) { // _CRS method - get current settings Name(PRR0, ResourceTemplate() { Interrupt(, Level, ActiveHigh, Shared) { 0 } }) CreateDWordField(PRR0, 0x05, PRRI) Store(And(Arg0, 0x0F), PRRI) Return (PRR0) } #define define_link(link, uid, reg) \ Device(link) { \ Name(_HID, EISAID("PNP0C0F")) \ Name(_UID, uid) \ Name(_PRS, ResourceTemplate() { \ Interrupt(, Level, ActiveHigh, Shared) { \ 5, 10, 11 \ } \ }) \ Method(_STA, 0, NotSerialized) { \ Return (IQST(reg)) \ } \ Method(_DIS, 0, NotSerialized) { \ Or(reg, 0x80, reg) \ } \ Method(_CRS, 0, NotSerialized) { \ Return (IQCR(reg)) \ } \ Method(_SRS, 1, NotSerialized) { \ CreateDWordField(Arg0, 0x05, PRRI) \ Store(PRRI, reg) \ } \ } define_link(LNKA, 0, PRQA) define_link(LNKB, 1, PRQB) define_link(LNKC, 2, PRQC) define_link(LNKD, 3, PRQD) define_link(LNKE, 4, PRQE) define_link(LNKF, 5, PRQF) define_link(LNKG, 6, PRQG) define_link(LNKH, 7, PRQH) #define define_gsi_link(link, uid, gsi) \ Device(link) { \ Name(_HID, EISAID("PNP0C0F")) \ Name(_UID, uid) \ Name(_PRS, ResourceTemplate() { \ Interrupt(, Level, ActiveHigh, Shared) { \ gsi \ } \ }) \ Name(_CRS, ResourceTemplate() { \ Interrupt(, Level, ActiveHigh, Shared) { \ gsi \ } \ }) \ Method(_SRS, 1, NotSerialized) { \ } \ } define_gsi_link(GSIA, 0, 0x10) define_gsi_link(GSIB, 0, 0x11) define_gsi_link(GSIC, 0, 0x12) define_gsi_link(GSID, 0, 0x13) define_gsi_link(GSIE, 0, 0x14) define_gsi_link(GSIF, 0, 0x15) define_gsi_link(GSIG, 0, 0x16) define_gsi_link(GSIH, 0, 0x17) } #include "acpi-dsdt-cpu-hotplug.dsl" /**************************************************************** * General purpose events ****************************************************************/ Scope(\_GPE) { Name(_HID, "ACPI0006") Method(_L00) { } Method(_L01) { // CPU hotplug event \_SB.PRSC() } Method(_L02) { } Method(_L03) { } Method(_L04) { } Method(_L05) { } Method(_L06) { } Method(_L07) { } Method(_L08) { } Method(_L09) { } Method(_L0A) { } Method(_L0B) { } Method(_L0C) { } Method(_L0D) { } Method(_L0E) { } Method(_L0F) { } } } tinyvisor/bios/src/acpi-dsdt-hpet.dsl0000644006644000001440000000215412172661303020124 0ustar yuichi_xyusers/**************************************************************** * HPET ****************************************************************/ Scope(\_SB) { Device(HPET) { Name(_HID, EISAID("PNP0103")) Name(_UID, 0) OperationRegion(HPTM, SystemMemory, 0xFED00000, 0x400) Field(HPTM, DWordAcc, Lock, Preserve) { VEND, 32, PRD, 32, } Method(_STA, 0, NotSerialized) { Store(VEND, Local0) Store(PRD, Local1) ShiftRight(Local0, 16, Local0) If (LOr(LEqual(Local0, 0), LEqual(Local0, 0xffff))) { Return (0x0) } If (LOr(LEqual(Local1, 0), LGreater(Local1, 100000000))) { Return (0x0) } Return (0x0F) } Name(_CRS, ResourceTemplate() { #if 0 /* This makes WinXP BSOD for not yet figured reasons. */ IRQNoFlags() {2, 8} #endif Memory32Fixed(ReadOnly, 0xFED00000, // Address Base 0x00000400, // Address Length ) }) } } tinyvisor/bios/src/ps2port.c0000644006644000001440000002756212172661303016401 0ustar yuichi_xyusers// Support for handling the PS/2 mouse/keyboard ports. // // Copyright (C) 2008 Kevin O'Connor // Several ideas taken from code Copyright (c) 1999-2004 Vojtech Pavlik // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "ioport.h" // inb #include "util.h" // dprintf #include "biosvar.h" // GET_LOW #include "ps2port.h" // ps2_kbd_command #include "pic.h" // eoi_pic1 /**************************************************************** * Low level i8042 commands. ****************************************************************/ // Timeout value. #define I8042_CTL_TIMEOUT 10000 #define I8042_BUFFER_SIZE 16 static int i8042_wait_read(void) { dprintf(7, "i8042_wait_read\n"); int i; for (i=0; i> 8) & 0xf; int send = (command >> 12) & 0xf; // Send the command. int ret = i8042_wait_write(); if (ret) return ret; outb(command, PORT_PS2_STATUS); // Send parameters (if any). int i; for (i = 0; i < send; i++) { ret = i8042_wait_write(); if (ret) return ret; outb(param[i], PORT_PS2_DATA); } // Receive parameters (if any). for (i = 0; i < receive; i++) { ret = i8042_wait_read(); if (ret) return ret; param[i] = inb(PORT_PS2_DATA); dprintf(7, "i8042 param=%x\n", param[i]); } return 0; } static int i8042_command(int command, u8 *param) { dprintf(7, "i8042_command cmd=%x\n", command); int ret = __i8042_command(command, param); if (ret) dprintf(2, "i8042 command %x failed\n", command); return ret; } static int i8042_kbd_write(u8 c) { dprintf(7, "i8042_kbd_write c=%d\n", c); int ret = i8042_wait_write(); if (! ret) outb(c, PORT_PS2_DATA); return ret; } static int i8042_aux_write(u8 c) { return i8042_command(I8042_CMD_AUX_SEND, &c); } void i8042_reboot(void) { if (! CONFIG_PS2PORT) return; int i; for (i=0; i<10; i++) { i8042_wait_write(); udelay(50); outb(0xfe, PORT_PS2_STATUS); /* pulse reset low */ udelay(50); } } /**************************************************************** * Device commands. ****************************************************************/ #define PS2_RET_ACK 0xfa #define PS2_RET_NAK 0xfe static int ps2_recvbyte(int aux, int needack, int timeout) { u64 end = calc_future_tsc(timeout); for (;;) { u8 status = inb(PORT_PS2_STATUS); if (status & I8042_STR_OBF) { u8 data = inb(PORT_PS2_DATA); dprintf(7, "ps2 read %x\n", data); if (!!(status & I8042_STR_AUXDATA) == aux) { if (!needack) return data; if (data == PS2_RET_ACK) return data; if (data == PS2_RET_NAK) { dprintf(1, "Got ps2 nak (status=%x)\n", status); return data; } } // This data not part of command - just discard it. dprintf(1, "Discarding ps2 data %02x (status=%02x)\n", data, status); } if (check_tsc(end)) { // Don't warn on second byte of a reset if (timeout > 100) warn_timeout(); return -1; } yield(); } } static int ps2_sendbyte(int aux, u8 command, int timeout) { dprintf(7, "ps2_sendbyte aux=%d cmd=%x\n", aux, command); int ret; if (aux) ret = i8042_aux_write(command); else ret = i8042_kbd_write(command); if (ret) return ret; // Read ack. ret = ps2_recvbyte(aux, 1, timeout); if (ret < 0) return ret; if (ret != PS2_RET_ACK) return -1; return 0; } u8 Ps2ctr VARLOW; static int __ps2_command(int aux, int command, u8 *param) { int ret2; int receive = (command >> 8) & 0xf; int send = (command >> 12) & 0xf; // Disable interrupts and keyboard/mouse. u8 ps2ctr = GET_LOW(Ps2ctr); u8 newctr = ((ps2ctr | I8042_CTR_AUXDIS | I8042_CTR_KBDDIS) & ~(I8042_CTR_KBDINT|I8042_CTR_AUXINT)); dprintf(6, "i8042 ctr old=%x new=%x\n", ps2ctr, newctr); int ret = i8042_command(I8042_CMD_CTL_WCTR, &newctr); if (ret) return ret; // Flush any interrupts already pending. yield(); // Enable port command is being sent to. if (aux) newctr &= ~I8042_CTR_AUXDIS; else newctr &= ~I8042_CTR_KBDDIS; ret = i8042_command(I8042_CMD_CTL_WCTR, &newctr); if (ret) goto fail; if (command == ATKBD_CMD_RESET_BAT) { // Reset is special wrt timeouts and bytes received. // Send command. ret = ps2_sendbyte(aux, command, 1000); if (ret) goto fail; // Receive parameters. ret = ps2_recvbyte(aux, 0, 4000); if (ret < 0) goto fail; param[0] = ret; ret = ps2_recvbyte(aux, 0, 100); if (ret < 0) // Some devices only respond with one byte on reset. ret = 0; param[1] = ret; } else if (command == ATKBD_CMD_GETID) { // Getid is special wrt bytes received. // Send command. ret = ps2_sendbyte(aux, command, 200); if (ret) goto fail; // Receive parameters. ret = ps2_recvbyte(aux, 0, 500); if (ret < 0) goto fail; param[0] = ret; if (ret == 0xab || ret == 0xac || ret == 0x2b || ret == 0x5d || ret == 0x60 || ret == 0x47) { // These ids (keyboards) return two bytes. ret = ps2_recvbyte(aux, 0, 500); if (ret < 0) goto fail; param[1] = ret; } else { param[1] = 0; } } else { // Send command. ret = ps2_sendbyte(aux, command, 200); if (ret) goto fail; // Send parameters (if any). int i; for (i = 0; i < send; i++) { ret = ps2_sendbyte(aux, param[i], 200); if (ret) goto fail; } // Receive parameters (if any). for (i = 0; i < receive; i++) { ret = ps2_recvbyte(aux, 0, 500); if (ret < 0) goto fail; param[i] = ret; } } ret = 0; fail: // Restore interrupts and keyboard/mouse. ret2 = i8042_command(I8042_CMD_CTL_WCTR, &ps2ctr); if (ret2) return ret2; return ret; } static int ps2_command(int aux, int command, u8 *param) { dprintf(7, "ps2_command aux=%d cmd=%x\n", aux, command); int ret = __ps2_command(aux, command, param); if (ret) dprintf(2, "ps2 command %x failed (aux=%d)\n", command, aux); return ret; } int ps2_kbd_command(int command, u8 *param) { if (! CONFIG_PS2PORT) return -1; return ps2_command(0, command, param); } int ps2_mouse_command(int command, u8 *param) { if (! CONFIG_PS2PORT) return -1; // Update ps2ctr for mouse enable/disable. if (command == PSMOUSE_CMD_ENABLE || command == PSMOUSE_CMD_DISABLE) { u8 ps2ctr = GET_LOW(Ps2ctr); if (command == PSMOUSE_CMD_ENABLE) ps2ctr = (ps2ctr | I8042_CTR_AUXINT) & ~I8042_CTR_AUXDIS; else ps2ctr = (ps2ctr | I8042_CTR_AUXDIS) & ~I8042_CTR_AUXINT; SET_LOW(Ps2ctr, ps2ctr); } return ps2_command(1, command, param); } /**************************************************************** * IRQ handlers ****************************************************************/ // INT74h : PS/2 mouse hardware interrupt void VISIBLE16 handle_74(void) { if (! CONFIG_PS2PORT) return; debug_isr(DEBUG_ISR_74); u8 v = inb(PORT_PS2_STATUS); if ((v & (I8042_STR_OBF|I8042_STR_AUXDATA)) != (I8042_STR_OBF|I8042_STR_AUXDATA)) { dprintf(1, "ps2 mouse irq but no mouse data.\n"); goto done; } v = inb(PORT_PS2_DATA); if (!(GET_LOW(Ps2ctr) & I8042_CTR_AUXINT)) // Interrupts not enabled. goto done; process_mouse(v); done: eoi_pic2(); } // INT09h : Keyboard Hardware Service Entry Point void VISIBLE16 handle_09(void) { if (! CONFIG_PS2PORT) return; debug_isr(DEBUG_ISR_09); // read key from keyboard controller u8 v = inb(PORT_PS2_STATUS); if (v & I8042_STR_AUXDATA) { dprintf(1, "ps2 keyboard irq but found mouse data?!\n"); goto done; } v = inb(PORT_PS2_DATA); if (!(GET_LOW(Ps2ctr) & I8042_CTR_KBDINT)) // Interrupts not enabled. goto done; process_key(v); // Some old programs expect ISR to turn keyboard back on. i8042_command(I8042_CMD_KBD_ENABLE, NULL); done: eoi_pic1(); } /**************************************************************** * Setup ****************************************************************/ static void ps2_keyboard_setup(void *data) { /* flush incoming keys */ int ret = i8042_flush(); if (ret) return; // Controller self-test. u8 param[2]; ret = i8042_command(I8042_CMD_CTL_TEST, param); if (ret) return; if (param[0] != 0x55) { dprintf(1, "i8042 self test failed (got %x not 0x55)\n", param[0]); return; } // Controller keyboard test. ret = i8042_command(I8042_CMD_KBD_TEST, param); if (ret) return; if (param[0] != 0x00) { dprintf(1, "i8042 keyboard test failed (got %x not 0x00)\n", param[0]); return; } // Disable keyboard and mouse events. SET_LOW(Ps2ctr, I8042_CTR_KBDDIS | I8042_CTR_AUXDIS); /* ------------------- keyboard side ------------------------*/ /* reset keyboard and self test (keyboard side) */ int spinupdelay = romfile_loadint("etc/ps2-keyboard-spinup", 0); u64 end = calc_future_tsc(spinupdelay); for (;;) { ret = ps2_kbd_command(ATKBD_CMD_RESET_BAT, param); if (!ret) break; if (check_tsc(end)) { if (spinupdelay) warn_timeout(); return; } yield(); } if (param[0] != 0xaa) { dprintf(1, "keyboard self test failed (got %x not 0xaa)\n", param[0]); return; } /* Disable keyboard */ ret = ps2_kbd_command(ATKBD_CMD_RESET_DIS, NULL); if (ret) return; // Set scancode command (mode 2) param[0] = 0x02; ret = ps2_kbd_command(ATKBD_CMD_SSCANSET, param); if (ret) return; // Keyboard Mode: disable mouse, scan code convert, enable kbd IRQ SET_LOW(Ps2ctr, I8042_CTR_AUXDIS | I8042_CTR_XLATE | I8042_CTR_KBDINT); /* Enable keyboard */ ret = ps2_kbd_command(ATKBD_CMD_ENABLE, NULL); if (ret) return; dprintf(1, "PS2 keyboard initialized\n"); } void ps2port_setup(void) { ASSERT32FLAT(); if (! CONFIG_PS2PORT) return; dprintf(3, "init ps2port\n"); enable_hwirq(1, FUNC16(entry_09)); enable_hwirq(12, FUNC16(entry_74)); run_thread(ps2_keyboard_setup, NULL); } tinyvisor/bios/src/ramdisk.c0000644006644000001440000000526112172661303016412 0ustar yuichi_xyusers// Code for emulating a drive via high-memory accesses. // // Copyright (C) 2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "disk.h" // process_ramdisk_op #include "util.h" // dprintf #include "memmap.h" // add_e820 #include "biosvar.h" // GET_GLOBAL #include "bregs.h" // struct bregs #include "boot.h" // boot_add_floppy void ramdisk_setup(void) { if (!CONFIG_FLASH_FLOPPY) return; // Find image. struct romfile_s *file = romfile_findprefix("floppyimg/", NULL); if (!file) return; const char *filename = file->name; u32 size = file->size; dprintf(3, "Found floppy file %s of size %d\n", filename, size); int ftype = find_floppy_type(size); if (ftype < 0) { dprintf(3, "No floppy type found for ramdisk size\n"); return; } // Allocate ram for image. void *pos = memalign_tmphigh(PAGE_SIZE, size); if (!pos) { warn_noalloc(); return; } add_e820((u32)pos, size, E820_RESERVED); // Copy image into ram. int ret = file->copy(file, pos, size); if (ret < 0) return; // Setup driver. struct drive_s *drive_g = init_floppy((u32)pos, ftype); if (!drive_g) return; drive_g->type = DTYPE_RAMDISK; dprintf(1, "Mapping CBFS floppy %s to addr %p\n", filename, pos); char *desc = znprintf(MAXDESCSIZE, "Ramdisk [%s]", &filename[10]); boot_add_floppy(drive_g, desc, bootprio_find_named_rom(filename, 0)); } static int ramdisk_copy(struct disk_op_s *op, int iswrite) { u32 offset = GET_GLOBAL(op->drive_g->cntl_id); offset += (u32)op->lba * DISK_SECTOR_SIZE; u64 opd = GDT_DATA | GDT_LIMIT(0xfffff) | GDT_BASE((u32)op->buf_fl); u64 ramd = GDT_DATA | GDT_LIMIT(0xfffff) | GDT_BASE(offset); u64 gdt[6]; if (iswrite) { gdt[2] = opd; gdt[3] = ramd; } else { gdt[2] = ramd; gdt[3] = opd; } // Call int 1587 to copy data. struct bregs br; memset(&br, 0, sizeof(br)); br.flags = F_CF|F_IF; br.ah = 0x87; br.es = GET_SEG(SS); br.si = (u32)gdt; br.cx = op->count * DISK_SECTOR_SIZE / 2; call16_int(0x15, &br); if (br.flags & F_CF) return DISK_RET_EBADTRACK; return DISK_RET_SUCCESS; } int process_ramdisk_op(struct disk_op_s *op) { if (!CONFIG_FLASH_FLOPPY) return 0; switch (op->command) { case CMD_READ: return ramdisk_copy(op, 0); case CMD_WRITE: return ramdisk_copy(op, 1); case CMD_VERIFY: case CMD_FORMAT: case CMD_RESET: return DISK_RET_SUCCESS; default: op->count = 0; return DISK_RET_EPARAM; } } tinyvisor/bios/src/virtio-scsi.h0000644006644000001440000000204012172661303017230 0ustar yuichi_xyusers#ifndef _VIRTIO_SCSI_H #define _VIRTIO_SCSI_H #define VIRTIO_SCSI_CDB_SIZE 32 #define VIRTIO_SCSI_SENSE_SIZE 96 struct virtio_scsi_config { u32 num_queues; u32 seg_max; u32 max_sectors; u32 cmd_per_lun; u32 event_info_size; u32 sense_size; u32 cdb_size; u16 max_channel; u16 max_target; u32 max_lun; } __attribute__((packed)); /* This is the first element of the "out" scatter-gather list. */ struct virtio_scsi_req_cmd { u8 lun[8]; u64 id; u8 task_attr; u8 prio; u8 crn; char cdb[VIRTIO_SCSI_CDB_SIZE]; } __attribute__((packed)); /* This is the first element of the "in" scatter-gather list. */ struct virtio_scsi_resp_cmd { u32 sense_len; u32 residual; u16 status_qualifier; u8 status; u8 response; u8 sense[VIRTIO_SCSI_SENSE_SIZE]; } __attribute__((packed)); #define VIRTIO_SCSI_S_OK 0 struct disk_op_s; int virtio_scsi_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize); void virtio_scsi_setup(void); #endif /* _VIRTIO_SCSI_H */ tinyvisor/bios/src/csm.c0000644006644000001440000002325112172661303015541 0ustar yuichi_xyusers// Compatibility Support Module (CSM) for UEFI / EDK-II // // Copyright © 2013 Intel Corporation // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "config.h" // CONFIG_* #include "csm.h" #include "util.h" // checksum #include "bregs.h" #include "optionroms.h" #include "pci.h" #include "memmap.h" #include "biosvar.h" #include "post.h" #include "acpi.h" #include "boot.h" #include "smbios.h" #include "pic.h" struct rsdp_descriptor csm_rsdp VARFSEG __aligned(16); EFI_COMPATIBILITY16_TABLE csm_compat_table VARFSEG __aligned(16) = { .Signature = 0x24454649, .TableChecksum = 0 /* Filled in by checkrom.py */, .TableLength = sizeof(csm_compat_table), .Compatibility16CallSegment = SEG_BIOS, .Compatibility16CallOffset = 0 /* Filled in by checkrom.py */, .OemIdStringPointer = (u32)"SeaBIOS", .AcpiRsdPtrPointer = (u32)&csm_rsdp, }; EFI_TO_COMPATIBILITY16_INIT_TABLE *csm_init_table; EFI_TO_COMPATIBILITY16_BOOT_TABLE *csm_boot_table; extern void __csm_return(struct bregs *regs) __noreturn; static void csm_return(struct bregs *regs) { dprintf(3, "handle_csm returning AX=%04x\n", regs->ax); pic_save_mask(); __csm_return(regs); } static void csm_maininit(struct bregs *regs) { interface_init(); pci_probe_devices(); csm_compat_table.PnPInstallationCheckSegment = SEG_BIOS; csm_compat_table.PnPInstallationCheckOffset = get_pnp_offset(); regs->ax = 0; csm_return(regs); } /* Legacy16InitializeYourself */ static void handle_csm_0000(struct bregs *regs) { dprintf(3, "Legacy16InitializeYourself table %04x:%04x\n", regs->es, regs->bx); csm_init_table = MAKE_FLATPTR(regs->es, regs->bx); dprintf(3, "BiosLessThan1MB %08x\n", csm_init_table->BiosLessThan1MB); dprintf(3, "HiPmmMemory %08x\n", csm_init_table->HiPmmMemory); dprintf(3, "HiPmmMemorySize %08x\n", csm_init_table->HiPmmMemorySizeInBytes); dprintf(3, "ReverseThunk %04x:%04x\n", csm_init_table->ReverseThunkCallSegment, csm_init_table->ReverseThunkCallOffset); dprintf(3, "NumE820Entries %08x\n", csm_init_table->NumberE820Entries); dprintf(3, "OsMemoryAbove1M %08x\n", csm_init_table->OsMemoryAbove1Mb); dprintf(3, "ThunkStart %08x\n", csm_init_table->ThunkStart); dprintf(3, "ThunkSize %08x\n", csm_init_table->ThunkSizeInBytes); dprintf(3, "LoPmmMemory %08x\n", csm_init_table->LowPmmMemory); dprintf(3, "LoPmmMemorySize %08x\n", csm_init_table->LowPmmMemorySizeInBytes); csm_malloc_preinit(csm_init_table->LowPmmMemory, csm_init_table->LowPmmMemorySizeInBytes, csm_init_table->HiPmmMemory, csm_init_table->HiPmmMemorySizeInBytes); reloc_preinit(csm_maininit, regs); } /* Legacy16UpdateBbs */ static void handle_csm_0001(struct bregs *regs) { if (!CONFIG_BOOT) { regs->ax = 1; return; } dprintf(3, "Legacy16UpdateBbs table %04x:%04x\n", regs->es, regs->bx); csm_boot_table = MAKE_FLATPTR(regs->es, regs->bx); dprintf(3, "MajorVersion %04x\n", csm_boot_table->MajorVersion); dprintf(3, "MinorVersion %04x\n", csm_boot_table->MinorVersion); dprintf(3, "AcpiTable %08x\n", csm_boot_table->AcpiTable); dprintf(3, "SmbiosTable %08x\n", csm_boot_table->SmbiosTable); dprintf(3, "SmbiosTableLength %08x\n", csm_boot_table->SmbiosTableLength); // dprintf(3, "SioData %08x\n", csm_boot_table->SioData); dprintf(3, "DevicePathType %04x\n", csm_boot_table->DevicePathType); dprintf(3, "PciIrqMask %04x\n", csm_boot_table->PciIrqMask); dprintf(3, "NumberE820Entries %08x\n", csm_boot_table->NumberE820Entries); // dprintf(3, "HddInfo %08x\n", csm_boot_table->HddInfo); dprintf(3, "NumberBbsEntries %08x\n", csm_boot_table->NumberBbsEntries); dprintf(3, "BBsTable %08x\n", csm_boot_table->BbsTable); dprintf(3, "SmmTable %08x\n", csm_boot_table->SmmTable); dprintf(3, "OsMemoryAbove1Mb %08x\n", csm_boot_table->OsMemoryAbove1Mb); dprintf(3, "UnconventionalDeviceTable %08x\n", csm_boot_table->UnconventionalDeviceTable); regs->ax = 0; } /* PrepareToBoot */ static void handle_csm_0002(struct bregs *regs) { if (!CONFIG_BOOT) { regs->ax = 1; return; } dprintf(3, "PrepareToBoot table %04x:%04x\n", regs->es, regs->bx); struct e820entry *p = (void *)csm_compat_table.E820Pointer; int i; for (i=0; i < csm_compat_table.E820Length / sizeof(struct e820entry); i++) add_e820(p[i].start, p[i].size, p[i].type); if (csm_init_table->HiPmmMemorySizeInBytes > BUILD_MAX_HIGHTABLE) { u32 hi_pmm_end = csm_init_table->HiPmmMemory + csm_init_table->HiPmmMemorySizeInBytes; add_e820(hi_pmm_end - BUILD_MAX_HIGHTABLE, BUILD_MAX_HIGHTABLE, E820_RESERVED); } // For PCIBIOS 1ab10e if (csm_compat_table.IrqRoutingTablePointer && csm_compat_table.IrqRoutingTableLength) { PirAddr = (void *)csm_compat_table.IrqRoutingTablePointer; dprintf(3, "CSM PIRQ table at %p\n", PirAddr); } // For find_resume_vector()... and find_acpi_features() if (csm_rsdp.signature == RSDP_SIGNATURE) { RsdpAddr = &csm_rsdp; dprintf(3, "CSM ACPI RSDP at %p\n", RsdpAddr); find_acpi_features(); } // SMBIOS table needs to be copied into the f-seg // XX: OVMF doesn't seem to set SmbiosTableLength so don't check it if (csm_boot_table->SmbiosTable && !SMBiosAddr) copy_smbios((void *)csm_boot_table->SmbiosTable); // MPTABLE is just there; we don't care where. // EFI may have reinitialised the video using its *own* driver. enable_vga_console(); // EFI fills this in for us. Zero it for now... struct bios_data_area_s *bda = MAKE_FLATPTR(SEG_BDA, 0); bda->hdcount = 0; timer_setup(); device_hardware_setup(); wait_threads(); interactive_bootmenu(); prepareboot(); regs->ax = 0; } /* Boot */ static void handle_csm_0003(struct bregs *regs) { if (!CONFIG_BOOT) { regs->ax = 1; return; } dprintf(3, "Boot\n"); startBoot(); regs->ax = 1; } /* Legacy16DispatchOprom */ static void handle_csm_0005(struct bregs *regs) { EFI_DISPATCH_OPROM_TABLE *table = MAKE_FLATPTR(regs->es, regs->bx); struct rom_header *rom; u16 bdf; if (!CONFIG_OPTIONROMS) { regs->ax = 1; return; } dprintf(3, "Legacy16DispatchOprom rom %p\n", table); dprintf(3, "OpromSegment %04x\n", table->OpromSegment); dprintf(3, "RuntimeSegment %04x\n", table->RuntimeSegment); dprintf(3, "PnPInstallationCheck %04x:%04x\n", table->PnPInstallationCheckSegment, table->PnPInstallationCheckOffset); dprintf(3, "RuntimeSegment %04x\n", table->RuntimeSegment); rom = MAKE_FLATPTR(table->OpromSegment, 0); bdf = pci_bus_devfn_to_bdf(table->PciBus, table->PciDeviceFunction); rom_reserve(rom->size * 512); // XX PnP seg/ofs should never be other than default callrom(rom, bdf); rom_confirm(rom->size * 512); regs->bx = 0; // FIXME regs->ax = 0; } /* Legacy16GetTableAddress */ static void handle_csm_0006(struct bregs *regs) { u16 size = regs->cx; u16 align = regs->dx; u16 region = regs->bx; // (1 for F000 seg, 2 for E000 seg, 0 for either) void *chunk = NULL; if (!region) region = 3; dprintf(3, "Legacy16GetTableAddress size %x align %x region %d\n", size, align, region); if (region & 2) chunk = pmm_malloc(&ZoneLow, PMM_DEFAULT_HANDLE, size, align); if (!chunk && (region & 1)) chunk = pmm_malloc(&ZoneFSeg, PMM_DEFAULT_HANDLE, size, align); dprintf(3, "Legacy16GetTableAddress size %x align %x region %d yields %p\n", size, align, region, chunk); if (chunk) { regs->ds = FLATPTR_TO_SEG(chunk); regs->bx = FLATPTR_TO_OFFSET(chunk); regs->ax = 0; } else { regs->ax = 1; } } void VISIBLE32INIT handle_csm(struct bregs *regs) { ASSERT32FLAT(); if (!CONFIG_CSM) return; dprintf(3, "handle_csm regs %p AX=%04x\n", regs, regs->ax); pic_restore_mask(); switch(regs->ax) { case 0000: handle_csm_0000(regs); break; case 0001: handle_csm_0001(regs); break; case 0002: handle_csm_0002(regs); break; case 0003: handle_csm_0003(regs); break; // case 0004: handle_csm_0004(regs); break; case 0005: handle_csm_0005(regs); break; case 0006: handle_csm_0006(regs); break; // case 0007: handle_csm_0007(regs); break; // case 0008: hamdle_csm_0008(regs); break; default: regs->al = 1; } csm_return(regs); } int csm_bootprio_ata(struct pci_device *pci, int chanid, int slave) { if (!csm_boot_table) return -1; BBS_TABLE *bbs = (void *)csm_boot_table->BbsTable; int index = 1 + (chanid * 2) + slave; dprintf(3, "CSM bootprio for ATA%d,%d (index %d) is %d\n", chanid, slave, index, bbs[index].BootPriority); return bbs[index].BootPriority; } int csm_bootprio_fdc(struct pci_device *pci, int port, int fdid) { if (!csm_boot_table) return -1; BBS_TABLE *bbs = (void *)csm_boot_table->BbsTable; dprintf(3, "CSM bootprio for FDC is %d\n", bbs[0].BootPriority); return bbs[0].BootPriority; } int csm_bootprio_pci(struct pci_device *pci) { if (!csm_boot_table) return -1; BBS_TABLE *bbs = (void *)csm_boot_table->BbsTable; int i; for (i = 5; i < csm_boot_table->NumberBbsEntries; i++) { if (pci->bdf == pci_to_bdf(bbs[i].Bus, bbs[i].Device, bbs[i].Function)) { dprintf(3, "CSM bootprio for PCI(%d,%d,%d) is %d\n", bbs[i].Bus, bbs[i].Device, bbs[i].Function, bbs[i].BootPriority); return bbs[i].BootPriority; } } return -1; } tinyvisor/bios/src/disk.h0000644006644000001440000001547012172661303015722 0ustar yuichi_xyusers// Definitions for X86 bios disks. // // Copyright (C) 2008 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #ifndef __DISK_H #define __DISK_H #include "types.h" // u8 #include "config.h" // CONFIG_* #include "farptr.h" // struct segoff_s #define DISK_RET_SUCCESS 0x00 #define DISK_RET_EPARAM 0x01 #define DISK_RET_EADDRNOTFOUND 0x02 #define DISK_RET_EWRITEPROTECT 0x03 #define DISK_RET_ECHANGED 0x06 #define DISK_RET_EBOUNDARY 0x09 #define DISK_RET_EBADTRACK 0x0c #define DISK_RET_ECONTROLLER 0x20 #define DISK_RET_ETIMEOUT 0x80 #define DISK_RET_ENOTLOCKED 0xb0 #define DISK_RET_ELOCKED 0xb1 #define DISK_RET_ENOTREMOVABLE 0xb2 #define DISK_RET_ETOOMANYLOCKS 0xb4 #define DISK_RET_EMEDIA 0xC0 #define DISK_RET_ENOTREADY 0xAA /**************************************************************** * Interface structs ****************************************************************/ // Bios disk structures. struct int13ext_s { u8 size; u8 reserved; u16 count; struct segoff_s data; u64 lba; } PACKED; // DPTE definition struct dpte_s { u16 iobase1; u16 iobase2; u8 prefix; u8 unused; u8 irq; u8 blkcount; u8 dma; u8 pio; u16 options; u16 reserved; u8 revision; u8 checksum; }; extern struct dpte_s DefaultDPTE; // Disk Physical Table definition struct int13dpt_s { u16 size; u16 infos; u32 cylinders; u32 heads; u32 spt; u64 sector_count; u16 blksize; struct segoff_s dpte; u16 key; u8 dpi_length; u8 reserved1; u16 reserved2; u8 host_bus[4]; u8 iface_type[8]; u64 iface_path; union { struct { u64 device_path; u8 reserved3; u8 checksum; } phoenix; struct { u64 device_path[2]; u8 reserved3; u8 checksum; } t13; }; } PACKED; // Floppy "Disk Base Table" struct floppy_dbt_s { u8 specify1; u8 specify2; u8 shutoff_ticks; u8 bps_code; u8 sectors; u8 interblock_len; u8 data_len; u8 gap_len; u8 fill_byte; u8 settle_time; u8 startup_time; } PACKED; struct floppy_ext_dbt_s { struct floppy_dbt_s dbt; // Extra fields u8 max_track; u8 data_rate; u8 drive_type; } PACKED; // Helper function for setting up a return code. struct bregs; void __disk_ret(struct bregs *regs, u32 linecode, const char *fname); #define disk_ret(regs, code) \ __disk_ret((regs), (code) | (__LINE__ << 8), __func__) void __disk_ret_unimplemented(struct bregs *regs, u32 linecode , const char *fname); #define disk_ret_unimplemented(regs, code) \ __disk_ret_unimplemented((regs), (code) | (__LINE__ << 8), __func__) /**************************************************************** * Master boot record ****************************************************************/ struct packed_chs_s { u8 heads; u8 sptcyl; u8 cyllow; }; struct partition_s { u8 status; struct packed_chs_s first; u8 type; struct packed_chs_s last; u32 lba; u32 count; } PACKED; struct mbr_s { u8 code[440]; // 0x01b8 u32 diskseg; // 0x01bc u16 null; // 0x01be struct partition_s partitions[4]; // 0x01fe u16 signature; } PACKED; #define MBR_SIGNATURE 0xaa55 /**************************************************************** * Disk command request ****************************************************************/ struct disk_op_s { u64 lba; void *buf_fl; struct drive_s *drive_g; u16 count; u8 command; }; #define CMD_RESET 0x00 #define CMD_READ 0x02 #define CMD_WRITE 0x03 #define CMD_VERIFY 0x04 #define CMD_FORMAT 0x05 #define CMD_SEEK 0x07 #define CMD_ISREADY 0x10 /**************************************************************** * Global storage ****************************************************************/ struct chs_s { u16 heads; // # heads u16 cylinders; // # cylinders u16 spt; // # sectors / track u16 pad; }; // ElTorito Device Emulation data struct cdemu_s { struct drive_s *emulated_drive_gf; u32 ilba; u16 buffer_segment; u16 load_segment; u16 sector_count; u8 active; u8 media; u8 emulated_extdrive; // Virtual device struct chs_s lchs; }; struct drive_s { u8 type; // Driver type (DTYPE_*) u8 floppy_type; // Type of floppy (only for floppy drives). struct chs_s lchs; // Logical CHS u64 sectors; // Total sectors count u32 cntl_id; // Unique id for a given driver type. u8 removable; // Is media removable (currently unused) // Info for EDD calls u8 translation; // type of translation u16 blksize; // block size struct chs_s pchs; // Physical CHS }; #define DISK_SECTOR_SIZE 512 #define CDROM_SECTOR_SIZE 2048 #define DTYPE_NONE 0x00 #define DTYPE_FLOPPY 0x01 #define DTYPE_ATA 0x02 #define DTYPE_ATA_ATAPI 0x03 #define DTYPE_RAMDISK 0x04 #define DTYPE_CDEMU 0x05 #define DTYPE_AHCI 0x06 #define DTYPE_AHCI_ATAPI 0x07 #define DTYPE_VIRTIO_SCSI 0x08 #define DTYPE_VIRTIO_BLK 0x09 #define DTYPE_USB 0x0a #define DTYPE_UAS 0x0b #define DTYPE_LSI_SCSI 0x0c #define DTYPE_ESP_SCSI 0x0d #define DTYPE_MEGASAS 0x0e #define MAXDESCSIZE 80 #define TRANSLATION_NONE 0 #define TRANSLATION_LBA 1 #define TRANSLATION_LARGE 2 #define TRANSLATION_RECHS 3 #define EXTTYPE_FLOPPY 0 #define EXTTYPE_HD 1 #define EXTTYPE_CD 2 #define EXTSTART_HD 0x80 #define EXTSTART_CD 0xE0 /**************************************************************** * Function defs ****************************************************************/ // block.c extern u8 FloppyCount, CDCount; extern u8 *bounce_buf_fl; struct drive_s *getDrive(u8 exttype, u8 extdriveoffset); int getDriveId(u8 exttype, struct drive_s *drive_g); void map_floppy_drive(struct drive_s *drive_g); void map_hd_drive(struct drive_s *drive_g); void map_cd_drive(struct drive_s *drive_g); int process_op(struct disk_op_s *op); int send_disk_op(struct disk_op_s *op); int create_bounce_buf(void); // floppy.c extern struct floppy_ext_dbt_s diskette_param_table2; void floppy_setup(void); struct drive_s *init_floppy(int floppyid, int ftype); int find_floppy_type(u32 size); int process_floppy_op(struct disk_op_s *op); void floppy_tick(void); // cdrom.c extern u8 CDRom_locks[]; extern struct cdemu_s CDEmu; extern struct drive_s *cdemu_drive_gf; int process_cdemu_op(struct disk_op_s *op); void cdrom_prepboot(void); void cdemu_134b(struct bregs *regs); int cdrom_boot(struct drive_s *drive_g); // ramdisk.c void ramdisk_setup(void); int process_ramdisk_op(struct disk_op_s *op); #endif // disk.h tinyvisor/bios/src/smbios.h0000644006644000001440000001013512172661303016255 0ustar yuichi_xyusers#ifndef __SMBIOS_H #define __SMBIOS_H // smbios.c void smbios_setup(void); /* SMBIOS entry point -- must be written to a 16-bit aligned address between 0xf0000 and 0xfffff. */ struct smbios_entry_point { char anchor_string[4]; u8 checksum; u8 length; u8 smbios_major_version; u8 smbios_minor_version; u16 max_structure_size; u8 entry_point_revision; u8 formatted_area[5]; char intermediate_anchor_string[5]; u8 intermediate_checksum; u16 structure_table_length; u32 structure_table_address; u16 number_of_structures; u8 smbios_bcd_revision; } PACKED; extern struct smbios_entry_point *SMBiosAddr; /* This goes at the beginning of every SMBIOS structure. */ struct smbios_structure_header { u8 type; u8 length; u16 handle; } PACKED; /* SMBIOS type 0 - BIOS Information */ struct smbios_type_0 { struct smbios_structure_header header; u8 vendor_str; u8 bios_version_str; u16 bios_starting_address_segment; u8 bios_release_date_str; u8 bios_rom_size; u8 bios_characteristics[8]; u8 bios_characteristics_extension_bytes[2]; u8 system_bios_major_release; u8 system_bios_minor_release; u8 embedded_controller_major_release; u8 embedded_controller_minor_release; } PACKED; /* SMBIOS type 1 - System Information */ struct smbios_type_1 { struct smbios_structure_header header; u8 manufacturer_str; u8 product_name_str; u8 version_str; u8 serial_number_str; u8 uuid[16]; u8 wake_up_type; u8 sku_number_str; u8 family_str; } PACKED; /* SMBIOS type 3 - System Enclosure (v2.3) */ struct smbios_type_3 { struct smbios_structure_header header; u8 manufacturer_str; u8 type; u8 version_str; u8 serial_number_str; u8 asset_tag_number_str; u8 boot_up_state; u8 power_supply_state; u8 thermal_state; u8 security_status; u32 oem_defined; u8 height; u8 number_of_power_cords; u8 contained_element_count; // contained elements follow } PACKED; /* SMBIOS type 4 - Processor Information (v2.0) */ struct smbios_type_4 { struct smbios_structure_header header; u8 socket_designation_str; u8 processor_type; u8 processor_family; u8 processor_manufacturer_str; u32 processor_id[2]; u8 processor_version_str; u8 voltage; u16 external_clock; u16 max_speed; u16 current_speed; u8 status; u8 processor_upgrade; u16 l1_cache_handle; u16 l2_cache_handle; u16 l3_cache_handle; } PACKED; /* SMBIOS type 16 - Physical Memory Array * Associated with one type 17 (Memory Device). */ struct smbios_type_16 { struct smbios_structure_header header; u8 location; u8 use; u8 error_correction; u32 maximum_capacity; u16 memory_error_information_handle; u16 number_of_memory_devices; } PACKED; /* SMBIOS type 17 - Memory Device * Associated with one type 19 */ struct smbios_type_17 { struct smbios_structure_header header; u16 physical_memory_array_handle; u16 memory_error_information_handle; u16 total_width; u16 data_width; u16 size; u8 form_factor; u8 device_set; u8 device_locator_str; u8 bank_locator_str; u8 memory_type; u16 type_detail; } PACKED; /* SMBIOS type 19 - Memory Array Mapped Address */ struct smbios_type_19 { struct smbios_structure_header header; u32 starting_address; u32 ending_address; u16 memory_array_handle; u8 partition_width; } PACKED; /* SMBIOS type 20 - Memory Device Mapped Address */ struct smbios_type_20 { struct smbios_structure_header header; u32 starting_address; u32 ending_address; u16 memory_device_handle; u16 memory_array_mapped_address_handle; u8 partition_row_position; u8 interleave_position; u8 interleaved_data_depth; } PACKED; /* SMBIOS type 32 - System Boot Information */ struct smbios_type_32 { struct smbios_structure_header header; u8 reserved[6]; u8 boot_status; } PACKED; /* SMBIOS type 127 -- End-of-table */ struct smbios_type_127 { struct smbios_structure_header header; } PACKED; void display_uuid(void); #endif // smbios.h tinyvisor/bios/src/output.c0000644006644000001440000003501112172661303016314 0ustar yuichi_xyusers// Raw screen writing and debug output code. // // Copyright (C) 2008,2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include // va_list #include "farptr.h" // GET_VAR #include "util.h" // printf #include "bregs.h" // struct bregs #include "config.h" // CONFIG_* #include "biosvar.h" // GET_GLOBAL #include "paravirt.h" // PlatformRunningOn struct putcinfo { void (*func)(struct putcinfo *info, char c); }; /**************************************************************** * Debug output ****************************************************************/ #define DEBUG_TIMEOUT 100000 u16 DebugOutputPort VARFSEG = 0x402; void debug_serial_preinit(void) { if (!CONFIG_DEBUG_SERIAL) return; // setup for serial logging: 8N1 u8 oldparam, newparam = 0x03; oldparam = inb(CONFIG_DEBUG_SERIAL_PORT+SEROFF_LCR); outb(newparam, CONFIG_DEBUG_SERIAL_PORT+SEROFF_LCR); // Disable irqs u8 oldier, newier = 0; oldier = inb(CONFIG_DEBUG_SERIAL_PORT+SEROFF_IER); outb(newier, CONFIG_DEBUG_SERIAL_PORT+SEROFF_IER); if (oldparam != newparam || oldier != newier) dprintf(1, "Changing serial settings was %x/%x now %x/%x\n" , oldparam, oldier, newparam, newier); } // Write a character to the serial port. static void debug_serial(char c) { if (!CONFIG_DEBUG_SERIAL) return; int timeout = DEBUG_TIMEOUT; while ((inb(CONFIG_DEBUG_SERIAL_PORT+SEROFF_LSR) & 0x20) != 0x20) if (!timeout--) // Ran out of time. return; outb(c, CONFIG_DEBUG_SERIAL_PORT+SEROFF_DATA); } // Make sure all serial port writes have been completely sent. static void debug_serial_flush(void) { if (!CONFIG_DEBUG_SERIAL) return; int timeout = DEBUG_TIMEOUT; while ((inb(CONFIG_DEBUG_SERIAL_PORT+SEROFF_LSR) & 0x60) != 0x60) if (!timeout--) // Ran out of time. return; } // Write a character to debug port(s). static void putc_debug(struct putcinfo *action, char c) { if (! CONFIG_DEBUG_LEVEL) return; if (CONFIG_DEBUG_IO && runningOnQEMU()) // Send character to debug port. outb(c, GET_GLOBAL(DebugOutputPort)); if (c == '\n') debug_serial('\r'); debug_serial(c); } // In segmented mode just need a dummy variable (putc_debug is always // used anyway), and in 32bit flat mode need a pointer to the 32bit // instance of putc_debug(). #if MODE16 static struct putcinfo debuginfo VAR16; #elif MODESEGMENT static struct putcinfo debuginfo VAR32SEG; #else static struct putcinfo debuginfo = { putc_debug }; #endif /**************************************************************** * Screen writing ****************************************************************/ // Show a character on the screen. static void screenc(char c) { struct bregs br; memset(&br, 0, sizeof(br)); br.flags = F_IF; br.ah = 0x0e; br.al = c; call16_int(0x10, &br); } // Handle a character from a printf request. static void putc_screen(struct putcinfo *action, char c) { if (ScreenAndDebug) putc_debug(&debuginfo, c); if (c == '\n') screenc('\r'); screenc(c); } static struct putcinfo screeninfo = { putc_screen }; /**************************************************************** * Xprintf code ****************************************************************/ // Output a character. static void putc(struct putcinfo *action, char c) { if (MODESEGMENT) { // Only debugging output supported in segmented mode. putc_debug(action, c); return; } void (*func)(struct putcinfo *info, char c) = GET_GLOBAL(action->func); func(action, c); } // Ouptut a string. static void puts(struct putcinfo *action, const char *s) { if (!MODESEGMENT && !s) s = "(NULL)"; for (; *s; s++) putc(action, *s); } // Output a string that is in the CS segment. static void puts_cs(struct putcinfo *action, const char *s) { char *vs = (char*)s; for (;; vs++) { char c = GET_GLOBAL(*vs); if (!c) break; putc(action, c); } } // Output an unsigned integer. static void putuint(struct putcinfo *action, u32 val) { char buf[12]; char *d = &buf[sizeof(buf) - 1]; *d-- = '\0'; for (;;) { *d = (val % 10) + '0'; val /= 10; if (!val) break; d--; } puts(action, d); } // Output a single digit hex character. static inline void putsinglehex(struct putcinfo *action, u32 val) { if (val <= 9) val = '0' + val; else val = 'a' + val - 10; putc(action, val); } // Output an integer in hexadecimal with a specified width. static void puthex(struct putcinfo *action, u32 val, int width) { switch (width) { default: putsinglehex(action, (val >> 28) & 0xf); case 7: putsinglehex(action, (val >> 24) & 0xf); case 6: putsinglehex(action, (val >> 20) & 0xf); case 5: putsinglehex(action, (val >> 16) & 0xf); case 4: putsinglehex(action, (val >> 12) & 0xf); case 3: putsinglehex(action, (val >> 8) & 0xf); case 2: putsinglehex(action, (val >> 4) & 0xf); case 1: putsinglehex(action, (val >> 0) & 0xf); } } // Output an integer in hexadecimal with a minimum width. static void putprettyhex(struct putcinfo *action, u32 val, int width, char padchar) { u32 tmp = val; int count = 1; while (tmp >>= 4) count++; width -= count; while (width-- > 0) putc(action, padchar); puthex(action, val, count); } static inline int isdigit(u8 c) { return ((u8)(c - '0')) < 10; } static void bvprintf(struct putcinfo *action, const char *fmt, va_list args) { const char *s = fmt; for (;; s++) { char c = GET_GLOBAL(*(u8*)s); if (!c) break; if (c != '%') { putc(action, c); continue; } const char *n = s+1; int field_width = 0; char padchar = ' '; u8 is64 = 0; for (;;) { c = GET_GLOBAL(*(u8*)n); if (!isdigit(c)) break; if (!field_width && (c == '0')) padchar = '0'; else field_width = field_width * 10 + c - '0'; n++; } if (c == 'l') { // Ignore long format indicator n++; c = GET_GLOBAL(*(u8*)n); } if (c == 'l') { is64 = 1; n++; c = GET_GLOBAL(*(u8*)n); } s32 val; const char *sarg; switch (c) { case '%': putc(action, '%'); break; case 'd': val = va_arg(args, s32); if (is64) va_arg(args, s32); if (val < 0) { putc(action, '-'); val = -val; } putuint(action, val); break; case 'u': val = va_arg(args, s32); if (is64) va_arg(args, s32); putuint(action, val); break; case 'p': val = va_arg(args, s32); putc(action, '0'); putc(action, 'x'); puthex(action, val, 8); break; case 'x': val = va_arg(args, s32); if (is64) { u32 upper = va_arg(args, s32); if (upper) { putprettyhex(action, upper, field_width - 8, padchar); puthex(action, val, 8); break; } } putprettyhex(action, val, field_width, padchar); break; case 'c': val = va_arg(args, int); putc(action, val); break; case '.': // Hack to support "%.s" - meaning string on stack. if (GET_GLOBAL(*(u8*)(n+1)) != 's') break; n++; sarg = va_arg(args, const char *); puts(action, sarg); break; case 's': sarg = va_arg(args, const char *); puts_cs(action, sarg); break; default: putc(action, '%'); n = s; } s = n; } } void panic(const char *fmt, ...) { if (CONFIG_DEBUG_LEVEL) { va_list args; va_start(args, fmt); bvprintf(&debuginfo, fmt, args); va_end(args); debug_serial_flush(); } // XXX - use PANIC PORT. irq_disable(); for (;;) hlt(); } void __dprintf(const char *fmt, ...) { if (!MODESEGMENT && CONFIG_THREADS && CONFIG_DEBUG_LEVEL >= DEBUG_thread && *fmt != '\\' && *fmt != '/') { struct thread_info *cur = getCurThread(); if (cur != &MainThread) { // Show "thread id" for this debug message. putc_debug(&debuginfo, '|'); puthex(&debuginfo, (u32)cur, 8); putc_debug(&debuginfo, '|'); putc_debug(&debuginfo, ' '); } } va_list args; va_start(args, fmt); bvprintf(&debuginfo, fmt, args); va_end(args); debug_serial_flush(); } void printf(const char *fmt, ...) { ASSERT32FLAT(); va_list args; va_start(args, fmt); bvprintf(&screeninfo, fmt, args); va_end(args); if (ScreenAndDebug) debug_serial_flush(); } /**************************************************************** * snprintf ****************************************************************/ struct snprintfinfo { struct putcinfo info; char *str, *end; }; static void putc_str(struct putcinfo *info, char c) { struct snprintfinfo *sinfo = container_of(info, struct snprintfinfo, info); if (sinfo->str >= sinfo->end) return; *sinfo->str = c; sinfo->str++; } // Build a formatted string. Note, this function returns the actual // number of bytes used (not including null) even in the overflow // case. int snprintf(char *str, size_t size, const char *fmt, ...) { ASSERT32FLAT(); if (!size) return 0; struct snprintfinfo sinfo = { { putc_str }, str, str + size }; va_list args; va_start(args, fmt); bvprintf(&sinfo.info, fmt, args); va_end(args); char *end = sinfo.str; if (end >= sinfo.end) end = sinfo.end - 1; *end = '\0'; return end - str; } // Build a formatted string - malloc'ing the memory. char * znprintf(size_t size, const char *fmt, ...) { ASSERT32FLAT(); if (!size) return NULL; char *str = malloc_tmp(size); if (!str) { warn_noalloc(); return NULL; } struct snprintfinfo sinfo = { { putc_str }, str, str + size }; va_list args; va_start(args, fmt); bvprintf(&sinfo.info, fmt, args); va_end(args); char *end = sinfo.str; if (end >= sinfo.end) end = sinfo.end - 1; *end = '\0'; return str; } /**************************************************************** * Misc helpers ****************************************************************/ void hexdump(const void *d, int len) { int count=0; while (len > 0) { if (count % 8 == 0) { putc(&debuginfo, '\n'); puthex(&debuginfo, count*4, 8); putc(&debuginfo, ':'); } else { putc(&debuginfo, ' '); } puthex(&debuginfo, *(u32*)d, 8); count++; len-=4; d+=4; } putc(&debuginfo, '\n'); debug_serial_flush(); } static void dump_regs(struct bregs *regs) { if (!regs) { dprintf(1, " NULL\n"); return; } dprintf(1, " a=%08x b=%08x c=%08x d=%08x ds=%04x es=%04x ss=%04x\n" , regs->eax, regs->ebx, regs->ecx, regs->edx , regs->ds, regs->es, GET_SEG(SS)); dprintf(1, " si=%08x di=%08x bp=%08x sp=%08x cs=%04x ip=%04x f=%04x\n" , regs->esi, regs->edi, regs->ebp, (u32)®s[1] , regs->code.seg, regs->code.offset, regs->flags); } // Report entry to an Interrupt Service Routine (ISR). void __debug_isr(const char *fname) { puts_cs(&debuginfo, fname); putc(&debuginfo, '\n'); debug_serial_flush(); } // Function called on handler startup. void __debug_enter(struct bregs *regs, const char *fname) { dprintf(1, "enter %s:\n", fname); dump_regs(regs); } // Send debugging output info. void __debug_stub(struct bregs *regs, int lineno, const char *fname) { dprintf(1, "stub %s:%d:\n", fname, lineno); dump_regs(regs); } // Report on an invalid parameter. void __warn_invalid(struct bregs *regs, int lineno, const char *fname) { if (CONFIG_DEBUG_LEVEL >= DEBUG_invalid) { dprintf(1, "invalid %s:%d:\n", fname, lineno); dump_regs(regs); } } // Report on an unimplemented feature. void __warn_unimplemented(struct bregs *regs, int lineno, const char *fname) { if (CONFIG_DEBUG_LEVEL >= DEBUG_unimplemented) { dprintf(1, "unimplemented %s:%d:\n", fname, lineno); dump_regs(regs); } } // Report a detected internal inconsistency. void __warn_internalerror(int lineno, const char *fname) { dprintf(1, "WARNING - internal error detected at %s:%d!\n" , fname, lineno); } // Report on an allocation failure. void __warn_noalloc(int lineno, const char *fname) { dprintf(1, "WARNING - Unable to allocate resource at %s:%d!\n" , fname, lineno); } // Report on a timeout exceeded. void __warn_timeout(int lineno, const char *fname) { dprintf(1, "WARNING - Timeout at %s:%d!\n", fname, lineno); } // Report a handler reporting an invalid parameter to the caller. void __set_invalid(struct bregs *regs, int lineno, const char *fname) { __warn_invalid(regs, lineno, fname); set_invalid_silent(regs); } // Report a call of an unimplemented function. void __set_unimplemented(struct bregs *regs, int lineno, const char *fname) { __warn_unimplemented(regs, lineno, fname); set_invalid_silent(regs); } // Report a handler reporting an invalid parameter code to the // caller. Note, the lineno and return code are encoded in the same // parameter as gcc does a better job of scheduling function calls // when there are 3 or less parameters. void __set_code_invalid(struct bregs *regs, u32 linecode, const char *fname) { u8 code = linecode; u32 lineno = linecode >> 8; __warn_invalid(regs, lineno, fname); set_code_invalid_silent(regs, code); } // Report a call of an unimplemented function. void __set_code_unimplemented(struct bregs *regs, u32 linecode, const char *fname) { u8 code = linecode; u32 lineno = linecode >> 8; __warn_unimplemented(regs, lineno, fname); set_code_invalid_silent(regs, code); } tinyvisor/bios/src/asm-offsets.c0000644006644000001440000000122212172661303017200 0ustar yuichi_xyusers// Generate assembler offsets. #include "gen-defs.h" // OFFSET #include "bregs.h" // struct bregs /* workaround for a warning with -Wmissing-prototypes */ void foo(void) VISIBLE16; void foo(void) { COMMENT("BREGS"); OFFSET(BREGS_es, bregs, es); OFFSET(BREGS_ds, bregs, ds); OFFSET(BREGS_eax, bregs, eax); OFFSET(BREGS_ebx, bregs, ebx); OFFSET(BREGS_ecx, bregs, ecx); OFFSET(BREGS_edx, bregs, edx); OFFSET(BREGS_ebp, bregs, ebp); OFFSET(BREGS_esi, bregs, esi); OFFSET(BREGS_edi, bregs, edi); OFFSET(BREGS_flags, bregs, flags); OFFSET(BREGS_code, bregs, code); DEFINE(BREGS_size, sizeof(struct bregs)); } tinyvisor/bios/src/virtio-ring.h0000644006644000001440000000617111733243570017243 0ustar yuichi_xyusers#ifndef _VIRTIO_RING_H #define _VIRTIO_RING_H #include "types.h" // u64 #include "memmap.h" // PAGE_SIZE #define PAGE_SHIFT 12 #define PAGE_MASK (PAGE_SIZE-1) #define virt_to_phys(v) (unsigned long)(v) #define phys_to_virt(p) (void*)(p) /* Compiler barrier is enough as an x86 CPU does not reorder reads or writes */ #define smp_rmb() barrier() #define smp_wmb() barrier() /* Status byte for guest to report progress, and synchronize features. */ /* We have seen device and processed generic fields (VIRTIO_CONFIG_F_VIRTIO) */ #define VIRTIO_CONFIG_S_ACKNOWLEDGE 1 /* We have found a driver for the device. */ #define VIRTIO_CONFIG_S_DRIVER 2 /* Driver has used its parts of the config, and is happy */ #define VIRTIO_CONFIG_S_DRIVER_OK 4 /* We've given up on this device. */ #define VIRTIO_CONFIG_S_FAILED 0x80 #define MAX_QUEUE_NUM (128) #define VRING_DESC_F_NEXT 1 #define VRING_DESC_F_WRITE 2 #define VRING_AVAIL_F_NO_INTERRUPT 1 #define VRING_USED_F_NO_NOTIFY 1 struct vring_desc { u64 addr; u32 len; u16 flags; u16 next; }; struct vring_avail { u16 flags; u16 idx; u16 ring[0]; }; struct vring_used_elem { u32 id; u32 len; }; struct vring_used { u16 flags; u16 idx; struct vring_used_elem ring[]; }; struct vring { unsigned int num; struct vring_desc *desc; struct vring_avail *avail; struct vring_used *used; }; #define vring_size(num) \ (((((sizeof(struct vring_desc) * num) + \ (sizeof(struct vring_avail) + sizeof(u16) * num)) \ + PAGE_MASK) & ~PAGE_MASK) + \ (sizeof(struct vring_used) + sizeof(struct vring_used_elem) * num)) typedef unsigned char virtio_queue_t[vring_size(MAX_QUEUE_NUM)]; struct vring_virtqueue { virtio_queue_t queue; struct vring vring; u16 free_head; u16 last_used_idx; u16 vdata[MAX_QUEUE_NUM]; /* PCI */ int queue_index; }; struct vring_list { char *addr; unsigned int length; }; static inline void vring_init(struct vring *vr, unsigned int num, unsigned char *queue) { unsigned int i; unsigned long pa; ASSERT32FLAT(); vr->num = num; /* physical address of desc must be page aligned */ pa = virt_to_phys(queue); pa = (pa + PAGE_MASK) & ~PAGE_MASK; vr->desc = phys_to_virt(pa); vr->avail = (struct vring_avail *)&vr->desc[num]; /* disable interrupts */ vr->avail->flags |= VRING_AVAIL_F_NO_INTERRUPT; /* physical address of used must be page aligned */ pa = virt_to_phys(&vr->avail->ring[num]); pa = (pa + PAGE_MASK) & ~PAGE_MASK; vr->used = phys_to_virt(pa); for (i = 0; i < num - 1; i++) vr->desc[i].next = i + 1; vr->desc[i].next = 0; } int vring_more_used(struct vring_virtqueue *vq); void vring_detach(struct vring_virtqueue *vq, unsigned int head); int vring_get_buf(struct vring_virtqueue *vq, unsigned int *len); void vring_add_buf(struct vring_virtqueue *vq, struct vring_list list[], unsigned int out, unsigned int in, int index, int num_added); void vring_kick(unsigned int ioaddr, struct vring_virtqueue *vq, int num_added); #endif /* _VIRTIO_RING_H_ */ tinyvisor/bios/src/bregs.h0000644006644000001440000000417112172661303016066 0ustar yuichi_xyusers// Structure layout of cpu registers the the bios uses. // // Copyright (C) 2008 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #ifndef __BREGS_H #define __BREGS_H // CPU flag bitdefs #define F_CF (1<<0) #define F_ZF (1<<6) #define F_IF (1<<9) #define F_ID (1<<21) // CR0 flags #define CR0_PG (1<<31) // Paging #define CR0_CD (1<<30) // Cache disable #define CR0_NW (1<<29) // Not Write-through #define CR0_PE (1<<0) // Protection enable #ifndef __ASSEMBLY__ #include "farptr.h" // struct segoff_s /**************************************************************** * Registers saved/restored in romlayout.S ****************************************************************/ #include "types.h" // u16 #define UREG(ER, R, RH, RL) union { u32 ER; struct { u16 R; u16 R ## _hi; }; struct { u8 RL; u8 RH; u8 R ## _hilo; u8 R ## _hihi; }; } // Layout of registers passed in to irq handlers. Note that this // layout corresponds to code in romlayout.S - don't change it here // without also updating the assembler code. struct bregs { u16 ds; u16 es; UREG(edi, di, di8u, di8l); UREG(esi, si, si8u, si8l); UREG(ebp, bp, bp8u, bp8l); UREG(ebx, bx, bh, bl); UREG(edx, dx, dh, dl); UREG(ecx, cx, ch, cl); UREG(eax, ax, ah, al); struct segoff_s code; u16 flags; } PACKED; /**************************************************************** * Helper functions ****************************************************************/ static inline void set_cf(struct bregs *regs, int cond) { if (cond) regs->flags |= F_CF; else regs->flags &= ~F_CF; } // Frequently used return codes #define RET_EUNSUPPORTED 0x86 static inline void set_success(struct bregs *regs) { set_cf(regs, 0); } static inline void set_code_success(struct bregs *regs) { regs->ah = 0; set_cf(regs, 0); } static inline void set_invalid_silent(struct bregs *regs) { set_cf(regs, 1); } static inline void set_code_invalid_silent(struct bregs *regs, u8 code) { regs->ah = code; set_cf(regs, 1); } #endif // !__ASSEMBLY__ #endif // bregs.h tinyvisor/bios/src/cdrom.c0000644006644000001440000002111312172661303016056 0ustar yuichi_xyusers// Support for booting from cdroms (the "El Torito" spec). // // Copyright (C) 2008,2009 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "disk.h" // cdrom_13 #include "util.h" // memset #include "bregs.h" // struct bregs #include "biosvar.h" // GET_GLOBAL #include "ata.h" // ATA_CMD_REQUEST_SENSE #include "blockcmd.h" // CDB_CMD_REQUEST_SENSE // Locks for removable devices u8 CDRom_locks[BUILD_MAX_EXTDRIVE] VARLOW; /**************************************************************** * CD emulation ****************************************************************/ struct cdemu_s CDEmu VARLOW; struct drive_s *cdemu_drive_gf VARFSEG; static int cdemu_read(struct disk_op_s *op) { struct drive_s *drive_g; drive_g = GLOBALFLAT2GLOBAL(GET_LOW(CDEmu.emulated_drive_gf)); struct disk_op_s dop; dop.drive_g = drive_g; dop.command = op->command; dop.lba = GET_LOW(CDEmu.ilba) + op->lba / 4; int count = op->count; op->count = 0; u8 *cdbuf_fl = GET_GLOBAL(bounce_buf_fl); if (op->lba & 3) { // Partial read of first block. dop.count = 1; dop.buf_fl = cdbuf_fl; int ret = process_op(&dop); if (ret) return ret; u8 thiscount = 4 - (op->lba & 3); if (thiscount > count) thiscount = count; count -= thiscount; memcpy_fl(op->buf_fl, cdbuf_fl + (op->lba & 3) * 512, thiscount * 512); op->buf_fl += thiscount * 512; op->count += thiscount; dop.lba++; } if (count > 3) { // Read n number of regular blocks. dop.count = count / 4; dop.buf_fl = op->buf_fl; int ret = process_op(&dop); op->count += dop.count * 4; if (ret) return ret; u8 thiscount = count & ~3; count &= 3; op->buf_fl += thiscount * 512; dop.lba += thiscount / 4; } if (count) { // Partial read on last block. dop.count = 1; dop.buf_fl = cdbuf_fl; int ret = process_op(&dop); if (ret) return ret; u8 thiscount = count; memcpy_fl(op->buf_fl, cdbuf_fl, thiscount * 512); op->count += thiscount; } return DISK_RET_SUCCESS; } int process_cdemu_op(struct disk_op_s *op) { if (!CONFIG_CDROM_EMU) return 0; switch (op->command) { case CMD_READ: return cdemu_read(op); case CMD_WRITE: case CMD_FORMAT: return DISK_RET_EWRITEPROTECT; case CMD_VERIFY: case CMD_RESET: case CMD_SEEK: case CMD_ISREADY: return DISK_RET_SUCCESS; default: op->count = 0; return DISK_RET_EPARAM; } } void cdrom_prepboot(void) { if (!CONFIG_CDROM_EMU) return; if (!CDCount) return; if (create_bounce_buf() < 0) return; struct drive_s *drive_g = malloc_fseg(sizeof(*drive_g)); if (!drive_g) { warn_noalloc(); free(drive_g); return; } cdemu_drive_gf = drive_g; memset(drive_g, 0, sizeof(*drive_g)); drive_g->type = DTYPE_CDEMU; drive_g->blksize = DISK_SECTOR_SIZE; drive_g->sectors = (u64)-1; } struct eltorito_s { u8 size; u8 media; u8 emulated_drive; u8 controller_index; u32 ilba; u16 device_spec; u16 buffer_segment; u16 load_segment; u16 sector_count; u8 cylinders; u8 sectors; u8 heads; }; #define SET_INT13ET(regs,var,val) \ SET_FARVAR((regs)->ds, ((struct eltorito_s*)((regs)->si+0))->var, (val)) // ElTorito - Terminate disk emu void cdemu_134b(struct bregs *regs) { // FIXME ElTorito Hardcoded SET_INT13ET(regs, size, 0x13); SET_INT13ET(regs, media, GET_LOW(CDEmu.media)); SET_INT13ET(regs, emulated_drive, GET_LOW(CDEmu.emulated_extdrive)); struct drive_s *drive_gf = GET_LOW(CDEmu.emulated_drive_gf); u8 cntl_id = 0; if (drive_gf) cntl_id = GET_GLOBALFLAT(drive_gf->cntl_id); SET_INT13ET(regs, controller_index, cntl_id / 2); SET_INT13ET(regs, device_spec, cntl_id % 2); SET_INT13ET(regs, ilba, GET_LOW(CDEmu.ilba)); SET_INT13ET(regs, buffer_segment, GET_LOW(CDEmu.buffer_segment)); SET_INT13ET(regs, load_segment, GET_LOW(CDEmu.load_segment)); SET_INT13ET(regs, sector_count, GET_LOW(CDEmu.sector_count)); SET_INT13ET(regs, cylinders, GET_LOW(CDEmu.lchs.cylinders)); SET_INT13ET(regs, sectors, GET_LOW(CDEmu.lchs.spt)); SET_INT13ET(regs, heads, GET_LOW(CDEmu.lchs.heads)); // If we have to terminate emulation if (regs->al == 0x00) { // FIXME ElTorito Various. Should be handled accordingly to spec SET_LOW(CDEmu.active, 0x00); // bye bye // XXX - update floppy/hd count. } disk_ret(regs, DISK_RET_SUCCESS); } /**************************************************************** * CD booting ****************************************************************/ int cdrom_boot(struct drive_s *drive_g) { ASSERT32FLAT(); struct disk_op_s dop; int cdid = getDriveId(EXTTYPE_CD, drive_g); memset(&dop, 0, sizeof(dop)); dop.drive_g = drive_g; if (!dop.drive_g || cdid < 0) return 1; int ret = scsi_is_ready(&dop); if (ret) dprintf(1, "scsi_is_ready returned %d\n", ret); // Read the Boot Record Volume Descriptor u8 buffer[CDROM_SECTOR_SIZE]; dop.lba = 0x11; dop.count = 1; dop.buf_fl = buffer; ret = cdb_read(&dop); if (ret) return 3; // Validity checks if (buffer[0]) return 4; if (strcmp((char*)&buffer[1], "CD001\001EL TORITO SPECIFICATION") != 0) return 5; // ok, now we calculate the Boot catalog address u32 lba = *(u32*)&buffer[0x47]; // And we read the Boot Catalog dop.lba = lba; dop.count = 1; ret = cdb_read(&dop); if (ret) return 7; // Validation entry if (buffer[0x00] != 0x01) return 8; // Header if (buffer[0x01] != 0x00) return 9; // Platform if (buffer[0x1E] != 0x55) return 10; // key 1 if (buffer[0x1F] != 0xAA) return 10; // key 2 // Initial/Default Entry if (buffer[0x20] != 0x88) return 11; // Bootable u8 media = buffer[0x21]; CDEmu.media = media; CDEmu.emulated_drive_gf = dop.drive_g; u16 boot_segment = *(u16*)&buffer[0x22]; if (!boot_segment) boot_segment = 0x07C0; CDEmu.load_segment = boot_segment; CDEmu.buffer_segment = 0x0000; u16 nbsectors = *(u16*)&buffer[0x26]; CDEmu.sector_count = nbsectors; lba = *(u32*)&buffer[0x28]; CDEmu.ilba = lba; // And we read the image in memory dop.lba = lba; dop.count = DIV_ROUND_UP(nbsectors, 4); dop.buf_fl = MAKE_FLATPTR(boot_segment, 0); ret = cdb_read(&dop); if (ret) return 12; if (media == 0) { // No emulation requested - return success. CDEmu.emulated_extdrive = EXTSTART_CD + cdid; return 0; } // Emulation of a floppy/harddisk requested if (! CONFIG_CDROM_EMU || !cdemu_drive_gf) return 13; // Set emulated drive id and increase bios installed hardware // number of devices if (media < 4) { // Floppy emulation CDEmu.emulated_extdrive = 0x00; // XXX - get and set actual floppy count. set_equipment_flags(0x41, 0x41); switch (media) { case 0x01: // 1.2M floppy CDEmu.lchs.spt = 15; CDEmu.lchs.cylinders = 80; CDEmu.lchs.heads = 2; break; case 0x02: // 1.44M floppy CDEmu.lchs.spt = 18; CDEmu.lchs.cylinders = 80; CDEmu.lchs.heads = 2; break; case 0x03: // 2.88M floppy CDEmu.lchs.spt = 36; CDEmu.lchs.cylinders = 80; CDEmu.lchs.heads = 2; break; } } else { // Harddrive emulation CDEmu.emulated_extdrive = 0x80; SET_BDA(hdcount, GET_BDA(hdcount) + 1); // Peak at partition table to get chs. struct mbr_s *mbr = (void*)0; u8 sptcyl = GET_FARVAR(boot_segment, mbr->partitions[0].last.sptcyl); u8 cyllow = GET_FARVAR(boot_segment, mbr->partitions[0].last.cyllow); u8 heads = GET_FARVAR(boot_segment, mbr->partitions[0].last.heads); CDEmu.lchs.spt = sptcyl & 0x3f; CDEmu.lchs.cylinders = ((sptcyl<<2)&0x300) + cyllow + 1; CDEmu.lchs.heads = heads + 1; } // everything is ok, so from now on, the emulation is active CDEmu.active = 0x01; dprintf(6, "cdemu media=%d\n", media); return 0; } tinyvisor/bios/src/smbios.c0000644006644000001440000005015512172661303016256 0ustar yuichi_xyusers// smbios table generation (on emulators) // // Copyright (C) 2008,2009 Kevin O'Connor // Copyright (C) 2006 Fabrice Bellard // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "config.h" // CONFIG_* #include "paravirt.h" // RamSize #include "smbios.h" // struct smbios_entry_point struct smbios_entry_point *SMBiosAddr; static void smbios_entry_point_setup(u16 max_structure_size, u16 structure_table_length, void *structure_table_address, u16 number_of_structures) { struct smbios_entry_point *ep = malloc_fseg(sizeof(*ep)); void *finaltable; if (structure_table_length <= BUILD_MAX_SMBIOS_FSEG) // Table is small enough for f-seg - allocate there. This // works around a bug in JunOS (at least for small SMBIOS tables). finaltable = malloc_fseg(structure_table_length); else finaltable = malloc_high(structure_table_length); if (!ep || !finaltable) { warn_noalloc(); free(ep); free(finaltable); return; } memcpy(finaltable, structure_table_address, structure_table_length); memcpy(ep->anchor_string, "_SM_", 4); ep->length = 0x1f; ep->smbios_major_version = 2; ep->smbios_minor_version = 4; ep->max_structure_size = max_structure_size; ep->entry_point_revision = 0; memset(ep->formatted_area, 0, 5); memcpy(ep->intermediate_anchor_string, "_DMI_", 5); ep->structure_table_length = structure_table_length; ep->structure_table_address = (u32)finaltable; ep->number_of_structures = number_of_structures; ep->smbios_bcd_revision = 0x24; ep->checksum -= checksum(ep, 0x10); ep->intermediate_checksum -= checksum((void*)ep + 0x10, ep->length - 0x10); SMBiosAddr = ep; dprintf(1, "SMBIOS ptr=%p table=%p size=%d\n" , ep, finaltable, structure_table_length); } static int get_field(int type, int offset, void *dest) { char name[128]; snprintf(name, sizeof(name), "smbios/field%d-%d", type, offset); struct romfile_s *file = romfile_find(name); if (!file) return 0; file->copy(file, dest, file->size); return file->size; } static int get_external(int type, char **p, unsigned *nr_structs, unsigned *max_struct_size, char *end) { static u64 used_bitmap[4] = { 0 }; char *start = *p; /* Check if we've already reported these tables */ if (used_bitmap[(type >> 6) & 0x3] & (1ULL << (type & 0x3f))) return 1; /* Don't introduce spurious end markers */ if (type == 127) return 0; char prefix[128]; snprintf(prefix, sizeof(prefix), "smbios/table%d-", type); struct romfile_s *file = NULL; for (;;) { file = romfile_findprefix(prefix, file); if (!file) break; if (end - *p < file->size) { warn_noalloc(); break; } struct smbios_structure_header *header = (void*)*p; file->copy(file, header, file->size); *p += file->size; /* Entries end with a double NULL char, if there's a string at * the end (length is greater than formatted length), the string * terminator provides the first NULL. */ *((u8*)*p) = 0; (*p)++; if (header->length >= file->size) { *((u8*)*p) = 0; (*p)++; } (*nr_structs)++; if (*p - (char*)header > *max_struct_size) *max_struct_size = *p - (char*)header; } if (start == *p) return 0; /* Mark that we've reported on this type */ used_bitmap[(type >> 6) & 0x3] |= (1ULL << (type & 0x3f)); return 1; } #define load_str_field_with_default(type, field, def) \ do { \ size = get_field(type, offsetof(struct smbios_type_##type, \ field), end); \ if (size > 0) { \ end += size; \ } else { \ memcpy(end, def, sizeof(def)); \ end += sizeof(def); \ } \ p->field = ++str_index; \ } while (0) #define load_str_field_or_skip(type, field) \ do { \ size = get_field(type, offsetof(struct smbios_type_##type, \ field), end); \ if (size > 0) { \ end += size; \ p->field = ++str_index; \ } else { \ p->field = 0; \ } \ } while (0) #define set_field_with_default(type, field, def) \ do { \ if (!get_field(type, offsetof(struct smbios_type_##type, \ field), &p->field)) { \ p->field = def; \ } \ } while (0) /* Type 0 -- BIOS Information */ #define RELEASE_DATE_STR "01/01/2011" static void * smbios_init_type_0(void *start) { struct smbios_type_0 *p = (struct smbios_type_0 *)start; char *end = (char *)start + sizeof(struct smbios_type_0); size_t size; int str_index = 0; p->header.type = 0; p->header.length = sizeof(struct smbios_type_0); p->header.handle = 0; load_str_field_with_default(0, vendor_str, BUILD_APPNAME); load_str_field_with_default(0, bios_version_str, BUILD_APPNAME); p->bios_starting_address_segment = 0xe800; load_str_field_with_default(0, bios_release_date_str, RELEASE_DATE_STR); p->bios_rom_size = 0; /* FIXME */ if (!get_field(0, offsetof(struct smbios_type_0, bios_characteristics), &p->bios_characteristics)) { memset(p->bios_characteristics, 0, 8); /* BIOS characteristics not supported */ p->bios_characteristics[0] = 0x08; } if (!get_field(0, offsetof(struct smbios_type_0, bios_characteristics_extension_bytes), &p->bios_characteristics_extension_bytes)) { p->bios_characteristics_extension_bytes[0] = 0; /* Enable targeted content distribution. Needed for SVVP */ p->bios_characteristics_extension_bytes[1] = 4; } set_field_with_default(0, system_bios_major_release, 1); set_field_with_default(0, system_bios_minor_release, 0); set_field_with_default(0, embedded_controller_major_release, 0xff); set_field_with_default(0, embedded_controller_minor_release, 0xff); *end = 0; end++; return end; } /* Type 1 -- System Information */ static void * smbios_init_type_1(void *start) { struct smbios_type_1 *p = (struct smbios_type_1 *)start; char *end = (char *)start + sizeof(struct smbios_type_1); size_t size; int str_index = 0; p->header.type = 1; p->header.length = sizeof(struct smbios_type_1); p->header.handle = 0x100; load_str_field_with_default(1, manufacturer_str, BUILD_APPNAME); load_str_field_with_default(1, product_name_str, BUILD_APPNAME); load_str_field_or_skip(1, version_str); load_str_field_or_skip(1, serial_number_str); if (!get_field(1, offsetof(struct smbios_type_1, uuid), &p->uuid)) memset(p->uuid, 0, 16); set_field_with_default(1, wake_up_type, 0x06); /* power switch */ load_str_field_or_skip(1, sku_number_str); load_str_field_or_skip(1, family_str); *end = 0; end++; if (!str_index) { *end = 0; end++; } return end; } /* Type 3 -- System Enclosure */ static void * smbios_init_type_3(void *start) { struct smbios_type_3 *p = (struct smbios_type_3 *)start; char *end = (char *)start + sizeof(struct smbios_type_3); size_t size; int str_index = 0; p->header.type = 3; p->header.length = sizeof(struct smbios_type_3); p->header.handle = 0x300; load_str_field_with_default(3, manufacturer_str, BUILD_APPNAME); set_field_with_default(3, type, 0x01); /* other */ load_str_field_or_skip(3, version_str); load_str_field_or_skip(3, serial_number_str); load_str_field_or_skip(3, asset_tag_number_str); set_field_with_default(3, boot_up_state, 0x03); /* safe */ set_field_with_default(3, power_supply_state, 0x03); /* safe */ set_field_with_default(3, thermal_state, 0x03); /* safe */ set_field_with_default(3, security_status, 0x02); /* unknown */ set_field_with_default(3, oem_defined, 0); set_field_with_default(3, height, 0); set_field_with_default(3, number_of_power_cords, 0); set_field_with_default(3, contained_element_count, 0); *end = 0; end++; if (!str_index) { *end = 0; end++; } return end; } /* Type 4 -- Processor Information */ static void * smbios_init_type_4(void *start, unsigned int cpu_number) { struct smbios_type_4 *p = (struct smbios_type_4 *)start; char *end = (char *)start + sizeof(struct smbios_type_4); size_t size; int str_index = 0; char name[1024]; p->header.type = 4; p->header.length = sizeof(struct smbios_type_4); p->header.handle = 0x400 + cpu_number; size = get_field(4, offsetof(struct smbios_type_4, socket_designation_str), name); if (size) snprintf(name + size - 1, sizeof(name) - size, "%2x", cpu_number); else snprintf(name, sizeof(name), "CPU%2x", cpu_number); memcpy(end, name, strlen(name) + 1); end += strlen(name) + 1; p->socket_designation_str = ++str_index; set_field_with_default(4, processor_type, 0x03); /* CPU */ set_field_with_default(4, processor_family, 0x01); /* other */ load_str_field_with_default(4, processor_manufacturer_str, BUILD_APPNAME); if (!get_field(4, offsetof(struct smbios_type_4, processor_id) , p->processor_id)) { u32 cpuid_signature, ebx, ecx, cpuid_features; cpuid(1, &cpuid_signature, &ebx, &ecx, &cpuid_features); p->processor_id[0] = cpuid_signature; p->processor_id[1] = cpuid_features; } load_str_field_or_skip(4, processor_version_str); set_field_with_default(4, voltage, 0); set_field_with_default(4, external_clock, 0); set_field_with_default(4, max_speed, 2000); set_field_with_default(4, current_speed, 2000); set_field_with_default(4, status, 0x41); /* socket populated, CPU enabled */ set_field_with_default(4, processor_upgrade, 0x01); /* other */ /* cache information structure not provided */ p->l1_cache_handle = 0xffff; p->l2_cache_handle = 0xffff; p->l3_cache_handle = 0xffff; *end = 0; end++; if (!str_index) { *end = 0; end++; } return end; } /* Type 16 -- Physical Memory Array */ static void * smbios_init_type_16(void *start, u32 memory_size_mb, int nr_mem_devs) { struct smbios_type_16 *p = (struct smbios_type_16*)start; p->header.type = 16; p->header.length = sizeof(struct smbios_type_16); p->header.handle = 0x1000; set_field_with_default(16, location, 0x01); /* other */ set_field_with_default(16, use, 0x03); /* system memory */ /* Multi-bit ECC to make Microsoft happy */ set_field_with_default(16, error_correction, 0x06); /* 0x80000000 = unknown, accept sizes < 2TB - TODO multiple arrays */ p->maximum_capacity = memory_size_mb < 2 << 20 ? memory_size_mb << 10 : 0x80000000; p->memory_error_information_handle = 0xfffe; /* none provided */ p->number_of_memory_devices = nr_mem_devs; start += sizeof(struct smbios_type_16); *((u16 *)start) = 0; return start + 2; } /* Type 17 -- Memory Device */ static void * smbios_init_type_17(void *start, u32 size_mb, int instance) { struct smbios_type_17 *p = (struct smbios_type_17 *)start; char *end = (char *)start + sizeof(struct smbios_type_17); size_t size; int str_index = 0; char name[1024]; p->header.type = 17; p->header.length = sizeof(struct smbios_type_17); p->header.handle = 0x1100 + instance; p->physical_memory_array_handle = 0x1000; set_field_with_default(17, total_width, 64); set_field_with_default(17, data_width, 64); /* TODO: should assert in case something is wrong ASSERT((memory_size_mb & ~0x7fff) == 0); */ p->size = size_mb; set_field_with_default(17, form_factor, 0x09); /* DIMM */ p->device_set = 0; size = get_field(17, offsetof(struct smbios_type_17, device_locator_str), name); if (size) snprintf(name + size - 1, sizeof(name) - size, "%d", instance); else snprintf(name, sizeof(name), "DIMM %d", instance); memcpy(end, name, strlen(name) + 1); end += strlen(name) + 1; p->device_locator_str = ++str_index; load_str_field_or_skip(17, bank_locator_str); set_field_with_default(17, memory_type, 0x07); /* RAM */ set_field_with_default(17, type_detail, 0); *end = 0; end++; if (!str_index) { *end = 0; end++; } return end; } /* Type 19 -- Memory Array Mapped Address */ static void * smbios_init_type_19(void *start, u32 start_mb, u32 size_mb, int instance) { struct smbios_type_19 *p = (struct smbios_type_19 *)start; p->header.type = 19; p->header.length = sizeof(struct smbios_type_19); p->header.handle = 0x1300 + instance; p->starting_address = start_mb << 10; p->ending_address = p->starting_address + (size_mb << 10) - 1; p->memory_array_handle = 0x1000; p->partition_width = 1; start += sizeof(struct smbios_type_19); *((u16 *)start) = 0; return start + 2; } /* Type 20 -- Memory Device Mapped Address */ static void * smbios_init_type_20(void *start, u32 start_mb, u32 size_mb, int instance, int dev_handle, int array_handle) { struct smbios_type_20 *p = (struct smbios_type_20 *)start; p->header.type = 20; p->header.length = sizeof(struct smbios_type_20); p->header.handle = 0x1400 + instance; p->starting_address = start_mb << 10; p->ending_address = p->starting_address + (size_mb << 10) - 1; p->memory_device_handle = 0x1100 + dev_handle; p->memory_array_mapped_address_handle = 0x1300 + array_handle; p->partition_row_position = 1; p->interleave_position = 0; p->interleaved_data_depth = 0; start += sizeof(struct smbios_type_20); *((u16 *)start) = 0; return start+2; } /* Type 32 -- System Boot Information */ static void * smbios_init_type_32(void *start) { struct smbios_type_32 *p = (struct smbios_type_32 *)start; p->header.type = 32; p->header.length = sizeof(struct smbios_type_32); p->header.handle = 0x2000; memset(p->reserved, 0, 6); set_field_with_default(32, boot_status, 0); /* no errors detected */ start += sizeof(struct smbios_type_32); *((u16 *)start) = 0; return start+2; } /* Type 127 -- End of Table */ static void * smbios_init_type_127(void *start) { struct smbios_type_127 *p = (struct smbios_type_127 *)start; p->header.type = 127; p->header.length = sizeof(struct smbios_type_127); p->header.handle = 0x7f00; start += sizeof(struct smbios_type_127); *((u16 *)start) = 0; return start + 2; } #define TEMPSMBIOSSIZE (32 * 1024) void smbios_setup(void) { if (! CONFIG_SMBIOS) return; dprintf(3, "init SMBIOS tables\n"); char *start = malloc_tmphigh(TEMPSMBIOSSIZE); if (! start) { warn_noalloc(); return; } u32 nr_structs = 0, max_struct_size = 0; char *q, *p = start; char *end = start + TEMPSMBIOSSIZE - sizeof(struct smbios_type_127); #define add_struct(type, args...) \ do { \ if (!get_external(type, &p, &nr_structs, &max_struct_size, end)) { \ q = smbios_init_type_##type(args); \ nr_structs++; \ if ((q - p) > max_struct_size) \ max_struct_size = q - p; \ p = q; \ } \ } while (0) add_struct(0, p); add_struct(1, p); add_struct(3, p); int cpu_num; for (cpu_num = 1; cpu_num <= MaxCountCPUs; cpu_num++) add_struct(4, p, cpu_num); int ram_mb = (RamSize + RamSizeOver4G) >> 20; int nr_mem_devs = (ram_mb + 0x3fff) >> 14; add_struct(16, p, ram_mb, nr_mem_devs); int i, j; for (i = 0; i < nr_mem_devs; i++) { u32 dev_mb = ((i == (nr_mem_devs - 1)) ? (((ram_mb - 1) & 0x3fff) + 1) : 16384); add_struct(17, p, dev_mb, i); } add_struct(19, p, 0, RamSize >> 20, 0); if (RamSizeOver4G) add_struct(19, p, 4096, RamSizeOver4G >> 20, 1); add_struct(20, p, 0, RamSize >> 20, 0, 0, 0); if (RamSizeOver4G) { u32 start_mb = 4096; for (j = 1, i = 0; i < nr_mem_devs; i++, j++) { u32 dev_mb = ((i == (nr_mem_devs - 1)) ? (((ram_mb - 1) & 0x3fff) + 1) : 16384); if (i == 0) dev_mb -= RamSize >> 20; add_struct(20, p, start_mb, dev_mb, j, i, 1); start_mb += dev_mb; } } add_struct(32, p); /* Add any remaining provided entries before the end marker */ for (i = 0; i < 256; i++) get_external(i, &p, &nr_structs, &max_struct_size, end); add_struct(127, p); #undef add_struct smbios_entry_point_setup(max_struct_size, p - start, start, nr_structs); free(start); } void display_uuid(void) { u32 addr, end; u8 *uuid; u8 empty_uuid[16] = { 0 }; if (SMBiosAddr == NULL) return; addr = SMBiosAddr->structure_table_address; end = addr + SMBiosAddr->structure_table_length; /* the following takes care of any initial wraparound too */ while (addr < end) { const struct smbios_structure_header *hdr; /* partial structure header */ if (end - addr < sizeof(struct smbios_structure_header)) return; hdr = (struct smbios_structure_header *)addr; /* partial structure */ if (end - addr < hdr->length) return; /* any Type 1 structure version will do that has the UUID */ if (hdr->type == 1 && hdr->length >= offsetof(struct smbios_type_1, uuid) + 16) break; /* done with formatted area, skip string-set */ addr += hdr->length; while (end - addr >= 2 && (*(u8 *)addr != '\0' || *(u8 *)(addr+1) != '\0')) ++addr; /* structure terminator not found */ if (end - addr < 2) return; addr += 2; } /* parsing finished or skipped entirely, UUID not found */ if (addr >= end) return; uuid = (u8 *)(addr + offsetof(struct smbios_type_1, uuid)); if (memcmp(uuid, empty_uuid, sizeof empty_uuid) == 0) return; printf("Machine UUID" " %02x%02x%02x%02x" "-%02x%02x" "-%02x%02x" "-%02x%02x" "-%02x%02x%02x%02x%02x%02x\n" , uuid[ 0], uuid[ 1], uuid[ 2], uuid[ 3] , uuid[ 4], uuid[ 5] , uuid[ 6], uuid[ 7] , uuid[ 8], uuid[ 9] , uuid[10], uuid[11], uuid[12], uuid[13], uuid[14], uuid[15]); } tinyvisor/bios/src/ps2port.h0000644006644000001440000000351611733243570016403 0ustar yuichi_xyusers// Basic ps2 port (keyboard/mouse) command handling. #ifndef __PS2PORT_H #define __PS2PORT_H #include "types.h" // u8 // Standard commands. #define I8042_CMD_CTL_RCTR 0x0120 #define I8042_CMD_CTL_WCTR 0x1060 #define I8042_CMD_CTL_TEST 0x01aa #define I8042_CMD_KBD_TEST 0x01ab #define I8042_CMD_KBD_DISABLE 0x00ad #define I8042_CMD_KBD_ENABLE 0x00ae #define I8042_CMD_AUX_DISABLE 0x00a7 #define I8042_CMD_AUX_ENABLE 0x00a8 #define I8042_CMD_AUX_SEND 0x10d4 // Keyboard commands #define ATKBD_CMD_SETLEDS 0x10ed #define ATKBD_CMD_SSCANSET 0x10f0 #define ATKBD_CMD_GETID 0x02f2 #define ATKBD_CMD_ENABLE 0x00f4 #define ATKBD_CMD_RESET_DIS 0x00f5 #define ATKBD_CMD_RESET_BAT 0x02ff // Mouse commands #define PSMOUSE_CMD_SETSCALE11 0x00e6 #define PSMOUSE_CMD_SETSCALE21 0x00e7 #define PSMOUSE_CMD_SETRES 0x10e8 #define PSMOUSE_CMD_GETINFO 0x03e9 #define PSMOUSE_CMD_GETID 0x02f2 #define PSMOUSE_CMD_SETRATE 0x10f3 #define PSMOUSE_CMD_ENABLE 0x00f4 #define PSMOUSE_CMD_DISABLE 0x00f5 #define PSMOUSE_CMD_RESET_BAT 0x02ff // Status register bits. #define I8042_STR_PARITY 0x80 #define I8042_STR_TIMEOUT 0x40 #define I8042_STR_AUXDATA 0x20 #define I8042_STR_KEYLOCK 0x10 #define I8042_STR_CMDDAT 0x08 #define I8042_STR_MUXERR 0x04 #define I8042_STR_IBF 0x02 #define I8042_STR_OBF 0x01 // Control register bits. #define I8042_CTR_KBDINT 0x01 #define I8042_CTR_AUXINT 0x02 #define I8042_CTR_IGNKEYLOCK 0x08 #define I8042_CTR_KBDDIS 0x10 #define I8042_CTR_AUXDIS 0x20 #define I8042_CTR_XLATE 0x40 // functions void i8042_reboot(void); int ps2_kbd_command(int command, u8 *param); int ps2_mouse_command(int command, u8 *param); void ps2port_setup(void); #endif // ps2port.h tinyvisor/bios/src/usb-hid.h0000644006644000001440000000157212172661303016321 0ustar yuichi_xyusers#ifndef __USB_HID_H #define __USB_HID_H // usb-hid.c struct usbdevice_s; int usb_hid_setup(struct usbdevice_s *usbdev); inline int usb_kbd_active(void); inline int usb_kbd_command(int command, u8 *param); inline int usb_mouse_active(void); inline int usb_mouse_command(int command, u8 *param); void usb_check_event(void); /**************************************************************** * hid flags ****************************************************************/ #define USB_INTERFACE_SUBCLASS_BOOT 1 #define USB_INTERFACE_PROTOCOL_KEYBOARD 1 #define USB_INTERFACE_PROTOCOL_MOUSE 2 #define HID_REQ_GET_REPORT 0x01 #define HID_REQ_GET_IDLE 0x02 #define HID_REQ_GET_PROTOCOL 0x03 #define HID_REQ_SET_REPORT 0x09 #define HID_REQ_SET_IDLE 0x0A #define HID_REQ_SET_PROTOCOL 0x0B #endif // ush-hid.h tinyvisor/bios/src/pci.c0000644006644000001440000001711612172661303015535 0ustar yuichi_xyusers// PCI config space access functions. // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "config.h" // CONFIG_* #include "pci.h" // pci_config_writel #include "ioport.h" // outl #include "util.h" // dprintf #include "farptr.h" // MAKE_FLATPTR #include "pci_regs.h" // PCI_VENDOR_ID #include "pci_ids.h" // PCI_CLASS_DISPLAY_VGA void pci_config_writel(u16 bdf, u32 addr, u32 val) { outl(0x80000000 | (bdf << 8) | (addr & 0xfc), PORT_PCI_CMD); outl(val, PORT_PCI_DATA); } void pci_config_writew(u16 bdf, u32 addr, u16 val) { outl(0x80000000 | (bdf << 8) | (addr & 0xfc), PORT_PCI_CMD); outw(val, PORT_PCI_DATA + (addr & 2)); } void pci_config_writeb(u16 bdf, u32 addr, u8 val) { outl(0x80000000 | (bdf << 8) | (addr & 0xfc), PORT_PCI_CMD); outb(val, PORT_PCI_DATA + (addr & 3)); } u32 pci_config_readl(u16 bdf, u32 addr) { outl(0x80000000 | (bdf << 8) | (addr & 0xfc), PORT_PCI_CMD); return inl(PORT_PCI_DATA); } u16 pci_config_readw(u16 bdf, u32 addr) { outl(0x80000000 | (bdf << 8) | (addr & 0xfc), PORT_PCI_CMD); return inw(PORT_PCI_DATA + (addr & 2)); } u8 pci_config_readb(u16 bdf, u32 addr) { outl(0x80000000 | (bdf << 8) | (addr & 0xfc), PORT_PCI_CMD); return inb(PORT_PCI_DATA + (addr & 3)); } void pci_config_maskw(u16 bdf, u32 addr, u16 off, u16 on) { u16 val = pci_config_readw(bdf, addr); val = (val & ~off) | on; pci_config_writew(bdf, addr, val); } // Helper function for foreachbdf() macro - return next device int pci_next(int bdf, int bus) { if (pci_bdf_to_fn(bdf) == 0 && (pci_config_readb(bdf, PCI_HEADER_TYPE) & 0x80) == 0) // Last found device wasn't a multi-function device - skip to // the next device. bdf += 8; else bdf += 1; for (;;) { if (pci_bdf_to_bus(bdf) != bus) return -1; u16 v = pci_config_readw(bdf, PCI_VENDOR_ID); if (v != 0x0000 && v != 0xffff) // Device is present. return bdf; if (pci_bdf_to_fn(bdf) == 0) bdf += 8; else bdf += 1; } } struct hlist_head PCIDevices VARVERIFY32INIT; int MaxPCIBus VARFSEG; // Check if PCI is available at all int pci_probe_host(void) { outl(0x80000000, PORT_PCI_CMD); if (inl(PORT_PCI_CMD) != 0x80000000) { dprintf(1, "Detected non-PCI system\n"); return -1; } return 0; } // Find all PCI devices and populate PCIDevices linked list. void pci_probe_devices(void) { dprintf(3, "PCI probe\n"); struct pci_device *busdevs[256]; memset(busdevs, 0, sizeof(busdevs)); struct hlist_node **pprev = &PCIDevices.first; int extraroots = romfile_loadint("etc/extra-pci-roots", 0); int bus = -1, lastbus = 0, rootbuses = 0, count=0; while (bus < 0xff && (bus < MaxPCIBus || rootbuses < extraroots)) { bus++; int bdf; foreachbdf(bdf, bus) { // Create new pci_device struct and add to list. struct pci_device *dev = malloc_tmp(sizeof(*dev)); if (!dev) { warn_noalloc(); return; } memset(dev, 0, sizeof(*dev)); hlist_add(&dev->node, pprev); count++; // Find parent device. int rootbus; struct pci_device *parent = busdevs[bus]; if (!parent) { if (bus != lastbus) rootbuses++; lastbus = bus; rootbus = rootbuses; if (bus > MaxPCIBus) MaxPCIBus = bus; } else { rootbus = parent->rootbus; } // Populate pci_device info. dev->bdf = bdf; dev->parent = parent; dev->rootbus = rootbus; u32 vendev = pci_config_readl(bdf, PCI_VENDOR_ID); dev->vendor = vendev & 0xffff; dev->device = vendev >> 16; u32 classrev = pci_config_readl(bdf, PCI_CLASS_REVISION); dev->class = classrev >> 16; dev->prog_if = classrev >> 8; dev->revision = classrev & 0xff; dev->header_type = pci_config_readb(bdf, PCI_HEADER_TYPE); u8 v = dev->header_type & 0x7f; if (v == PCI_HEADER_TYPE_BRIDGE || v == PCI_HEADER_TYPE_CARDBUS) { u8 secbus = pci_config_readb(bdf, PCI_SECONDARY_BUS); dev->secondary_bus = secbus; if (secbus > bus && !busdevs[secbus]) busdevs[secbus] = dev; if (secbus > MaxPCIBus) MaxPCIBus = secbus; } dprintf(4, "PCI device %02x:%02x.%x (vd=%04x:%04x c=%04x)\n" , pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf) , pci_bdf_to_fn(bdf) , dev->vendor, dev->device, dev->class); } } dprintf(1, "Found %d PCI devices (max PCI bus is %02x)\n", count, MaxPCIBus); } // Search for a device with the specified vendor and device ids. struct pci_device * pci_find_device(u16 vendid, u16 devid) { struct pci_device *pci; foreachpci(pci) { if (pci->vendor == vendid && pci->device == devid) return pci; } return NULL; } // Search for a device with the specified class id. struct pci_device * pci_find_class(u16 classid) { struct pci_device *pci; foreachpci(pci) { if (pci->class == classid) return pci; } return NULL; } int pci_init_device(const struct pci_device_id *ids , struct pci_device *pci, void *arg) { while (ids->vendid || ids->class_mask) { if ((ids->vendid == PCI_ANY_ID || ids->vendid == pci->vendor) && (ids->devid == PCI_ANY_ID || ids->devid == pci->device) && !((ids->class ^ pci->class) & ids->class_mask)) { if (ids->func) ids->func(pci, arg); return 0; } ids++; } return -1; } struct pci_device * pci_find_init_device(const struct pci_device_id *ids, void *arg) { struct pci_device *pci; foreachpci(pci) { if (pci_init_device(ids, pci, arg) == 0) return pci; } return NULL; } void pci_reboot(void) { u8 v = inb(PORT_PCI_REBOOT) & ~6; outb(v|2, PORT_PCI_REBOOT); /* Request hard reset */ udelay(50); outb(v|6, PORT_PCI_REBOOT); /* Actually do the reset */ udelay(50); } // helper functions to access pci mmio bars from real mode u32 VISIBLE32FLAT pci_readl_32(u32 addr) { dprintf(9, "32: pci read : %x\n", addr); return readl((void*)addr); } u32 pci_readl(u32 addr) { if (MODESEGMENT) { dprintf(9, "16: pci read : %x\n", addr); extern void _cfunc32flat_pci_readl_32(u32 addr); return call32(_cfunc32flat_pci_readl_32, addr, -1); } else { return pci_readl_32(addr); } } struct reg32 { u32 addr; u32 data; }; void VISIBLE32FLAT pci_writel_32(struct reg32 *reg32) { dprintf(9, "32: pci write: %x, %x (%p)\n", reg32->addr, reg32->data, reg32); writel((void*)(reg32->addr), reg32->data); } void pci_writel(u32 addr, u32 val) { struct reg32 reg32 = { .addr = addr, .data = val }; if (MODESEGMENT) { dprintf(9, "16: pci write: %x, %x (%x:%p)\n", reg32.addr, reg32.data, GET_SEG(SS), ®32); void *flatptr = MAKE_FLATPTR(GET_SEG(SS), ®32); extern void _cfunc32flat_pci_writel_32(struct reg32 *reg32); call32(_cfunc32flat_pci_writel_32, (u32)flatptr, -1); } else { pci_writel_32(®32); } } tinyvisor/bios/src/usb-uhci.c0000644006644000001440000004212512172661303016477 0ustar yuichi_xyusers// Code for handling UHCI USB controllers. // // Copyright (C) 2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "pci.h" // pci_bdf_to_bus #include "config.h" // CONFIG_* #include "ioport.h" // outw #include "usb-uhci.h" // USBLEGSUP #include "pci_regs.h" // PCI_BASE_ADDRESS_4 #include "usb.h" // struct usb_s #include "biosvar.h" // GET_LOWFLAT struct usb_uhci_s { struct usb_s usb; u16 iobase; struct uhci_qh *control_qh; struct uhci_framelist *framelist; }; struct uhci_pipe { struct uhci_qh qh; struct uhci_td *next_td; struct usb_pipe pipe; u16 iobase; u8 toggle; }; /**************************************************************** * Root hub ****************************************************************/ // Check if device attached to a given port static int uhci_hub_detect(struct usbhub_s *hub, u32 port) { struct usb_uhci_s *cntl = container_of(hub->cntl, struct usb_uhci_s, usb); u16 ioport = cntl->iobase + USBPORTSC1 + port * 2; u16 status = inw(ioport); if (!(status & USBPORTSC_CCS)) // No device return -1; // XXX - if just powered up, need to wait for USB_TIME_ATTDB? // Begin reset on port outw(USBPORTSC_PR, ioport); msleep(USB_TIME_DRSTR); return 0; } // Reset device on port static int uhci_hub_reset(struct usbhub_s *hub, u32 port) { struct usb_uhci_s *cntl = container_of(hub->cntl, struct usb_uhci_s, usb); u16 ioport = cntl->iobase + USBPORTSC1 + port * 2; // Finish reset on port outw(0, ioport); udelay(6); // 64 high-speed bit times u16 status = inw(ioport); if (!(status & USBPORTSC_CCS)) // No longer connected return -1; outw(USBPORTSC_PE, ioport); return !!(status & USBPORTSC_LSDA); } // Disable port static void uhci_hub_disconnect(struct usbhub_s *hub, u32 port) { struct usb_uhci_s *cntl = container_of(hub->cntl, struct usb_uhci_s, usb); u16 ioport = cntl->iobase + USBPORTSC1 + port * 2; outw(0, ioport); } static struct usbhub_op_s uhci_HubOp = { .detect = uhci_hub_detect, .reset = uhci_hub_reset, .disconnect = uhci_hub_disconnect, }; // Find any devices connected to the root hub. static int check_uhci_ports(struct usb_uhci_s *cntl) { ASSERT32FLAT(); struct usbhub_s hub; memset(&hub, 0, sizeof(hub)); hub.cntl = &cntl->usb; hub.portcount = 2; hub.op = &uhci_HubOp; usb_enumerate(&hub); return hub.devcount; } /**************************************************************** * Setup ****************************************************************/ // Wait for next USB frame to start - for ensuring safe memory release. static void uhci_waittick(u16 iobase) { barrier(); u16 startframe = inw(iobase + USBFRNUM); u64 end = calc_future_tsc(1000 * 5); for (;;) { if (inw(iobase + USBFRNUM) != startframe) break; if (check_tsc(end)) { warn_timeout(); return; } yield(); } } static void uhci_free_pipes(struct usb_uhci_s *cntl) { dprintf(7, "uhci_free_pipes %p\n", cntl); struct uhci_qh *pos = (void*)(cntl->framelist->links[0] & ~UHCI_PTR_BITS); for (;;) { u32 link = pos->link; if (link == UHCI_PTR_TERM) break; struct uhci_qh *next = (void*)(link & ~UHCI_PTR_BITS); struct uhci_pipe *pipe = container_of(next, struct uhci_pipe, qh); if (pipe->pipe.cntl != &cntl->usb) pos->link = next->link; else pos = next; } uhci_waittick(cntl->iobase); for (;;) { struct usb_pipe *usbpipe = cntl->usb.freelist; if (!usbpipe) break; cntl->usb.freelist = usbpipe->freenext; struct uhci_pipe *pipe = container_of(usbpipe, struct uhci_pipe, pipe); free(pipe); } } static void reset_uhci(struct usb_uhci_s *cntl, u16 bdf) { // XXX - don't reset if not needed. // Reset PIRQ and SMI pci_config_writew(bdf, USBLEGSUP, USBLEGSUP_RWC); // Reset the HC outw(USBCMD_HCRESET, cntl->iobase + USBCMD); udelay(5); // Disable interrupts and commands (just to be safe). outw(0, cntl->iobase + USBINTR); outw(0, cntl->iobase + USBCMD); } static void configure_uhci(void *data) { struct usb_uhci_s *cntl = data; // Allocate ram for schedule storage struct uhci_td *term_td = malloc_high(sizeof(*term_td)); struct uhci_framelist *fl = memalign_high(sizeof(*fl), sizeof(*fl)); struct uhci_pipe *intr_pipe = malloc_high(sizeof(*intr_pipe)); struct uhci_pipe *term_pipe = malloc_high(sizeof(*term_pipe)); if (!term_td || !fl || !intr_pipe || !term_pipe) { warn_noalloc(); goto fail; } // Work around for PIIX errata memset(term_td, 0, sizeof(*term_td)); term_td->link = UHCI_PTR_TERM; term_td->token = (uhci_explen(0) | (0x7f << TD_TOKEN_DEVADDR_SHIFT) | USB_PID_IN); memset(term_pipe, 0, sizeof(*term_pipe)); term_pipe->qh.element = (u32)term_td; term_pipe->qh.link = UHCI_PTR_TERM; term_pipe->pipe.cntl = &cntl->usb; // Set schedule to point to primary intr queue head memset(intr_pipe, 0, sizeof(*intr_pipe)); intr_pipe->qh.element = UHCI_PTR_TERM; intr_pipe->qh.link = (u32)&term_pipe->qh | UHCI_PTR_QH; intr_pipe->pipe.cntl = &cntl->usb; int i; for (i=0; ilinks); i++) fl->links[i] = (u32)&intr_pipe->qh | UHCI_PTR_QH; cntl->framelist = fl; cntl->control_qh = &intr_pipe->qh; barrier(); // Set the frame length to the default: 1 ms exactly outb(USBSOF_DEFAULT, cntl->iobase + USBSOF); // Store the frame list base address outl((u32)fl->links, cntl->iobase + USBFLBASEADD); // Set the current frame number outw(0, cntl->iobase + USBFRNUM); // Mark as configured and running with a 64-byte max packet. outw(USBCMD_RS | USBCMD_CF | USBCMD_MAXP, cntl->iobase + USBCMD); // Find devices int count = check_uhci_ports(cntl); uhci_free_pipes(cntl); if (count) // Success return; // No devices found - shutdown and free controller. outw(0, cntl->iobase + USBCMD); fail: free(term_td); free(fl); free(intr_pipe); free(term_pipe); free(cntl); } void uhci_setup(struct pci_device *pci, int busid) { if (! CONFIG_USB_UHCI) return; u16 bdf = pci->bdf; struct usb_uhci_s *cntl = malloc_tmphigh(sizeof(*cntl)); if (!cntl) { warn_noalloc(); return; } memset(cntl, 0, sizeof(*cntl)); cntl->usb.busid = busid; cntl->usb.pci = pci; cntl->usb.type = USB_TYPE_UHCI; cntl->iobase = (pci_config_readl(bdf, PCI_BASE_ADDRESS_4) & PCI_BASE_ADDRESS_IO_MASK); dprintf(1, "UHCI init on dev %02x:%02x.%x (io=%x)\n" , pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf) , pci_bdf_to_fn(bdf), cntl->iobase); pci_config_maskw(bdf, PCI_COMMAND, 0, PCI_COMMAND_MASTER); reset_uhci(cntl, bdf); run_thread(configure_uhci, cntl); } /**************************************************************** * End point communication ****************************************************************/ static struct usb_pipe * uhci_alloc_intr_pipe(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc) { struct usb_uhci_s *cntl = container_of( usbdev->hub->cntl, struct usb_uhci_s, usb); int frameexp = usb_getFrameExp(usbdev, epdesc); dprintf(7, "uhci_alloc_intr_pipe %p %d\n", &cntl->usb, frameexp); if (frameexp > 10) frameexp = 10; int maxpacket = epdesc->wMaxPacketSize; // Determine number of entries needed for 2 timer ticks. int ms = 1<pipe, usbdev, epdesc); int lowspeed = pipe->pipe.speed; int devaddr = pipe->pipe.devaddr | (pipe->pipe.ep << 7); pipe->qh.element = (u32)tds; pipe->next_td = &tds[0]; pipe->iobase = cntl->iobase; int toggle = 0; int i; for (i=0; iframelist; if (frameexp == 0) { // Add to existing interrupt entry. struct uhci_qh *intr_qh = (void*)(fl->links[0] & ~UHCI_PTR_BITS); pipe->qh.link = intr_qh->link; barrier(); intr_qh->link = (u32)&pipe->qh | UHCI_PTR_QH; if (cntl->control_qh == intr_qh) cntl->control_qh = &pipe->qh; } else { int startpos = 1<<(frameexp-1); pipe->qh.link = fl->links[startpos]; barrier(); for (i=startpos; ilinks); i+=ms) fl->links[i] = (u32)&pipe->qh | UHCI_PTR_QH; } return &pipe->pipe; fail: free(pipe); free(tds); free(data); return NULL; } struct usb_pipe * uhci_alloc_pipe(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc) { if (! CONFIG_USB_UHCI) return NULL; u8 eptype = epdesc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK; if (eptype == USB_ENDPOINT_XFER_INT) return uhci_alloc_intr_pipe(usbdev, epdesc); struct usb_uhci_s *cntl = container_of( usbdev->hub->cntl, struct usb_uhci_s, usb); dprintf(7, "uhci_alloc_async_pipe %p %d\n", &cntl->usb, eptype); struct usb_pipe *usbpipe = usb_getFreePipe(&cntl->usb, eptype); if (usbpipe) { // Use previously allocated pipe. usb_desc2pipe(usbpipe, usbdev, epdesc); return usbpipe; } // Allocate a new queue head. struct uhci_pipe *pipe; if (eptype == USB_ENDPOINT_XFER_CONTROL) pipe = malloc_tmphigh(sizeof(*pipe)); else pipe = malloc_low(sizeof(*pipe)); if (!pipe) { warn_noalloc(); return NULL; } memset(pipe, 0, sizeof(*pipe)); usb_desc2pipe(&pipe->pipe, usbdev, epdesc); pipe->qh.element = UHCI_PTR_TERM; pipe->iobase = cntl->iobase; // Add queue head to controller list. struct uhci_qh *control_qh = cntl->control_qh; pipe->qh.link = control_qh->link; barrier(); control_qh->link = (u32)&pipe->qh | UHCI_PTR_QH; if (eptype == USB_ENDPOINT_XFER_CONTROL) cntl->control_qh = &pipe->qh; return &pipe->pipe; } static int wait_pipe(struct uhci_pipe *pipe, int timeout) { u64 end = calc_future_tsc(timeout); for (;;) { u32 el_link = GET_LOWFLAT(pipe->qh.element); if (el_link & UHCI_PTR_TERM) return 0; if (check_tsc(end)) { warn_timeout(); u16 iobase = GET_LOWFLAT(pipe->iobase); struct uhci_td *td = (void*)(el_link & ~UHCI_PTR_BITS); dprintf(1, "Timeout on wait_pipe %p (td=%p s=%x c=%x/%x)\n" , pipe, (void*)el_link, GET_LOWFLAT(td->status) , inw(iobase + USBCMD) , inw(iobase + USBSTS)); SET_LOWFLAT(pipe->qh.element, UHCI_PTR_TERM); uhci_waittick(iobase); return -1; } yield(); } } static int wait_td(struct uhci_td *td) { u64 end = calc_future_tsc(5000); // XXX - lookup real time. u32 status; for (;;) { status = td->status; if (!(status & TD_CTRL_ACTIVE)) break; if (check_tsc(end)) { warn_timeout(); return -1; } yield(); } if (status & TD_CTRL_ANY_ERROR) { dprintf(1, "wait_td error - status=%x\n", status); return -2; } return 0; } int uhci_control(struct usb_pipe *p, int dir, const void *cmd, int cmdsize , void *data, int datasize) { ASSERT32FLAT(); if (! CONFIG_USB_UHCI) return -1; dprintf(5, "uhci_control %p\n", p); struct uhci_pipe *pipe = container_of(p, struct uhci_pipe, pipe); int maxpacket = pipe->pipe.maxpacket; int lowspeed = pipe->pipe.speed; int devaddr = pipe->pipe.devaddr | (pipe->pipe.ep << 7); // Setup transfer descriptors int count = 2 + DIV_ROUND_UP(datasize, maxpacket); struct uhci_td *tds = malloc_tmphigh(sizeof(*tds) * count); if (!tds) { warn_noalloc(); return -1; } tds[0].link = (u32)&tds[1] | UHCI_PTR_DEPTH; tds[0].status = (uhci_maxerr(3) | (lowspeed ? TD_CTRL_LS : 0) | TD_CTRL_ACTIVE); tds[0].token = (uhci_explen(cmdsize) | (devaddr << TD_TOKEN_DEVADDR_SHIFT) | USB_PID_SETUP); tds[0].buffer = (void*)cmd; int toggle = TD_TOKEN_TOGGLE; int i; for (i=1; iqh.element = (u32)&tds[0]; int ret = wait_pipe(pipe, 500); free(tds); return ret; } #define STACKTDS 4 #define TDALIGN 16 int uhci_send_bulk(struct usb_pipe *p, int dir, void *data, int datasize) { if (! CONFIG_USB_UHCI) return -1; struct uhci_pipe *pipe = container_of(p, struct uhci_pipe, pipe); dprintf(7, "uhci_send_bulk qh=%p dir=%d data=%p size=%d\n" , &pipe->qh, dir, data, datasize); int maxpacket = GET_LOWFLAT(pipe->pipe.maxpacket); int lowspeed = GET_LOWFLAT(pipe->pipe.speed); int devaddr = (GET_LOWFLAT(pipe->pipe.devaddr) | (GET_LOWFLAT(pipe->pipe.ep) << 7)); int toggle = GET_LOWFLAT(pipe->toggle) ? TD_TOKEN_TOGGLE : 0; // Allocate 4 tds on stack (16byte aligned) u8 tdsbuf[sizeof(struct uhci_td) * STACKTDS + TDALIGN - 1]; struct uhci_td *tds = (void*)ALIGN((u32)tdsbuf, TDALIGN); memset(tds, 0, sizeof(*tds) * STACKTDS); // Enable tds barrier(); SET_LOWFLAT(pipe->qh.element, (u32)MAKE_FLATPTR(GET_SEG(SS), tds)); int tdpos = 0; while (datasize) { struct uhci_td *td = &tds[tdpos++ % STACKTDS]; int ret = wait_td(td); if (ret) goto fail; int transfer = datasize; if (transfer > maxpacket) transfer = maxpacket; struct uhci_td *nexttd_fl = MAKE_FLATPTR(GET_SEG(SS) , &tds[tdpos % STACKTDS]); td->link = (transfer==datasize ? UHCI_PTR_TERM : (u32)nexttd_fl); td->token = (uhci_explen(transfer) | toggle | (devaddr << TD_TOKEN_DEVADDR_SHIFT) | (dir ? USB_PID_IN : USB_PID_OUT)); td->buffer = data; barrier(); td->status = (uhci_maxerr(3) | (lowspeed ? TD_CTRL_LS : 0) | TD_CTRL_ACTIVE); toggle ^= TD_TOKEN_TOGGLE; data += transfer; datasize -= transfer; } SET_LOWFLAT(pipe->toggle, !!toggle); return wait_pipe(pipe, 5000); fail: dprintf(1, "uhci_send_bulk failed\n"); SET_LOWFLAT(pipe->qh.element, UHCI_PTR_TERM); uhci_waittick(GET_LOWFLAT(pipe->iobase)); return -1; } int uhci_poll_intr(struct usb_pipe *p, void *data) { ASSERT16(); if (! CONFIG_USB_UHCI) return -1; struct uhci_pipe *pipe = container_of(p, struct uhci_pipe, pipe); struct uhci_td *td = GET_LOWFLAT(pipe->next_td); u32 status = GET_LOWFLAT(td->status); u32 token = GET_LOWFLAT(td->token); if (status & TD_CTRL_ACTIVE) // No intrs found. return -1; // XXX - check for errors. // Copy data. void *tddata = GET_LOWFLAT(td->buffer); memcpy_far(GET_SEG(SS), data, SEG_LOW, LOWFLAT2LOW(tddata) , uhci_expected_length(token)); // Reenable this td. struct uhci_td *next = (void*)(GET_LOWFLAT(td->link) & ~UHCI_PTR_BITS); SET_LOWFLAT(pipe->next_td, next); barrier(); SET_LOWFLAT(td->status, (uhci_maxerr(0) | (status & TD_CTRL_LS) | TD_CTRL_ACTIVE)); return 0; } tinyvisor/bios/src/font.c0000644006644000001440000001550211733243570015731 0ustar yuichi_xyusers#include "types.h" // u8 // Character Font for 320x200 & 640x200 Graphics (lower 128 characters) /* * This font comes from the fntcol16.zip package (c) by Joseph Gil * found at ftp://ftp.simtel.net/pub/simtelnet/msdos/screen/fntcol16.zip * This font is public domain */ u8 vgafont8[128*8] VAR16FIXED(0xfa6e) = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0x81, 0xa5, 0x81, 0xbd, 0x99, 0x81, 0x7e, 0x7e, 0xff, 0xdb, 0xff, 0xc3, 0xe7, 0xff, 0x7e, 0x6c, 0xfe, 0xfe, 0xfe, 0x7c, 0x38, 0x10, 0x00, 0x10, 0x38, 0x7c, 0xfe, 0x7c, 0x38, 0x10, 0x00, 0x38, 0x7c, 0x38, 0xfe, 0xfe, 0x7c, 0x38, 0x7c, 0x10, 0x10, 0x38, 0x7c, 0xfe, 0x7c, 0x38, 0x7c, 0x00, 0x00, 0x18, 0x3c, 0x3c, 0x18, 0x00, 0x00, 0xff, 0xff, 0xe7, 0xc3, 0xc3, 0xe7, 0xff, 0xff, 0x00, 0x3c, 0x66, 0x42, 0x42, 0x66, 0x3c, 0x00, 0xff, 0xc3, 0x99, 0xbd, 0xbd, 0x99, 0xc3, 0xff, 0x0f, 0x07, 0x0f, 0x7d, 0xcc, 0xcc, 0xcc, 0x78, 0x3c, 0x66, 0x66, 0x66, 0x3c, 0x18, 0x7e, 0x18, 0x3f, 0x33, 0x3f, 0x30, 0x30, 0x70, 0xf0, 0xe0, 0x7f, 0x63, 0x7f, 0x63, 0x63, 0x67, 0xe6, 0xc0, 0x99, 0x5a, 0x3c, 0xe7, 0xe7, 0x3c, 0x5a, 0x99, 0x80, 0xe0, 0xf8, 0xfe, 0xf8, 0xe0, 0x80, 0x00, 0x02, 0x0e, 0x3e, 0xfe, 0x3e, 0x0e, 0x02, 0x00, 0x18, 0x3c, 0x7e, 0x18, 0x18, 0x7e, 0x3c, 0x18, 0x66, 0x66, 0x66, 0x66, 0x66, 0x00, 0x66, 0x00, 0x7f, 0xdb, 0xdb, 0x7b, 0x1b, 0x1b, 0x1b, 0x00, 0x3e, 0x63, 0x38, 0x6c, 0x6c, 0x38, 0xcc, 0x78, 0x00, 0x00, 0x00, 0x00, 0x7e, 0x7e, 0x7e, 0x00, 0x18, 0x3c, 0x7e, 0x18, 0x7e, 0x3c, 0x18, 0xff, 0x18, 0x3c, 0x7e, 0x18, 0x18, 0x18, 0x18, 0x00, 0x18, 0x18, 0x18, 0x18, 0x7e, 0x3c, 0x18, 0x00, 0x00, 0x18, 0x0c, 0xfe, 0x0c, 0x18, 0x00, 0x00, 0x00, 0x30, 0x60, 0xfe, 0x60, 0x30, 0x00, 0x00, 0x00, 0x00, 0xc0, 0xc0, 0xc0, 0xfe, 0x00, 0x00, 0x00, 0x24, 0x66, 0xff, 0x66, 0x24, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x7e, 0xff, 0xff, 0x00, 0x00, 0x00, 0xff, 0xff, 0x7e, 0x3c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x78, 0x78, 0x30, 0x30, 0x00, 0x30, 0x00, 0x6c, 0x6c, 0x6c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x6c, 0x6c, 0xfe, 0x6c, 0xfe, 0x6c, 0x6c, 0x00, 0x30, 0x7c, 0xc0, 0x78, 0x0c, 0xf8, 0x30, 0x00, 0x00, 0xc6, 0xcc, 0x18, 0x30, 0x66, 0xc6, 0x00, 0x38, 0x6c, 0x38, 0x76, 0xdc, 0xcc, 0x76, 0x00, 0x60, 0x60, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x30, 0x60, 0x60, 0x60, 0x30, 0x18, 0x00, 0x60, 0x30, 0x18, 0x18, 0x18, 0x30, 0x60, 0x00, 0x00, 0x66, 0x3c, 0xff, 0x3c, 0x66, 0x00, 0x00, 0x00, 0x30, 0x30, 0xfc, 0x30, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x30, 0x60, 0x00, 0x00, 0x00, 0xfc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x30, 0x00, 0x06, 0x0c, 0x18, 0x30, 0x60, 0xc0, 0x80, 0x00, 0x7c, 0xc6, 0xce, 0xde, 0xf6, 0xe6, 0x7c, 0x00, 0x30, 0x70, 0x30, 0x30, 0x30, 0x30, 0xfc, 0x00, 0x78, 0xcc, 0x0c, 0x38, 0x60, 0xcc, 0xfc, 0x00, 0x78, 0xcc, 0x0c, 0x38, 0x0c, 0xcc, 0x78, 0x00, 0x1c, 0x3c, 0x6c, 0xcc, 0xfe, 0x0c, 0x1e, 0x00, 0xfc, 0xc0, 0xf8, 0x0c, 0x0c, 0xcc, 0x78, 0x00, 0x38, 0x60, 0xc0, 0xf8, 0xcc, 0xcc, 0x78, 0x00, 0xfc, 0xcc, 0x0c, 0x18, 0x30, 0x30, 0x30, 0x00, 0x78, 0xcc, 0xcc, 0x78, 0xcc, 0xcc, 0x78, 0x00, 0x78, 0xcc, 0xcc, 0x7c, 0x0c, 0x18, 0x70, 0x00, 0x00, 0x30, 0x30, 0x00, 0x00, 0x30, 0x30, 0x00, 0x00, 0x30, 0x30, 0x00, 0x00, 0x30, 0x30, 0x60, 0x18, 0x30, 0x60, 0xc0, 0x60, 0x30, 0x18, 0x00, 0x00, 0x00, 0xfc, 0x00, 0x00, 0xfc, 0x00, 0x00, 0x60, 0x30, 0x18, 0x0c, 0x18, 0x30, 0x60, 0x00, 0x78, 0xcc, 0x0c, 0x18, 0x30, 0x00, 0x30, 0x00, 0x7c, 0xc6, 0xde, 0xde, 0xde, 0xc0, 0x78, 0x00, 0x30, 0x78, 0xcc, 0xcc, 0xfc, 0xcc, 0xcc, 0x00, 0xfc, 0x66, 0x66, 0x7c, 0x66, 0x66, 0xfc, 0x00, 0x3c, 0x66, 0xc0, 0xc0, 0xc0, 0x66, 0x3c, 0x00, 0xf8, 0x6c, 0x66, 0x66, 0x66, 0x6c, 0xf8, 0x00, 0xfe, 0x62, 0x68, 0x78, 0x68, 0x62, 0xfe, 0x00, 0xfe, 0x62, 0x68, 0x78, 0x68, 0x60, 0xf0, 0x00, 0x3c, 0x66, 0xc0, 0xc0, 0xce, 0x66, 0x3e, 0x00, 0xcc, 0xcc, 0xcc, 0xfc, 0xcc, 0xcc, 0xcc, 0x00, 0x78, 0x30, 0x30, 0x30, 0x30, 0x30, 0x78, 0x00, 0x1e, 0x0c, 0x0c, 0x0c, 0xcc, 0xcc, 0x78, 0x00, 0xe6, 0x66, 0x6c, 0x78, 0x6c, 0x66, 0xe6, 0x00, 0xf0, 0x60, 0x60, 0x60, 0x62, 0x66, 0xfe, 0x00, 0xc6, 0xee, 0xfe, 0xfe, 0xd6, 0xc6, 0xc6, 0x00, 0xc6, 0xe6, 0xf6, 0xde, 0xce, 0xc6, 0xc6, 0x00, 0x38, 0x6c, 0xc6, 0xc6, 0xc6, 0x6c, 0x38, 0x00, 0xfc, 0x66, 0x66, 0x7c, 0x60, 0x60, 0xf0, 0x00, 0x78, 0xcc, 0xcc, 0xcc, 0xdc, 0x78, 0x1c, 0x00, 0xfc, 0x66, 0x66, 0x7c, 0x6c, 0x66, 0xe6, 0x00, 0x78, 0xcc, 0xe0, 0x70, 0x1c, 0xcc, 0x78, 0x00, 0xfc, 0xb4, 0x30, 0x30, 0x30, 0x30, 0x78, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xfc, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x78, 0x30, 0x00, 0xc6, 0xc6, 0xc6, 0xd6, 0xfe, 0xee, 0xc6, 0x00, 0xc6, 0xc6, 0x6c, 0x38, 0x38, 0x6c, 0xc6, 0x00, 0xcc, 0xcc, 0xcc, 0x78, 0x30, 0x30, 0x78, 0x00, 0xfe, 0xc6, 0x8c, 0x18, 0x32, 0x66, 0xfe, 0x00, 0x78, 0x60, 0x60, 0x60, 0x60, 0x60, 0x78, 0x00, 0xc0, 0x60, 0x30, 0x18, 0x0c, 0x06, 0x02, 0x00, 0x78, 0x18, 0x18, 0x18, 0x18, 0x18, 0x78, 0x00, 0x10, 0x38, 0x6c, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x30, 0x30, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0x76, 0x00, 0xe0, 0x60, 0x60, 0x7c, 0x66, 0x66, 0xdc, 0x00, 0x00, 0x00, 0x78, 0xcc, 0xc0, 0xcc, 0x78, 0x00, 0x1c, 0x0c, 0x0c, 0x7c, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x78, 0xcc, 0xfc, 0xc0, 0x78, 0x00, 0x38, 0x6c, 0x60, 0xf0, 0x60, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x76, 0xcc, 0xcc, 0x7c, 0x0c, 0xf8, 0xe0, 0x60, 0x6c, 0x76, 0x66, 0x66, 0xe6, 0x00, 0x30, 0x00, 0x70, 0x30, 0x30, 0x30, 0x78, 0x00, 0x0c, 0x00, 0x0c, 0x0c, 0x0c, 0xcc, 0xcc, 0x78, 0xe0, 0x60, 0x66, 0x6c, 0x78, 0x6c, 0xe6, 0x00, 0x70, 0x30, 0x30, 0x30, 0x30, 0x30, 0x78, 0x00, 0x00, 0x00, 0xcc, 0xfe, 0xfe, 0xd6, 0xc6, 0x00, 0x00, 0x00, 0xf8, 0xcc, 0xcc, 0xcc, 0xcc, 0x00, 0x00, 0x00, 0x78, 0xcc, 0xcc, 0xcc, 0x78, 0x00, 0x00, 0x00, 0xdc, 0x66, 0x66, 0x7c, 0x60, 0xf0, 0x00, 0x00, 0x76, 0xcc, 0xcc, 0x7c, 0x0c, 0x1e, 0x00, 0x00, 0xdc, 0x76, 0x66, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x7c, 0xc0, 0x78, 0x0c, 0xf8, 0x00, 0x10, 0x30, 0x7c, 0x30, 0x30, 0x34, 0x18, 0x00, 0x00, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0xcc, 0xcc, 0xcc, 0x78, 0x30, 0x00, 0x00, 0x00, 0xc6, 0xd6, 0xfe, 0xfe, 0x6c, 0x00, 0x00, 0x00, 0xc6, 0x6c, 0x38, 0x6c, 0xc6, 0x00, 0x00, 0x00, 0xcc, 0xcc, 0xcc, 0x7c, 0x0c, 0xf8, 0x00, 0x00, 0xfc, 0x98, 0x30, 0x64, 0xfc, 0x00, 0x1c, 0x30, 0x30, 0xe0, 0x30, 0x30, 0x1c, 0x00, 0x18, 0x18, 0x18, 0x00, 0x18, 0x18, 0x18, 0x00, 0xe0, 0x30, 0x30, 0x1c, 0x30, 0x30, 0xe0, 0x00, 0x76, 0xdc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0xc6, 0xc6, 0xfe, 0x00, }; tinyvisor/bios/src/usb-hid.c0000644006644000001440000002565612172661303016325 0ustar yuichi_xyusers// Code for handling USB Human Interface Devices (HID). // // Copyright (C) 2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "usb-hid.h" // usb_keyboard_setup #include "config.h" // CONFIG_* #include "usb.h" // usb_ctrlrequest #include "biosvar.h" // GET_GLOBAL #include "ps2port.h" // ATKBD_CMD_GETID struct usb_pipe *keyboard_pipe VARFSEG; struct usb_pipe *mouse_pipe VARFSEG; /**************************************************************** * Setup ****************************************************************/ // Send USB HID protocol message. static int set_protocol(struct usb_pipe *pipe, u16 val) { struct usb_ctrlrequest req; req.bRequestType = USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE; req.bRequest = HID_REQ_SET_PROTOCOL; req.wValue = val; req.wIndex = 0; req.wLength = 0; return send_default_control(pipe, &req, NULL); } // Send USB HID SetIdle request. static int set_idle(struct usb_pipe *pipe, int ms) { struct usb_ctrlrequest req; req.bRequestType = USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE; req.bRequest = HID_REQ_SET_IDLE; req.wValue = (ms/4)<<8; req.wIndex = 0; req.wLength = 0; return send_default_control(pipe, &req, NULL); } #define KEYREPEATWAITMS 500 #define KEYREPEATMS 33 static int usb_kbd_setup(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc) { if (! CONFIG_USB_KEYBOARD) return -1; if (keyboard_pipe) // XXX - this enables the first found keyboard (could be random) return -1; if (epdesc->wMaxPacketSize != 8) return -1; // Enable "boot" protocol. int ret = set_protocol(usbdev->defpipe, 0); if (ret) return -1; // Periodically send reports to enable key repeat. ret = set_idle(usbdev->defpipe, KEYREPEATMS); if (ret) return -1; keyboard_pipe = usb_alloc_pipe(usbdev, epdesc); if (!keyboard_pipe) return -1; dprintf(1, "USB keyboard initialized\n"); return 0; } static int usb_mouse_setup(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc) { if (! CONFIG_USB_MOUSE) return -1; if (mouse_pipe) // XXX - this enables the first found mouse (could be random) return -1; if (epdesc->wMaxPacketSize < 3 || epdesc->wMaxPacketSize > 8) return -1; // Enable "boot" protocol. int ret = set_protocol(usbdev->defpipe, 0); if (ret) return -1; mouse_pipe = usb_alloc_pipe(usbdev, epdesc); if (!mouse_pipe) return -1; dprintf(1, "USB mouse initialized\n"); return 0; } // Initialize a found USB HID device (if applicable). int usb_hid_setup(struct usbdevice_s *usbdev) { if (! CONFIG_USB_KEYBOARD || ! CONFIG_USB_MOUSE) return -1; dprintf(2, "usb_hid_setup %p\n", usbdev->defpipe); struct usb_interface_descriptor *iface = usbdev->iface; if (iface->bInterfaceSubClass != USB_INTERFACE_SUBCLASS_BOOT) // Doesn't support boot protocol. return -1; // Find intr in endpoint. struct usb_endpoint_descriptor *epdesc = findEndPointDesc( usbdev, USB_ENDPOINT_XFER_INT, USB_DIR_IN); if (!epdesc) { dprintf(1, "No usb hid intr in?\n"); return -1; } if (iface->bInterfaceProtocol == USB_INTERFACE_PROTOCOL_KEYBOARD) return usb_kbd_setup(usbdev, epdesc); if (iface->bInterfaceProtocol == USB_INTERFACE_PROTOCOL_MOUSE) return usb_mouse_setup(usbdev, epdesc); return -1; } /**************************************************************** * Keyboard events ****************************************************************/ // Mapping from USB key id to ps2 key sequence. static u16 KeyToScanCode[] VAR16 = { 0x0000, 0x0000, 0x0000, 0x0000, 0x001e, 0x0030, 0x002e, 0x0020, 0x0012, 0x0021, 0x0022, 0x0023, 0x0017, 0x0024, 0x0025, 0x0026, 0x0032, 0x0031, 0x0018, 0x0019, 0x0010, 0x0013, 0x001f, 0x0014, 0x0016, 0x002f, 0x0011, 0x002d, 0x0015, 0x002c, 0x0002, 0x0003, 0x0004, 0x0005, 0x0006, 0x0007, 0x0008, 0x0009, 0x000a, 0x000b, 0x001c, 0x0001, 0x000e, 0x000f, 0x0039, 0x000c, 0x000d, 0x001a, 0x001b, 0x002b, 0x0000, 0x0027, 0x0028, 0x0029, 0x0033, 0x0034, 0x0035, 0x003a, 0x003b, 0x003c, 0x003d, 0x003e, 0x003f, 0x0040, 0x0041, 0x0042, 0x0043, 0x0044, 0x0057, 0x0058, 0xe037, 0x0046, 0xe11d, 0xe052, 0xe047, 0xe049, 0xe053, 0xe04f, 0xe051, 0xe04d, 0xe04b, 0xe050, 0xe048, 0x0045, 0xe035, 0x0037, 0x004a, 0x004e, 0xe01c, 0x004f, 0x0050, 0x0051, 0x004b, 0x004c, 0x004d, 0x0047, 0x0048, 0x0049, 0x0052, 0x0053 }; // Mapping from USB modifier id to ps2 key sequence. static u16 ModifierToScanCode[] VAR16 = { //lcntl, lshift, lalt, lgui, rcntl, rshift, ralt, rgui 0x001d, 0x002a, 0x0038, 0xe05b, 0xe01d, 0x0036, 0xe038, 0xe05c }; #define RELEASEBIT 0x80 // Format of USB keyboard event data struct keyevent { u8 modifiers; u8 reserved; u8 keys[6]; }; // Translate data from KeyToScanCode[] to calls to process_key(). static void prockeys(u16 keys) { if (keys > 0xff) { u8 key = keys>>8; if (key == 0xe1) { // Pause key process_key(0xe1); process_key(0x1d | (keys & RELEASEBIT)); process_key(0x45 | (keys & RELEASEBIT)); return; } process_key(key); } process_key(keys); } // Handle a USB key press/release event. static void procscankey(u8 key, u8 flags) { if (key >= ARRAY_SIZE(KeyToScanCode)) return; u16 keys = GET_GLOBAL(KeyToScanCode[key]); if (keys) prockeys(keys | flags); } // Handle a USB modifier press/release event. static void procmodkey(u8 mods, u8 flags) { int i; for (i=0; mods; i++) if (mods & (1<modifiers, data->keys[0]); // Load old keys. struct usbkeyinfo old; old.data = GET_LOW(LastUSBkey.data); // Check for keys no longer pressed. int addpos = 0; int i; for (i=0; i=ARRAY_SIZE(data->keys)) { // Key released. procscankey(key, RELEASEBIT); if (i+1 >= ARRAY_SIZE(old.keys) || !old.keys[i+1]) // Last pressed key released - disable repeat. old.repeatcount = 0xff; break; } if (data->keys[j] == key) { // Key still pressed. data->keys[j] = 0; old.keys[addpos++] = key; break; } } } procmodkey(old.modifiers & ~data->modifiers, RELEASEBIT); // Process new keys procmodkey(data->modifiers & ~old.modifiers, 0); old.modifiers = data->modifiers; for (i=0; ikeys); i++) { u8 key = data->keys[i]; if (!key) continue; // New key pressed. procscankey(key, 0); old.keys[addpos++] = key; old.repeatcount = KEYREPEATWAITMS / KEYREPEATMS + 1; } if (addpos < ARRAY_SIZE(old.keys)) old.keys[addpos] = 0; // Check for key repeat event. if (addpos) { if (!old.repeatcount) procscankey(old.keys[addpos-1], 0); else if (old.repeatcount != 0xff) old.repeatcount--; } // Update old keys SET_LOW(LastUSBkey.data, old.data); } // Check if a USB keyboard event is pending and process it if so. static void usb_check_key(void) { if (! CONFIG_USB_KEYBOARD) return; struct usb_pipe *pipe = GET_GLOBAL(keyboard_pipe); if (!pipe) return; for (;;) { struct keyevent data; int ret = usb_poll_intr(pipe, &data); if (ret) break; handle_key(&data); } } // Test if USB keyboard is active. inline int usb_kbd_active(void) { if (! CONFIG_USB_KEYBOARD) return 0; return GET_GLOBAL(keyboard_pipe) != NULL; } // Handle a ps2 style keyboard command. inline int usb_kbd_command(int command, u8 *param) { if (! CONFIG_USB_KEYBOARD) return -1; dprintf(9, "usb keyboard cmd=%x\n", command); switch (command) { case ATKBD_CMD_GETID: // Return the id of a standard AT keyboard. param[0] = 0xab; param[1] = 0x83; return 0; default: return -1; } } /**************************************************************** * Mouse events ****************************************************************/ // Format of USB mouse event data struct mouseevent { u8 buttons; u8 x, y; u8 reserved[5]; }; // Process USB mouse data. static void handle_mouse(struct mouseevent *data) { dprintf(9, "Got mouse b=%x x=%x y=%x\n", data->buttons, data->x, data->y); s8 x = data->x, y = -data->y; u8 flag = ((data->buttons & 0x7) | (1<<3) | (x & 0x80 ? (1<<4) : 0) | (y & 0x80 ? (1<<5) : 0)); process_mouse(flag); process_mouse(x); process_mouse(y); } // Check if a USB mouse event is pending and process it if so. static void usb_check_mouse(void) { if (! CONFIG_USB_MOUSE) return; struct usb_pipe *pipe = GET_GLOBAL(mouse_pipe); if (!pipe) return; for (;;) { struct mouseevent data; int ret = usb_poll_intr(pipe, &data); if (ret) break; handle_mouse(&data); } } // Test if USB mouse is active. inline int usb_mouse_active(void) { if (! CONFIG_USB_MOUSE) return 0; return GET_GLOBAL(mouse_pipe) != NULL; } // Handle a ps2 style mouse command. inline int usb_mouse_command(int command, u8 *param) { if (! CONFIG_USB_MOUSE) return -1; dprintf(9, "usb mouse cmd=%x\n", command); switch (command) { case PSMOUSE_CMD_ENABLE: case PSMOUSE_CMD_DISABLE: case PSMOUSE_CMD_SETSCALE11: return 0; case PSMOUSE_CMD_SETSCALE21: case PSMOUSE_CMD_SETRATE: case PSMOUSE_CMD_SETRES: // XXX return 0; case PSMOUSE_CMD_RESET_BAT: case PSMOUSE_CMD_GETID: // Return the id of a standard AT mouse. param[0] = 0xaa; param[1] = 0x00; return 0; case PSMOUSE_CMD_GETINFO: param[0] = 0x00; param[1] = 4; param[2] = 100; return 0; default: return -1; } } // Check for USB events pending - called periodically from timer interrupt. void usb_check_event(void) { usb_check_key(); usb_check_mouse(); } tinyvisor/bios/src/resume.c0000644006644000001440000000757512172661303016272 0ustar yuichi_xyusers// Code for handling calls to "post" that are resume related. // // Copyright (C) 2008,2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "ioport.h" // outb #include "pic.h" // eoi_pic2 #include "biosvar.h" // struct bios_data_area_s #include "bregs.h" // struct bregs #include "acpi.h" // find_resume_vector #include "ps2port.h" // i8042_reboot #include "pci.h" // pci_reboot #include "cmos.h" // inb_cmos // Indicator if POST phase has been run. int HaveRunPost VARFSEG; // Reset DMA controller void dma_setup(void) { // first reset the DMA controllers outb(0, PORT_DMA1_MASTER_CLEAR); outb(0, PORT_DMA2_MASTER_CLEAR); // then initialize the DMA controllers outb(0xc0, PORT_DMA2_MODE_REG); outb(0x00, PORT_DMA2_MASK_REG); } // Handler for post calls that look like a resume. void VISIBLE16 handle_resume(void) { ASSERT16(); debug_serial_preinit(); int status = inb_cmos(CMOS_RESET_CODE); outb_cmos(0, CMOS_RESET_CODE); dprintf(1, "In resume (status=%d)\n", status); dma_setup(); switch (status) { case 0x01 ... 0x04: case 0x06 ... 0x09: panic("Unimplemented shutdown status: %02x\n", status); case 0x05: // flush keyboard (issue EOI) and jump via 40h:0067h eoi_pic2(); // NO BREAK case 0x0a: #define BDA_JUMP (((struct bios_data_area_s *)0)->jump) // resume execution by jump via 40h:0067h asm volatile( "movw %w1, %%ds\n" "ljmpw *%0\n" : : "m"(BDA_JUMP), "r"(SEG_BDA) ); break; case 0x0b: // resume execution via IRET via 40h:0067h asm volatile( "movw %w1, %%ds\n" "lssw %0, %%sp\n" "iretw\n" : : "m"(BDA_JUMP), "r"(SEG_BDA) ); break; case 0x0c: // resume execution via RETF via 40h:0067h asm volatile( "movw %w1, %%ds\n" "lssw %0, %%sp\n" "lretw\n" : : "m"(BDA_JUMP), "r"(SEG_BDA) ); break; default: break; } // Not a 16bit resume - do remaining checks in 32bit mode asm volatile( "movw %w1, %%ss\n" "movl %0, %%esp\n" "movl $_cfunc32flat_handle_resume32, %%edx\n" "jmp transition32\n" : : "i"(BUILD_S3RESUME_STACK_ADDR), "r"(0), "a"(status) ); } // Handle an S3 resume event static void s3_resume(void) { if (!CONFIG_S3_RESUME) return; u32 s3_resume_vector = find_resume_vector(); if (!s3_resume_vector) { dprintf(1, "No resume vector set!\n"); return; } pic_setup(); smm_setup(); s3_resume_vga(); make_bios_readonly(); // Invoke the resume vector. struct bregs br; memset(&br, 0, sizeof(br)); dprintf(1, "Jump to resume vector (%x)\n", s3_resume_vector); br.code = FLATPTR_TO_SEGOFF((void*)s3_resume_vector); farcall16big(&br); } u8 HaveAttemptedReboot VARLOW; // Attempt to invoke a hard-reboot. static void tryReboot(void) { if (HaveAttemptedReboot) { // Hard reboot has failed - try to shutdown machine. dprintf(1, "Unable to hard-reboot machine - attempting shutdown.\n"); apm_shutdown(); } HaveAttemptedReboot = 1; dprintf(1, "Attempting a hard reboot\n"); // Setup for reset on qemu. qemu_prep_reset(); // Reboot using ACPI RESET_REG acpi_reboot(); // Try keyboard controller reboot. i8042_reboot(); // Try PCI 0xcf9 reboot pci_reboot(); // Try triple fault asm volatile("int3"); panic("Could not reboot"); } void VISIBLE32FLAT handle_resume32(int status) { ASSERT32FLAT(); dprintf(1, "In 32bit resume\n"); if (status == 0xfe) s3_resume(); // Must be a soft reboot - invoke a hard reboot. tryReboot(); } tinyvisor/bios/src/ahci.c0000644006644000001440000005110412174763154015672 0ustar yuichi_xyusers// Low level AHCI disk access // // Copyright (C) 2010 Gerd Hoffmann // // This file may be distributed under the terms of the GNU LGPLv3 license. /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include "types.h" // u8 #include "ioport.h" // inb #include "util.h" // dprintf #include "biosvar.h" // GET_GLOBAL #include "pci.h" // foreachpci #include "pci_ids.h" // PCI_CLASS_STORAGE_OTHER #include "pci_regs.h" // PCI_INTERRUPT_LINE #include "boot.h" // add_bcv_hd #include "disk.h" // struct ata_s #include "ata.h" // ATA_CB_STAT #include "ahci.h" // CDB_CMD_READ_10 #include "blockcmd.h" // CDB_CMD_READ_10 #define AHCI_REQUEST_TIMEOUT 32000 // 32 seconds max for IDE ops #define AHCI_RESET_TIMEOUT 500 // 500 miliseconds #define AHCI_HBA_RESET_TIMEOUT 1000 // 1 second #define AHCI_LINK_TIMEOUT 10 // 10 miliseconds /**************************************************************** * these bits must run in both 16bit and 32bit modes ****************************************************************/ // prepare sata command fis static void sata_prep_simple(struct sata_cmd_fis *fis, u8 command) { memset_fl(fis, 0, sizeof(*fis)); SET_LOWFLAT(fis->command, command); } static void sata_prep_readwrite(struct sata_cmd_fis *fis, struct disk_op_s *op, int iswrite) { u64 lba = op->lba; u8 command; memset_fl(fis, 0, sizeof(*fis)); if (op->count >= (1<<8) || lba + op->count >= (1<<28)) { SET_LOWFLAT(fis->sector_count2, op->count >> 8); SET_LOWFLAT(fis->lba_low2, lba >> 24); SET_LOWFLAT(fis->lba_mid2, lba >> 32); SET_LOWFLAT(fis->lba_high2, lba >> 40); lba &= 0xffffff; command = (iswrite ? ATA_CMD_WRITE_DMA_EXT : ATA_CMD_READ_DMA_EXT); } else { command = (iswrite ? ATA_CMD_WRITE_DMA : ATA_CMD_READ_DMA); } SET_LOWFLAT(fis->feature, 1); /* dma */ SET_LOWFLAT(fis->command, command); SET_LOWFLAT(fis->sector_count, op->count); SET_LOWFLAT(fis->lba_low, lba); SET_LOWFLAT(fis->lba_mid, lba >> 8); SET_LOWFLAT(fis->lba_high, lba >> 16); SET_LOWFLAT(fis->device, ((lba >> 24) & 0xf) | ATA_CB_DH_LBA); } static void sata_prep_atapi(struct sata_cmd_fis *fis, u16 blocksize) { memset_fl(fis, 0, sizeof(*fis)); SET_LOWFLAT(fis->command, ATA_CMD_PACKET); SET_LOWFLAT(fis->feature, 1); /* dma */ SET_LOWFLAT(fis->lba_mid, blocksize); SET_LOWFLAT(fis->lba_high, blocksize >> 8); } // ahci register access helpers static u32 ahci_ctrl_readl(struct ahci_ctrl_s *ctrl, u32 reg) { u32 addr = GET_GLOBALFLAT(ctrl->iobase) + reg; return pci_readl(addr); } static void ahci_ctrl_writel(struct ahci_ctrl_s *ctrl, u32 reg, u32 val) { u32 addr = GET_GLOBALFLAT(ctrl->iobase) + reg; pci_writel(addr, val); } static u32 ahci_port_to_ctrl(u32 pnr, u32 port_reg) { u32 ctrl_reg = 0x100; ctrl_reg += pnr * 0x80; ctrl_reg += port_reg; return ctrl_reg; } static u32 ahci_port_readl(struct ahci_ctrl_s *ctrl, u32 pnr, u32 reg) { u32 ctrl_reg = ahci_port_to_ctrl(pnr, reg); return ahci_ctrl_readl(ctrl, ctrl_reg); } static void ahci_port_writel(struct ahci_ctrl_s *ctrl, u32 pnr, u32 reg, u32 val) { u32 ctrl_reg = ahci_port_to_ctrl(pnr, reg); ahci_ctrl_writel(ctrl, ctrl_reg, val); } // submit ahci command + wait for result static int ahci_command(struct ahci_port_s *port, int iswrite, int isatapi, void *buffer, u32 bsize) { u32 val, status, success, flags, intbits, error; struct ahci_ctrl_s *ctrl = GET_GLOBAL(port->ctrl); struct ahci_cmd_s *cmd = GET_GLOBAL(port->cmd); struct ahci_fis_s *fis = GET_GLOBAL(port->fis); struct ahci_list_s *list = GET_GLOBAL(port->list); u32 pnr = GET_GLOBAL(port->pnr); u64 end; SET_LOWFLAT(cmd->fis.reg, 0x27); SET_LOWFLAT(cmd->fis.pmp_type, (1 << 7)); /* cmd fis */ SET_LOWFLAT(cmd->prdt[0].base, ((u32)buffer)); SET_LOWFLAT(cmd->prdt[0].baseu, 0); SET_LOWFLAT(cmd->prdt[0].flags, bsize-1); flags = ((1 << 16) | /* one prd entry */ (iswrite ? (1 << 6) : 0) | (isatapi ? (1 << 5) : 0) | (5 << 0)); /* fis length (dwords) */ SET_LOWFLAT(list[0].flags, flags); SET_LOWFLAT(list[0].bytes, 0); SET_LOWFLAT(list[0].base, ((u32)(cmd))); SET_LOWFLAT(list[0].baseu, 0); dprintf(8, "AHCI/%d: send cmd ...\n", pnr); intbits = ahci_port_readl(ctrl, pnr, PORT_IRQ_STAT); if (intbits) ahci_port_writel(ctrl, pnr, PORT_IRQ_STAT, intbits); #if 0 /* * If the command is a queued command, we need to set Serial ATA * Active register's bit. * But, we don't issue a queued command. we should not set it. */ ahci_port_writel(ctrl, pnr, PORT_SCR_ACT, 1); #endif ahci_port_writel(ctrl, pnr, PORT_CMD_ISSUE, 1); end = calc_future_tsc(AHCI_REQUEST_TIMEOUT); do { for (;;) { intbits = ahci_port_readl(ctrl, pnr, PORT_IRQ_STAT); if (intbits) { ahci_port_writel(ctrl, pnr, PORT_IRQ_STAT, intbits); if (intbits & 0x02) { status = GET_LOWFLAT(fis->psfis[2]); error = GET_LOWFLAT(fis->psfis[3]); break; } if (intbits & 0x01) { status = GET_LOWFLAT(fis->rfis[2]); error = GET_LOWFLAT(fis->rfis[3]); break; } } if (check_tsc(end)) { warn_timeout(); return -1; } yield(); } dprintf(8, "AHCI/%d: ... intbits 0x%x, status 0x%x ...\n", pnr, intbits, status); } while (status & ATA_CB_STAT_BSY); success = (0x00 == (status & (ATA_CB_STAT_BSY | ATA_CB_STAT_DF | ATA_CB_STAT_ERR)) && ATA_CB_STAT_RDY == (status & (ATA_CB_STAT_RDY))); if (success) { dprintf(8, "AHCI/%d: ... finished, status 0x%x, OK\n", pnr, status); } else { dprintf(2, "AHCI/%d: ... finished, status 0x%x, ERROR 0x%x\n", pnr, status, error); // non-queued error recovery (AHCI 1.3 section 6.2.2.1) // Clears PxCMD.ST to 0 to reset the PxCI register val = ahci_port_readl(ctrl, pnr, PORT_CMD); ahci_port_writel(ctrl, pnr, PORT_CMD, val & ~PORT_CMD_START); // waits for PxCMD.CR to clear to 0 while (1) { val = ahci_port_readl(ctrl, pnr, PORT_CMD); if ((val & PORT_CMD_LIST_ON) == 0) break; yield(); } // Clears any error bits in PxSERR to enable capturing new errors val = ahci_port_readl(ctrl, pnr, PORT_SCR_ERR); ahci_port_writel(ctrl, pnr, PORT_SCR_ERR, val); // Clears status bits in PxIS as appropriate val = ahci_port_readl(ctrl, pnr, PORT_IRQ_STAT); ahci_port_writel(ctrl, pnr, PORT_IRQ_STAT, val); // If PxTFD.STS.BSY or PxTFD.STS.DRQ is set to 1, issue // a COMRESET to the device to put it in an idle state val = ahci_port_readl(ctrl, pnr, PORT_TFDATA); if (val & (ATA_CB_STAT_BSY | ATA_CB_STAT_DRQ)) { dprintf(2, "AHCI/%d: issue comreset\n", pnr); val = ahci_port_readl(ctrl, pnr, PORT_SCR_CTL); // set Device Detection Initialization (DET) to 1 for 1 ms for comreset ahci_port_writel(ctrl, pnr, PORT_SCR_CTL, val | 1); mdelay (1); ahci_port_writel(ctrl, pnr, PORT_SCR_CTL, val); } // Sets PxCMD.ST to 1 to enable issuing new commands val = ahci_port_readl(ctrl, pnr, PORT_CMD); ahci_port_writel(ctrl, pnr, PORT_CMD, val | PORT_CMD_START); } return success ? 0 : -1; } #define CDROM_CDB_SIZE 12 int ahci_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize) { if (! CONFIG_AHCI) return 0; struct ahci_port_s *port = container_of( op->drive_g, struct ahci_port_s, drive); struct ahci_cmd_s *cmd = GET_GLOBAL(port->cmd); u8 *atapi = cdbcmd; int i, rc; sata_prep_atapi(&cmd->fis, blocksize); for (i = 0; i < CDROM_CDB_SIZE; i++) { SET_LOWFLAT(cmd->atapi[i], atapi[i]); } rc = ahci_command(port, 0, 1, op->buf_fl, op->count * blocksize); if (rc < 0) return DISK_RET_EBADTRACK; return DISK_RET_SUCCESS; } // read/write count blocks from a harddrive, op->buf_fl must be word aligned static int ahci_disk_readwrite_aligned(struct disk_op_s *op, int iswrite) { struct ahci_port_s *port = container_of( op->drive_g, struct ahci_port_s, drive); struct ahci_cmd_s *cmd = GET_GLOBAL(port->cmd); int rc; sata_prep_readwrite(&cmd->fis, op, iswrite); rc = ahci_command(port, iswrite, 0, op->buf_fl, op->count * DISK_SECTOR_SIZE); dprintf(8, "ahci disk %s, lba %6x, count %3x, buf %p, rc %d\n", iswrite ? "write" : "read", (u32)op->lba, op->count, op->buf_fl, rc); if (rc < 0) return DISK_RET_EBADTRACK; return DISK_RET_SUCCESS; } // read/write count blocks from a harddrive. static int ahci_disk_readwrite(struct disk_op_s *op, int iswrite) { // if caller's buffer is word aligned, use it directly if (((u32) op->buf_fl & 1) == 0) return ahci_disk_readwrite_aligned(op, iswrite); // Use a word aligned buffer for AHCI I/O int rc; struct disk_op_s localop = *op; u8 *alignedbuf_fl = GET_GLOBAL(bounce_buf_fl); u8 *position = op->buf_fl; localop.buf_fl = alignedbuf_fl; localop.count = 1; if (iswrite) { u16 block; for (block = 0; block < op->count; block++) { memcpy_fl (alignedbuf_fl, position, DISK_SECTOR_SIZE); rc = ahci_disk_readwrite_aligned (&localop, 1); if (rc) return rc; position += DISK_SECTOR_SIZE; localop.lba++; } } else { // read u16 block; for (block = 0; block < op->count; block++) { rc = ahci_disk_readwrite_aligned (&localop, 0); if (rc) return rc; memcpy_fl (position, alignedbuf_fl, DISK_SECTOR_SIZE); position += DISK_SECTOR_SIZE; localop.lba++; } } return DISK_RET_SUCCESS; } // command demuxer int process_ahci_op(struct disk_op_s *op) { if (!CONFIG_AHCI) return 0; switch (op->command) { case CMD_READ: return ahci_disk_readwrite(op, 0); case CMD_WRITE: return ahci_disk_readwrite(op, 1); case CMD_FORMAT: case CMD_RESET: case CMD_ISREADY: case CMD_VERIFY: case CMD_SEEK: return DISK_RET_SUCCESS; default: dprintf(1, "AHCI: unknown disk command %d\n", op->command); op->count = 0; return DISK_RET_EPARAM; } } /**************************************************************** * everything below is pure 32bit code ****************************************************************/ static void ahci_port_reset(struct ahci_ctrl_s *ctrl, u32 pnr) { u32 val; u64 end; /* disable FIS + CMD */ end = calc_future_tsc(AHCI_RESET_TIMEOUT); for (;;) { val = ahci_port_readl(ctrl, pnr, PORT_CMD); if (!(val & (PORT_CMD_FIS_RX | PORT_CMD_START | PORT_CMD_FIS_ON | PORT_CMD_LIST_ON))) break; val &= ~(PORT_CMD_FIS_RX | PORT_CMD_START); ahci_port_writel(ctrl, pnr, PORT_CMD, val); if (check_tsc(end)) { warn_timeout(); break; } yield(); } /* disable + clear IRQs */ ahci_port_writel(ctrl, pnr, PORT_IRQ_MASK, 0); val = ahci_port_readl(ctrl, pnr, PORT_IRQ_STAT); if (val) ahci_port_writel(ctrl, pnr, PORT_IRQ_STAT, val); } static struct ahci_port_s* ahci_port_alloc(struct ahci_ctrl_s *ctrl, u32 pnr) { struct ahci_port_s *port = malloc_tmp(sizeof(*port)); if (!port) { warn_noalloc(); return NULL; } port->pnr = pnr; port->ctrl = ctrl; port->list = memalign_tmp(1024, 1024); port->fis = memalign_tmp(256, 256); port->cmd = memalign_tmp(256, 256); if (port->list == NULL || port->fis == NULL || port->cmd == NULL) { warn_noalloc(); return NULL; } memset(port->list, 0, 1024); memset(port->fis, 0, 256); memset(port->cmd, 0, 256); ahci_port_writel(ctrl, pnr, PORT_LST_ADDR, (u32)port->list); ahci_port_writel(ctrl, pnr, PORT_FIS_ADDR, (u32)port->fis); return port; } static struct ahci_port_s* ahci_port_realloc(struct ahci_port_s *port) { struct ahci_port_s *tmp; u32 cmd; tmp = malloc_fseg(sizeof(*port)); *tmp = *port; free(port); port = tmp; ahci_port_reset(port->ctrl, port->pnr); free(port->list); free(port->fis); free(port->cmd); port->list = memalign_low(1024, 1024); port->fis = memalign_low(256, 256); port->cmd = memalign_low(256, 256); ahci_port_writel(port->ctrl, port->pnr, PORT_LST_ADDR, (u32)port->list); ahci_port_writel(port->ctrl, port->pnr, PORT_FIS_ADDR, (u32)port->fis); cmd = ahci_port_readl(port->ctrl, port->pnr, PORT_CMD); cmd |= (PORT_CMD_FIS_RX|PORT_CMD_START); ahci_port_writel(port->ctrl, port->pnr, PORT_CMD, cmd); return port; } static void ahci_port_release(struct ahci_port_s *port) { ahci_port_reset(port->ctrl, port->pnr); free(port->list); free(port->fis); free(port->cmd); free(port); } #define MAXMODEL 40 /* See ahci spec chapter 10.1 "Software Initialization of HBA" */ static int ahci_port_setup(struct ahci_port_s *port) { struct ahci_ctrl_s *ctrl = port->ctrl; u32 pnr = port->pnr; char model[MAXMODEL+1]; u16 buffer[256]; u32 cmd, stat, err, tf; u64 end; int rc; /* enable FIS recv */ cmd = ahci_port_readl(ctrl, pnr, PORT_CMD); cmd |= PORT_CMD_FIS_RX; ahci_port_writel(ctrl, pnr, PORT_CMD, cmd); /* spin up */ cmd |= PORT_CMD_SPIN_UP; ahci_port_writel(ctrl, pnr, PORT_CMD, cmd); end = calc_future_tsc(AHCI_LINK_TIMEOUT); for (;;) { stat = ahci_port_readl(ctrl, pnr, PORT_SCR_STAT); if ((stat & 0x07) == 0x03) { dprintf(2, "AHCI/%d: link up\n", port->pnr); break; } if (check_tsc(end)) { dprintf(2, "AHCI/%d: link down\n", port->pnr); return -1; } yield(); } /* clear error status */ err = ahci_port_readl(ctrl, pnr, PORT_SCR_ERR); if (err) ahci_port_writel(ctrl, pnr, PORT_SCR_ERR, err); /* wait for device becoming ready */ end = calc_future_tsc(AHCI_REQUEST_TIMEOUT); for (;;) { tf = ahci_port_readl(ctrl, pnr, PORT_TFDATA); if (!(tf & (ATA_CB_STAT_BSY | ATA_CB_STAT_DRQ))) break; if (check_tsc(end)) { warn_timeout(); dprintf(1, "AHCI/%d: device not ready (tf 0x%x)\n", port->pnr, tf); return -1; } yield(); } /* start device */ cmd |= PORT_CMD_START; ahci_port_writel(ctrl, pnr, PORT_CMD, cmd); #if 0 sata_prep_simple(&port->cmd->fis, ATA_CMD_IDENTIFY_PACKET_DEVICE); rc = ahci_command(port, 0, 0, buffer, sizeof(buffer)); if (rc == 0) { port->atapi = 1; } else { port->atapi = 0; sata_prep_simple(&port->cmd->fis, ATA_CMD_IDENTIFY_DEVICE); rc = ahci_command(port, 0, 0, buffer, sizeof(buffer)); if (rc < 0) return -1; } #else port->atapi = 0; sata_prep_simple(&port->cmd->fis, ATA_CMD_IDENTIFY_DEVICE); rc = ahci_command(port, 0, 0, buffer, sizeof(buffer)); if (rc < 0) return -1; #endif port->drive.cntl_id = pnr; port->drive.removable = (buffer[0] & 0x80) ? 1 : 0; if (!port->atapi) { // found disk (ata) port->drive.type = DTYPE_AHCI; port->drive.blksize = DISK_SECTOR_SIZE; port->drive.pchs.cylinders = buffer[1]; port->drive.pchs.heads = buffer[3]; port->drive.pchs.spt = buffer[6]; u64 sectors; if (buffer[83] & (1 << 10)) // word 83 - lba48 support sectors = *(u64*)&buffer[100]; // word 100-103 else sectors = *(u32*)&buffer[60]; // word 60 and word 61 port->drive.sectors = sectors; u64 adjsize = sectors >> 11; char adjprefix = 'M'; if (adjsize >= (1 << 16)) { adjsize >>= 10; adjprefix = 'G'; } port->desc = znprintf(MAXDESCSIZE , "AHCI/%d: %s ATA-%d Hard-Disk (%u %ciBytes)" , port->pnr , ata_extract_model(model, MAXMODEL, buffer) , ata_extract_version(buffer) , (u32)adjsize, adjprefix); port->prio = bootprio_find_ata_device(ctrl->pci_tmp, pnr, 0); } else { // found cdrom (atapi) port->drive.type = DTYPE_AHCI_ATAPI; port->drive.blksize = CDROM_SECTOR_SIZE; port->drive.sectors = (u64)-1; u8 iscd = ((buffer[0] >> 8) & 0x1f) == 0x05; if (!iscd) { dprintf(1, "AHCI/%d: atapi device isn't a cdrom\n", port->pnr); return -1; } port->desc = znprintf(MAXDESCSIZE , "DVD/CD [AHCI/%d: %s ATAPI-%d DVD/CD]" , port->pnr , ata_extract_model(model, MAXMODEL, buffer) , ata_extract_version(buffer)); port->prio = bootprio_find_ata_device(ctrl->pci_tmp, pnr, 0); } return 0; } // Detect any drives attached to a given controller. static void ahci_port_detect(void *data) { struct ahci_port_s *port = data; int rc; dprintf(2, "AHCI/%d: probing\n", port->pnr); ahci_port_reset(port->ctrl, port->pnr); rc = ahci_port_setup(port); if (rc < 0) ahci_port_release(port); else { port = ahci_port_realloc(port); dprintf(1, "AHCI/%d: registering: \"%s\"\n", port->pnr, port->desc); if (!port->atapi) { // Register with bcv system. boot_add_hd(&port->drive, port->desc, port->prio); } else { // fill cdidmap boot_add_cd(&port->drive, port->desc, port->prio); } } } // Initialize an ata controller and detect its drives. static void ahci_controller_setup(struct pci_device *pci) { struct ahci_ctrl_s *ctrl = malloc_fseg(sizeof(*ctrl)); struct ahci_port_s *port; u16 bdf = pci->bdf; u32 val, pnr, max; #ifdef AHCI_HBA_RESET u64 end; #endif if (!ctrl) { warn_noalloc(); return; } if (create_bounce_buf() < 0) { warn_noalloc(); free(ctrl); return; } pci->have_driver = 1; ctrl->pci_tmp = pci; ctrl->pci_bdf = bdf; ctrl->iobase = pci_config_readl(bdf, PCI_BASE_ADDRESS_5); ctrl->irq = pci_config_readb(bdf, PCI_INTERRUPT_LINE); dprintf(1, "AHCI controller at %02x.%x, iobase %x, irq %d\n", bdf >> 3, bdf & 7, ctrl->iobase, ctrl->irq); pci_config_maskw(bdf, PCI_COMMAND, 0, PCI_COMMAND_IO | PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER); #if AHCI_HBA_RESET /* HBA Reset */ val = ahci_ctrl_readl(ctrl, HOST_CTL); ahci_ctrl_writel(ctrl, HOST_CTL, val | HOST_CTL_AHCI_EN | HOST_CTL_RESET); end = calc_future_tsc(AHCI_HBA_RESET_TIMEOUT); while (ahci_ctrl_readl(ctrl, HOST_CTL) & HOST_CTL_AHCI_EN) { if (check_tsc(end)) { warn_timeout(); return; } yield(); } #endif /* Enable AHCI mode */ val = ahci_ctrl_readl(ctrl, HOST_CTL); ahci_ctrl_writel(ctrl, HOST_CTL, val | HOST_CTL_AHCI_EN); ctrl->caps = ahci_ctrl_readl(ctrl, HOST_CAP); ctrl->ports = ahci_ctrl_readl(ctrl, HOST_PORTS_IMPL); dprintf(2, "AHCI: cap 0x%x, ports_impl 0x%x\n", ctrl->caps, ctrl->ports); max = ctrl->caps & 0x1f; for (pnr = 0; pnr <= max; pnr++) { if (!(ctrl->ports & (1 << pnr))) continue; port = ahci_port_alloc(ctrl, pnr); if (port == NULL) continue; run_thread(ahci_port_detect, port); } } // Locate and init ahci controllers. static void ahci_scan(void) { // Scan PCI bus for ATA adapters struct pci_device *pci; foreachpci(pci) { if (pci->class != PCI_CLASS_STORAGE_SATA) continue; if (pci->prog_if != 1 /* AHCI rev 1 */) continue; ahci_controller_setup(pci); } } void ahci_setup(void) { ASSERT32FLAT(); if (!CONFIG_AHCI) return; dprintf(3, "init ahci\n"); ahci_scan(); } tinyvisor/bios/src/virtio-pci.h0000644006644000001440000000542011733243570017053 0ustar yuichi_xyusers#ifndef _VIRTIO_PCI_H #define _VIRTIO_PCI_H #include "ioport.h" // inl /* A 32-bit r/o bitmask of the features supported by the host */ #define VIRTIO_PCI_HOST_FEATURES 0 /* A 32-bit r/w bitmask of features activated by the guest */ #define VIRTIO_PCI_GUEST_FEATURES 4 /* A 32-bit r/w PFN for the currently selected queue */ #define VIRTIO_PCI_QUEUE_PFN 8 /* A 16-bit r/o queue size for the currently selected queue */ #define VIRTIO_PCI_QUEUE_NUM 12 /* A 16-bit r/w queue selector */ #define VIRTIO_PCI_QUEUE_SEL 14 /* A 16-bit r/w queue notifier */ #define VIRTIO_PCI_QUEUE_NOTIFY 16 /* An 8-bit device status register. */ #define VIRTIO_PCI_STATUS 18 /* An 8-bit r/o interrupt status register. Reading the value will return the * current contents of the ISR and will also clear it. This is effectively * a read-and-acknowledge. */ #define VIRTIO_PCI_ISR 19 /* The bit of the ISR which indicates a device configuration change. */ #define VIRTIO_PCI_ISR_CONFIG 0x2 /* The remaining space is defined by each driver as the per-driver * configuration space */ #define VIRTIO_PCI_CONFIG 20 /* Virtio ABI version, this must match exactly */ #define VIRTIO_PCI_ABI_VERSION 0 static inline u32 vp_get_features(unsigned int ioaddr) { return inl(ioaddr + VIRTIO_PCI_HOST_FEATURES); } static inline void vp_set_features(unsigned int ioaddr, u32 features) { outl(features, ioaddr + VIRTIO_PCI_GUEST_FEATURES); } static inline void vp_get(unsigned int ioaddr, unsigned offset, void *buf, unsigned len) { u8 *ptr = buf; unsigned i; for (i = 0; i < len; i++) ptr[i] = inb(ioaddr + VIRTIO_PCI_CONFIG + offset + i); } static inline u8 vp_get_status(unsigned int ioaddr) { return inb(ioaddr + VIRTIO_PCI_STATUS); } static inline void vp_set_status(unsigned int ioaddr, u8 status) { if (status == 0) /* reset */ return; outb(status, ioaddr + VIRTIO_PCI_STATUS); } static inline u8 vp_get_isr(unsigned int ioaddr) { return inb(ioaddr + VIRTIO_PCI_ISR); } static inline void vp_reset(unsigned int ioaddr) { outb(0, ioaddr + VIRTIO_PCI_STATUS); (void)inb(ioaddr + VIRTIO_PCI_ISR); } static inline void vp_notify(unsigned int ioaddr, int queue_index) { outw(queue_index, ioaddr + VIRTIO_PCI_QUEUE_NOTIFY); } static inline void vp_del_vq(unsigned int ioaddr, int queue_index) { /* select the queue */ outw(queue_index, ioaddr + VIRTIO_PCI_QUEUE_SEL); /* deactivate the queue */ outl(0, ioaddr + VIRTIO_PCI_QUEUE_PFN); } struct vring_virtqueue; u16 vp_init_simple(u16 bdf); int vp_find_vq(unsigned int ioaddr, int queue_index, struct vring_virtqueue **p_vq); #endif /* _VIRTIO_PCI_H_ */ tinyvisor/bios/src/optionroms.c0000644006644000001440000003320212174763154017176 0ustar yuichi_xyusers// Option rom scanning code. // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. /* * Copyright (c) 2010-2012 Yuichi Watanabe */ #include "bregs.h" // struct bregs #include "farptr.h" // FLATPTR_TO_SEG #include "config.h" // CONFIG_* #include "util.h" // dprintf #include "pci.h" // foreachpci #include "pci_regs.h" // PCI_ROM_ADDRESS #include "pci_ids.h" // PCI_CLASS_DISPLAY_VGA #include "boot.h" // IPL #include "optionroms.h" // struct rom_header /**************************************************************** * Helper functions ****************************************************************/ // Execute a given option rom. static void __callrom(struct rom_header *rom, u16 offset, u16 bdf) { u16 seg = FLATPTR_TO_SEG(rom); dprintf(1, "Running option rom at %04x:%04x\n", seg, offset); struct bregs br; memset(&br, 0, sizeof(br)); br.flags = F_IF; br.ax = bdf; br.bx = 0xffff; br.dx = 0xffff; br.es = SEG_BIOS; br.di = get_pnp_offset(); br.code = SEGOFF(seg, offset); start_preempt(); farcall16big(&br); finish_preempt(); debug_serial_preinit(); } // Execute a given option rom at the standard entry vector. void callrom(struct rom_header *rom, u16 bdf) { __callrom(rom, OPTION_ROM_INITVECTOR, bdf); } // Execute a BCV option rom registered via add_bcv(). void call_bcv(u16 seg, u16 ip) { __callrom(MAKE_FLATPTR(seg, 0), ip, 0); } static int EnforceChecksum; // Verify that an option rom looks valid static int is_valid_rom(struct rom_header *rom) { dprintf(6, "Checking rom %p (sig %x size %d)\n" , rom, rom->signature, rom->size); if (rom->signature != OPTION_ROM_SIGNATURE) return 0; if (! rom->size) return 0; u32 len = rom->size * 512; u8 sum = checksum(rom, len); if (sum != 0) { dprintf(1, "Found option rom with bad checksum: loc=%p len=%d sum=%x\n" , rom, len, sum); if (EnforceChecksum) return 0; } return 1; } // Check if a valid option rom has a pnp struct; return it if so. static struct pnp_data * get_pnp_rom(struct rom_header *rom) { struct pnp_data *pnp = (void*)((u8*)rom + rom->pnpoffset); if (pnp->signature != PNP_SIGNATURE) return NULL; return pnp; } // Check for multiple pnp option rom headers. static struct pnp_data * get_pnp_next(struct rom_header *rom, struct pnp_data *pnp) { if (! pnp->nextoffset) return NULL; pnp = (void*)((u8*)rom + pnp->nextoffset); if (pnp->signature != PNP_SIGNATURE) return NULL; return pnp; } // Check if a valid option rom has a pci struct; return it if so. static struct pci_data * get_pci_rom(struct rom_header *rom) { struct pci_data *pd = (void*)((u32)rom + rom->pcioffset); if (pd->signature != PCI_ROM_SIGNATURE) return NULL; if (rom->pcioffset & 3) dprintf(1, "WARNING! Found unaligned PCI rom (vd=%04x:%04x)\n" , pd->vendor, pd->device); return pd; } // Run rom init code and note rom size. static int init_optionrom(struct rom_header *rom, u16 bdf, int isvga) { if (! is_valid_rom(rom)) return -1; struct rom_header *newrom = rom_reserve(rom->size * 512); if (!newrom) { warn_noalloc(); return -1; } if (newrom != rom) memmove(newrom, rom, rom->size * 512); if (isvga || get_pnp_rom(newrom)) // Only init vga and PnP roms here. callrom(newrom, bdf); return rom_confirm(newrom->size * 512); } #define RS_PCIROM (1LL<<33) static void setRomSource(u64 *sources, struct rom_header *rom, u64 source) { if (sources) sources[((u32)rom - BUILD_ROM_START) / OPTION_ROM_ALIGN] = source; } static int getRomPriority(u64 *sources, struct rom_header *rom, int instance) { u64 source = sources[((u32)rom - BUILD_ROM_START) / OPTION_ROM_ALIGN]; if (!source) return -1; if (source & RS_PCIROM) return bootprio_find_pci_rom((void*)(u32)source, instance); struct romfile_s *file = (void*)(u32)source; return bootprio_find_named_rom(file->name, instance); } /**************************************************************** * Roms in CBFS ****************************************************************/ static struct rom_header * deploy_romfile(struct romfile_s *file) { u32 size = file->size; struct rom_header *rom = rom_reserve(size); if (!rom) { warn_noalloc(); return NULL; } int ret = file->copy(file, rom, size); if (ret <= 0) return NULL; return rom; } // Check if an option rom is at a hardcoded location or in CBFS. static struct rom_header * lookup_hardcode(struct pci_device *pci) { char fname[17]; snprintf(fname, sizeof(fname), "pci%04x,%04x.rom" , pci->vendor, pci->device); struct romfile_s *file = romfile_find(fname); if (file) return deploy_romfile(file); return NULL; } // Run all roms in a given CBFS directory. static void run_file_roms(const char *prefix, int isvga, u64 *sources) { struct romfile_s *file = NULL; for (;;) { file = romfile_findprefix(prefix, file); if (!file) break; struct rom_header *rom = deploy_romfile(file); if (rom) { setRomSource(sources, rom, (u32)file); init_optionrom(rom, 0, isvga); } } } /**************************************************************** * PCI roms ****************************************************************/ // Verify device is a vga device with legacy address decoding enabled. int is_pci_vga(struct pci_device *pci) { if (pci->class != PCI_CLASS_DISPLAY_VGA) return 0; u16 cmd = pci_config_readw(pci->bdf, PCI_COMMAND); if (!(cmd & PCI_COMMAND_IO && cmd & PCI_COMMAND_MEMORY)) return 0; while (pci->parent) { pci = pci->parent; u32 ctrl = pci_config_readb(pci->bdf, PCI_BRIDGE_CONTROL); if (!(ctrl & PCI_BRIDGE_CTL_VGA)) return 0; } return 1; } // Copy a rom to its permanent location below 1MiB static struct rom_header * copy_rom(struct rom_header *rom) { u32 romsize = rom->size * 512; struct rom_header *newrom = rom_reserve(romsize); if (!newrom) { warn_noalloc(); return NULL; } dprintf(4, "Copying option rom (size %d) from %p to %p\n" , romsize, rom, newrom); iomemcpy(newrom, rom, romsize); return newrom; } // Map the option rom of a given PCI device. static struct rom_header * map_pcirom(struct pci_device *pci) { u16 bdf = pci->bdf; dprintf(6, "Attempting to map option rom on dev %02x:%02x.%x\n" , pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf), pci_bdf_to_fn(bdf)); if ((pci->header_type & 0x7f) != PCI_HEADER_TYPE_NORMAL) { dprintf(6, "Skipping non-normal pci device (type=%x)\n" , pci->header_type); return NULL; } u16 orig_cmd = pci_config_readw(bdf, PCI_COMMAND); u32 orig = pci_config_readl(bdf, PCI_ROM_ADDRESS); pci_config_writel(bdf, PCI_ROM_ADDRESS, ~PCI_ROM_ADDRESS_ENABLE); u32 sz = pci_config_readl(bdf, PCI_ROM_ADDRESS); dprintf(6, "Option rom sizing returned %x %x\n", orig, sz); orig &= ~PCI_ROM_ADDRESS_ENABLE; if (!sz || sz == 0xffffffff) goto fail; if (orig == sz || (u32)(orig + 4*1024*1024) < 20*1024*1024) { // Don't try to map to a pci addresses at its max, in the last // 4MiB of ram, or the first 16MiB of ram. dprintf(6, "Preset rom address doesn't look valid\n"); goto fail; } // Looks like a rom - enable it. pci_config_writel(bdf, PCI_ROM_ADDRESS, orig | PCI_ROM_ADDRESS_ENABLE); pci_config_writew(bdf, PCI_COMMAND, orig_cmd | PCI_COMMAND_MEMORY); struct rom_header *rom = (void*)orig; for (;;) { dprintf(5, "Inspecting possible rom at %p (vd=%04x:%04x" " bdf=%02x:%02x.%x)\n" , rom, pci->vendor, pci->device , pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf), pci_bdf_to_fn(bdf)); if (rom->signature != OPTION_ROM_SIGNATURE) { dprintf(6, "No option rom signature (got %x)\n", rom->signature); goto fail; } struct pci_data *pd = get_pci_rom(rom); if (! pd) { dprintf(6, "No valid pci signature found\n"); goto fail; } if (pd->vendor == pci->vendor && pd->device == pci->device && pd->type == PCIROM_CODETYPE_X86) // A match break; dprintf(6, "Didn't match dev/ven (got %04x:%04x) or type (got %d)\n" , pd->vendor, pd->device, pd->type); if (pd->indicator & 0x80) { dprintf(6, "No more images left\n"); goto fail; } rom = (void*)((u32)rom + pd->ilen * 512); } rom = copy_rom(rom); pci_config_writel(bdf, PCI_COMMAND, orig_cmd); pci_config_writew(bdf, PCI_ROM_ADDRESS, orig); return rom; fail: // Not valid - restore original and exit. pci_config_writel(bdf, PCI_COMMAND, orig_cmd); pci_config_writew(bdf, PCI_ROM_ADDRESS, orig); return NULL; } // Attempt to map and initialize the option rom on a given PCI device. static int init_pcirom(struct pci_device *pci, int isvga, u64 *sources) { u16 bdf = pci->bdf; dprintf(4, "Attempting to init PCI bdf %02x:%02x.%x (vd %04x:%04x)\n" , pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf), pci_bdf_to_fn(bdf) , pci->vendor, pci->device); struct rom_header *rom = lookup_hardcode(pci); if (! rom) rom = map_pcirom(pci); if (! rom) // No ROM present. return -1; setRomSource(sources, rom, RS_PCIROM | (u32)pci); return init_optionrom(rom, bdf, isvga); } /**************************************************************** * Non-VGA option rom init ****************************************************************/ void optionrom_setup(void) { if (! CONFIG_OPTIONROMS) return; dprintf(1, "Scan for option roms\n"); u64 sources[(BUILD_BIOS_ADDR - BUILD_ROM_START) / OPTION_ROM_ALIGN]; memset(sources, 0, sizeof(sources)); u32 post_vga = rom_get_last(); if (CONFIG_OPTIONROMS_DEPLOYED) { // Option roms are already deployed on the system. u32 pos = post_vga; while (pos < rom_get_max()) { int ret = init_optionrom((void*)pos, 0, 0); if (ret) pos += OPTION_ROM_ALIGN; else pos = rom_get_last(); } } else { // Find and deploy PCI roms. struct pci_device *pci; foreachpci(pci) { if (pci->class == PCI_CLASS_DISPLAY_VGA || pci->have_driver) continue; init_pcirom(pci, 0, sources); } // Find and deploy CBFS roms not associated with a device. run_file_roms("genroms/", 0, sources); } rom_reserve(0); // All option roms found and deployed - now build BEV/BCV vectors. u32 pos = post_vga; while (pos < rom_get_last()) { struct rom_header *rom = (void*)pos; if (! is_valid_rom(rom)) { pos += OPTION_ROM_ALIGN; continue; } pos += ALIGN(rom->size * 512, OPTION_ROM_ALIGN); struct pnp_data *pnp = get_pnp_rom(rom); if (! pnp) { // Legacy rom. boot_add_bcv(FLATPTR_TO_SEG(rom), OPTION_ROM_INITVECTOR, 0 , getRomPriority(sources, rom, 0)); continue; } // PnP rom - check for BEV and BCV boot capabilities. int instance = 0; while (pnp) { if (pnp->bev) boot_add_bev(FLATPTR_TO_SEG(rom), pnp->bev, pnp->productname , getRomPriority(sources, rom, instance++)); else if (pnp->bcv) boot_add_bcv(FLATPTR_TO_SEG(rom), pnp->bcv, pnp->productname , getRomPriority(sources, rom, instance++)); else break; pnp = get_pnp_next(rom, pnp); } } } /**************************************************************** * VGA init ****************************************************************/ static int S3ResumeVga; int ScreenAndDebug; struct rom_header *VgaROM; // Call into vga code to turn on console. void vgarom_setup(void) { if (! CONFIG_OPTIONROMS) return; dprintf(1, "Scan for VGA option rom\n"); // Load some config settings that impact VGA. EnforceChecksum = romfile_loadint("etc/optionroms-checksum", 1); S3ResumeVga = romfile_loadint("etc/s3-resume-vga-init", CONFIG_QEMU); ScreenAndDebug = romfile_loadint("etc/screen-and-debug", CONFIG_SCREEN_AND_DEBUG); if (CONFIG_OPTIONROMS_DEPLOYED) { // Option roms are already deployed on the system. init_optionrom((void*)BUILD_ROM_START, 0, 1); } else { // Clear option rom memory memset((void*)BUILD_ROM_START, 0, rom_get_max() - BUILD_ROM_START); // Find and deploy PCI VGA rom. struct pci_device *pci; foreachpci(pci) { if (!is_pci_vga(pci)) continue; vgahook_setup(pci); init_pcirom(pci, 1, NULL); break; } // Find and deploy CBFS vga-style roms not associated with a device. run_file_roms("vgaroms/", 1, NULL); } rom_reserve(0); if (rom_get_last() == BUILD_ROM_START) // No VGA rom found return; VgaROM = (void*)BUILD_ROM_START; enable_vga_console(); } void s3_resume_vga(void) { if (!S3ResumeVga) return; if (!VgaROM || ! is_valid_rom(VgaROM)) return; callrom(VgaROM, 0); } tinyvisor/bios/src/optionroms.h0000644006644000001440000000205212172661303017171 0ustar yuichi_xyusers#ifndef __OPTIONROMS_H #define __OPTIONROMS_H #include "types.h" // u32 #define OPTION_ROM_SIGNATURE 0xaa55 struct rom_header { u16 signature; u8 size; u8 initVector[4]; u8 reserved[17]; u16 pcioffset; u16 pnpoffset; } PACKED; #define PCI_ROM_SIGNATURE 0x52494350 // "PCIR" struct pci_data { u32 signature; u16 vendor; u16 device; u16 vitaldata; u16 dlen; u8 drevision; u8 class_lo; u16 class_hi; u16 ilen; u16 irevision; u8 type; u8 indicator; u16 reserved; } PACKED; struct pnp_data { u32 signature; u8 revision; u8 len; u16 nextoffset; u8 reserved_08; u8 checksum; u32 devid; u16 manufacturer; u16 productname; u8 type_lo; u16 type_hi; u8 dev_flags; u16 bcv; u16 dv; u16 bev; u16 reserved_1c; u16 staticresource; } PACKED; #define OPTION_ROM_ALIGN 2048 #define OPTION_ROM_INITVECTOR offsetof(struct rom_header, initVector[0]) #define PCIROM_CODETYPE_X86 0 void callrom(struct rom_header *rom, u16 bdf); #endif tinyvisor/bios/src/esp-scsi.c0000644006644000001440000001403312172661303016503 0ustar yuichi_xyusers// AMD PCscsi boot support. // // Copyright (C) 2012 Red Hat Inc. // // Authors: // Paolo Bonzini // // based on lsi-scsi.c which is written by: // Gerd Hoffman // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "pci.h" // foreachpci #include "config.h" // CONFIG_* #include "biosvar.h" // GET_GLOBAL #include "pci_ids.h" // PCI_DEVICE_ID #include "pci_regs.h" // PCI_VENDOR_ID #include "boot.h" // bootprio_find_scsi_device #include "blockcmd.h" // scsi_drive_setup #include "paravirt.h" // runningOnQEMU #include "disk.h" #define ESP_TCLO 0x00 #define ESP_TCMID 0x04 #define ESP_FIFO 0x08 #define ESP_CMD 0x0c #define ESP_WBUSID 0x10 #define ESP_TCHI 0x38 #define ESP_RSTAT 0x10 #define ESP_RINTR 0x14 #define ESP_RFLAGS 0x1c #define ESP_DMA_CMD 0x40 #define ESP_DMA_STC 0x44 #define ESP_DMA_SPA 0x48 #define ESP_DMA_WBC 0x4c #define ESP_DMA_WAC 0x50 #define ESP_DMA_STAT 0x54 #define ESP_DMA_SMDLA 0x58 #define ESP_DMA_WMAC 0x58c #define ESP_CMD_DMA 0x80 #define ESP_CMD_RESET 0x02 #define ESP_CMD_TI 0x10 #define ESP_CMD_ICCS 0x11 #define ESP_CMD_SELATN 0x42 #define ESP_STAT_DI 0x01 #define ESP_STAT_CD 0x02 #define ESP_STAT_MSG 0x04 #define ESP_STAT_TC 0x10 #define ESP_INTR_DC 0x20 struct esp_lun_s { struct drive_s drive; struct pci_device *pci; u32 iobase; u8 target; u8 lun; }; static void esp_scsi_dma(u32 iobase, u32 buf, u32 len, int read) { outb(len & 0xff, iobase + ESP_TCLO); outb((len >> 8) & 0xff, iobase + ESP_TCMID); outb((len >> 16) & 0xff, iobase + ESP_TCHI); outl(buf, iobase + ESP_DMA_SPA); outl(len, iobase + ESP_DMA_STC); outb(read ? 0x83 : 0x03, iobase + ESP_DMA_CMD); } static int esp_scsi_cmd(struct esp_lun_s *llun, struct disk_op_s *op, u8 *cdbcmd, u16 target, u16 lun, u16 blocksize) { u32 iobase = GET_GLOBAL(llun->iobase); int i, state; u8 status; outb(target, iobase + ESP_WBUSID); /* * We need to pass the LUN at the beginning of the command, and the FIFO * is only 16 bytes, so we cannot support 16-byte CDBs. The alternative * would be to use DMA for the 17-byte command too, which is quite * overkill. */ outb(lun, iobase + ESP_FIFO); cdbcmd[1] &= 0x1f; cdbcmd[1] |= lun << 5; for (i = 0; i < 12; i++) outb(cdbcmd[i], iobase + ESP_FIFO); outb(ESP_CMD_SELATN, iobase + ESP_CMD); for (state = 0;;) { u8 stat = inb(iobase + ESP_RSTAT); /* Detect disconnected device. */ if (state == 0 && (inb(iobase + ESP_RINTR) & ESP_INTR_DC)) { return DISK_RET_ENOTREADY; } /* HBA reads command, clears CD, sets TC -> do DMA if needed. */ if (state == 0 && (stat & ESP_STAT_TC)) { state++; if (op->count && blocksize) { /* Data phase. */ u32 count = (u32)op->count * blocksize; esp_scsi_dma(iobase, (u32)op->buf_fl, count, cdb_is_read(cdbcmd, blocksize)); outb(ESP_CMD_TI | ESP_CMD_DMA, iobase + ESP_CMD); continue; } } /* At end of DMA TC is set again -> complete command. */ if (state == 1 && (stat & ESP_STAT_TC)) { state++; outb(ESP_CMD_ICCS, iobase + ESP_CMD); continue; } /* Finally read data from the message in phase. */ if (state == 2 && (stat & ESP_STAT_MSG)) { state++; status = inb(iobase + ESP_FIFO); inb(iobase + ESP_FIFO); break; } usleep(5); } if (status == 0) { return DISK_RET_SUCCESS; } return DISK_RET_EBADTRACK; } int esp_scsi_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize) { if (!CONFIG_ESP_SCSI) return DISK_RET_EBADTRACK; struct esp_lun_s *llun = container_of(op->drive_g, struct esp_lun_s, drive); return esp_scsi_cmd(llun, op, cdbcmd, GET_GLOBAL(llun->target), GET_GLOBAL(llun->lun), blocksize); } static int esp_scsi_add_lun(struct pci_device *pci, u32 iobase, u8 target, u8 lun) { struct esp_lun_s *llun = malloc_fseg(sizeof(*llun)); if (!llun) { warn_noalloc(); return -1; } memset(llun, 0, sizeof(*llun)); llun->drive.type = DTYPE_ESP_SCSI; llun->drive.cntl_id = pci->bdf; llun->pci = pci; llun->target = target; llun->lun = lun; llun->iobase = iobase; char *name = znprintf(16, "esp %02x:%02x.%x %d:%d", pci_bdf_to_bus(pci->bdf), pci_bdf_to_dev(pci->bdf), pci_bdf_to_fn(pci->bdf), target, lun); int prio = bootprio_find_scsi_device(pci, target, lun); int ret = scsi_drive_setup(&llun->drive, name, prio); free(name); if (ret) goto fail; return 0; fail: free(llun); return -1; } static void esp_scsi_scan_target(struct pci_device *pci, u32 iobase, u8 target) { esp_scsi_add_lun(pci, iobase, target, 0); } static void init_esp_scsi(struct pci_device *pci) { u16 bdf = pci->bdf; u32 iobase = pci_config_readl(pci->bdf, PCI_BASE_ADDRESS_0) & PCI_BASE_ADDRESS_IO_MASK; dprintf(1, "found esp at %02x:%02x.%x, io @ %x\n", pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf), pci_bdf_to_fn(bdf), iobase); pci_config_maskw(bdf, PCI_COMMAND, 0, PCI_COMMAND_MASTER); // reset outb(ESP_CMD_RESET, iobase + ESP_CMD); int i; for (i = 0; i <= 7; i++) esp_scsi_scan_target(pci, iobase, i); return; } void esp_scsi_setup(void) { ASSERT32FLAT(); if (!CONFIG_ESP_SCSI || !runningOnQEMU()) return; dprintf(3, "init esp\n"); struct pci_device *pci; foreachpci(pci) { if (pci->vendor != PCI_VENDOR_ID_AMD || pci->device != PCI_DEVICE_ID_AMD_SCSI) continue; init_esp_scsi(pci); } } tinyvisor/bios/src/biosvar.h0000644006644000001440000001730112172661303016430 0ustar yuichi_xyusers// Variable layouts of bios. // // Copyright (C) 2008-2010 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #ifndef __BIOSVAR_H #define __BIOSVAR_H #include "types.h" // u8 #include "farptr.h" // GET_FARVAR #include "config.h" // SEG_BDA /**************************************************************** * Interupt vector table ****************************************************************/ struct rmode_IVT { struct segoff_s ivec[256]; }; #define GET_IVT(vector) \ GET_FARVAR(SEG_IVT, ((struct rmode_IVT *)0)->ivec[vector]) #define SET_IVT(vector, segoff) \ SET_FARVAR(SEG_IVT, ((struct rmode_IVT *)0)->ivec[vector], segoff) #define FUNC16(func) ({ \ ASSERT32FLAT(); \ extern void func (void); \ SEGOFF(SEG_BIOS, (u32)func - BUILD_BIOS_ADDR); \ }) /**************************************************************** * Bios Data Area (BDA) ****************************************************************/ struct bios_data_area_s { // 40:00 u16 port_com[4]; u16 port_lpt[3]; u16 ebda_seg; // 40:10 u16 equipment_list_flags; u8 pad1; u16 mem_size_kb; u8 pad2; u8 ps2_ctrl_flag; u8 kbd_flag0; u8 kbd_flag1; u8 alt_keypad; u16 kbd_buf_head; u16 kbd_buf_tail; // 40:1e u8 kbd_buf[32]; u8 floppy_recalibration_status; u8 floppy_motor_status; // 40:40 u8 floppy_motor_counter; u8 floppy_last_status; u8 floppy_return_status[7]; u8 video_mode; u16 video_cols; u16 video_pagesize; u16 video_pagestart; // 40:50 u16 cursor_pos[8]; // 40:60 u16 cursor_type; u8 video_page; u16 crtc_address; u8 video_msr; u8 video_pal; struct segoff_s jump; u8 other_6b; u32 timer_counter; // 40:70 u8 timer_rollover; u8 break_flag; u16 soft_reset_flag; u8 disk_last_status; u8 hdcount; u8 disk_control_byte; u8 port_disk; u8 lpt_timeout[4]; u8 com_timeout[4]; // 40:80 u16 kbd_buf_start_offset; u16 kbd_buf_end_offset; u8 video_rows; u16 char_height; u8 video_ctl; u8 video_switches; u8 modeset_ctl; u8 dcc_index; u8 floppy_last_data_rate; u8 disk_status_controller; u8 disk_error_controller; u8 disk_interrupt_flag; u8 floppy_harddisk_info; // 40:90 u8 floppy_media_state[4]; u8 floppy_track[2]; u8 kbd_flag2; u8 kbd_led; struct segoff_s user_wait_complete_flag; u32 user_wait_timeout; // 40:A0 u8 rtc_wait_flag; u8 other_a1[7]; struct segoff_s video_savetable; u8 other_ac[4]; // 40:B0 u8 other_b0[9]; u8 vbe_flag; u16 vbe_mode; u8 other_bc[4]; // 40:C0 u8 other_c0[4*16]; } PACKED; // BDA floppy_recalibration_status bitdefs #define FRS_IRQ (1<<7) // BDA rtc_wait_flag bitdefs #define RWS_WAIT_PENDING (1<<0) #define RWS_WAIT_ELAPSED (1<<7) // BDA floppy_media_state bitdefs #define FMS_DRIVE_STATE_MASK (0x07) #define FMS_MEDIA_DRIVE_ESTABLISHED (1<<4) #define FMS_DOUBLE_STEPPING (1<<5) #define FMS_DATA_RATE_MASK (0xc0) // Accessor functions #define GET_BDA(var) \ GET_FARVAR(SEG_BDA, ((struct bios_data_area_s *)0)->var) #define SET_BDA(var, val) \ SET_FARVAR(SEG_BDA, ((struct bios_data_area_s *)0)->var, (val)) // Helper function to set the bits of the equipment_list_flags variable. static inline void set_equipment_flags(u16 clear, u16 set) { u16 eqf = GET_BDA(equipment_list_flags); SET_BDA(equipment_list_flags, (eqf & ~clear) | set); } /**************************************************************** * Extended Bios Data Area (EBDA) ****************************************************************/ struct fdpt_s { u16 cylinders; u8 heads; u8 a0h_signature; u8 phys_sectors; u16 precompensation; u8 reserved; u8 drive_control_byte; u16 phys_cylinders; u8 phys_heads; u16 landing_zone; u8 sectors; u8 checksum; } PACKED; struct extended_bios_data_area_s { u8 size; u8 reserved1[0x21]; struct segoff_s far_call_pointer; u8 mouse_flag1; u8 mouse_flag2; u8 mouse_data[0x08]; // 0x30 u8 other1[0x0d]; // 0x3d struct fdpt_s fdpt[2]; // 0x5d u8 other2[0xC4]; // 0x121 - Begin custom storage. } PACKED; // The initial size and location of EBDA #define EBDA_SIZE_START \ DIV_ROUND_UP(sizeof(struct extended_bios_data_area_s), 1024) #define EBDA_SEGMENT_START \ FLATPTR_TO_SEG(BUILD_LOWRAM_END - EBDA_SIZE_START*1024) // Accessor functions static inline u16 get_ebda_seg(void) { return GET_BDA(ebda_seg); } static inline struct extended_bios_data_area_s * get_ebda_ptr(void) { ASSERT32FLAT(); return MAKE_FLATPTR(get_ebda_seg(), 0); } #define GET_EBDA(eseg, var) \ GET_FARVAR(eseg, ((struct extended_bios_data_area_s *)0)->var) #define SET_EBDA(eseg, var, val) \ SET_FARVAR(eseg, ((struct extended_bios_data_area_s *)0)->var, (val)) /**************************************************************** * Global variables ****************************************************************/ #if MODE16 == 0 && MODESEGMENT == 1 // In 32bit segmented mode %cs may not be readable and the code may be // relocated. The entry code sets up %gs with a readable segment and // the code offset can be determined by get_global_offset(). #define GLOBAL_SEGREG GS static inline u32 __attribute_const get_global_offset(void) { u32 ret; asm(" calll 1f\n" "1:popl %0\n" " subl $1b, %0" : "=r"(ret)); return ret; } #else #define GLOBAL_SEGREG CS static inline u32 __attribute_const get_global_offset(void) { return 0; } #endif static inline u16 get_global_seg(void) { return GET_SEG(GLOBAL_SEGREG); } #define GET_GLOBAL(var) \ GET_VAR(GLOBAL_SEGREG, *(typeof(&(var)))((void*)&(var) \ + get_global_offset())) #define SET_GLOBAL(var, val) do { \ ASSERT32FLAT(); \ (var) = (val); \ } while (0) #if MODESEGMENT #define GLOBALFLAT2GLOBAL(var) ((typeof(var))((void*)(var) - BUILD_BIOS_ADDR)) #else #define GLOBALFLAT2GLOBAL(var) (var) #endif // Access a "flat" pointer known to point to the f-segment. #define GET_GLOBALFLAT(var) GET_GLOBAL(*GLOBALFLAT2GLOBAL(&(var))) /**************************************************************** * "Low" memory variables ****************************************************************/ extern u8 _zonelow_seg, zonelow_base[]; #define SEG_LOW ((u32)&_zonelow_seg) #if MODESEGMENT #define GET_LOW(var) GET_FARVAR(SEG_LOW, (var)) #define SET_LOW(var, val) SET_FARVAR(SEG_LOW, (var), (val)) #define LOWFLAT2LOW(var) ((typeof(var))((void*)(var) - (u32)zonelow_base)) #else #define GET_LOW(var) (var) #define SET_LOW(var, val) do { (var) = (val); } while (0) #define LOWFLAT2LOW(var) (var) #endif #define GET_LOWFLAT(var) GET_LOW(*LOWFLAT2LOW(&(var))) #define SET_LOWFLAT(var, val) SET_LOW(*LOWFLAT2LOW(&(var)), (val)) /**************************************************************** * Bios Config Table ****************************************************************/ struct bios_config_table_s { u16 size; u8 model; u8 submodel; u8 biosrev; u8 feature1, feature2, feature3, feature4, feature5; } PACKED; extern struct bios_config_table_s BIOS_CONFIG_TABLE __aligned(1); #endif // __BIOSVAR_H tinyvisor/bios/src/memmap.h0000644006644000001440000000107012172661303016233 0ustar yuichi_xyusers#ifndef __E820MAP_H #define __E820MAP_H #include "types.h" // u64 #define E820_RAM 1 #define E820_RESERVED 2 #define E820_ACPI 3 #define E820_NVS 4 #define E820_UNUSABLE 5 #define E820_HOLE ((u32)-1) // Useful for removing entries struct e820entry { u64 start; u64 size; u32 type; }; void add_e820(u64 start, u64 size, u32 type); void memmap_prepboot(void); // A typical OS page size #define PAGE_SIZE 4096 // e820 map storage extern struct e820entry e820_list[]; extern int e820_count; #endif // e820map.h tinyvisor/bios/src/paravirt.h0000644006644000001440000000135212172661303016612 0ustar yuichi_xyusers#ifndef __PV_H #define __PV_H #include "config.h" // CONFIG_* #include "biosvar.h" // GET_GLOBAL // Types of paravirtualized platforms. #define PF_QEMU (1<<0) #define PF_XEN (1<<1) #define PF_KVM (1<<2) extern u32 RamSize; extern u64 RamSizeOver4G; extern int PlatformRunningOn; static inline int runningOnQEMU(void) { return CONFIG_QEMU || ( CONFIG_QEMU_HARDWARE && GET_GLOBAL(PlatformRunningOn) & PF_QEMU); } static inline int runningOnXen(void) { return CONFIG_XEN && GET_GLOBAL(PlatformRunningOn) & PF_XEN; } static inline int runningOnKVM(void) { return CONFIG_QEMU && GET_GLOBAL(PlatformRunningOn) & PF_KVM; } void qemu_preinit(void); void qemu_platform_setup(void); void qemu_cfg_init(void); #endif tinyvisor/bios/src/bmp.h0000644006644000001440000000117311733243570015545 0ustar yuichi_xyusers#ifndef BMP_H #define BMP_H #include "types.h" struct bmp_decdata { struct tagRGBQUAD *quadp; unsigned char *datap; int width; int height; int bpp; }; /* allocate decdata struct */ struct bmp_decdata *bmp_alloc(void); /* extract information from bmp file data */ int bmp_decode(struct bmp_decdata *bmp, unsigned char *data, int data_size); /* get bmp properties */ void bmp_get_size(struct bmp_decdata *bmp, int *width, int *height); /* flush flat picture data to *pc */ int bmp_show(struct bmp_decdata *bmp, unsigned char *pic, int width , int height, int depth, int bytes_per_line_dest); #endif tinyvisor/bios/src/lsi-scsi.h0000644006644000001440000000027512172661303016513 0ustar yuichi_xyusers#ifndef __LSI_SCSI_H #define __LSI_SCSI_H struct disk_op_s; int lsi_scsi_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize); void lsi_scsi_setup(void); #endif /* __LSI_SCSI_H */ tinyvisor/bios/src/xen.c0000644006644000001440000000774612172661303015564 0ustar yuichi_xyusers// Xen HVM support // // Copyright (C) 2011 Citrix Systems. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "config.h" #include "xen.h" #include "paravirt.h" // PlatformRunningOn #include "memmap.h" // add_e820 #include "types.h" // ASM32FLAT #include "util.h" // copy_acpi_rsdp #include "acpi.h" // find_acpi_features #define INFO_PHYSICAL_ADDRESS 0x00001000 u32 xen_cpuid_base = 0; unsigned long xen_hypercall_page = 0; struct xen_seabios_info { char signature[14]; /* XenHVMSeaBIOS\0 */ u8 length; /* Length of this struct */ u8 checksum; /* Set such that the sum over bytes 0..length == 0 */ /* * Physical address of an array of tables_nr elements. * * Each element is a 32 bit value contianing the physical address * of a BIOS table. */ u32 tables; u32 tables_nr; /* * Physical address of the e820 table, contains e820_nr entries. */ u32 e820; u32 e820_nr; } PACKED; static void validate_info(struct xen_seabios_info *t) { if ( memcmp(t->signature, "XenHVMSeaBIOS", 14) ) panic("Bad Xen info signature\n"); if ( t->length < sizeof(struct xen_seabios_info) ) panic("Bad Xen info length\n"); if (checksum(t, t->length) != 0) panic("Bad Xen info checksum\n"); } void xen_preinit(void) { u32 base, eax, ebx, ecx, edx; char signature[13]; if (!CONFIG_XEN) return; for (base = 0x40000000; base < 0x40010000; base += 0x100) { cpuid(base, &eax, &ebx, &ecx, &edx); memcpy(signature + 0, &ebx, 4); memcpy(signature + 4, &ecx, 4); memcpy(signature + 8, &edx, 4); signature[12] = 0; dprintf(9, "Found hypervisor signature \"%s\" at %x\n", signature, base); if (strcmp(signature, "XenVMMXenVMM") == 0) { /* Set debug_io_port first, so the following messages work. */ DebugOutputPort = 0xe9; dprintf(1, "SeaBIOS (version %s)\n\n", VERSION); dprintf(1, "Found Xen hypervisor signature at %x\n", base); if ((eax - base) < 2) panic("Insufficient Xen cpuid leaves. eax=%x at base %x\n", eax, base); xen_cpuid_base = base; break; } } if (!xen_cpuid_base) { dprintf(1, "No Xen hypervisor found.\n"); return; } PlatformRunningOn = PF_QEMU|PF_XEN; } static int hypercall_xen_version( int cmd, void *arg) { return _hypercall2(int, xen_version, cmd, arg); } /* Fill in hypercall transfer pages. */ void xen_hypercall_setup(void) { u32 eax, ebx, ecx, edx; xen_extraversion_t extraversion; unsigned long i; if (!runningOnXen()) return; cpuid(xen_cpuid_base + 2, &eax, &ebx, &ecx, &edx); xen_hypercall_page = (unsigned long)memalign_high(PAGE_SIZE, eax*PAGE_SIZE); if (!xen_hypercall_page) panic("unable to allocate Xen hypercall page\n"); dprintf(1, "Allocated Xen hypercall page at %lx\n", xen_hypercall_page); for ( i = 0; i < eax; i++ ) wrmsr(ebx, xen_hypercall_page + (i << 12) + i); /* Print version information. */ cpuid(xen_cpuid_base + 1, &eax, &ebx, &ecx, &edx); hypercall_xen_version(XENVER_extraversion, extraversion); dprintf(1, "Detected Xen v%u.%u%s\n", eax >> 16, eax & 0xffff, extraversion); } void xen_biostable_setup(void) { struct xen_seabios_info *info = (void *)INFO_PHYSICAL_ADDRESS; void **tables = (void*)info->tables; int i; dprintf(1, "xen: copy BIOS tables...\n"); for (i=0; itables_nr; i++) copy_table(tables[i]); find_acpi_features(); } void xen_ramsize_preinit(void) { int i; struct xen_seabios_info *info = (void *)INFO_PHYSICAL_ADDRESS; struct e820entry *e820 = (struct e820entry *)info->e820; validate_info(info); dprintf(1, "xen: copy e820...\n"); for (i = 0; i < info->e820_nr; i++) { struct e820entry *e = &e820[i]; add_e820(e->start, e->size, e->type); } } tinyvisor/bios/src/pic.c0000644006644000001440000000317712172661303015537 0ustar yuichi_xyusers// Helpers for working with i8259 interrupt controller. // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "pic.h" // get_pic1_isr #include "util.h" // dprintf #include "config.h" // CONFIG_* void set_pics(u8 irq0, u8 irq8) { // Send ICW1 (select OCW1 + will send ICW4) outb(0x11, PORT_PIC1_CMD); outb(0x11, PORT_PIC2_CMD); // Send ICW2 (base irqs: 0x08-0x0f for irq0-7, 0x70-0x77 for irq8-15) outb(irq0, PORT_PIC1_DATA); outb(irq8, PORT_PIC2_DATA); // Send ICW3 (cascaded pic ids) outb(0x04, PORT_PIC1_DATA); outb(0x02, PORT_PIC2_DATA); // Send ICW4 (enable 8086 mode) outb(0x01, PORT_PIC1_DATA); outb(0x01, PORT_PIC2_DATA); // Mask all irqs (except cascaded PIC2 irq) outb(~PIC1_IRQ2, PORT_PIC1_DATA); outb(~0, PORT_PIC2_DATA); } void pic_setup(void) { dprintf(3, "init pic\n"); set_pics(BIOS_HWIRQ0_VECTOR, BIOS_HWIRQ8_VECTOR); } // Handler for otherwise unused hardware irqs. void VISIBLE16 handle_hwpic1(struct bregs *regs) { dprintf(DEBUG_ISR_hwpic1, "handle_hwpic1 irq=%x\n", get_pic1_isr()); eoi_pic1(); } void VISIBLE16 handle_hwpic2(struct bregs *regs) { dprintf(DEBUG_ISR_hwpic2, "handle_hwpic2 irq=%x\n", get_pic2_isr()); eoi_pic2(); } u8 saved_pic_mask[2] = { ~PIC1_IRQ2, ~0 }; void pic_save_mask(void) { saved_pic_mask[0] = inb(PORT_PIC1_DATA); saved_pic_mask[1] = inb(PORT_PIC2_DATA); } void pic_restore_mask(void) { outb(saved_pic_mask[0], PORT_PIC1_DATA); outb(saved_pic_mask[1], PORT_PIC2_DATA); } tinyvisor/bios/src/romfile.c0000644006644000001440000000452312172661303016415 0ustar yuichi_xyusers// Access to pseudo "file" interface for configuration information. // // Copyright (C) 2012 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "config.h" // CONFIG_* #include "util.h" // dprintf static struct romfile_s *RomfileRoot VARVERIFY32INIT; void romfile_add(struct romfile_s *file) { dprintf(3, "Add romfile: %s (size=%d)\n", file->name, file->size); file->next = RomfileRoot; RomfileRoot = file; } // Search for the specified file. static struct romfile_s * __romfile_findprefix(const char *prefix, int prefixlen, struct romfile_s *prev) { struct romfile_s *cur = RomfileRoot; if (prev) cur = prev->next; while (cur) { if (memcmp(prefix, cur->name, prefixlen) == 0) return cur; cur = cur->next; } return NULL; } struct romfile_s * romfile_findprefix(const char *prefix, struct romfile_s *prev) { return __romfile_findprefix(prefix, strlen(prefix), prev); } struct romfile_s * romfile_find(const char *name) { return __romfile_findprefix(name, strlen(name) + 1, NULL); } // Helper function to find, malloc_tmphigh, and copy a romfile. This // function adds a trailing zero to the malloc'd copy. void * romfile_loadfile(const char *name, int *psize) { struct romfile_s *file = romfile_find(name); if (!file) return NULL; int filesize = file->size; if (!filesize) return NULL; char *data = malloc_tmphigh(filesize+1); if (!data) { warn_noalloc(); return NULL; } dprintf(5, "Copying romfile '%s' (len %d)\n", name, filesize); int ret = file->copy(file, data, filesize); if (ret < 0) { free(data); return NULL; } if (psize) *psize = filesize; data[filesize] = '\0'; return data; } // Attempt to load an integer from the given file - return 'defval' // if unsuccesful. u64 romfile_loadint(const char *name, u64 defval) { struct romfile_s *file = romfile_find(name); if (!file) return defval; int filesize = file->size; if (!filesize || filesize > sizeof(u64) || (filesize & (filesize-1))) // Doesn't look like a valid integer. return defval; u64 val = 0; int ret = file->copy(file, &val, sizeof(val)); if (ret < 0) return defval; return val; } tinyvisor/bios/src/bmp.c0000644006644000001440000000540711733243570015544 0ustar yuichi_xyusers/* * Basic BMP data process and Raw picture data handle functions. * Could be used to adjust pixel data format, get infomation, etc. * * Copyright (C) 2011 Wayne Xia * * This work is licensed under the terms of the GNU LGPLv3. */ #include "util.h" #include "bmp.h" #define bmp_load4byte(addr) (*(u32 *)(addr)) #define bmp_load2byte(addr) (*(u16 *)(addr)) typedef struct tagBITMAPFILEHEADER { u8 bfType[2]; u8 bfSize[4]; u8 bfReserved1[2]; u8 bfReserved2[2]; u8 bfOffBits[4]; } BITMAPFILEHEADER, tagBITMAPFILEHEADER; typedef struct tagBITMAPINFOHEADER { u8 biSize[4]; u8 biWidth[4]; u8 biHeight[4]; u8 biPlanes[2]; u8 biBitCount[2]; u8 biCompression[4]; u8 biSizeImage[4]; u8 biXPelsPerMeter[4]; u8 biYPelsPerMeter[4]; u8 biClrUsed[4]; u8 biClrImportant[4]; } BITMAPINFOHEADER, tagBITMAPINFOHEADER; typedef struct tagRGBQUAD { u8 rgbBlue; u8 rgbGreen; u8 rgbRed; u8 rgbReserved; } RGBQUAD, tagRGBQUAD; /* flat picture data adjusting function * description: * switch the vertical line sequence * arrange horizontal pixel data, add extra space in the dest buffer * for every line */ static void raw_data_format_adjust_24bpp(u8 *src, u8 *dest, int width, int height, int bytes_per_line_dest) { int bytes_per_line_src = 3 * width; int i; for (i = 0 ; i < height ; i++) { memcpy(dest + i * bytes_per_line_dest, src + (height - 1 - i) * bytes_per_line_src, bytes_per_line_src); } } struct bmp_decdata *bmp_alloc(void) { struct bmp_decdata *bmp = malloc_tmphigh(sizeof(*bmp)); return bmp; } int bmp_decode(struct bmp_decdata *bmp, unsigned char *data, int data_size) { if (data_size < 54) return 1; u16 bmp_filehead = bmp_load2byte(data + 0); if (bmp_filehead != 0x4d42) return 2; u32 bmp_recordsize = bmp_load4byte(data + 2); if (bmp_recordsize != data_size) return 3; u32 bmp_dataoffset = bmp_load4byte(data + 10); bmp->datap = (unsigned char *)data + bmp_dataoffset; bmp->width = bmp_load4byte(data + 18); bmp->height = bmp_load4byte(data + 22); bmp->bpp = bmp_load2byte(data + 28); return 0; } void bmp_get_size(struct bmp_decdata *bmp, int *width, int *height) { *width = bmp->width; *height = bmp->height; } int bmp_show(struct bmp_decdata *bmp, unsigned char *pic, int width , int height, int depth, int bytes_per_line_dest) { if (bmp->datap == pic) return 0; /* now only support 24bpp bmp file */ if ((depth == 24) && (bmp->bpp == 24)) { raw_data_format_adjust_24bpp(bmp->datap, pic, width, height, bytes_per_line_dest); return 0; } return 1; } tinyvisor/bios/src/ssdt-misc.dsl0000644006644000001440000000624312172661303017227 0ustar yuichi_xyusersACPI_EXTRACT_ALL_CODE ssdp_misc_aml DefinitionBlock ("ssdt-misc.aml", "SSDT", 0x01, "BXPC", "BXSSDTSUSP", 0x1) { /**************************************************************** * PCI memory ranges ****************************************************************/ Scope(\) { ACPI_EXTRACT_NAME_DWORD_CONST acpi_pci32_start Name(P0S, 0x12345678) ACPI_EXTRACT_NAME_DWORD_CONST acpi_pci32_end Name(P0E, 0x12345678) ACPI_EXTRACT_NAME_BYTE_CONST acpi_pci64_valid Name(P1V, 0x12) ACPI_EXTRACT_NAME_BUFFER8 acpi_pci64_start Name(P1S, Buffer() { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }) ACPI_EXTRACT_NAME_BUFFER8 acpi_pci64_end Name(P1E, Buffer() { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }) ACPI_EXTRACT_NAME_BUFFER8 acpi_pci64_length Name(P1L, Buffer() { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }) } /**************************************************************** * Suspend ****************************************************************/ Scope(\) { /* * S3 (suspend-to-ram), S4 (suspend-to-disk) and S5 (power-off) type codes: * must match piix4 emulation. */ ACPI_EXTRACT_NAME_STRING acpi_s3_name Name(_S3, Package(0x04) { One, /* PM1a_CNT.SLP_TYP */ One, /* PM1b_CNT.SLP_TYP */ Zero, /* reserved */ Zero /* reserved */ }) ACPI_EXTRACT_NAME_STRING acpi_s4_name ACPI_EXTRACT_PKG_START acpi_s4_pkg Name(_S4, Package(0x04) { 0x2, /* PM1a_CNT.SLP_TYP */ 0x2, /* PM1b_CNT.SLP_TYP */ Zero, /* reserved */ Zero /* reserved */ }) Name(_S5, Package(0x04) { Zero, /* PM1a_CNT.SLP_TYP */ Zero, /* PM1b_CNT.SLP_TYP */ Zero, /* reserved */ Zero /* reserved */ }) } External(\_SB.PCI0, DeviceObj) External(\_SB.PCI0.ISA, DeviceObj) Scope(\_SB.PCI0.ISA) { Device(PEVT) { Name(_HID, "QEMU0001") /* PEST will be patched to be Zero if no such device */ ACPI_EXTRACT_NAME_WORD_CONST ssdt_isa_pest Name(PEST, 0xFFFF) OperationRegion(PEOR, SystemIO, PEST, 0x01) Field(PEOR, ByteAcc, NoLock, Preserve) { PEPT, 8, } Method(_STA, 0, NotSerialized) { Store(PEST, Local0) If (LEqual(Local0, Zero)) { Return (0x00) } Else { Return (0x0F) } } Method(RDPT, 0, NotSerialized) { Store(PEPT, Local0) Return (Local0) } Method(WRPT, 1, NotSerialized) { Store(Arg0, PEPT) } Name(_CRS, ResourceTemplate() { IO(Decode16, 0x00, 0x00, 0x01, 0x01, IO) }) CreateWordField(_CRS, IO._MIN, IOMN) CreateWordField(_CRS, IO._MAX, IOMX) Method(_INI, 0, NotSerialized) { Store(PEST, IOMN) Store(PEST, IOMX) } } } } tinyvisor/bios/src/types.h0000644006644000001440000001313112172661303016124 0ustar yuichi_xyusers// Basic type definitions for X86 cpus. // // Copyright (C) 2008-2010 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #ifndef __TYPES_H #define __TYPES_H typedef unsigned char u8; typedef signed char s8; typedef unsigned short u16; typedef signed short s16; typedef unsigned int u32; typedef signed int s32; typedef unsigned long long u64; typedef signed long long s64; typedef u32 size_t; union u64_u32_u { struct { u32 lo, hi; }; u64 val; }; #ifdef MANUAL_NO_JUMP_TABLE # define default case 775324556: asm(""); default #endif #ifdef WHOLE_PROGRAM # define __VISIBLE __attribute__((externally_visible)) #else # define __VISIBLE #endif #define UNIQSEC __FILE__ "." __stringify(__LINE__) #define __noreturn __attribute__((noreturn)) extern void __force_link_error__only_in_32bit_flat(void) __noreturn; extern void __force_link_error__only_in_32bit_segmented(void) __noreturn; extern void __force_link_error__only_in_16bit(void) __noreturn; #define __ASM(code) asm(".section .text.asm." UNIQSEC "\n\t" code) #if MODE16 == 1 // Notes a function as externally visible in the 16bit code chunk. # define VISIBLE16 __VISIBLE // Notes a function as externally visible in the 32bit flat code chunk. # define VISIBLE32FLAT // Notes a 32bit flat function that will only be called during init. # define VISIBLE32INIT // Notes a function as externally visible in the 32bit segmented code chunk. # define VISIBLE32SEG // Designate a variable as (only) visible to 16bit code. # define VAR16 __section(".data16." UNIQSEC) // Designate a variable at a specific 16bit address # define VAR16FIXED(addr) __aligned(1) __VISIBLE __section(".fixedaddr." __stringify(addr)) // Designate a variable as (only) visible to 32bit segmented code. # define VAR32SEG __section(".discard.var32seg." UNIQSEC) // Designate a variable as visible and located in the e-segment. # define VARLOW __section(".discard.varlow." UNIQSEC) __VISIBLE __weak // Designate a variable as visible and located in the f-segment. # define VARFSEG __section(".discard.varfseg." UNIQSEC) __VISIBLE __weak // Verify a variable is only accessable via 32bit "init" functions # define VARVERIFY32INIT __section(".discard.varinit." UNIQSEC) // Designate top-level assembler as 16bit only. # define ASM16(code) __ASM(code) // Designate top-level assembler as 32bit flat only. # define ASM32FLAT(code) // Compile time check for a given mode. # define ASSERT16() do { } while (0) # define ASSERT32SEG() __force_link_error__only_in_32bit_segmented() # define ASSERT32FLAT() __force_link_error__only_in_32bit_flat() #elif MODESEGMENT == 1 # define VISIBLE16 # define VISIBLE32FLAT # define VISIBLE32INIT # define VISIBLE32SEG __VISIBLE # define VAR16 __section(".discard.var16." UNIQSEC) # define VAR16FIXED(addr) VAR16 __VISIBLE __weak # define VAR32SEG __section(".data32seg." UNIQSEC) # define VARLOW __section(".discard.varlow." UNIQSEC) __VISIBLE __weak # define VARFSEG __section(".discard.varfseg." UNIQSEC) __VISIBLE __weak # define VARVERIFY32INIT __section(".discard.varinit." UNIQSEC) # define ASM16(code) # define ASM32FLAT(code) # define ASSERT16() __force_link_error__only_in_16bit() # define ASSERT32SEG() do { } while (0) # define ASSERT32FLAT() __force_link_error__only_in_32bit_flat() #else # define VISIBLE16 # define VISIBLE32FLAT __section(".text.runtime." UNIQSEC) __VISIBLE # define VISIBLE32INIT __section(".text.init." UNIQSEC) __VISIBLE # define VISIBLE32SEG # define VAR16 __section(".discard.var16." UNIQSEC) # define VAR16FIXED(addr) VAR16 __VISIBLE __weak # define VAR32SEG __section(".discard.var32seg." UNIQSEC) # define VARLOW __section(".data.varlow." UNIQSEC) __VISIBLE __weak # define VARFSEG __section(".data.varfseg." UNIQSEC) __VISIBLE # define VARVERIFY32INIT __section(".data.varinit." UNIQSEC) # define ASM16(code) # define ASM32FLAT(code) __ASM(code) # define ASSERT16() __force_link_error__only_in_16bit() # define ASSERT32SEG() __force_link_error__only_in_32bit_segmented() # define ASSERT32FLAT() do { } while (0) #endif #define offsetof(TYPE, MEMBER) ((size_t) &((TYPE *)0)->MEMBER) #define ARRAY_SIZE(a) (sizeof(a) / sizeof(a[0])) #define FIELD_SIZEOF(t, f) (sizeof(((t*)0)->f)) #define DIV_ROUND_UP(n,d) (((n) + (d) - 1) / (d)) #define DIV_ROUND_CLOSEST(x, divisor)({ \ typeof(divisor) __divisor = divisor; \ (((x) + ((__divisor) / 2)) / (__divisor)); \ }) #define ALIGN(x,a) __ALIGN_MASK(x,(typeof(x))(a)-1) #define __ALIGN_MASK(x,mask) (((x)+(mask))&~(mask)) #define ALIGN_DOWN(x,a) ((x) & ~((typeof(x))(a)-1)) #define container_of(ptr, type, member) ({ \ const typeof( ((type *)0)->member ) *__mptr = (ptr); \ (type *)( (char *)__mptr - offsetof(type,member) );}) #define container_of_or_null(ptr, type, member) ({ \ const typeof( ((type *)0)->member ) *___mptr = (ptr); \ ___mptr ? container_of(___mptr, type, member) : NULL; }) #define likely(x) __builtin_expect(!!(x), 1) #define unlikely(x) __builtin_expect(!!(x), 0) #define NULL ((void*)0) #define __weak __attribute__((weak)) #define __section(S) __attribute__((section(S))) #define PACKED __attribute__((packed)) #define __aligned(x) __attribute__((aligned(x))) #define barrier() __asm__ __volatile__("": : :"memory") #define noinline __attribute__((noinline)) #define __always_inline inline __attribute__((always_inline)) #define __malloc __attribute__((__malloc__)) #define __attribute_const __attribute__((__const__)) #define __stringify_1(x) #x #define __stringify(x) __stringify_1(x) #endif // types.h tinyvisor/bios/src/mouse.c0000644006644000001440000001740012172661303016106 0ustar yuichi_xyusers// 16bit code to handle mouse events. // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "biosvar.h" // GET_EBDA #include "util.h" // dprintf #include "bregs.h" // struct bregs #include "ps2port.h" // ps2_mouse_command #include "usb-hid.h" // usb_mouse_command void mouse_init(void) { if (! CONFIG_MOUSE) return; dprintf(3, "init mouse\n"); // pointing device installed set_equipment_flags(0x04, 0x04); } static int mouse_command(int command, u8 *param) { if (usb_mouse_active()) return stack_hop(command, (u32)param, usb_mouse_command); return stack_hop(command, (u32)param, ps2_mouse_command); } #define RET_SUCCESS 0x00 #define RET_EINVFUNCTION 0x01 #define RET_EINVINPUT 0x02 #define RET_EINTERFACE 0x03 #define RET_ENEEDRESEND 0x04 #define RET_ENOHANDLER 0x05 // Disable Mouse static void mouse_15c20000(struct bregs *regs) { int ret = mouse_command(PSMOUSE_CMD_DISABLE, NULL); if (ret) set_code_invalid(regs, RET_ENEEDRESEND); else set_code_success(regs); } // Enable Mouse static void mouse_15c20001(struct bregs *regs) { u16 ebda_seg = get_ebda_seg(); u8 mouse_flags_2 = GET_EBDA(ebda_seg, mouse_flag2); if ((mouse_flags_2 & 0x80) == 0) { set_code_invalid(regs, RET_ENOHANDLER); return; } int ret = mouse_command(PSMOUSE_CMD_ENABLE, NULL); if (ret) set_code_invalid(regs, RET_ENEEDRESEND); else set_code_success(regs); } static void mouse_15c200XX(struct bregs *regs) { set_code_unimplemented(regs, RET_EINVFUNCTION); } // Disable/Enable Mouse static void mouse_15c200(struct bregs *regs) { switch (regs->bh) { case 0x00: mouse_15c20000(regs); break; case 0x01: mouse_15c20001(regs); break; default: mouse_15c200XX(regs); break; } } // Reset Mouse static void mouse_15c201(struct bregs *regs) { u8 param[2]; int ret = mouse_command(PSMOUSE_CMD_RESET_BAT, param); if (ret) { set_code_invalid(regs, RET_ENEEDRESEND); return; } regs->bl = param[0]; regs->bh = param[1]; set_code_success(regs); } // Set Sample Rate static void mouse_15c202(struct bregs *regs) { static u8 VAR16 sample_rates[7] = {10, 20, 40, 60, 80, 100, 200}; if (regs->bh >= ARRAY_SIZE(sample_rates)) { set_code_invalid(regs, RET_EINVINPUT); return; } u8 mouse_data1 = GET_GLOBAL(sample_rates[regs->bh]); int ret = mouse_command(PSMOUSE_CMD_SETRATE, &mouse_data1); if (ret) set_code_invalid(regs, RET_ENEEDRESEND); else set_code_success(regs); } // Set Resolution static void mouse_15c203(struct bregs *regs) { // BH: // 0 = 25 dpi, 1 count per millimeter // 1 = 50 dpi, 2 counts per millimeter // 2 = 100 dpi, 4 counts per millimeter // 3 = 200 dpi, 8 counts per millimeter if (regs->bh >= 4) { set_code_invalid(regs, RET_EINVINPUT); return; } u8 param = regs->bh; int ret = mouse_command(PSMOUSE_CMD_SETRES, ¶m); if (ret) set_code_invalid(regs, RET_ENEEDRESEND); else set_code_success(regs); } // Get Device ID static void mouse_15c204(struct bregs *regs) { u8 param[2]; int ret = mouse_command(PSMOUSE_CMD_GETID, param); if (ret) { set_code_invalid(regs, RET_ENEEDRESEND); return; } regs->bh = param[0]; set_code_success(regs); } // Initialize Mouse static void mouse_15c205(struct bregs *regs) { if (regs->bh != 3) { set_code_invalid(regs, RET_EINTERFACE); return; } u16 ebda_seg = get_ebda_seg(); SET_EBDA(ebda_seg, mouse_flag1, 0x00); SET_EBDA(ebda_seg, mouse_flag2, regs->bh); // Reset Mouse mouse_15c201(regs); } // Return Status static void mouse_15c20600(struct bregs *regs) { u8 param[3]; int ret = mouse_command(PSMOUSE_CMD_GETINFO, param); if (ret) { set_code_invalid(regs, RET_ENEEDRESEND); return; } regs->bl = param[0]; regs->cl = param[1]; regs->dl = param[2]; set_code_success(regs); } // Set Scaling Factor to 1:1 static void mouse_15c20601(struct bregs *regs) { int ret = mouse_command(PSMOUSE_CMD_SETSCALE11, NULL); if (ret) set_code_invalid(regs, RET_ENEEDRESEND); else set_code_success(regs); } // Set Scaling Factor to 2:1 static void mouse_15c20602(struct bregs *regs) { int ret = mouse_command(PSMOUSE_CMD_SETSCALE21, NULL); if (ret) set_code_invalid(regs, RET_ENEEDRESEND); else set_code_success(regs); } static void mouse_15c206XX(struct bregs *regs) { set_code_unimplemented(regs, RET_EINVFUNCTION); } // Return Status & Set Scaling Factor... static void mouse_15c206(struct bregs *regs) { switch (regs->bh) { case 0x00: mouse_15c20600(regs); break; case 0x01: mouse_15c20601(regs); break; case 0x02: mouse_15c20602(regs); break; default: mouse_15c206XX(regs); break; } } // Set Mouse Handler Address static void mouse_15c207(struct bregs *regs) { struct segoff_s farptr = SEGOFF(regs->es, regs->bx); u16 ebda_seg = get_ebda_seg(); u8 mouse_flags_2 = GET_EBDA(ebda_seg, mouse_flag2); if (! farptr.segoff) { /* remove handler */ if ((mouse_flags_2 & 0x80) != 0) { mouse_flags_2 &= ~0x80; mouse_command(PSMOUSE_CMD_DISABLE, NULL); } } else { /* install handler */ mouse_flags_2 |= 0x80; } SET_EBDA(ebda_seg, mouse_flag2, mouse_flags_2); SET_EBDA(ebda_seg, far_call_pointer, farptr); set_code_success(regs); } static void mouse_15c2XX(struct bregs *regs) { set_code_unimplemented(regs, RET_EINVFUNCTION); } void handle_15c2(struct bregs *regs) { //debug_stub(regs); if (! CONFIG_MOUSE) { set_code_invalid(regs, RET_EUNSUPPORTED); return; } switch (regs->al) { case 0x00: mouse_15c200(regs); break; case 0x01: mouse_15c201(regs); break; case 0x02: mouse_15c202(regs); break; case 0x03: mouse_15c203(regs); break; case 0x04: mouse_15c204(regs); break; case 0x05: mouse_15c205(regs); break; case 0x06: mouse_15c206(regs); break; case 0x07: mouse_15c207(regs); break; default: mouse_15c2XX(regs); break; } } static void invoke_mouse_handler(u16 ebda_seg) { u16 status = GET_EBDA(ebda_seg, mouse_data[0]); u16 X = GET_EBDA(ebda_seg, mouse_data[1]); u16 Y = GET_EBDA(ebda_seg, mouse_data[2]); struct segoff_s func = GET_EBDA(ebda_seg, far_call_pointer); dprintf(16, "mouse farcall s=%04x x=%04x y=%04x func=%04x:%04x\n" , status, X, Y, func.seg, func.offset); asm volatile( "pushl %%ebp\n" "sti\n" "pushl %0\n" "pushw %w1\n" // status "pushw %w2\n" // X "pushw %w3\n" // Y "pushw $0\n" // Z "lcallw *8(%%esp)\n" "addl $12, %%esp\n" "cli\n" "cld\n" "popl %%ebp" : "+a"(func.segoff), "+c"(status), "+d"(X), "+b"(Y) : : "edi", "esi", "cc", "memory"); } void process_mouse(u8 data) { if (!CONFIG_MOUSE) return; u16 ebda_seg = get_ebda_seg(); u8 mouse_flags_1 = GET_EBDA(ebda_seg, mouse_flag1); u8 mouse_flags_2 = GET_EBDA(ebda_seg, mouse_flag2); if (! (mouse_flags_2 & 0x80)) // far call handler not installed return; u8 package_count = mouse_flags_2 & 0x07; u8 index = mouse_flags_1 & 0x07; SET_EBDA(ebda_seg, mouse_data[index], data); if ((index+1) < package_count) { mouse_flags_1++; SET_EBDA(ebda_seg, mouse_flag1, mouse_flags_1); return; } SET_EBDA(ebda_seg, mouse_flag1, 0); stack_hop_back(ebda_seg, 0, invoke_mouse_handler); } tinyvisor/bios/src/pci.h0000644006644000001440000001065712172661303015545 0ustar yuichi_xyusers#ifndef __PCI_H #define __PCI_H #include "types.h" // u32 #include "list.h" // hlist_node #define PCI_ROM_SLOT 6 #define PCI_NUM_REGIONS 7 #define PCI_BRIDGE_NUM_REGIONS 2 static inline u8 pci_bdf_to_bus(u16 bdf) { return bdf >> 8; } static inline u8 pci_bdf_to_devfn(u16 bdf) { return bdf & 0xff; } static inline u16 pci_bdf_to_busdev(u16 bdf) { return bdf & ~0x07; } static inline u8 pci_bdf_to_dev(u16 bdf) { return (bdf >> 3) & 0x1f; } static inline u8 pci_bdf_to_fn(u16 bdf) { return bdf & 0x07; } static inline u16 pci_to_bdf(int bus, int dev, int fn) { return (bus<<8) | (dev<<3) | fn; } static inline u16 pci_bus_devfn_to_bdf(int bus, u16 devfn) { return (bus << 8) | devfn; } void pci_config_writel(u16 bdf, u32 addr, u32 val); void pci_config_writew(u16 bdf, u32 addr, u16 val); void pci_config_writeb(u16 bdf, u32 addr, u8 val); u32 pci_config_readl(u16 bdf, u32 addr); u16 pci_config_readw(u16 bdf, u32 addr); u8 pci_config_readb(u16 bdf, u32 addr); void pci_config_maskw(u16 bdf, u32 addr, u16 off, u16 on); struct pci_device *pci_find_device(u16 vendid, u16 devid); struct pci_device *pci_find_class(u16 classid); struct pci_device { u16 bdf; u8 rootbus; struct hlist_node node; struct pci_device *parent; // Configuration space device information u16 vendor, device; u16 class; u8 prog_if, revision; u8 header_type; u8 secondary_bus; // Local information on device. int have_driver; }; extern u64 pcimem_start, pcimem_end; extern u64 pcimem64_start, pcimem64_end; extern struct hlist_head PCIDevices; extern int MaxPCIBus; int pci_probe_host(void); void pci_probe_devices(void); static inline u32 pci_classprog(struct pci_device *pci) { return (pci->class << 8) | pci->prog_if; } #define foreachpci(PCI) \ hlist_for_each_entry(PCI, &PCIDevices, node) int pci_next(int bdf, int bus); #define foreachbdf(BDF, BUS) \ for (BDF=pci_next(pci_bus_devfn_to_bdf((BUS), 0)-1, (BUS)) \ ; BDF >= 0 \ ; BDF=pci_next(BDF, (BUS))) #define PCI_ANY_ID (~0) struct pci_device_id { u32 vendid; u32 devid; u32 class; u32 class_mask; void (*func)(struct pci_device *pci, void *arg); }; #define PCI_DEVICE(vendor_id, device_id, init_func) \ { \ .vendid = (vendor_id), \ .devid = (device_id), \ .class = PCI_ANY_ID, \ .class_mask = 0, \ .func = (init_func) \ } #define PCI_DEVICE_CLASS(vendor_id, device_id, class_code, init_func) \ { \ .vendid = (vendor_id), \ .devid = (device_id), \ .class = (class_code), \ .class_mask = ~0, \ .func = (init_func) \ } #define PCI_DEVICE_END \ { \ .vendid = 0, \ } int pci_init_device(const struct pci_device_id *ids , struct pci_device *pci, void *arg); struct pci_device *pci_find_init_device(const struct pci_device_id *ids , void *arg); void pci_reboot(void); // helper functions to access pci mmio bars from real mode u32 pci_readl(u32 addr); void pci_writel(u32 addr, u32 val); // pirtable.c void pirtable_setup(void); /**************************************************************** * PIR table ****************************************************************/ struct link_info { u8 link; u16 bitmap; } PACKED; struct pir_slot { u8 bus; u8 dev; struct link_info links[4]; u8 slot_nr; u8 reserved; } PACKED; struct pir_header { u32 signature; u16 version; u16 size; u8 router_bus; u8 router_devfunc; u16 exclusive_irqs; u32 compatible_devid; u32 miniport_data; u8 reserved[11]; u8 checksum; struct pir_slot slots[0]; } PACKED; extern struct pir_header *PirAddr; #define PIR_SIGNATURE 0x52495024 // $PIR #endif tinyvisor/bios/src/virtio-pci.c0000644006644000001440000000421611733243570017050 0ustar yuichi_xyusers/* virtio-pci.c - pci interface for virtio interface * * (c) Copyright 2008 Bull S.A.S. * * Author: Laurent Vivier * * some parts from Linux Virtio PCI driver * * Copyright IBM Corp. 2007 * Authors: Anthony Liguori * * Adopted for Seabios: Gleb Natapov * * This work is licensed under the terms of the GNU LGPLv3 * See the COPYING file in the top-level directory. */ #include "virtio-ring.h" #include "virtio-pci.h" #include "config.h" // CONFIG_DEBUG_LEVEL #include "util.h" // dprintf #include "pci.h" // pci_config_readl #include "pci_regs.h" // PCI_BASE_ADDRESS_0 int vp_find_vq(unsigned int ioaddr, int queue_index, struct vring_virtqueue **p_vq) { u16 num; ASSERT32FLAT(); struct vring_virtqueue *vq = *p_vq = memalign_low(PAGE_SIZE, sizeof(*vq)); if (!vq) { warn_noalloc(); goto fail; } memset(vq, 0, sizeof(*vq)); /* select the queue */ outw(queue_index, ioaddr + VIRTIO_PCI_QUEUE_SEL); /* check if the queue is available */ num = inw(ioaddr + VIRTIO_PCI_QUEUE_NUM); if (!num) { dprintf(1, "ERROR: queue size is 0\n"); goto fail; } if (num > MAX_QUEUE_NUM) { dprintf(1, "ERROR: queue size %d > %d\n", num, MAX_QUEUE_NUM); goto fail; } /* check if the queue is already active */ if (inl(ioaddr + VIRTIO_PCI_QUEUE_PFN)) { dprintf(1, "ERROR: queue already active\n"); goto fail; } vq->queue_index = queue_index; /* initialize the queue */ struct vring * vr = &vq->vring; vring_init(vr, num, (unsigned char*)&vq->queue); /* activate the queue * * NOTE: vr->desc is initialized by vring_init() */ outl((unsigned long)virt_to_phys(vr->desc) >> PAGE_SHIFT, ioaddr + VIRTIO_PCI_QUEUE_PFN); return num; fail: free(vq); *p_vq = NULL; return -1; } u16 vp_init_simple(u16 bdf) { u16 ioaddr = pci_config_readl(bdf, PCI_BASE_ADDRESS_0) & PCI_BASE_ADDRESS_IO_MASK; vp_reset(ioaddr); vp_set_status(ioaddr, VIRTIO_CONFIG_S_ACKNOWLEDGE | VIRTIO_CONFIG_S_DRIVER ); return ioaddr; } tinyvisor/bios/src/boot.h0000644006644000001440000000210212172661303015717 0ustar yuichi_xyusers// Storage for boot definitions. #ifndef __BOOT_H #define __BOOT_H // boot.c void boot_init(void); void boot_add_bev(u16 seg, u16 bev, u16 desc, int prio); void boot_add_bcv(u16 seg, u16 ip, u16 desc, int prio); struct drive_s; void boot_add_floppy(struct drive_s *drive_g, const char *desc, int prio); void boot_add_hd(struct drive_s *drive_g, const char *desc, int prio); void boot_add_cd(struct drive_s *drive_g, const char *desc, int prio); void boot_add_cbfs(void *data, const char *desc, int prio); void interactive_bootmenu(void); void bcv_prepboot(void); struct pci_device; int bootprio_find_pci_device(struct pci_device *pci); int bootprio_find_scsi_device(struct pci_device *pci, int target, int lun); int bootprio_find_ata_device(struct pci_device *pci, int chanid, int slave); int bootprio_find_fdc_device(struct pci_device *pci, int port, int fdid); int bootprio_find_pci_rom(struct pci_device *pci, int instance); int bootprio_find_named_rom(const char *name, int instance); struct usbdevice_s; int bootprio_find_usb(struct usbdevice_s *usbdev, int lun); #endif // __BOOT_H tinyvisor/bios/src/acpi-dsdt-isa.dsl0000644006644000001440000000517612172661303017747 0ustar yuichi_xyusers/* Common legacy ISA style devices. */ Scope(\_SB.PCI0.ISA) { Device(RTC) { Name(_HID, EisaId("PNP0B00")) Name(_CRS, ResourceTemplate() { IO(Decode16, 0x0070, 0x0070, 0x10, 0x02) IRQNoFlags() { 8 } IO(Decode16, 0x0072, 0x0072, 0x02, 0x06) }) } Device(KBD) { Name(_HID, EisaId("PNP0303")) Method(_STA, 0, NotSerialized) { Return (0x0f) } Name(_CRS, ResourceTemplate() { IO(Decode16, 0x0060, 0x0060, 0x01, 0x01) IO(Decode16, 0x0064, 0x0064, 0x01, 0x01) IRQNoFlags() { 1 } }) } Device(MOU) { Name(_HID, EisaId("PNP0F13")) Method(_STA, 0, NotSerialized) { Return (0x0f) } Name(_CRS, ResourceTemplate() { IRQNoFlags() { 12 } }) } Device(FDC0) { Name(_HID, EisaId("PNP0700")) Method(_STA, 0, NotSerialized) { Store(FDEN, Local0) If (LEqual(Local0, 0)) { Return (0x00) } Else { Return (0x0F) } } Name(_CRS, ResourceTemplate() { IO(Decode16, 0x03F2, 0x03F2, 0x00, 0x04) IO(Decode16, 0x03F7, 0x03F7, 0x00, 0x01) IRQNoFlags() { 6 } DMA(Compatibility, NotBusMaster, Transfer8) { 2 } }) } Device(LPT) { Name(_HID, EisaId("PNP0400")) Method(_STA, 0, NotSerialized) { Store(LPEN, Local0) If (LEqual(Local0, 0)) { Return (0x00) } Else { Return (0x0F) } } Name(_CRS, ResourceTemplate() { IO(Decode16, 0x0378, 0x0378, 0x08, 0x08) IRQNoFlags() { 7 } }) } Device(COM1) { Name(_HID, EisaId("PNP0501")) Name(_UID, 0x01) Method(_STA, 0, NotSerialized) { Store(CAEN, Local0) If (LEqual(Local0, 0)) { Return (0x00) } Else { Return (0x0F) } } Name(_CRS, ResourceTemplate() { IO(Decode16, 0x03F8, 0x03F8, 0x00, 0x08) IRQNoFlags() { 4 } }) } Device(COM2) { Name(_HID, EisaId("PNP0501")) Name(_UID, 0x02) Method(_STA, 0, NotSerialized) { Store(CBEN, Local0) If (LEqual(Local0, 0)) { Return (0x00) } Else { Return (0x0F) } } Name(_CRS, ResourceTemplate() { IO(Decode16, 0x02F8, 0x02F8, 0x00, 0x08) IRQNoFlags() { 3 } }) } } tinyvisor/bios/src/stacks.c0000644006644000001440000003030612172661303016246 0ustar yuichi_xyusers// Code for manipulating stack locations. // // Copyright (C) 2009-2010 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "biosvar.h" // GET_GLOBAL #include "util.h" // dprintf #include "bregs.h" // CR0_PE #include "list.h" // hlist_node /**************************************************************** * Extra 16bit stack ****************************************************************/ // Space for a stack for 16bit code. u8 ExtraStack[BUILD_EXTRA_STACK_SIZE+1] VARLOW __aligned(8); u8 *StackPos VARLOW; // Test if currently on the extra stack static inline int on_extra_stack(void) { return MODE16 && GET_SEG(SS) == SEG_LOW && getesp() > (u32)ExtraStack; } // Switch to the extra stack and call a function. u32 stack_hop(u32 eax, u32 edx, void *func) { if (on_extra_stack()) return ((u32 (*)(u32, u32))func)(eax, edx); ASSERT16(); u16 stack_seg = SEG_LOW; u32 bkup_ss, bkup_esp; asm volatile( // Backup current %ss/%esp values. "movw %%ss, %w3\n" "movl %%esp, %4\n" // Copy stack seg to %ds/%ss and set %esp "movw %w6, %%ds\n" "movw %w6, %%ss\n" "movl %5, %%esp\n" "pushl %3\n" "pushl %4\n" // Call func "calll *%2\n" "popl %4\n" "popl %3\n" // Restore segments and stack "movw %w3, %%ds\n" "movw %w3, %%ss\n" "movl %4, %%esp" : "+a" (eax), "+d" (edx), "+c" (func), "=&r" (bkup_ss), "=&r" (bkup_esp) : "m" (StackPos), "r" (stack_seg) : "cc", "memory"); return eax; } // Switch back to original caller's stack and call a function. u32 stack_hop_back(u32 eax, u32 edx, void *func) { if (!on_extra_stack()) return ((u32 (*)(u32, u32))func)(eax, edx); ASSERT16(); u16 bkup_ss; u32 bkup_stack_pos, temp; asm volatile( // Backup stack_pos and current %ss/%esp "movl %6, %4\n" "movw %%ss, %w3\n" "movl %%esp, %6\n" // Restore original callers' %ss/%esp "movl -4(%4), %5\n" "movl %5, %%ss\n" "movw %%ds:-8(%4), %%sp\n" "movl %5, %%ds\n" // Call func "calll *%2\n" // Restore %ss/%esp and stack_pos "movw %w3, %%ds\n" "movw %w3, %%ss\n" "movl %6, %%esp\n" "movl %4, %6" : "+a" (eax), "+d" (edx), "+c" (func), "=&r" (bkup_ss) , "=&r" (bkup_stack_pos), "=&r" (temp), "+m" (StackPos) : : "cc", "memory"); return eax; } /**************************************************************** * 16bit / 32bit calling ****************************************************************/ static inline void sgdt(struct descloc_s *desc) { asm("sgdtl %0" : "=m"(*desc)); } static inline void lgdt(struct descloc_s *desc) { asm("lgdtl %0" : : "m"(*desc) : "memory"); } // Call a 32bit SeaBIOS function from a 16bit SeaBIOS function. u32 VISIBLE16 call32(void *func, u32 eax, u32 errret) { ASSERT16(); u32 cr0 = getcr0(); if (cr0 & CR0_PE) // Called in 16bit protected mode?! return errret; // Backup cmos index register and disable nmi u8 cmosindex = inb(PORT_CMOS_INDEX); outb(cmosindex | NMI_DISABLE_BIT, PORT_CMOS_INDEX); inb(PORT_CMOS_DATA); // Backup fs/gs and gdt u16 fs = GET_SEG(FS), gs = GET_SEG(GS); struct descloc_s gdt; sgdt(&gdt); u32 bkup_ss, bkup_esp; asm volatile( // Backup ss/esp / set esp to flat stack location " movl %%ss, %0\n" " movl %%esp, %1\n" " shll $4, %0\n" " addl %0, %%esp\n" " shrl $4, %0\n" // Transition to 32bit mode, call func, return to 16bit " movl $(" __stringify(BUILD_BIOS_ADDR) " + 1f), %%edx\n" " jmp transition32\n" " .code32\n" "1:calll *%3\n" " movl $2f, %%edx\n" " jmp transition16big\n" // Restore ds/ss/esp " .code16gcc\n" "2:movl %0, %%ds\n" " movl %0, %%ss\n" " movl %1, %%esp\n" : "=&r" (bkup_ss), "=&r" (bkup_esp), "+a" (eax) : "r" (func) : "ecx", "edx", "cc", "memory"); // Restore gdt and fs/gs lgdt(&gdt); SET_SEG(FS, fs); SET_SEG(GS, gs); // Restore cmos index register outb(cmosindex, PORT_CMOS_INDEX); inb(PORT_CMOS_DATA); return eax; } // Call a 16bit SeaBIOS function from a 32bit SeaBIOS function. static inline u32 call16(u32 eax, void *func) { ASSERT32FLAT(); if (getesp() > BUILD_STACK_ADDR) panic("call16 with invalid stack\n"); asm volatile( "calll __call16" : "+a" (eax) : "b" ((u32)func - BUILD_BIOS_ADDR) : "ecx", "edx", "cc", "memory"); return eax; } static inline u32 call16big(u32 eax, void *func) { ASSERT32FLAT(); if (getesp() > BUILD_STACK_ADDR) panic("call16big with invalid stack\n"); asm volatile( "calll __call16big" : "+a" (eax) : "b" ((u32)func - BUILD_BIOS_ADDR) : "ecx", "edx", "cc", "memory"); return eax; } // Far call 16bit code with a specified register state. void VISIBLE16 _farcall16(struct bregs *callregs) { ASSERT16(); asm volatile( "calll __farcall16\n" : "+a" (callregs), "+m" (*callregs) : "m" (__segment_ES) : "ebx", "ecx", "edx", "esi", "edi", "cc", "memory"); } inline void farcall16(struct bregs *callregs) { if (MODE16) { SET_SEG(ES, GET_SEG(SS)); stack_hop_back((u32)callregs, 0, _farcall16); return; } extern void _cfunc16__farcall16(void); call16((u32)callregs, _cfunc16__farcall16); } inline void farcall16big(struct bregs *callregs) { extern void _cfunc16__farcall16(void); call16big((u32)callregs, _cfunc16__farcall16); } // Invoke a 16bit software interrupt. inline void __call16_int(struct bregs *callregs, u16 offset) { if (MODESEGMENT) callregs->code.seg = GET_SEG(CS); else callregs->code.seg = SEG_BIOS; callregs->code.offset = offset; farcall16(callregs); } /**************************************************************** * Threads ****************************************************************/ // Thread info - stored at bottom of each thread stack - don't change // without also updating the inline assembler below. struct thread_info { void *stackpos; struct hlist_node node; }; struct thread_info MainThread VARFSEG = { NULL, { &MainThread.node, &MainThread.node.next } }; #define THREADSTACKSIZE 4096 // Check if any threads are running. static int have_threads(void) { return (CONFIG_THREADS && GET_FLATPTR(MainThread.node.next) != &MainThread.node); } // Return the 'struct thread_info' for the currently running thread. struct thread_info * getCurThread(void) { u32 esp = getesp(); if (esp <= BUILD_STACK_ADDR) return &MainThread; return (void*)ALIGN_DOWN(esp, THREADSTACKSIZE); } // Switch to next thread stack. static void switch_next(struct thread_info *cur) { struct thread_info *next = container_of( cur->node.next, struct thread_info, node); if (cur == next) // Nothing to do. return; asm volatile( " pushl $1f\n" // store return pc " pushl %%ebp\n" // backup %ebp " movl %%esp, (%%eax)\n" // cur->stackpos = %esp " movl (%%ecx), %%esp\n" // %esp = next->stackpos " popl %%ebp\n" // restore %ebp " retl\n" // restore pc "1:\n" : "+a"(cur), "+c"(next) : : "ebx", "edx", "esi", "edi", "cc", "memory"); } // Last thing called from a thread (called on "next" stack). static void __end_thread(struct thread_info *old) { hlist_del(&old->node); free(old); dprintf(DEBUG_thread, "\\%08x/ End thread\n", (u32)old); if (!have_threads()) dprintf(1, "All threads complete.\n"); } // Create a new thread and start executing 'func' in it. void run_thread(void (*func)(void*), void *data) { ASSERT32FLAT(); if (! CONFIG_THREADS) goto fail; struct thread_info *thread; thread = memalign_tmphigh(THREADSTACKSIZE, THREADSTACKSIZE); if (!thread) goto fail; thread->stackpos = (void*)thread + THREADSTACKSIZE; struct thread_info *cur = getCurThread(); hlist_add_after(&thread->node, &cur->node); dprintf(DEBUG_thread, "/%08x\\ Start thread\n", (u32)thread); asm volatile( // Start thread " pushl $1f\n" // store return pc " pushl %%ebp\n" // backup %ebp " movl %%esp, (%%edx)\n" // cur->stackpos = %esp " movl (%%ebx), %%esp\n" // %esp = thread->stackpos " calll *%%ecx\n" // Call func // End thread " movl 4(%%ebx), %%ecx\n" // %ecx = thread->node.next " movl -4(%%ecx), %%esp\n" // %esp = next->stackpos " movl %%ebx, %%eax\n" " calll %4\n" // call __end_thread(thread) " popl %%ebp\n" // restore %ebp " retl\n" // restore pc "1:\n" : "+a"(data), "+c"(func), "+b"(thread), "+d"(cur) : "m"(*(u8*)__end_thread) : "esi", "edi", "cc", "memory"); return; fail: func(data); } /**************************************************************** * Thread helpers ****************************************************************/ // Low-level irq enable. void VISIBLE16 check_irqs(void) { asm volatile("sti ; nop ; rep ; nop ; cli ; cld" : : :"memory"); } // Briefly permit irqs to occur. void yield(void) { if (MODESEGMENT) { stack_hop_back(0, 0, check_irqs); return; } extern void _cfunc16_check_irqs(void); if (!CONFIG_THREADS) { call16big(0, _cfunc16_check_irqs); return; } struct thread_info *cur = getCurThread(); if (cur == &MainThread) // Permit irqs to fire call16big(0, _cfunc16_check_irqs); // Switch to the next thread switch_next(cur); } void VISIBLE16 wait_irq(void) { asm volatile("sti ; hlt ; cli ; cld": : :"memory"); } // Wait for next irq to occur. void yield_toirq(void) { if (MODESEGMENT) { stack_hop_back(0, 0, wait_irq); return; } if (have_threads()) { // Threads still active - do a yield instead. yield(); return; } extern void _cfunc16_wait_irq(void); call16big(0, _cfunc16_wait_irq); } // Wait for all threads (other than the main thread) to complete. void wait_threads(void) { ASSERT32FLAT(); while (have_threads()) yield(); } void mutex_lock(struct mutex_s *mutex) { ASSERT32FLAT(); if (! CONFIG_THREADS) return; while (mutex->isLocked) yield(); mutex->isLocked = 1; } void mutex_unlock(struct mutex_s *mutex) { ASSERT32FLAT(); if (! CONFIG_THREADS) return; mutex->isLocked = 0; } /**************************************************************** * Thread preemption ****************************************************************/ int CanPreempt VARFSEG; static u32 PreemptCount; // Turn on RTC irqs and arrange for them to check the 32bit threads. void start_preempt(void) { if (! CONFIG_THREAD_OPTIONROMS) return; CanPreempt = 1; PreemptCount = 0; useRTC(); } // Turn off RTC irqs / stop checking for thread execution. void finish_preempt(void) { if (! CONFIG_THREAD_OPTIONROMS) { yield(); return; } CanPreempt = 0; releaseRTC(); dprintf(9, "Done preempt - %d checks\n", PreemptCount); yield(); } // Check if preemption is on, and wait for it to complete if so. int wait_preempt(void) { if (MODESEGMENT || !CONFIG_THREAD_OPTIONROMS || !CanPreempt) return 0; while (CanPreempt) yield(); return 1; } // Try to execute 32bit threads. void VISIBLE32INIT yield_preempt(void) { PreemptCount++; switch_next(&MainThread); } // 16bit code that checks if threads are pending and executes them if so. void check_preempt(void) { extern void _cfunc32flat_yield_preempt(void); if (CONFIG_THREAD_OPTIONROMS && GET_GLOBAL(CanPreempt) && have_threads()) call32(_cfunc32flat_yield_preempt, 0, 0); } tinyvisor/bios/src/pci_ids.h0000644006644000001440000031127312172661303016402 0ustar yuichi_xyusers/* * PCI Class, Vendor and Device IDs * * Please keep sorted. */ /* Device classes and subclasses */ #define PCI_CLASS_NOT_DEFINED 0x0000 #define PCI_CLASS_NOT_DEFINED_VGA 0x0001 #define PCI_BASE_CLASS_STORAGE 0x01 #define PCI_CLASS_STORAGE_SCSI 0x0100 #define PCI_CLASS_STORAGE_IDE 0x0101 #define PCI_CLASS_STORAGE_FLOPPY 0x0102 #define PCI_CLASS_STORAGE_IPI 0x0103 #define PCI_CLASS_STORAGE_RAID 0x0104 #define PCI_CLASS_STORAGE_SATA 0x0106 #define PCI_CLASS_STORAGE_SATA_AHCI 0x010601 #define PCI_CLASS_STORAGE_SAS 0x0107 #define PCI_CLASS_STORAGE_OTHER 0x0180 #define PCI_BASE_CLASS_NETWORK 0x02 #define PCI_CLASS_NETWORK_ETHERNET 0x0200 #define PCI_CLASS_NETWORK_TOKEN_RING 0x0201 #define PCI_CLASS_NETWORK_FDDI 0x0202 #define PCI_CLASS_NETWORK_ATM 0x0203 #define PCI_CLASS_NETWORK_OTHER 0x0280 #define PCI_BASE_CLASS_DISPLAY 0x03 #define PCI_CLASS_DISPLAY_VGA 0x0300 #define PCI_CLASS_DISPLAY_XGA 0x0301 #define PCI_CLASS_DISPLAY_3D 0x0302 #define PCI_CLASS_DISPLAY_OTHER 0x0380 #define PCI_BASE_CLASS_MULTIMEDIA 0x04 #define PCI_CLASS_MULTIMEDIA_VIDEO 0x0400 #define PCI_CLASS_MULTIMEDIA_AUDIO 0x0401 #define PCI_CLASS_MULTIMEDIA_PHONE 0x0402 #define PCI_CLASS_MULTIMEDIA_OTHER 0x0480 #define PCI_BASE_CLASS_MEMORY 0x05 #define PCI_CLASS_MEMORY_RAM 0x0500 #define PCI_CLASS_MEMORY_FLASH 0x0501 #define PCI_CLASS_MEMORY_OTHER 0x0580 #define PCI_BASE_CLASS_BRIDGE 0x06 #define PCI_CLASS_BRIDGE_HOST 0x0600 #define PCI_CLASS_BRIDGE_ISA 0x0601 #define PCI_CLASS_BRIDGE_EISA 0x0602 #define PCI_CLASS_BRIDGE_MC 0x0603 #define PCI_CLASS_BRIDGE_PCI 0x0604 #define PCI_CLASS_BRIDGE_PCMCIA 0x0605 #define PCI_CLASS_BRIDGE_NUBUS 0x0606 #define PCI_CLASS_BRIDGE_CARDBUS 0x0607 #define PCI_CLASS_BRIDGE_RACEWAY 0x0608 #define PCI_CLASS_BRIDGE_OTHER 0x0680 #define PCI_BASE_CLASS_COMMUNICATION 0x07 #define PCI_CLASS_COMMUNICATION_SERIAL 0x0700 #define PCI_CLASS_COMMUNICATION_PARALLEL 0x0701 #define PCI_CLASS_COMMUNICATION_MULTISERIAL 0x0702 #define PCI_CLASS_COMMUNICATION_MODEM 0x0703 #define PCI_CLASS_COMMUNICATION_OTHER 0x0780 #define PCI_BASE_CLASS_SYSTEM 0x08 #define PCI_CLASS_SYSTEM_PIC 0x0800 #define PCI_CLASS_SYSTEM_PIC_IOAPIC 0x080010 #define PCI_CLASS_SYSTEM_PIC_IOXAPIC 0x080020 #define PCI_CLASS_SYSTEM_DMA 0x0801 #define PCI_CLASS_SYSTEM_TIMER 0x0802 #define PCI_CLASS_SYSTEM_RTC 0x0803 #define PCI_CLASS_SYSTEM_PCI_HOTPLUG 0x0804 #define PCI_CLASS_SYSTEM_SDHCI 0x0805 #define PCI_CLASS_SYSTEM_OTHER 0x0880 #define PCI_BASE_CLASS_INPUT 0x09 #define PCI_CLASS_INPUT_KEYBOARD 0x0900 #define PCI_CLASS_INPUT_PEN 0x0901 #define PCI_CLASS_INPUT_MOUSE 0x0902 #define PCI_CLASS_INPUT_SCANNER 0x0903 #define PCI_CLASS_INPUT_GAMEPORT 0x0904 #define PCI_CLASS_INPUT_OTHER 0x0980 #define PCI_BASE_CLASS_DOCKING 0x0a #define PCI_CLASS_DOCKING_GENERIC 0x0a00 #define PCI_CLASS_DOCKING_OTHER 0x0a80 #define PCI_BASE_CLASS_PROCESSOR 0x0b #define PCI_CLASS_PROCESSOR_386 0x0b00 #define PCI_CLASS_PROCESSOR_486 0x0b01 #define PCI_CLASS_PROCESSOR_PENTIUM 0x0b02 #define PCI_CLASS_PROCESSOR_ALPHA 0x0b10 #define PCI_CLASS_PROCESSOR_POWERPC 0x0b20 #define PCI_CLASS_PROCESSOR_MIPS 0x0b30 #define PCI_CLASS_PROCESSOR_CO 0x0b40 #define PCI_BASE_CLASS_SERIAL 0x0c #define PCI_CLASS_SERIAL_FIREWIRE 0x0c00 #define PCI_CLASS_SERIAL_FIREWIRE_OHCI 0x0c0010 #define PCI_CLASS_SERIAL_ACCESS 0x0c01 #define PCI_CLASS_SERIAL_SSA 0x0c02 #define PCI_CLASS_SERIAL_USB 0x0c03 #define PCI_CLASS_SERIAL_USB_UHCI 0x0c0300 #define PCI_CLASS_SERIAL_USB_OHCI 0x0c0310 #define PCI_CLASS_SERIAL_USB_EHCI 0x0c0320 #define PCI_CLASS_SERIAL_FIBER 0x0c04 #define PCI_CLASS_SERIAL_SMBUS 0x0c05 #define PCI_BASE_CLASS_WIRELESS 0x0d #define PCI_CLASS_WIRELESS_RF_CONTROLLER 0x0d10 #define PCI_CLASS_WIRELESS_WHCI 0x0d1010 #define PCI_BASE_CLASS_INTELLIGENT 0x0e #define PCI_CLASS_INTELLIGENT_I2O 0x0e00 #define PCI_BASE_CLASS_SATELLITE 0x0f #define PCI_CLASS_SATELLITE_TV 0x0f00 #define PCI_CLASS_SATELLITE_AUDIO 0x0f01 #define PCI_CLASS_SATELLITE_VOICE 0x0f03 #define PCI_CLASS_SATELLITE_DATA 0x0f04 #define PCI_BASE_CLASS_CRYPT 0x10 #define PCI_CLASS_CRYPT_NETWORK 0x1000 #define PCI_CLASS_CRYPT_ENTERTAINMENT 0x1001 #define PCI_CLASS_CRYPT_OTHER 0x1080 #define PCI_BASE_CLASS_SIGNAL_PROCESSING 0x11 #define PCI_CLASS_SP_DPIO 0x1100 #define PCI_CLASS_SP_OTHER 0x1180 #define PCI_CLASS_OTHERS 0xff /* Vendors and devices. Sort key: vendor first, device next. */ #define PCI_VENDOR_ID_TTTECH 0x0357 #define PCI_DEVICE_ID_TTTECH_MC322 0x000a #define PCI_VENDOR_ID_DYNALINK 0x0675 #define PCI_DEVICE_ID_DYNALINK_IS64PH 0x1702 #define PCI_VENDOR_ID_BERKOM 0x0871 #define PCI_DEVICE_ID_BERKOM_A1T 0xffa1 #define PCI_DEVICE_ID_BERKOM_T_CONCEPT 0xffa2 #define PCI_DEVICE_ID_BERKOM_A4T 0xffa4 #define PCI_DEVICE_ID_BERKOM_SCITEL_QUADRO 0xffa8 #define PCI_VENDOR_ID_COMPAQ 0x0e11 #define PCI_DEVICE_ID_COMPAQ_TOKENRING 0x0508 #define PCI_DEVICE_ID_COMPAQ_TACHYON 0xa0fc #define PCI_DEVICE_ID_COMPAQ_SMART2P 0xae10 #define PCI_DEVICE_ID_COMPAQ_NETEL100 0xae32 #define PCI_DEVICE_ID_COMPAQ_NETEL10 0xae34 #define PCI_DEVICE_ID_COMPAQ_TRIFLEX_IDE 0xae33 #define PCI_DEVICE_ID_COMPAQ_NETFLEX3I 0xae35 #define PCI_DEVICE_ID_COMPAQ_NETEL100D 0xae40 #define PCI_DEVICE_ID_COMPAQ_NETEL100PI 0xae43 #define PCI_DEVICE_ID_COMPAQ_NETEL100I 0xb011 #define PCI_DEVICE_ID_COMPAQ_CISS 0xb060 #define PCI_DEVICE_ID_COMPAQ_CISSB 0xb178 #define PCI_DEVICE_ID_COMPAQ_CISSC 0x46 #define PCI_DEVICE_ID_COMPAQ_THUNDER 0xf130 #define PCI_DEVICE_ID_COMPAQ_NETFLEX3B 0xf150 #define PCI_VENDOR_ID_NCR 0x1000 #define PCI_VENDOR_ID_LSI_LOGIC 0x1000 #define PCI_DEVICE_ID_NCR_53C810 0x0001 #define PCI_DEVICE_ID_NCR_53C820 0x0002 #define PCI_DEVICE_ID_NCR_53C825 0x0003 #define PCI_DEVICE_ID_NCR_53C815 0x0004 #define PCI_DEVICE_ID_LSI_53C810AP 0x0005 #define PCI_DEVICE_ID_NCR_53C860 0x0006 #define PCI_DEVICE_ID_LSI_53C1510 0x000a #define PCI_DEVICE_ID_NCR_53C896 0x000b #define PCI_DEVICE_ID_NCR_53C895 0x000c #define PCI_DEVICE_ID_NCR_53C885 0x000d #define PCI_DEVICE_ID_NCR_53C875 0x000f #define PCI_DEVICE_ID_NCR_53C1510 0x0010 #define PCI_DEVICE_ID_LSI_53C895A 0x0012 #define PCI_DEVICE_ID_LSI_53C875A 0x0013 #define PCI_DEVICE_ID_LSI_53C1010_33 0x0020 #define PCI_DEVICE_ID_LSI_53C1010_66 0x0021 #define PCI_DEVICE_ID_LSI_53C1030 0x0030 #define PCI_DEVICE_ID_LSI_1030_53C1035 0x0032 #define PCI_DEVICE_ID_LSI_53C1035 0x0040 #define PCI_DEVICE_ID_NCR_53C875J 0x008f #define PCI_DEVICE_ID_LSI_FC909 0x0621 #define PCI_DEVICE_ID_LSI_FC929 0x0622 #define PCI_DEVICE_ID_LSI_FC929_LAN 0x0623 #define PCI_DEVICE_ID_LSI_FC919 0x0624 #define PCI_DEVICE_ID_LSI_FC919_LAN 0x0625 #define PCI_DEVICE_ID_LSI_FC929X 0x0626 #define PCI_DEVICE_ID_LSI_FC939X 0x0642 #define PCI_DEVICE_ID_LSI_FC949X 0x0640 #define PCI_DEVICE_ID_LSI_FC949ES 0x0646 #define PCI_DEVICE_ID_LSI_FC919X 0x0628 #define PCI_DEVICE_ID_NCR_YELLOWFIN 0x0701 #define PCI_DEVICE_ID_LSI_61C102 0x0901 #define PCI_DEVICE_ID_LSI_63C815 0x1000 #define PCI_DEVICE_ID_LSI_SAS1064 0x0050 #define PCI_DEVICE_ID_LSI_SAS1064R 0x0411 #define PCI_DEVICE_ID_LSI_VERDE_ZCR 0x0413 #define PCI_DEVICE_ID_LSI_SAS1066 0x005E #define PCI_DEVICE_ID_LSI_SAS1068 0x0054 #define PCI_DEVICE_ID_LSI_SAS1064A 0x005C #define PCI_DEVICE_ID_LSI_SAS1064E 0x0056 #define PCI_DEVICE_ID_LSI_SAS1066E 0x005A #define PCI_DEVICE_ID_LSI_SAS1068E 0x0058 #define PCI_DEVICE_ID_LSI_SAS1078 0x0060 #define PCI_DEVICE_ID_LSI_SAS1078DE 0x007C #define PCI_DEVICE_ID_LSI_SAS2108E 0x0078 #define PCI_DEVICE_ID_LSI_SAS2108 0x0079 #define PCI_DEVICE_ID_LSI_SAS2208 0x005B #define PCI_DEVICE_ID_LSI_SAS3108 0x005D #define PCI_DEVICE_ID_LSI_SAS2004 0x0071 #define PCI_DEVICE_ID_LSI_SAS2008 0x0073 #define PCI_VENDOR_ID_ATI 0x1002 /* Mach64 */ #define PCI_DEVICE_ID_ATI_68800 0x4158 #define PCI_DEVICE_ID_ATI_215CT222 0x4354 #define PCI_DEVICE_ID_ATI_210888CX 0x4358 #define PCI_DEVICE_ID_ATI_215ET222 0x4554 /* Mach64 / Rage */ #define PCI_DEVICE_ID_ATI_215GB 0x4742 #define PCI_DEVICE_ID_ATI_215GD 0x4744 #define PCI_DEVICE_ID_ATI_215GI 0x4749 #define PCI_DEVICE_ID_ATI_215GP 0x4750 #define PCI_DEVICE_ID_ATI_215GQ 0x4751 #define PCI_DEVICE_ID_ATI_215XL 0x4752 #define PCI_DEVICE_ID_ATI_215GT 0x4754 #define PCI_DEVICE_ID_ATI_215GTB 0x4755 #define PCI_DEVICE_ID_ATI_215_IV 0x4756 #define PCI_DEVICE_ID_ATI_215_IW 0x4757 #define PCI_DEVICE_ID_ATI_215_IZ 0x475A #define PCI_DEVICE_ID_ATI_210888GX 0x4758 #define PCI_DEVICE_ID_ATI_215_LB 0x4c42 #define PCI_DEVICE_ID_ATI_215_LD 0x4c44 #define PCI_DEVICE_ID_ATI_215_LG 0x4c47 #define PCI_DEVICE_ID_ATI_215_LI 0x4c49 #define PCI_DEVICE_ID_ATI_215_LM 0x4c4D #define PCI_DEVICE_ID_ATI_215_LN 0x4c4E #define PCI_DEVICE_ID_ATI_215_LR 0x4c52 #define PCI_DEVICE_ID_ATI_215_LS 0x4c53 #define PCI_DEVICE_ID_ATI_264_LT 0x4c54 /* Mach64 VT */ #define PCI_DEVICE_ID_ATI_264VT 0x5654 #define PCI_DEVICE_ID_ATI_264VU 0x5655 #define PCI_DEVICE_ID_ATI_264VV 0x5656 /* Rage128 GL */ #define PCI_DEVICE_ID_ATI_RAGE128_RE 0x5245 #define PCI_DEVICE_ID_ATI_RAGE128_RF 0x5246 #define PCI_DEVICE_ID_ATI_RAGE128_RG 0x5247 /* Rage128 VR */ #define PCI_DEVICE_ID_ATI_RAGE128_RK 0x524b #define PCI_DEVICE_ID_ATI_RAGE128_RL 0x524c #define PCI_DEVICE_ID_ATI_RAGE128_SE 0x5345 #define PCI_DEVICE_ID_ATI_RAGE128_SF 0x5346 #define PCI_DEVICE_ID_ATI_RAGE128_SG 0x5347 #define PCI_DEVICE_ID_ATI_RAGE128_SH 0x5348 #define PCI_DEVICE_ID_ATI_RAGE128_SK 0x534b #define PCI_DEVICE_ID_ATI_RAGE128_SL 0x534c #define PCI_DEVICE_ID_ATI_RAGE128_SM 0x534d #define PCI_DEVICE_ID_ATI_RAGE128_SN 0x534e /* Rage128 Ultra */ #define PCI_DEVICE_ID_ATI_RAGE128_TF 0x5446 #define PCI_DEVICE_ID_ATI_RAGE128_TL 0x544c #define PCI_DEVICE_ID_ATI_RAGE128_TR 0x5452 #define PCI_DEVICE_ID_ATI_RAGE128_TS 0x5453 #define PCI_DEVICE_ID_ATI_RAGE128_TT 0x5454 #define PCI_DEVICE_ID_ATI_RAGE128_TU 0x5455 /* Rage128 M3 */ #define PCI_DEVICE_ID_ATI_RAGE128_LE 0x4c45 #define PCI_DEVICE_ID_ATI_RAGE128_LF 0x4c46 /* Rage128 M4 */ #define PCI_DEVICE_ID_ATI_RAGE128_MF 0x4d46 #define PCI_DEVICE_ID_ATI_RAGE128_ML 0x4d4c /* Rage128 Pro GL */ #define PCI_DEVICE_ID_ATI_RAGE128_PA 0x5041 #define PCI_DEVICE_ID_ATI_RAGE128_PB 0x5042 #define PCI_DEVICE_ID_ATI_RAGE128_PC 0x5043 #define PCI_DEVICE_ID_ATI_RAGE128_PD 0x5044 #define PCI_DEVICE_ID_ATI_RAGE128_PE 0x5045 #define PCI_DEVICE_ID_ATI_RAGE128_PF 0x5046 /* Rage128 Pro VR */ #define PCI_DEVICE_ID_ATI_RAGE128_PG 0x5047 #define PCI_DEVICE_ID_ATI_RAGE128_PH 0x5048 #define PCI_DEVICE_ID_ATI_RAGE128_PI 0x5049 #define PCI_DEVICE_ID_ATI_RAGE128_PJ 0x504A #define PCI_DEVICE_ID_ATI_RAGE128_PK 0x504B #define PCI_DEVICE_ID_ATI_RAGE128_PL 0x504C #define PCI_DEVICE_ID_ATI_RAGE128_PM 0x504D #define PCI_DEVICE_ID_ATI_RAGE128_PN 0x504E #define PCI_DEVICE_ID_ATI_RAGE128_PO 0x504F #define PCI_DEVICE_ID_ATI_RAGE128_PP 0x5050 #define PCI_DEVICE_ID_ATI_RAGE128_PQ 0x5051 #define PCI_DEVICE_ID_ATI_RAGE128_PR 0x5052 #define PCI_DEVICE_ID_ATI_RAGE128_PS 0x5053 #define PCI_DEVICE_ID_ATI_RAGE128_PT 0x5054 #define PCI_DEVICE_ID_ATI_RAGE128_PU 0x5055 #define PCI_DEVICE_ID_ATI_RAGE128_PV 0x5056 #define PCI_DEVICE_ID_ATI_RAGE128_PW 0x5057 #define PCI_DEVICE_ID_ATI_RAGE128_PX 0x5058 /* Rage128 M4 */ /* Radeon R100 */ #define PCI_DEVICE_ID_ATI_RADEON_QD 0x5144 #define PCI_DEVICE_ID_ATI_RADEON_QE 0x5145 #define PCI_DEVICE_ID_ATI_RADEON_QF 0x5146 #define PCI_DEVICE_ID_ATI_RADEON_QG 0x5147 /* Radeon RV100 (VE) */ #define PCI_DEVICE_ID_ATI_RADEON_QY 0x5159 #define PCI_DEVICE_ID_ATI_RADEON_QZ 0x515a /* Radeon R200 (8500) */ #define PCI_DEVICE_ID_ATI_RADEON_QL 0x514c #define PCI_DEVICE_ID_ATI_RADEON_QN 0x514e #define PCI_DEVICE_ID_ATI_RADEON_QO 0x514f #define PCI_DEVICE_ID_ATI_RADEON_Ql 0x516c #define PCI_DEVICE_ID_ATI_RADEON_BB 0x4242 /* Radeon R200 (9100) */ #define PCI_DEVICE_ID_ATI_RADEON_QM 0x514d /* Radeon RV200 (7500) */ #define PCI_DEVICE_ID_ATI_RADEON_QW 0x5157 #define PCI_DEVICE_ID_ATI_RADEON_QX 0x5158 /* Radeon NV-100 */ /* Radeon RV250 (9000) */ #define PCI_DEVICE_ID_ATI_RADEON_Id 0x4964 #define PCI_DEVICE_ID_ATI_RADEON_Ie 0x4965 #define PCI_DEVICE_ID_ATI_RADEON_If 0x4966 #define PCI_DEVICE_ID_ATI_RADEON_Ig 0x4967 /* Radeon RV280 (9200) */ #define PCI_DEVICE_ID_ATI_RADEON_Ya 0x5961 #define PCI_DEVICE_ID_ATI_RADEON_Yd 0x5964 /* Radeon R300 (9500) */ /* Radeon R300 (9700) */ #define PCI_DEVICE_ID_ATI_RADEON_ND 0x4e44 #define PCI_DEVICE_ID_ATI_RADEON_NE 0x4e45 #define PCI_DEVICE_ID_ATI_RADEON_NF 0x4e46 #define PCI_DEVICE_ID_ATI_RADEON_NG 0x4e47 /* Radeon R350 (9800) */ /* Radeon RV350 (9600) */ /* Radeon M6 */ #define PCI_DEVICE_ID_ATI_RADEON_LY 0x4c59 #define PCI_DEVICE_ID_ATI_RADEON_LZ 0x4c5a /* Radeon M7 */ #define PCI_DEVICE_ID_ATI_RADEON_LW 0x4c57 #define PCI_DEVICE_ID_ATI_RADEON_LX 0x4c58 /* Radeon M9 */ #define PCI_DEVICE_ID_ATI_RADEON_Ld 0x4c64 #define PCI_DEVICE_ID_ATI_RADEON_Le 0x4c65 #define PCI_DEVICE_ID_ATI_RADEON_Lf 0x4c66 #define PCI_DEVICE_ID_ATI_RADEON_Lg 0x4c67 /* Radeon */ /* RadeonIGP */ #define PCI_DEVICE_ID_ATI_RS100 0xcab0 #define PCI_DEVICE_ID_ATI_RS200 0xcab2 #define PCI_DEVICE_ID_ATI_RS200_B 0xcbb2 #define PCI_DEVICE_ID_ATI_RS250 0xcab3 #define PCI_DEVICE_ID_ATI_RS300_100 0x5830 #define PCI_DEVICE_ID_ATI_RS300_133 0x5831 #define PCI_DEVICE_ID_ATI_RS300_166 0x5832 #define PCI_DEVICE_ID_ATI_RS300_200 0x5833 #define PCI_DEVICE_ID_ATI_RS350_100 0x7830 #define PCI_DEVICE_ID_ATI_RS350_133 0x7831 #define PCI_DEVICE_ID_ATI_RS350_166 0x7832 #define PCI_DEVICE_ID_ATI_RS350_200 0x7833 #define PCI_DEVICE_ID_ATI_RS400_100 0x5a30 #define PCI_DEVICE_ID_ATI_RS400_133 0x5a31 #define PCI_DEVICE_ID_ATI_RS400_166 0x5a32 #define PCI_DEVICE_ID_ATI_RS400_200 0x5a33 #define PCI_DEVICE_ID_ATI_RS480 0x5950 /* ATI IXP Chipset */ #define PCI_DEVICE_ID_ATI_IXP200_IDE 0x4349 #define PCI_DEVICE_ID_ATI_IXP200_SMBUS 0x4353 #define PCI_DEVICE_ID_ATI_IXP300_SMBUS 0x4363 #define PCI_DEVICE_ID_ATI_IXP300_IDE 0x4369 #define PCI_DEVICE_ID_ATI_IXP300_SATA 0x436e #define PCI_DEVICE_ID_ATI_IXP400_SMBUS 0x4372 #define PCI_DEVICE_ID_ATI_IXP400_IDE 0x4376 #define PCI_DEVICE_ID_ATI_IXP400_SATA 0x4379 #define PCI_DEVICE_ID_ATI_IXP400_SATA2 0x437a #define PCI_DEVICE_ID_ATI_IXP600_SATA 0x4380 #define PCI_DEVICE_ID_ATI_SBX00_SMBUS 0x4385 #define PCI_DEVICE_ID_ATI_IXP600_IDE 0x438c #define PCI_DEVICE_ID_ATI_IXP700_SATA 0x4390 #define PCI_DEVICE_ID_ATI_IXP700_IDE 0x439c #define PCI_VENDOR_ID_VLSI 0x1004 #define PCI_DEVICE_ID_VLSI_82C592 0x0005 #define PCI_DEVICE_ID_VLSI_82C593 0x0006 #define PCI_DEVICE_ID_VLSI_82C594 0x0007 #define PCI_DEVICE_ID_VLSI_82C597 0x0009 #define PCI_DEVICE_ID_VLSI_82C541 0x000c #define PCI_DEVICE_ID_VLSI_82C543 0x000d #define PCI_DEVICE_ID_VLSI_82C532 0x0101 #define PCI_DEVICE_ID_VLSI_82C534 0x0102 #define PCI_DEVICE_ID_VLSI_82C535 0x0104 #define PCI_DEVICE_ID_VLSI_82C147 0x0105 #define PCI_DEVICE_ID_VLSI_VAS96011 0x0702 #define PCI_VENDOR_ID_ADL 0x1005 #define PCI_DEVICE_ID_ADL_2301 0x2301 #define PCI_VENDOR_ID_NS 0x100b #define PCI_DEVICE_ID_NS_87415 0x0002 #define PCI_DEVICE_ID_NS_87560_LIO 0x000e #define PCI_DEVICE_ID_NS_87560_USB 0x0012 #define PCI_DEVICE_ID_NS_83815 0x0020 #define PCI_DEVICE_ID_NS_83820 0x0022 #define PCI_DEVICE_ID_NS_CS5535_ISA 0x002b #define PCI_DEVICE_ID_NS_CS5535_IDE 0x002d #define PCI_DEVICE_ID_NS_CS5535_AUDIO 0x002e #define PCI_DEVICE_ID_NS_CS5535_USB 0x002f #define PCI_DEVICE_ID_NS_GX_VIDEO 0x0030 #define PCI_DEVICE_ID_NS_SATURN 0x0035 #define PCI_DEVICE_ID_NS_SCx200_BRIDGE 0x0500 #define PCI_DEVICE_ID_NS_SCx200_SMI 0x0501 #define PCI_DEVICE_ID_NS_SCx200_IDE 0x0502 #define PCI_DEVICE_ID_NS_SCx200_AUDIO 0x0503 #define PCI_DEVICE_ID_NS_SCx200_VIDEO 0x0504 #define PCI_DEVICE_ID_NS_SCx200_XBUS 0x0505 #define PCI_DEVICE_ID_NS_SC1100_BRIDGE 0x0510 #define PCI_DEVICE_ID_NS_SC1100_SMI 0x0511 #define PCI_DEVICE_ID_NS_SC1100_XBUS 0x0515 #define PCI_DEVICE_ID_NS_87410 0xd001 #define PCI_DEVICE_ID_NS_GX_HOST_BRIDGE 0x0028 #define PCI_VENDOR_ID_TSENG 0x100c #define PCI_DEVICE_ID_TSENG_W32P_2 0x3202 #define PCI_DEVICE_ID_TSENG_W32P_b 0x3205 #define PCI_DEVICE_ID_TSENG_W32P_c 0x3206 #define PCI_DEVICE_ID_TSENG_W32P_d 0x3207 #define PCI_DEVICE_ID_TSENG_ET6000 0x3208 #define PCI_VENDOR_ID_WEITEK 0x100e #define PCI_DEVICE_ID_WEITEK_P9000 0x9001 #define PCI_DEVICE_ID_WEITEK_P9100 0x9100 #define PCI_VENDOR_ID_DEC 0x1011 #define PCI_DEVICE_ID_DEC_BRD 0x0001 #define PCI_DEVICE_ID_DEC_TULIP 0x0002 #define PCI_DEVICE_ID_DEC_TGA 0x0004 #define PCI_DEVICE_ID_DEC_TULIP_FAST 0x0009 #define PCI_DEVICE_ID_DEC_TGA2 0x000D #define PCI_DEVICE_ID_DEC_FDDI 0x000F #define PCI_DEVICE_ID_DEC_TULIP_PLUS 0x0014 #define PCI_DEVICE_ID_DEC_21142 0x0019 #define PCI_DEVICE_ID_DEC_21052 0x0021 #define PCI_DEVICE_ID_DEC_21150 0x0022 #define PCI_DEVICE_ID_DEC_21152 0x0024 #define PCI_DEVICE_ID_DEC_21153 0x0025 #define PCI_DEVICE_ID_DEC_21154 0x0026 #define PCI_DEVICE_ID_DEC_21285 0x1065 #define PCI_DEVICE_ID_COMPAQ_42XX 0x0046 #define PCI_VENDOR_ID_CIRRUS 0x1013 #define PCI_DEVICE_ID_CIRRUS_7548 0x0038 #define PCI_DEVICE_ID_CIRRUS_5430 0x00a0 #define PCI_DEVICE_ID_CIRRUS_5434_4 0x00a4 #define PCI_DEVICE_ID_CIRRUS_5434_8 0x00a8 #define PCI_DEVICE_ID_CIRRUS_5436 0x00ac #define PCI_DEVICE_ID_CIRRUS_5446 0x00b8 #define PCI_DEVICE_ID_CIRRUS_5480 0x00bc #define PCI_DEVICE_ID_CIRRUS_5462 0x00d0 #define PCI_DEVICE_ID_CIRRUS_5464 0x00d4 #define PCI_DEVICE_ID_CIRRUS_5465 0x00d6 #define PCI_DEVICE_ID_CIRRUS_6729 0x1100 #define PCI_DEVICE_ID_CIRRUS_6832 0x1110 #define PCI_DEVICE_ID_CIRRUS_7543 0x1202 #define PCI_DEVICE_ID_CIRRUS_4610 0x6001 #define PCI_DEVICE_ID_CIRRUS_4612 0x6003 #define PCI_DEVICE_ID_CIRRUS_4615 0x6004 #define PCI_VENDOR_ID_IBM 0x1014 #define PCI_DEVICE_ID_IBM_TR 0x0018 #define PCI_DEVICE_ID_IBM_TR_WAKE 0x003e #define PCI_DEVICE_ID_IBM_CPC710_PCI64 0x00fc #define PCI_DEVICE_ID_IBM_SNIPE 0x0180 #define PCI_DEVICE_ID_IBM_CITRINE 0x028C #define PCI_DEVICE_ID_IBM_GEMSTONE 0xB166 #define PCI_DEVICE_ID_IBM_OBSIDIAN 0x02BD #define PCI_DEVICE_ID_IBM_ICOM_DEV_ID_1 0x0031 #define PCI_DEVICE_ID_IBM_ICOM_DEV_ID_2 0x0219 #define PCI_DEVICE_ID_IBM_ICOM_V2_TWO_PORTS_RVX 0x021A #define PCI_DEVICE_ID_IBM_ICOM_V2_ONE_PORT_RVX_ONE_PORT_MDM 0x0251 #define PCI_DEVICE_ID_IBM_ICOM_V2_ONE_PORT_RVX_ONE_PORT_MDM_PCIE 0x0361 #define PCI_DEVICE_ID_IBM_ICOM_FOUR_PORT_MODEL 0x252 #define PCI_VENDOR_ID_UNISYS 0x1018 #define PCI_DEVICE_ID_UNISYS_DMA_DIRECTOR 0x001C #define PCI_VENDOR_ID_COMPEX2 0x101a /* pci.ids says "AT&T GIS (NCR)" */ #define PCI_DEVICE_ID_COMPEX2_100VG 0x0005 #define PCI_VENDOR_ID_WD 0x101c #define PCI_DEVICE_ID_WD_90C 0xc24a #define PCI_VENDOR_ID_AMI 0x101e #define PCI_DEVICE_ID_AMI_MEGARAID3 0x1960 #define PCI_DEVICE_ID_AMI_MEGARAID 0x9010 #define PCI_DEVICE_ID_AMI_MEGARAID2 0x9060 #define PCI_VENDOR_ID_AMD 0x1022 #define PCI_DEVICE_ID_AMD_K8_NB 0x1100 #define PCI_DEVICE_ID_AMD_K8_NB_ADDRMAP 0x1101 #define PCI_DEVICE_ID_AMD_K8_NB_MEMCTL 0x1102 #define PCI_DEVICE_ID_AMD_K8_NB_MISC 0x1103 #define PCI_DEVICE_ID_AMD_10H_NB_HT 0x1200 #define PCI_DEVICE_ID_AMD_10H_NB_MAP 0x1201 #define PCI_DEVICE_ID_AMD_10H_NB_DRAM 0x1202 #define PCI_DEVICE_ID_AMD_10H_NB_MISC 0x1203 #define PCI_DEVICE_ID_AMD_10H_NB_LINK 0x1204 #define PCI_DEVICE_ID_AMD_11H_NB_HT 0x1300 #define PCI_DEVICE_ID_AMD_11H_NB_MAP 0x1301 #define PCI_DEVICE_ID_AMD_11H_NB_DRAM 0x1302 #define PCI_DEVICE_ID_AMD_11H_NB_MISC 0x1303 #define PCI_DEVICE_ID_AMD_11H_NB_LINK 0x1304 #define PCI_DEVICE_ID_AMD_LANCE 0x2000 #define PCI_DEVICE_ID_AMD_LANCE_HOME 0x2001 #define PCI_DEVICE_ID_AMD_SCSI 0x2020 #define PCI_DEVICE_ID_AMD_SERENADE 0x36c0 #define PCI_DEVICE_ID_AMD_FE_GATE_7006 0x7006 #define PCI_DEVICE_ID_AMD_FE_GATE_7007 0x7007 #define PCI_DEVICE_ID_AMD_FE_GATE_700C 0x700C #define PCI_DEVICE_ID_AMD_FE_GATE_700E 0x700E #define PCI_DEVICE_ID_AMD_COBRA_7401 0x7401 #define PCI_DEVICE_ID_AMD_VIPER_7409 0x7409 #define PCI_DEVICE_ID_AMD_VIPER_740B 0x740B #define PCI_DEVICE_ID_AMD_VIPER_7410 0x7410 #define PCI_DEVICE_ID_AMD_VIPER_7411 0x7411 #define PCI_DEVICE_ID_AMD_VIPER_7413 0x7413 #define PCI_DEVICE_ID_AMD_VIPER_7440 0x7440 #define PCI_DEVICE_ID_AMD_OPUS_7441 0x7441 #define PCI_DEVICE_ID_AMD_OPUS_7443 0x7443 #define PCI_DEVICE_ID_AMD_VIPER_7443 0x7443 #define PCI_DEVICE_ID_AMD_OPUS_7445 0x7445 #define PCI_DEVICE_ID_AMD_8111_LPC 0x7468 #define PCI_DEVICE_ID_AMD_8111_IDE 0x7469 #define PCI_DEVICE_ID_AMD_8111_SMBUS2 0x746a #define PCI_DEVICE_ID_AMD_8111_SMBUS 0x746b #define PCI_DEVICE_ID_AMD_8111_AUDIO 0x746d #define PCI_DEVICE_ID_AMD_8151_0 0x7454 #define PCI_DEVICE_ID_AMD_8131_BRIDGE 0x7450 #define PCI_DEVICE_ID_AMD_8131_APIC 0x7451 #define PCI_DEVICE_ID_AMD_8132_BRIDGE 0x7458 #define PCI_DEVICE_ID_AMD_CS5536_ISA 0x2090 #define PCI_DEVICE_ID_AMD_CS5536_FLASH 0x2091 #define PCI_DEVICE_ID_AMD_CS5536_AUDIO 0x2093 #define PCI_DEVICE_ID_AMD_CS5536_OHC 0x2094 #define PCI_DEVICE_ID_AMD_CS5536_EHC 0x2095 #define PCI_DEVICE_ID_AMD_CS5536_UDC 0x2096 #define PCI_DEVICE_ID_AMD_CS5536_UOC 0x2097 #define PCI_DEVICE_ID_AMD_CS5536_IDE 0x209A #define PCI_DEVICE_ID_AMD_LX_VIDEO 0x2081 #define PCI_DEVICE_ID_AMD_LX_AES 0x2082 #define PCI_VENDOR_ID_TRIDENT 0x1023 #define PCI_DEVICE_ID_TRIDENT_4DWAVE_DX 0x2000 #define PCI_DEVICE_ID_TRIDENT_4DWAVE_NX 0x2001 #define PCI_DEVICE_ID_TRIDENT_9320 0x9320 #define PCI_DEVICE_ID_TRIDENT_9388 0x9388 #define PCI_DEVICE_ID_TRIDENT_9397 0x9397 #define PCI_DEVICE_ID_TRIDENT_939A 0x939A #define PCI_DEVICE_ID_TRIDENT_9520 0x9520 #define PCI_DEVICE_ID_TRIDENT_9525 0x9525 #define PCI_DEVICE_ID_TRIDENT_9420 0x9420 #define PCI_DEVICE_ID_TRIDENT_9440 0x9440 #define PCI_DEVICE_ID_TRIDENT_9660 0x9660 #define PCI_DEVICE_ID_TRIDENT_9750 0x9750 #define PCI_DEVICE_ID_TRIDENT_9850 0x9850 #define PCI_DEVICE_ID_TRIDENT_9880 0x9880 #define PCI_DEVICE_ID_TRIDENT_8400 0x8400 #define PCI_DEVICE_ID_TRIDENT_8420 0x8420 #define PCI_DEVICE_ID_TRIDENT_8500 0x8500 #define PCI_VENDOR_ID_AI 0x1025 #define PCI_DEVICE_ID_AI_M1435 0x1435 #define PCI_VENDOR_ID_DELL 0x1028 #define PCI_DEVICE_ID_DELL_RACIII 0x0008 #define PCI_DEVICE_ID_DELL_RAC4 0x0012 #define PCI_DEVICE_ID_DELL_PERC5 0x0015 #define PCI_VENDOR_ID_MATROX 0x102B #define PCI_DEVICE_ID_MATROX_MGA_2 0x0518 #define PCI_DEVICE_ID_MATROX_MIL 0x0519 #define PCI_DEVICE_ID_MATROX_MYS 0x051A #define PCI_DEVICE_ID_MATROX_MIL_2 0x051b #define PCI_DEVICE_ID_MATROX_MYS_AGP 0x051e #define PCI_DEVICE_ID_MATROX_MIL_2_AGP 0x051f #define PCI_DEVICE_ID_MATROX_MGA_IMP 0x0d10 #define PCI_DEVICE_ID_MATROX_G100_MM 0x1000 #define PCI_DEVICE_ID_MATROX_G100_AGP 0x1001 #define PCI_DEVICE_ID_MATROX_G200_PCI 0x0520 #define PCI_DEVICE_ID_MATROX_G200_AGP 0x0521 #define PCI_DEVICE_ID_MATROX_G400 0x0525 #define PCI_DEVICE_ID_MATROX_G200EV_PCI 0x0530 #define PCI_DEVICE_ID_MATROX_G550 0x2527 #define PCI_DEVICE_ID_MATROX_VIA 0x4536 #define PCI_VENDOR_ID_CT 0x102c #define PCI_DEVICE_ID_CT_69000 0x00c0 #define PCI_DEVICE_ID_CT_65545 0x00d8 #define PCI_DEVICE_ID_CT_65548 0x00dc #define PCI_DEVICE_ID_CT_65550 0x00e0 #define PCI_DEVICE_ID_CT_65554 0x00e4 #define PCI_DEVICE_ID_CT_65555 0x00e5 #define PCI_VENDOR_ID_MIRO 0x1031 #define PCI_DEVICE_ID_MIRO_36050 0x5601 #define PCI_DEVICE_ID_MIRO_DC10PLUS 0x7efe #define PCI_DEVICE_ID_MIRO_DC30PLUS 0xd801 #define PCI_VENDOR_ID_NEC 0x1033 #define PCI_DEVICE_ID_NEC_CBUS_1 0x0001 /* PCI-Cbus Bridge */ #define PCI_DEVICE_ID_NEC_LOCAL 0x0002 /* Local Bridge */ #define PCI_DEVICE_ID_NEC_ATM 0x0003 /* ATM LAN Controller */ #define PCI_DEVICE_ID_NEC_R4000 0x0004 /* R4000 Bridge */ #define PCI_DEVICE_ID_NEC_486 0x0005 /* 486 Like Peripheral Bus Bridge */ #define PCI_DEVICE_ID_NEC_ACCEL_1 0x0006 /* Graphic Accelerator */ #define PCI_DEVICE_ID_NEC_UXBUS 0x0007 /* UX-Bus Bridge */ #define PCI_DEVICE_ID_NEC_ACCEL_2 0x0008 /* Graphic Accelerator */ #define PCI_DEVICE_ID_NEC_GRAPH 0x0009 /* PCI-CoreGraph Bridge */ #define PCI_DEVICE_ID_NEC_VL 0x0016 /* PCI-VL Bridge */ #define PCI_DEVICE_ID_NEC_STARALPHA2 0x002c /* STAR ALPHA2 */ #define PCI_DEVICE_ID_NEC_CBUS_2 0x002d /* PCI-Cbus Bridge */ #define PCI_DEVICE_ID_NEC_USB 0x0035 /* PCI-USB Host */ #define PCI_DEVICE_ID_NEC_CBUS_3 0x003b #define PCI_DEVICE_ID_NEC_NAPCCARD 0x003e #define PCI_DEVICE_ID_NEC_PCX2 0x0046 /* PowerVR */ #define PCI_DEVICE_ID_NEC_VRC5476 0x009b #define PCI_DEVICE_ID_NEC_VRC4173 0x00a5 #define PCI_DEVICE_ID_NEC_VRC5477_AC97 0x00a6 #define PCI_DEVICE_ID_NEC_PC9821CS01 0x800c /* PC-9821-CS01 */ #define PCI_DEVICE_ID_NEC_PC9821NRB06 0x800d /* PC-9821NR-B06 */ #define PCI_VENDOR_ID_FD 0x1036 #define PCI_DEVICE_ID_FD_36C70 0x0000 #define PCI_VENDOR_ID_SI 0x1039 #define PCI_DEVICE_ID_SI_5591_AGP 0x0001 #define PCI_DEVICE_ID_SI_6202 0x0002 #define PCI_DEVICE_ID_SI_503 0x0008 #define PCI_DEVICE_ID_SI_ACPI 0x0009 #define PCI_DEVICE_ID_SI_SMBUS 0x0016 #define PCI_DEVICE_ID_SI_LPC 0x0018 #define PCI_DEVICE_ID_SI_5597_VGA 0x0200 #define PCI_DEVICE_ID_SI_6205 0x0205 #define PCI_DEVICE_ID_SI_501 0x0406 #define PCI_DEVICE_ID_SI_496 0x0496 #define PCI_DEVICE_ID_SI_300 0x0300 #define PCI_DEVICE_ID_SI_315H 0x0310 #define PCI_DEVICE_ID_SI_315 0x0315 #define PCI_DEVICE_ID_SI_315PRO 0x0325 #define PCI_DEVICE_ID_SI_530 0x0530 #define PCI_DEVICE_ID_SI_540 0x0540 #define PCI_DEVICE_ID_SI_550 0x0550 #define PCI_DEVICE_ID_SI_540_VGA 0x5300 #define PCI_DEVICE_ID_SI_550_VGA 0x5315 #define PCI_DEVICE_ID_SI_620 0x0620 #define PCI_DEVICE_ID_SI_630 0x0630 #define PCI_DEVICE_ID_SI_633 0x0633 #define PCI_DEVICE_ID_SI_635 0x0635 #define PCI_DEVICE_ID_SI_640 0x0640 #define PCI_DEVICE_ID_SI_645 0x0645 #define PCI_DEVICE_ID_SI_646 0x0646 #define PCI_DEVICE_ID_SI_648 0x0648 #define PCI_DEVICE_ID_SI_650 0x0650 #define PCI_DEVICE_ID_SI_651 0x0651 #define PCI_DEVICE_ID_SI_655 0x0655 #define PCI_DEVICE_ID_SI_661 0x0661 #define PCI_DEVICE_ID_SI_730 0x0730 #define PCI_DEVICE_ID_SI_733 0x0733 #define PCI_DEVICE_ID_SI_630_VGA 0x6300 #define PCI_DEVICE_ID_SI_735 0x0735 #define PCI_DEVICE_ID_SI_740 0x0740 #define PCI_DEVICE_ID_SI_741 0x0741 #define PCI_DEVICE_ID_SI_745 0x0745 #define PCI_DEVICE_ID_SI_746 0x0746 #define PCI_DEVICE_ID_SI_755 0x0755 #define PCI_DEVICE_ID_SI_760 0x0760 #define PCI_DEVICE_ID_SI_900 0x0900 #define PCI_DEVICE_ID_SI_961 0x0961 #define PCI_DEVICE_ID_SI_962 0x0962 #define PCI_DEVICE_ID_SI_963 0x0963 #define PCI_DEVICE_ID_SI_965 0x0965 #define PCI_DEVICE_ID_SI_966 0x0966 #define PCI_DEVICE_ID_SI_968 0x0968 #define PCI_DEVICE_ID_SI_1180 0x1180 #define PCI_DEVICE_ID_SI_5511 0x5511 #define PCI_DEVICE_ID_SI_5513 0x5513 #define PCI_DEVICE_ID_SI_5517 0x5517 #define PCI_DEVICE_ID_SI_5518 0x5518 #define PCI_DEVICE_ID_SI_5571 0x5571 #define PCI_DEVICE_ID_SI_5581 0x5581 #define PCI_DEVICE_ID_SI_5582 0x5582 #define PCI_DEVICE_ID_SI_5591 0x5591 #define PCI_DEVICE_ID_SI_5596 0x5596 #define PCI_DEVICE_ID_SI_5597 0x5597 #define PCI_DEVICE_ID_SI_5598 0x5598 #define PCI_DEVICE_ID_SI_5600 0x5600 #define PCI_DEVICE_ID_SI_7012 0x7012 #define PCI_DEVICE_ID_SI_7013 0x7013 #define PCI_DEVICE_ID_SI_7016 0x7016 #define PCI_DEVICE_ID_SI_7018 0x7018 #define PCI_VENDOR_ID_HP 0x103c #define PCI_DEVICE_ID_HP_VISUALIZE_EG 0x1005 #define PCI_DEVICE_ID_HP_VISUALIZE_FX6 0x1006 #define PCI_DEVICE_ID_HP_VISUALIZE_FX4 0x1008 #define PCI_DEVICE_ID_HP_VISUALIZE_FX2 0x100a #define PCI_DEVICE_ID_HP_TACHYON 0x1028 #define PCI_DEVICE_ID_HP_TACHLITE 0x1029 #define PCI_DEVICE_ID_HP_J2585A 0x1030 #define PCI_DEVICE_ID_HP_J2585B 0x1031 #define PCI_DEVICE_ID_HP_J2973A 0x1040 #define PCI_DEVICE_ID_HP_J2970A 0x1042 #define PCI_DEVICE_ID_HP_DIVA 0x1048 #define PCI_DEVICE_ID_HP_DIVA_TOSCA1 0x1049 #define PCI_DEVICE_ID_HP_DIVA_TOSCA2 0x104A #define PCI_DEVICE_ID_HP_DIVA_MAESTRO 0x104B #define PCI_DEVICE_ID_HP_REO_IOC 0x10f1 #define PCI_DEVICE_ID_HP_VISUALIZE_FXE 0x108b #define PCI_DEVICE_ID_HP_DIVA_HALFDOME 0x1223 #define PCI_DEVICE_ID_HP_DIVA_KEYSTONE 0x1226 #define PCI_DEVICE_ID_HP_DIVA_POWERBAR 0x1227 #define PCI_DEVICE_ID_HP_ZX1_IOC 0x122a #define PCI_DEVICE_ID_HP_PCIX_LBA 0x122e #define PCI_DEVICE_ID_HP_SX1000_IOC 0x127c #define PCI_DEVICE_ID_HP_DIVA_EVEREST 0x1282 #define PCI_DEVICE_ID_HP_DIVA_AUX 0x1290 #define PCI_DEVICE_ID_HP_DIVA_RMP3 0x1301 #define PCI_DEVICE_ID_HP_DIVA_HURRICANE 0x132a #define PCI_DEVICE_ID_HP_CISSA 0x3220 #define PCI_DEVICE_ID_HP_CISSC 0x3230 #define PCI_DEVICE_ID_HP_CISSD 0x3238 #define PCI_DEVICE_ID_HP_CISSE 0x323a #define PCI_DEVICE_ID_HP_ZX2_IOC 0x4031 #define PCI_VENDOR_ID_PCTECH 0x1042 #define PCI_DEVICE_ID_PCTECH_RZ1000 0x1000 #define PCI_DEVICE_ID_PCTECH_RZ1001 0x1001 #define PCI_DEVICE_ID_PCTECH_SAMURAI_IDE 0x3020 #define PCI_VENDOR_ID_ASUSTEK 0x1043 #define PCI_DEVICE_ID_ASUSTEK_0675 0x0675 #define PCI_VENDOR_ID_DPT 0x1044 #define PCI_DEVICE_ID_DPT 0xa400 #define PCI_VENDOR_ID_OPTI 0x1045 #define PCI_DEVICE_ID_OPTI_82C558 0xc558 #define PCI_DEVICE_ID_OPTI_82C621 0xc621 #define PCI_DEVICE_ID_OPTI_82C700 0xc700 #define PCI_DEVICE_ID_OPTI_82C825 0xd568 #define PCI_VENDOR_ID_ELSA 0x1048 #define PCI_DEVICE_ID_ELSA_MICROLINK 0x1000 #define PCI_DEVICE_ID_ELSA_QS3000 0x3000 #define PCI_VENDOR_ID_BUSLOGIC 0x104B #define PCI_DEVICE_ID_BUSLOGIC_MULTIMASTER_NC 0x0140 #define PCI_DEVICE_ID_BUSLOGIC_MULTIMASTER 0x1040 #define PCI_DEVICE_ID_BUSLOGIC_FLASHPOINT 0x8130 #define PCI_VENDOR_ID_TI 0x104c #define PCI_DEVICE_ID_TI_TVP4020 0x3d07 #define PCI_DEVICE_ID_TI_4450 0x8011 #define PCI_DEVICE_ID_TI_TSB43AB22 0x8023 #define PCI_DEVICE_ID_TI_XX21_XX11 0x8031 #define PCI_DEVICE_ID_TI_XX21_XX11_FM 0x8033 #define PCI_DEVICE_ID_TI_XX21_XX11_SD 0x8034 #define PCI_DEVICE_ID_TI_X515 0x8036 #define PCI_DEVICE_ID_TI_XX12 0x8039 #define PCI_DEVICE_ID_TI_XX12_FM 0x803b #define PCI_DEVICE_ID_TI_1130 0xac12 #define PCI_DEVICE_ID_TI_1031 0xac13 #define PCI_DEVICE_ID_TI_1131 0xac15 #define PCI_DEVICE_ID_TI_1250 0xac16 #define PCI_DEVICE_ID_TI_1220 0xac17 #define PCI_DEVICE_ID_TI_1221 0xac19 #define PCI_DEVICE_ID_TI_1210 0xac1a #define PCI_DEVICE_ID_TI_1450 0xac1b #define PCI_DEVICE_ID_TI_1225 0xac1c #define PCI_DEVICE_ID_TI_1251A 0xac1d #define PCI_DEVICE_ID_TI_1211 0xac1e #define PCI_DEVICE_ID_TI_1251B 0xac1f #define PCI_DEVICE_ID_TI_4410 0xac41 #define PCI_DEVICE_ID_TI_4451 0xac42 #define PCI_DEVICE_ID_TI_4510 0xac44 #define PCI_DEVICE_ID_TI_4520 0xac46 #define PCI_DEVICE_ID_TI_7510 0xac47 #define PCI_DEVICE_ID_TI_7610 0xac48 #define PCI_DEVICE_ID_TI_7410 0xac49 #define PCI_DEVICE_ID_TI_1410 0xac50 #define PCI_DEVICE_ID_TI_1420 0xac51 #define PCI_DEVICE_ID_TI_1451A 0xac52 #define PCI_DEVICE_ID_TI_1620 0xac54 #define PCI_DEVICE_ID_TI_1520 0xac55 #define PCI_DEVICE_ID_TI_1510 0xac56 #define PCI_DEVICE_ID_TI_X620 0xac8d #define PCI_DEVICE_ID_TI_X420 0xac8e #define PCI_DEVICE_ID_TI_XX20_FM 0xac8f #define PCI_VENDOR_ID_SONY 0x104d /* Winbond have two vendor IDs! See 0x10ad as well */ #define PCI_VENDOR_ID_WINBOND2 0x1050 #define PCI_DEVICE_ID_WINBOND2_89C940F 0x5a5a #define PCI_DEVICE_ID_WINBOND2_6692 0x6692 #define PCI_VENDOR_ID_ANIGMA 0x1051 #define PCI_DEVICE_ID_ANIGMA_MC145575 0x0100 #define PCI_VENDOR_ID_EFAR 0x1055 #define PCI_DEVICE_ID_EFAR_SLC90E66_1 0x9130 #define PCI_DEVICE_ID_EFAR_SLC90E66_3 0x9463 #define PCI_VENDOR_ID_MOTOROLA 0x1057 #define PCI_DEVICE_ID_MOTOROLA_MPC105 0x0001 #define PCI_DEVICE_ID_MOTOROLA_MPC106 0x0002 #define PCI_DEVICE_ID_MOTOROLA_MPC107 0x0004 #define PCI_DEVICE_ID_MOTOROLA_RAVEN 0x4801 #define PCI_DEVICE_ID_MOTOROLA_FALCON 0x4802 #define PCI_DEVICE_ID_MOTOROLA_HAWK 0x4803 #define PCI_DEVICE_ID_MOTOROLA_HARRIER 0x480b #define PCI_DEVICE_ID_MOTOROLA_MPC5200 0x5803 #define PCI_DEVICE_ID_MOTOROLA_MPC5200B 0x5809 #define PCI_VENDOR_ID_PROMISE 0x105a #define PCI_DEVICE_ID_PROMISE_20265 0x0d30 #define PCI_DEVICE_ID_PROMISE_20267 0x4d30 #define PCI_DEVICE_ID_PROMISE_20246 0x4d33 #define PCI_DEVICE_ID_PROMISE_20262 0x4d38 #define PCI_DEVICE_ID_PROMISE_20263 0x0D38 #define PCI_DEVICE_ID_PROMISE_20268 0x4d68 #define PCI_DEVICE_ID_PROMISE_20269 0x4d69 #define PCI_DEVICE_ID_PROMISE_20270 0x6268 #define PCI_DEVICE_ID_PROMISE_20271 0x6269 #define PCI_DEVICE_ID_PROMISE_20275 0x1275 #define PCI_DEVICE_ID_PROMISE_20276 0x5275 #define PCI_DEVICE_ID_PROMISE_20277 0x7275 #define PCI_VENDOR_ID_UMC 0x1060 #define PCI_DEVICE_ID_UMC_UM8673F 0x0101 #define PCI_DEVICE_ID_UMC_UM8886BF 0x673a #define PCI_DEVICE_ID_UMC_UM8886A 0x886a #define PCI_VENDOR_ID_PICOPOWER 0x1066 #define PCI_DEVICE_ID_PICOPOWER_PT86C523 0x0002 #define PCI_DEVICE_ID_PICOPOWER_PT86C523BBP 0x8002 #define PCI_VENDOR_ID_MYLEX 0x1069 #define PCI_DEVICE_ID_MYLEX_DAC960_P 0x0001 #define PCI_DEVICE_ID_MYLEX_DAC960_PD 0x0002 #define PCI_DEVICE_ID_MYLEX_DAC960_PG 0x0010 #define PCI_DEVICE_ID_MYLEX_DAC960_LA 0x0020 #define PCI_DEVICE_ID_MYLEX_DAC960_LP 0x0050 #define PCI_DEVICE_ID_MYLEX_DAC960_BA 0xBA56 #define PCI_DEVICE_ID_MYLEX_DAC960_GEM 0xB166 #define PCI_VENDOR_ID_APPLE 0x106b #define PCI_DEVICE_ID_APPLE_BANDIT 0x0001 #define PCI_DEVICE_ID_APPLE_HYDRA 0x000e #define PCI_DEVICE_ID_APPLE_UNI_N_FW 0x0018 #define PCI_DEVICE_ID_APPLE_UNI_N_AGP 0x0020 #define PCI_DEVICE_ID_APPLE_UNI_N_GMAC 0x0021 #define PCI_DEVICE_ID_APPLE_UNI_N_GMACP 0x0024 #define PCI_DEVICE_ID_APPLE_UNI_N_AGP_P 0x0027 #define PCI_DEVICE_ID_APPLE_UNI_N_AGP15 0x002d #define PCI_DEVICE_ID_APPLE_UNI_N_PCI15 0x002e #define PCI_DEVICE_ID_APPLE_UNI_N_GMAC2 0x0032 #define PCI_DEVICE_ID_APPLE_UNI_N_ATA 0x0033 #define PCI_DEVICE_ID_APPLE_UNI_N_AGP2 0x0034 #define PCI_DEVICE_ID_APPLE_IPID_ATA100 0x003b #define PCI_DEVICE_ID_APPLE_K2_ATA100 0x0043 #define PCI_DEVICE_ID_APPLE_U3_AGP 0x004b #define PCI_DEVICE_ID_APPLE_K2_GMAC 0x004c #define PCI_DEVICE_ID_APPLE_SH_ATA 0x0050 #define PCI_DEVICE_ID_APPLE_SH_SUNGEM 0x0051 #define PCI_DEVICE_ID_APPLE_U3L_AGP 0x0058 #define PCI_DEVICE_ID_APPLE_U3H_AGP 0x0059 #define PCI_DEVICE_ID_APPLE_IPID2_AGP 0x0066 #define PCI_DEVICE_ID_APPLE_IPID2_ATA 0x0069 #define PCI_DEVICE_ID_APPLE_IPID2_FW 0x006a #define PCI_DEVICE_ID_APPLE_IPID2_GMAC 0x006b #define PCI_DEVICE_ID_APPLE_TIGON3 0x1645 #define PCI_VENDOR_ID_YAMAHA 0x1073 #define PCI_DEVICE_ID_YAMAHA_724 0x0004 #define PCI_DEVICE_ID_YAMAHA_724F 0x000d #define PCI_DEVICE_ID_YAMAHA_740 0x000a #define PCI_DEVICE_ID_YAMAHA_740C 0x000c #define PCI_DEVICE_ID_YAMAHA_744 0x0010 #define PCI_DEVICE_ID_YAMAHA_754 0x0012 #define PCI_VENDOR_ID_QLOGIC 0x1077 #define PCI_DEVICE_ID_QLOGIC_ISP10160 0x1016 #define PCI_DEVICE_ID_QLOGIC_ISP1020 0x1020 #define PCI_DEVICE_ID_QLOGIC_ISP1080 0x1080 #define PCI_DEVICE_ID_QLOGIC_ISP12160 0x1216 #define PCI_DEVICE_ID_QLOGIC_ISP1240 0x1240 #define PCI_DEVICE_ID_QLOGIC_ISP1280 0x1280 #define PCI_DEVICE_ID_QLOGIC_ISP2100 0x2100 #define PCI_DEVICE_ID_QLOGIC_ISP2200 0x2200 #define PCI_DEVICE_ID_QLOGIC_ISP2300 0x2300 #define PCI_DEVICE_ID_QLOGIC_ISP2312 0x2312 #define PCI_DEVICE_ID_QLOGIC_ISP2322 0x2322 #define PCI_DEVICE_ID_QLOGIC_ISP6312 0x6312 #define PCI_DEVICE_ID_QLOGIC_ISP6322 0x6322 #define PCI_DEVICE_ID_QLOGIC_ISP2422 0x2422 #define PCI_DEVICE_ID_QLOGIC_ISP2432 0x2432 #define PCI_DEVICE_ID_QLOGIC_ISP2512 0x2512 #define PCI_DEVICE_ID_QLOGIC_ISP2522 0x2522 #define PCI_DEVICE_ID_QLOGIC_ISP5422 0x5422 #define PCI_DEVICE_ID_QLOGIC_ISP5432 0x5432 #define PCI_VENDOR_ID_CYRIX 0x1078 #define PCI_DEVICE_ID_CYRIX_5510 0x0000 #define PCI_DEVICE_ID_CYRIX_PCI_MASTER 0x0001 #define PCI_DEVICE_ID_CYRIX_5520 0x0002 #define PCI_DEVICE_ID_CYRIX_5530_LEGACY 0x0100 #define PCI_DEVICE_ID_CYRIX_5530_IDE 0x0102 #define PCI_DEVICE_ID_CYRIX_5530_AUDIO 0x0103 #define PCI_DEVICE_ID_CYRIX_5530_VIDEO 0x0104 #define PCI_VENDOR_ID_CONTAQ 0x1080 #define PCI_DEVICE_ID_CONTAQ_82C693 0xc693 #define PCI_VENDOR_ID_OLICOM 0x108d #define PCI_DEVICE_ID_OLICOM_OC2325 0x0012 #define PCI_DEVICE_ID_OLICOM_OC2183 0x0013 #define PCI_DEVICE_ID_OLICOM_OC2326 0x0014 #define PCI_VENDOR_ID_SUN 0x108e #define PCI_DEVICE_ID_SUN_EBUS 0x1000 #define PCI_DEVICE_ID_SUN_HAPPYMEAL 0x1001 #define PCI_DEVICE_ID_SUN_RIO_EBUS 0x1100 #define PCI_DEVICE_ID_SUN_RIO_GEM 0x1101 #define PCI_DEVICE_ID_SUN_RIO_1394 0x1102 #define PCI_DEVICE_ID_SUN_RIO_USB 0x1103 #define PCI_DEVICE_ID_SUN_GEM 0x2bad #define PCI_DEVICE_ID_SUN_SIMBA 0x5000 #define PCI_DEVICE_ID_SUN_PBM 0x8000 #define PCI_DEVICE_ID_SUN_SCHIZO 0x8001 #define PCI_DEVICE_ID_SUN_SABRE 0xa000 #define PCI_DEVICE_ID_SUN_HUMMINGBIRD 0xa001 #define PCI_DEVICE_ID_SUN_TOMATILLO 0xa801 #define PCI_DEVICE_ID_SUN_CASSINI 0xabba #define PCI_VENDOR_ID_CMD 0x1095 #define PCI_DEVICE_ID_CMD_643 0x0643 #define PCI_DEVICE_ID_CMD_646 0x0646 #define PCI_DEVICE_ID_CMD_648 0x0648 #define PCI_DEVICE_ID_CMD_649 0x0649 #define PCI_DEVICE_ID_SII_680 0x0680 #define PCI_DEVICE_ID_SII_3112 0x3112 #define PCI_DEVICE_ID_SII_1210SA 0x0240 #define PCI_VENDOR_ID_BROOKTREE 0x109e #define PCI_DEVICE_ID_BROOKTREE_878 0x0878 #define PCI_DEVICE_ID_BROOKTREE_879 0x0879 #define PCI_VENDOR_ID_SGI 0x10a9 #define PCI_DEVICE_ID_SGI_IOC3 0x0003 #define PCI_DEVICE_ID_SGI_LITHIUM 0x1002 #define PCI_DEVICE_ID_SGI_IOC4 0x100a #define PCI_VENDOR_ID_WINBOND 0x10ad #define PCI_DEVICE_ID_WINBOND_82C105 0x0105 #define PCI_DEVICE_ID_WINBOND_83C553 0x0565 #define PCI_VENDOR_ID_PLX 0x10b5 #define PCI_DEVICE_ID_PLX_R685 0x1030 #define PCI_DEVICE_ID_PLX_ROMULUS 0x106a #define PCI_DEVICE_ID_PLX_SPCOM800 0x1076 #define PCI_DEVICE_ID_PLX_1077 0x1077 #define PCI_DEVICE_ID_PLX_SPCOM200 0x1103 #define PCI_DEVICE_ID_PLX_DJINN_ITOO 0x1151 #define PCI_DEVICE_ID_PLX_R753 0x1152 #define PCI_DEVICE_ID_PLX_OLITEC 0x1187 #define PCI_DEVICE_ID_PLX_PCI200SYN 0x3196 #define PCI_DEVICE_ID_PLX_9030 0x9030 #define PCI_DEVICE_ID_PLX_9050 0x9050 #define PCI_DEVICE_ID_PLX_9080 0x9080 #define PCI_DEVICE_ID_PLX_GTEK_SERIAL2 0xa001 #define PCI_VENDOR_ID_MADGE 0x10b6 #define PCI_DEVICE_ID_MADGE_MK2 0x0002 #define PCI_VENDOR_ID_3COM 0x10b7 #define PCI_DEVICE_ID_3COM_3C985 0x0001 #define PCI_DEVICE_ID_3COM_3C940 0x1700 #define PCI_DEVICE_ID_3COM_3C339 0x3390 #define PCI_DEVICE_ID_3COM_3C359 0x3590 #define PCI_DEVICE_ID_3COM_3C940B 0x80eb #define PCI_DEVICE_ID_3COM_3CR990 0x9900 #define PCI_DEVICE_ID_3COM_3CR990_TX_95 0x9902 #define PCI_DEVICE_ID_3COM_3CR990_TX_97 0x9903 #define PCI_DEVICE_ID_3COM_3CR990B 0x9904 #define PCI_DEVICE_ID_3COM_3CR990_FX 0x9905 #define PCI_DEVICE_ID_3COM_3CR990SVR95 0x9908 #define PCI_DEVICE_ID_3COM_3CR990SVR97 0x9909 #define PCI_DEVICE_ID_3COM_3CR990SVR 0x990a #define PCI_VENDOR_ID_AL 0x10b9 #define PCI_DEVICE_ID_AL_M1533 0x1533 #define PCI_DEVICE_ID_AL_M1535 0x1535 #define PCI_DEVICE_ID_AL_M1541 0x1541 #define PCI_DEVICE_ID_AL_M1563 0x1563 #define PCI_DEVICE_ID_AL_M1621 0x1621 #define PCI_DEVICE_ID_AL_M1631 0x1631 #define PCI_DEVICE_ID_AL_M1632 0x1632 #define PCI_DEVICE_ID_AL_M1641 0x1641 #define PCI_DEVICE_ID_AL_M1644 0x1644 #define PCI_DEVICE_ID_AL_M1647 0x1647 #define PCI_DEVICE_ID_AL_M1651 0x1651 #define PCI_DEVICE_ID_AL_M1671 0x1671 #define PCI_DEVICE_ID_AL_M1681 0x1681 #define PCI_DEVICE_ID_AL_M1683 0x1683 #define PCI_DEVICE_ID_AL_M1689 0x1689 #define PCI_DEVICE_ID_AL_M5219 0x5219 #define PCI_DEVICE_ID_AL_M5228 0x5228 #define PCI_DEVICE_ID_AL_M5229 0x5229 #define PCI_DEVICE_ID_AL_M5451 0x5451 #define PCI_DEVICE_ID_AL_M7101 0x7101 #define PCI_VENDOR_ID_NEOMAGIC 0x10c8 #define PCI_DEVICE_ID_NEOMAGIC_NM256AV_AUDIO 0x8005 #define PCI_DEVICE_ID_NEOMAGIC_NM256ZX_AUDIO 0x8006 #define PCI_DEVICE_ID_NEOMAGIC_NM256XL_PLUS_AUDIO 0x8016 #define PCI_VENDOR_ID_TCONRAD 0x10da #define PCI_DEVICE_ID_TCONRAD_TOKENRING 0x0508 #define PCI_VENDOR_ID_NVIDIA 0x10de #define PCI_DEVICE_ID_NVIDIA_TNT 0x0020 #define PCI_DEVICE_ID_NVIDIA_TNT2 0x0028 #define PCI_DEVICE_ID_NVIDIA_UTNT2 0x0029 #define PCI_DEVICE_ID_NVIDIA_TNT_UNKNOWN 0x002a #define PCI_DEVICE_ID_NVIDIA_VTNT2 0x002C #define PCI_DEVICE_ID_NVIDIA_UVTNT2 0x002D #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP04_SMBUS 0x0034 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP04_IDE 0x0035 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP04_SATA 0x0036 #define PCI_DEVICE_ID_NVIDIA_NVENET_10 0x0037 #define PCI_DEVICE_ID_NVIDIA_NVENET_11 0x0038 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP04_SATA2 0x003e #define PCI_DEVICE_ID_NVIDIA_GEFORCE_6800_ULTRA 0x0040 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_6800 0x0041 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_6800_LE 0x0042 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_6800_GT 0x0045 #define PCI_DEVICE_ID_NVIDIA_QUADRO_FX_4000 0x004E #define PCI_DEVICE_ID_NVIDIA_NFORCE4_SMBUS 0x0052 #define PCI_DEVICE_ID_NVIDIA_NFORCE_CK804_IDE 0x0053 #define PCI_DEVICE_ID_NVIDIA_NFORCE_CK804_SATA 0x0054 #define PCI_DEVICE_ID_NVIDIA_NFORCE_CK804_SATA2 0x0055 #define PCI_DEVICE_ID_NVIDIA_NVENET_8 0x0056 #define PCI_DEVICE_ID_NVIDIA_NVENET_9 0x0057 #define PCI_DEVICE_ID_NVIDIA_CK804_AUDIO 0x0059 #define PCI_DEVICE_ID_NVIDIA_CK804_PCIE 0x005d #define PCI_DEVICE_ID_NVIDIA_NFORCE2_SMBUS 0x0064 #define PCI_DEVICE_ID_NVIDIA_NFORCE2_IDE 0x0065 #define PCI_DEVICE_ID_NVIDIA_NVENET_2 0x0066 #define PCI_DEVICE_ID_NVIDIA_MCP2_MODEM 0x0069 #define PCI_DEVICE_ID_NVIDIA_MCP2_AUDIO 0x006a #define PCI_DEVICE_ID_NVIDIA_NFORCE2S_SMBUS 0x0084 #define PCI_DEVICE_ID_NVIDIA_NFORCE2S_IDE 0x0085 #define PCI_DEVICE_ID_NVIDIA_NVENET_4 0x0086 #define PCI_DEVICE_ID_NVIDIA_MCP2S_MODEM 0x0089 #define PCI_DEVICE_ID_NVIDIA_CK8_AUDIO 0x008a #define PCI_DEVICE_ID_NVIDIA_NVENET_5 0x008c #define PCI_DEVICE_ID_NVIDIA_NFORCE2S_SATA 0x008e #define PCI_DEVICE_ID_NVIDIA_GEFORCE_7800_GT 0x0090 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_7800_GTX 0x0091 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_GO_7800 0x0098 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_GO_7800_GTX 0x0099 #define PCI_DEVICE_ID_NVIDIA_ITNT2 0x00A0 #define PCI_DEVICE_ID_GEFORCE_6800A 0x00c1 #define PCI_DEVICE_ID_GEFORCE_6800A_LE 0x00c2 #define PCI_DEVICE_ID_GEFORCE_GO_6800 0x00c8 #define PCI_DEVICE_ID_GEFORCE_GO_6800_ULTRA 0x00c9 #define PCI_DEVICE_ID_QUADRO_FX_GO1400 0x00cc #define PCI_DEVICE_ID_QUADRO_FX_1400 0x00ce #define PCI_DEVICE_ID_NVIDIA_NFORCE3 0x00d1 #define PCI_DEVICE_ID_NVIDIA_NFORCE3_SMBUS 0x00d4 #define PCI_DEVICE_ID_NVIDIA_NFORCE3_IDE 0x00d5 #define PCI_DEVICE_ID_NVIDIA_NVENET_3 0x00d6 #define PCI_DEVICE_ID_NVIDIA_MCP3_MODEM 0x00d9 #define PCI_DEVICE_ID_NVIDIA_MCP3_AUDIO 0x00da #define PCI_DEVICE_ID_NVIDIA_NVENET_7 0x00df #define PCI_DEVICE_ID_NVIDIA_NFORCE3S 0x00e1 #define PCI_DEVICE_ID_NVIDIA_NFORCE3S_SATA 0x00e3 #define PCI_DEVICE_ID_NVIDIA_NFORCE3S_SMBUS 0x00e4 #define PCI_DEVICE_ID_NVIDIA_NFORCE3S_IDE 0x00e5 #define PCI_DEVICE_ID_NVIDIA_NVENET_6 0x00e6 #define PCI_DEVICE_ID_NVIDIA_CK8S_AUDIO 0x00ea #define PCI_DEVICE_ID_NVIDIA_NFORCE3S_SATA2 0x00ee #define PCIE_DEVICE_ID_NVIDIA_GEFORCE_6800_ALT1 0x00f0 #define PCIE_DEVICE_ID_NVIDIA_GEFORCE_6600_ALT1 0x00f1 #define PCIE_DEVICE_ID_NVIDIA_GEFORCE_6600_ALT2 0x00f2 #define PCIE_DEVICE_ID_NVIDIA_GEFORCE_6200_ALT1 0x00f3 #define PCIE_DEVICE_ID_NVIDIA_GEFORCE_6800_GT 0x00f9 #define PCIE_DEVICE_ID_NVIDIA_QUADRO_NVS280 0x00fd #define PCI_DEVICE_ID_NVIDIA_GEFORCE_SDR 0x0100 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_DDR 0x0101 #define PCI_DEVICE_ID_NVIDIA_QUADRO 0x0103 #define PCI_DEVICE_ID_NVIDIA_GEFORCE2_MX 0x0110 #define PCI_DEVICE_ID_NVIDIA_GEFORCE2_MX2 0x0111 #define PCI_DEVICE_ID_NVIDIA_GEFORCE2_GO 0x0112 #define PCI_DEVICE_ID_NVIDIA_QUADRO2_MXR 0x0113 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_6600_GT 0x0140 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_6600 0x0141 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_6610_XL 0x0145 #define PCI_DEVICE_ID_NVIDIA_QUADRO_FX_540 0x014E #define PCI_DEVICE_ID_NVIDIA_GEFORCE_6200 0x014F #define PCI_DEVICE_ID_NVIDIA_GEFORCE2_GTS 0x0150 #define PCI_DEVICE_ID_NVIDIA_GEFORCE2_GTS2 0x0151 #define PCI_DEVICE_ID_NVIDIA_GEFORCE2_ULTRA 0x0152 #define PCI_DEVICE_ID_NVIDIA_QUADRO2_PRO 0x0153 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_6200_TURBOCACHE 0x0161 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_GO_6200 0x0164 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_GO_6250 0x0166 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_GO_6200_1 0x0167 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_GO_6250_1 0x0168 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_MX_460 0x0170 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_MX_440 0x0171 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_MX_420 0x0172 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_MX_440_SE 0x0173 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_440_GO 0x0174 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_420_GO 0x0175 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_420_GO_M32 0x0176 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_460_GO 0x0177 #define PCI_DEVICE_ID_NVIDIA_QUADRO4_500XGL 0x0178 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_440_GO_M64 0x0179 #define PCI_DEVICE_ID_NVIDIA_QUADRO4_200 0x017A #define PCI_DEVICE_ID_NVIDIA_QUADRO4_550XGL 0x017B #define PCI_DEVICE_ID_NVIDIA_QUADRO4_500_GOGL 0x017C #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_410_GO_M16 0x017D #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_MX_440_8X 0x0181 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_MX_440SE_8X 0x0182 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_MX_420_8X 0x0183 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_MX_4000 0x0185 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_448_GO 0x0186 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_488_GO 0x0187 #define PCI_DEVICE_ID_NVIDIA_QUADRO4_580_XGL 0x0188 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_MX_MAC 0x0189 #define PCI_DEVICE_ID_NVIDIA_QUADRO4_280_NVS 0x018A #define PCI_DEVICE_ID_NVIDIA_QUADRO4_380_XGL 0x018B #define PCI_DEVICE_ID_NVIDIA_IGEFORCE2 0x01a0 #define PCI_DEVICE_ID_NVIDIA_NFORCE 0x01a4 #define PCI_DEVICE_ID_NVIDIA_MCP1_AUDIO 0x01b1 #define PCI_DEVICE_ID_NVIDIA_NFORCE_SMBUS 0x01b4 #define PCI_DEVICE_ID_NVIDIA_NFORCE_IDE 0x01bc #define PCI_DEVICE_ID_NVIDIA_MCP1_MODEM 0x01c1 #define PCI_DEVICE_ID_NVIDIA_NVENET_1 0x01c3 #define PCI_DEVICE_ID_NVIDIA_NFORCE2 0x01e0 #define PCI_DEVICE_ID_NVIDIA_GEFORCE3 0x0200 #define PCI_DEVICE_ID_NVIDIA_GEFORCE3_1 0x0201 #define PCI_DEVICE_ID_NVIDIA_GEFORCE3_2 0x0202 #define PCI_DEVICE_ID_NVIDIA_QUADRO_DDC 0x0203 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_6800B 0x0211 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_6800B_LE 0x0212 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_6800B_GT 0x0215 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_TI_4600 0x0250 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_TI_4400 0x0251 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_TI_4200 0x0253 #define PCI_DEVICE_ID_NVIDIA_QUADRO4_900XGL 0x0258 #define PCI_DEVICE_ID_NVIDIA_QUADRO4_750XGL 0x0259 #define PCI_DEVICE_ID_NVIDIA_QUADRO4_700XGL 0x025B #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_SMBUS 0x0264 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_IDE 0x0265 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_SATA 0x0266 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP51_SATA2 0x0267 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_SMBUS 0x0368 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_IDE 0x036E #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_SATA 0x037E #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP55_SATA2 0x037F #define PCI_DEVICE_ID_NVIDIA_NVENET_12 0x0268 #define PCI_DEVICE_ID_NVIDIA_NVENET_13 0x0269 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_TI_4800 0x0280 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_TI_4800_8X 0x0281 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_TI_4800SE 0x0282 #define PCI_DEVICE_ID_NVIDIA_GEFORCE4_4200_GO 0x0286 #define PCI_DEVICE_ID_NVIDIA_QUADRO4_980_XGL 0x0288 #define PCI_DEVICE_ID_NVIDIA_QUADRO4_780_XGL 0x0289 #define PCI_DEVICE_ID_NVIDIA_QUADRO4_700_GOGL 0x028C #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5800_ULTRA 0x0301 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5800 0x0302 #define PCI_DEVICE_ID_NVIDIA_QUADRO_FX_2000 0x0308 #define PCI_DEVICE_ID_NVIDIA_QUADRO_FX_1000 0x0309 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5600_ULTRA 0x0311 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5600 0x0312 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5600SE 0x0314 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_GO5600 0x031A #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_GO5650 0x031B #define PCI_DEVICE_ID_NVIDIA_QUADRO_FX_GO700 0x031C #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5200 0x0320 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5200_ULTRA 0x0321 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5200_1 0x0322 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5200SE 0x0323 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_GO5200 0x0324 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_GO5250 0x0325 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5500 0x0326 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5100 0x0327 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_GO5250_32 0x0328 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_GO_5200 0x0329 #define PCI_DEVICE_ID_NVIDIA_QUADRO_NVS_280_PCI 0x032A #define PCI_DEVICE_ID_NVIDIA_QUADRO_FX_500 0x032B #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_GO5300 0x032C #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_GO5100 0x032D #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5900_ULTRA 0x0330 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5900 0x0331 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5900XT 0x0332 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5950_ULTRA 0x0333 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5900ZT 0x0334 #define PCI_DEVICE_ID_NVIDIA_QUADRO_FX_3000 0x0338 #define PCI_DEVICE_ID_NVIDIA_QUADRO_FX_700 0x033F #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5700_ULTRA 0x0341 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5700 0x0342 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5700LE 0x0343 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_5700VE 0x0344 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_GO5700_1 0x0347 #define PCI_DEVICE_ID_NVIDIA_GEFORCE_FX_GO5700_2 0x0348 #define PCI_DEVICE_ID_NVIDIA_QUADRO_FX_GO1000 0x034C #define PCI_DEVICE_ID_NVIDIA_QUADRO_FX_1100 0x034E #define PCI_DEVICE_ID_NVIDIA_NVENET_14 0x0372 #define PCI_DEVICE_ID_NVIDIA_NVENET_15 0x0373 #define PCI_DEVICE_ID_NVIDIA_NVENET_16 0x03E5 #define PCI_DEVICE_ID_NVIDIA_NVENET_17 0x03E6 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP61_SATA 0x03E7 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP61_SMBUS 0x03EB #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP61_IDE 0x03EC #define PCI_DEVICE_ID_NVIDIA_NVENET_18 0x03EE #define PCI_DEVICE_ID_NVIDIA_NVENET_19 0x03EF #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP61_SATA2 0x03F6 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP61_SATA3 0x03F7 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP65_SMBUS 0x0446 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP65_IDE 0x0448 #define PCI_DEVICE_ID_NVIDIA_NVENET_20 0x0450 #define PCI_DEVICE_ID_NVIDIA_NVENET_21 0x0451 #define PCI_DEVICE_ID_NVIDIA_NVENET_22 0x0452 #define PCI_DEVICE_ID_NVIDIA_NVENET_23 0x0453 #define PCI_DEVICE_ID_NVIDIA_NVENET_24 0x054C #define PCI_DEVICE_ID_NVIDIA_NVENET_25 0x054D #define PCI_DEVICE_ID_NVIDIA_NVENET_26 0x054E #define PCI_DEVICE_ID_NVIDIA_NVENET_27 0x054F #define PCI_DEVICE_ID_NVIDIA_NVENET_28 0x07DC #define PCI_DEVICE_ID_NVIDIA_NVENET_29 0x07DD #define PCI_DEVICE_ID_NVIDIA_NVENET_30 0x07DE #define PCI_DEVICE_ID_NVIDIA_NVENET_31 0x07DF #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP67_IDE 0x0560 #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP73_IDE 0x056C #define PCI_DEVICE_ID_NVIDIA_NFORCE_MCP77_IDE 0x0759 #define PCI_DEVICE_ID_NVIDIA_NVENET_32 0x0760 #define PCI_DEVICE_ID_NVIDIA_NVENET_33 0x0761 #define PCI_DEVICE_ID_NVIDIA_NVENET_34 0x0762 #define PCI_DEVICE_ID_NVIDIA_NVENET_35 0x0763 #define PCI_DEVICE_ID_NVIDIA_NVENET_36 0x0AB0 #define PCI_DEVICE_ID_NVIDIA_NVENET_37 0x0AB1 #define PCI_DEVICE_ID_NVIDIA_NVENET_38 0x0AB2 #define PCI_DEVICE_ID_NVIDIA_NVENET_39 0x0AB3 #define PCI_VENDOR_ID_IMS 0x10e0 #define PCI_DEVICE_ID_IMS_TT128 0x9128 #define PCI_DEVICE_ID_IMS_TT3D 0x9135 #define PCI_VENDOR_ID_INTERG 0x10ea #define PCI_DEVICE_ID_INTERG_1682 0x1682 #define PCI_DEVICE_ID_INTERG_2000 0x2000 #define PCI_DEVICE_ID_INTERG_2010 0x2010 #define PCI_DEVICE_ID_INTERG_5000 0x5000 #define PCI_DEVICE_ID_INTERG_5050 0x5050 #define PCI_VENDOR_ID_REALTEK 0x10ec #define PCI_DEVICE_ID_REALTEK_8139 0x8139 #define PCI_VENDOR_ID_XILINX 0x10ee #define PCI_DEVICE_ID_RME_DIGI96 0x3fc0 #define PCI_DEVICE_ID_RME_DIGI96_8 0x3fc1 #define PCI_DEVICE_ID_RME_DIGI96_8_PRO 0x3fc2 #define PCI_DEVICE_ID_RME_DIGI96_8_PAD_OR_PST 0x3fc3 #define PCI_DEVICE_ID_XILINX_HAMMERFALL_DSP 0x3fc5 #define PCI_DEVICE_ID_XILINX_HAMMERFALL_DSP_MADI 0x3fc6 #define PCI_VENDOR_ID_INIT 0x1101 #define PCI_VENDOR_ID_CREATIVE 0x1102 /* duplicate: ECTIVA */ #define PCI_DEVICE_ID_CREATIVE_EMU10K1 0x0002 #define PCI_VENDOR_ID_ECTIVA 0x1102 /* duplicate: CREATIVE */ #define PCI_DEVICE_ID_ECTIVA_EV1938 0x8938 #define PCI_VENDOR_ID_TTI 0x1103 #define PCI_DEVICE_ID_TTI_HPT343 0x0003 #define PCI_DEVICE_ID_TTI_HPT366 0x0004 #define PCI_DEVICE_ID_TTI_HPT372 0x0005 #define PCI_DEVICE_ID_TTI_HPT302 0x0006 #define PCI_DEVICE_ID_TTI_HPT371 0x0007 #define PCI_DEVICE_ID_TTI_HPT374 0x0008 #define PCI_DEVICE_ID_TTI_HPT372N 0x0009 /* apparently a 372N variant? */ #define PCI_VENDOR_ID_VIA 0x1106 #define PCI_DEVICE_ID_VIA_8763_0 0x0198 #define PCI_DEVICE_ID_VIA_8380_0 0x0204 #define PCI_DEVICE_ID_VIA_3238_0 0x0238 #define PCI_DEVICE_ID_VIA_PT880 0x0258 #define PCI_DEVICE_ID_VIA_PT880ULTRA 0x0308 #define PCI_DEVICE_ID_VIA_PX8X0_0 0x0259 #define PCI_DEVICE_ID_VIA_3269_0 0x0269 #define PCI_DEVICE_ID_VIA_K8T800PRO_0 0x0282 #define PCI_DEVICE_ID_VIA_3296_0 0x0296 #define PCI_DEVICE_ID_VIA_8363_0 0x0305 #define PCI_DEVICE_ID_VIA_P4M800CE 0x0314 #define PCI_DEVICE_ID_VIA_P4M890 0x0327 #define PCI_DEVICE_ID_VIA_VT3324 0x0324 #define PCI_DEVICE_ID_VIA_VT3336 0x0336 #define PCI_DEVICE_ID_VIA_VT3351 0x0351 #define PCI_DEVICE_ID_VIA_VT3364 0x0364 #define PCI_DEVICE_ID_VIA_8371_0 0x0391 #define PCI_DEVICE_ID_VIA_8501_0 0x0501 #define PCI_DEVICE_ID_VIA_82C561 0x0561 #define PCI_DEVICE_ID_VIA_82C586_1 0x0571 #define PCI_DEVICE_ID_VIA_82C576 0x0576 #define PCI_DEVICE_ID_VIA_82C586_0 0x0586 #define PCI_DEVICE_ID_VIA_82C596 0x0596 #define PCI_DEVICE_ID_VIA_82C597_0 0x0597 #define PCI_DEVICE_ID_VIA_82C598_0 0x0598 #define PCI_DEVICE_ID_VIA_8601_0 0x0601 #define PCI_DEVICE_ID_VIA_8605_0 0x0605 #define PCI_DEVICE_ID_VIA_82C686 0x0686 #define PCI_DEVICE_ID_VIA_82C691_0 0x0691 #define PCI_DEVICE_ID_VIA_82C576_1 0x1571 #define PCI_DEVICE_ID_VIA_82C586_2 0x3038 #define PCI_DEVICE_ID_VIA_82C586_3 0x3040 #define PCI_DEVICE_ID_VIA_82C596_3 0x3050 #define PCI_DEVICE_ID_VIA_82C596B_3 0x3051 #define PCI_DEVICE_ID_VIA_82C686_4 0x3057 #define PCI_DEVICE_ID_VIA_82C686_5 0x3058 #define PCI_DEVICE_ID_VIA_8233_5 0x3059 #define PCI_DEVICE_ID_VIA_8233_0 0x3074 #define PCI_DEVICE_ID_VIA_8633_0 0x3091 #define PCI_DEVICE_ID_VIA_8367_0 0x3099 #define PCI_DEVICE_ID_VIA_8653_0 0x3101 #define PCI_DEVICE_ID_VIA_8622 0x3102 #define PCI_DEVICE_ID_VIA_8235_USB_2 0x3104 #define PCI_DEVICE_ID_VIA_8233C_0 0x3109 #define PCI_DEVICE_ID_VIA_8361 0x3112 #define PCI_DEVICE_ID_VIA_XM266 0x3116 #define PCI_DEVICE_ID_VIA_612X 0x3119 #define PCI_DEVICE_ID_VIA_862X_0 0x3123 #define PCI_DEVICE_ID_VIA_8753_0 0x3128 #define PCI_DEVICE_ID_VIA_8233A 0x3147 #define PCI_DEVICE_ID_VIA_8703_51_0 0x3148 #define PCI_DEVICE_ID_VIA_8237_SATA 0x3149 #define PCI_DEVICE_ID_VIA_XN266 0x3156 #define PCI_DEVICE_ID_VIA_6410 0x3164 #define PCI_DEVICE_ID_VIA_8754C_0 0x3168 #define PCI_DEVICE_ID_VIA_8235 0x3177 #define PCI_DEVICE_ID_VIA_8385_0 0x3188 #define PCI_DEVICE_ID_VIA_8377_0 0x3189 #define PCI_DEVICE_ID_VIA_8378_0 0x3205 #define PCI_DEVICE_ID_VIA_8783_0 0x3208 #define PCI_DEVICE_ID_VIA_8237 0x3227 #define PCI_DEVICE_ID_VIA_8251 0x3287 #define PCI_DEVICE_ID_VIA_8237A 0x3337 #define PCI_DEVICE_ID_VIA_8237S 0x3372 #define PCI_DEVICE_ID_VIA_SATA_EIDE 0x5324 #define PCI_DEVICE_ID_VIA_8231 0x8231 #define PCI_DEVICE_ID_VIA_8231_4 0x8235 #define PCI_DEVICE_ID_VIA_8365_1 0x8305 #define PCI_DEVICE_ID_VIA_CX700 0x8324 #define PCI_DEVICE_ID_VIA_CX700_IDE 0x0581 #define PCI_DEVICE_ID_VIA_VX800 0x8353 #define PCI_DEVICE_ID_VIA_8371_1 0x8391 #define PCI_DEVICE_ID_VIA_82C598_1 0x8598 #define PCI_DEVICE_ID_VIA_838X_1 0xB188 #define PCI_DEVICE_ID_VIA_83_87XX_1 0xB198 #define PCI_VENDOR_ID_SIEMENS 0x110A #define PCI_DEVICE_ID_SIEMENS_DSCC4 0x2102 #define PCI_VENDOR_ID_VORTEX 0x1119 #define PCI_DEVICE_ID_VORTEX_GDT60x0 0x0000 #define PCI_DEVICE_ID_VORTEX_GDT6000B 0x0001 #define PCI_DEVICE_ID_VORTEX_GDT6x10 0x0002 #define PCI_DEVICE_ID_VORTEX_GDT6x20 0x0003 #define PCI_DEVICE_ID_VORTEX_GDT6530 0x0004 #define PCI_DEVICE_ID_VORTEX_GDT6550 0x0005 #define PCI_DEVICE_ID_VORTEX_GDT6x17 0x0006 #define PCI_DEVICE_ID_VORTEX_GDT6x27 0x0007 #define PCI_DEVICE_ID_VORTEX_GDT6537 0x0008 #define PCI_DEVICE_ID_VORTEX_GDT6557 0x0009 #define PCI_DEVICE_ID_VORTEX_GDT6x15 0x000a #define PCI_DEVICE_ID_VORTEX_GDT6x25 0x000b #define PCI_DEVICE_ID_VORTEX_GDT6535 0x000c #define PCI_DEVICE_ID_VORTEX_GDT6555 0x000d #define PCI_DEVICE_ID_VORTEX_GDT6x17RP 0x0100 #define PCI_DEVICE_ID_VORTEX_GDT6x27RP 0x0101 #define PCI_DEVICE_ID_VORTEX_GDT6537RP 0x0102 #define PCI_DEVICE_ID_VORTEX_GDT6557RP 0x0103 #define PCI_DEVICE_ID_VORTEX_GDT6x11RP 0x0104 #define PCI_DEVICE_ID_VORTEX_GDT6x21RP 0x0105 #define PCI_VENDOR_ID_EF 0x111a #define PCI_DEVICE_ID_EF_ATM_FPGA 0x0000 #define PCI_DEVICE_ID_EF_ATM_ASIC 0x0002 #define PCI_DEVICE_ID_EF_ATM_LANAI2 0x0003 #define PCI_DEVICE_ID_EF_ATM_LANAIHB 0x0005 #define PCI_VENDOR_ID_IDT 0x111d #define PCI_DEVICE_ID_IDT_IDT77201 0x0001 #define PCI_VENDOR_ID_FORE 0x1127 #define PCI_DEVICE_ID_FORE_PCA200E 0x0300 #define PCI_VENDOR_ID_PHILIPS 0x1131 #define PCI_DEVICE_ID_PHILIPS_SAA7146 0x7146 #define PCI_DEVICE_ID_PHILIPS_SAA9730 0x9730 #define PCI_VENDOR_ID_EICON 0x1133 #define PCI_DEVICE_ID_EICON_DIVA20 0xe002 #define PCI_DEVICE_ID_EICON_DIVA20_U 0xe004 #define PCI_DEVICE_ID_EICON_DIVA201 0xe005 #define PCI_DEVICE_ID_EICON_DIVA202 0xe00b #define PCI_DEVICE_ID_EICON_MAESTRA 0xe010 #define PCI_DEVICE_ID_EICON_MAESTRAQ 0xe012 #define PCI_DEVICE_ID_EICON_MAESTRAQ_U 0xe013 #define PCI_DEVICE_ID_EICON_MAESTRAP 0xe014 #define PCI_VENDOR_ID_CISCO 0x1137 #define PCI_VENDOR_ID_ZIATECH 0x1138 #define PCI_DEVICE_ID_ZIATECH_5550_HC 0x5550 #define PCI_VENDOR_ID_SYSKONNECT 0x1148 #define PCI_DEVICE_ID_SYSKONNECT_TR 0x4200 #define PCI_DEVICE_ID_SYSKONNECT_GE 0x4300 #define PCI_DEVICE_ID_SYSKONNECT_YU 0x4320 #define PCI_DEVICE_ID_SYSKONNECT_9DXX 0x4400 #define PCI_DEVICE_ID_SYSKONNECT_9MXX 0x4500 #define PCI_VENDOR_ID_DIGI 0x114f #define PCI_DEVICE_ID_DIGI_DF_M_IOM2_E 0x0070 #define PCI_DEVICE_ID_DIGI_DF_M_E 0x0071 #define PCI_DEVICE_ID_DIGI_DF_M_IOM2_A 0x0072 #define PCI_DEVICE_ID_DIGI_DF_M_A 0x0073 #define PCI_DEVICE_ID_NEO_2DB9 0x00C8 #define PCI_DEVICE_ID_NEO_2DB9PRI 0x00C9 #define PCI_DEVICE_ID_NEO_2RJ45 0x00CA #define PCI_DEVICE_ID_NEO_2RJ45PRI 0x00CB #define PCIE_DEVICE_ID_NEO_4_IBM 0x00F4 #define PCI_VENDOR_ID_XIRCOM 0x115d #define PCI_DEVICE_ID_XIRCOM_RBM56G 0x0101 #define PCI_DEVICE_ID_XIRCOM_X3201_MDM 0x0103 #define PCI_VENDOR_ID_SERVERWORKS 0x1166 #define PCI_DEVICE_ID_SERVERWORKS_HE 0x0008 #define PCI_DEVICE_ID_SERVERWORKS_LE 0x0009 #define PCI_DEVICE_ID_SERVERWORKS_GCNB_LE 0x0017 #define PCI_DEVICE_ID_SERVERWORKS_HT1000_PXB 0x0036 #define PCI_DEVICE_ID_SERVERWORKS_EPB 0x0103 #define PCI_DEVICE_ID_SERVERWORKS_HT2000_PCIE 0x0132 #define PCI_DEVICE_ID_SERVERWORKS_OSB4 0x0200 #define PCI_DEVICE_ID_SERVERWORKS_CSB5 0x0201 #define PCI_DEVICE_ID_SERVERWORKS_CSB6 0x0203 #define PCI_DEVICE_ID_SERVERWORKS_HT1000SB 0x0205 #define PCI_DEVICE_ID_SERVERWORKS_OSB4IDE 0x0211 #define PCI_DEVICE_ID_SERVERWORKS_CSB5IDE 0x0212 #define PCI_DEVICE_ID_SERVERWORKS_CSB6IDE 0x0213 #define PCI_DEVICE_ID_SERVERWORKS_HT1000IDE 0x0214 #define PCI_DEVICE_ID_SERVERWORKS_CSB6IDE2 0x0217 #define PCI_DEVICE_ID_SERVERWORKS_CSB6LPC 0x0227 #define PCI_VENDOR_ID_SBE 0x1176 #define PCI_DEVICE_ID_SBE_WANXL100 0x0301 #define PCI_DEVICE_ID_SBE_WANXL200 0x0302 #define PCI_DEVICE_ID_SBE_WANXL400 0x0104 #define PCI_VENDOR_ID_TOSHIBA 0x1179 #define PCI_DEVICE_ID_TOSHIBA_PICCOLO 0x0102 #define PCI_DEVICE_ID_TOSHIBA_PICCOLO_1 0x0103 #define PCI_DEVICE_ID_TOSHIBA_PICCOLO_2 0x0105 #define PCI_DEVICE_ID_TOSHIBA_TOPIC95 0x060a #define PCI_DEVICE_ID_TOSHIBA_TOPIC97 0x060f #define PCI_DEVICE_ID_TOSHIBA_TOPIC100 0x0617 #define PCI_VENDOR_ID_TOSHIBA_2 0x102f #define PCI_DEVICE_ID_TOSHIBA_TC35815CF 0x0030 #define PCI_DEVICE_ID_TOSHIBA_TC35815_NWU 0x0031 #define PCI_DEVICE_ID_TOSHIBA_TC35815_TX4939 0x0032 #define PCI_DEVICE_ID_TOSHIBA_TC86C001_IDE 0x0105 #define PCI_DEVICE_ID_TOSHIBA_TC86C001_MISC 0x0108 #define PCI_DEVICE_ID_TOSHIBA_SPIDER_NET 0x01b3 #define PCI_VENDOR_ID_ATTO 0x117c #define PCI_VENDOR_ID_RICOH 0x1180 #define PCI_DEVICE_ID_RICOH_RL5C465 0x0465 #define PCI_DEVICE_ID_RICOH_RL5C466 0x0466 #define PCI_DEVICE_ID_RICOH_RL5C475 0x0475 #define PCI_DEVICE_ID_RICOH_RL5C476 0x0476 #define PCI_DEVICE_ID_RICOH_RL5C478 0x0478 #define PCI_DEVICE_ID_RICOH_R5C822 0x0822 #define PCI_DEVICE_ID_RICOH_R5C832 0x0832 #define PCI_DEVICE_ID_RICOH_R5C843 0x0843 #define PCI_VENDOR_ID_DLINK 0x1186 #define PCI_DEVICE_ID_DLINK_DGE510T 0x4c00 #define PCI_VENDOR_ID_ARTOP 0x1191 #define PCI_DEVICE_ID_ARTOP_ATP850UF 0x0005 #define PCI_DEVICE_ID_ARTOP_ATP860 0x0006 #define PCI_DEVICE_ID_ARTOP_ATP860R 0x0007 #define PCI_DEVICE_ID_ARTOP_ATP865 0x0008 #define PCI_DEVICE_ID_ARTOP_ATP865R 0x0009 #define PCI_DEVICE_ID_ARTOP_AEC7610 0x8002 #define PCI_DEVICE_ID_ARTOP_AEC7612UW 0x8010 #define PCI_DEVICE_ID_ARTOP_AEC7612U 0x8020 #define PCI_DEVICE_ID_ARTOP_AEC7612S 0x8030 #define PCI_DEVICE_ID_ARTOP_AEC7612D 0x8040 #define PCI_DEVICE_ID_ARTOP_AEC7612SUW 0x8050 #define PCI_DEVICE_ID_ARTOP_8060 0x8060 #define PCI_VENDOR_ID_ZEITNET 0x1193 #define PCI_DEVICE_ID_ZEITNET_1221 0x0001 #define PCI_DEVICE_ID_ZEITNET_1225 0x0002 #define PCI_VENDOR_ID_FUJITSU_ME 0x119e #define PCI_DEVICE_ID_FUJITSU_FS155 0x0001 #define PCI_DEVICE_ID_FUJITSU_FS50 0x0003 #define PCI_SUBVENDOR_ID_KEYSPAN 0x11a9 #define PCI_SUBDEVICE_ID_KEYSPAN_SX2 0x5334 #define PCI_VENDOR_ID_MARVELL 0x11ab #define PCI_DEVICE_ID_MARVELL_GT64111 0x4146 #define PCI_DEVICE_ID_MARVELL_GT64260 0x6430 #define PCI_DEVICE_ID_MARVELL_MV64360 0x6460 #define PCI_DEVICE_ID_MARVELL_MV64460 0x6480 #define PCI_DEVICE_ID_MARVELL_88ALP01_NAND 0x4100 #define PCI_DEVICE_ID_MARVELL_88ALP01_SD 0x4101 #define PCI_DEVICE_ID_MARVELL_88ALP01_CCIC 0x4102 #define PCI_VENDOR_ID_V3 0x11b0 #define PCI_DEVICE_ID_V3_V960 0x0001 #define PCI_DEVICE_ID_V3_V351 0x0002 #define PCI_VENDOR_ID_ATT 0x11c1 #define PCI_DEVICE_ID_ATT_VENUS_MODEM 0x480 #define PCI_VENDOR_ID_SPECIALIX 0x11cb #define PCI_DEVICE_ID_SPECIALIX_IO8 0x2000 #define PCI_DEVICE_ID_SPECIALIX_RIO 0x8000 #define PCI_SUBDEVICE_ID_SPECIALIX_SPEED4 0xa004 #define PCI_VENDOR_ID_ANALOG_DEVICES 0x11d4 #define PCI_DEVICE_ID_AD1889JS 0x1889 #define PCI_DEVICE_ID_SEGA_BBA 0x1234 #define PCI_VENDOR_ID_ZORAN 0x11de #define PCI_DEVICE_ID_ZORAN_36057 0x6057 #define PCI_DEVICE_ID_ZORAN_36120 0x6120 #define PCI_VENDOR_ID_COMPEX 0x11f6 #define PCI_DEVICE_ID_COMPEX_ENET100VG4 0x0112 #define PCI_VENDOR_ID_RP 0x11fe #define PCI_DEVICE_ID_RP32INTF 0x0001 #define PCI_DEVICE_ID_RP8INTF 0x0002 #define PCI_DEVICE_ID_RP16INTF 0x0003 #define PCI_DEVICE_ID_RP4QUAD 0x0004 #define PCI_DEVICE_ID_RP8OCTA 0x0005 #define PCI_DEVICE_ID_RP8J 0x0006 #define PCI_DEVICE_ID_RP4J 0x0007 #define PCI_DEVICE_ID_RP8SNI 0x0008 #define PCI_DEVICE_ID_RP16SNI 0x0009 #define PCI_DEVICE_ID_RPP4 0x000A #define PCI_DEVICE_ID_RPP8 0x000B #define PCI_DEVICE_ID_RP4M 0x000D #define PCI_DEVICE_ID_RP2_232 0x000E #define PCI_DEVICE_ID_RP2_422 0x000F #define PCI_DEVICE_ID_URP32INTF 0x0801 #define PCI_DEVICE_ID_URP8INTF 0x0802 #define PCI_DEVICE_ID_URP16INTF 0x0803 #define PCI_DEVICE_ID_URP8OCTA 0x0805 #define PCI_DEVICE_ID_UPCI_RM3_8PORT 0x080C #define PCI_DEVICE_ID_UPCI_RM3_4PORT 0x080D #define PCI_DEVICE_ID_CRP16INTF 0x0903 #define PCI_VENDOR_ID_CYCLADES 0x120e #define PCI_DEVICE_ID_CYCLOM_Y_Lo 0x0100 #define PCI_DEVICE_ID_CYCLOM_Y_Hi 0x0101 #define PCI_DEVICE_ID_CYCLOM_4Y_Lo 0x0102 #define PCI_DEVICE_ID_CYCLOM_4Y_Hi 0x0103 #define PCI_DEVICE_ID_CYCLOM_8Y_Lo 0x0104 #define PCI_DEVICE_ID_CYCLOM_8Y_Hi 0x0105 #define PCI_DEVICE_ID_CYCLOM_Z_Lo 0x0200 #define PCI_DEVICE_ID_CYCLOM_Z_Hi 0x0201 #define PCI_DEVICE_ID_PC300_RX_2 0x0300 #define PCI_DEVICE_ID_PC300_RX_1 0x0301 #define PCI_DEVICE_ID_PC300_TE_2 0x0310 #define PCI_DEVICE_ID_PC300_TE_1 0x0311 #define PCI_DEVICE_ID_PC300_TE_M_2 0x0320 #define PCI_DEVICE_ID_PC300_TE_M_1 0x0321 #define PCI_VENDOR_ID_ESSENTIAL 0x120f #define PCI_DEVICE_ID_ESSENTIAL_ROADRUNNER 0x0001 #define PCI_VENDOR_ID_O2 0x1217 #define PCI_DEVICE_ID_O2_6729 0x6729 #define PCI_DEVICE_ID_O2_6730 0x673a #define PCI_DEVICE_ID_O2_6832 0x6832 #define PCI_DEVICE_ID_O2_6836 0x6836 #define PCI_VENDOR_ID_3DFX 0x121a #define PCI_DEVICE_ID_3DFX_VOODOO 0x0001 #define PCI_DEVICE_ID_3DFX_VOODOO2 0x0002 #define PCI_DEVICE_ID_3DFX_BANSHEE 0x0003 #define PCI_DEVICE_ID_3DFX_VOODOO3 0x0005 #define PCI_DEVICE_ID_3DFX_VOODOO5 0x0009 #define PCI_VENDOR_ID_AVM 0x1244 #define PCI_DEVICE_ID_AVM_B1 0x0700 #define PCI_DEVICE_ID_AVM_C4 0x0800 #define PCI_DEVICE_ID_AVM_A1 0x0a00 #define PCI_DEVICE_ID_AVM_A1_V2 0x0e00 #define PCI_DEVICE_ID_AVM_C2 0x1100 #define PCI_DEVICE_ID_AVM_T1 0x1200 #define PCI_VENDOR_ID_STALLION 0x124d /* Allied Telesyn */ #define PCI_VENDOR_ID_AT 0x1259 #define PCI_SUBDEVICE_ID_AT_2700FX 0x2701 #define PCI_SUBDEVICE_ID_AT_2701FX 0x2703 #define PCI_VENDOR_ID_ESS 0x125d #define PCI_DEVICE_ID_ESS_ESS1968 0x1968 #define PCI_DEVICE_ID_ESS_ESS1978 0x1978 #define PCI_DEVICE_ID_ESS_ALLEGRO_1 0x1988 #define PCI_DEVICE_ID_ESS_ALLEGRO 0x1989 #define PCI_DEVICE_ID_ESS_CANYON3D_2LE 0x1990 #define PCI_DEVICE_ID_ESS_CANYON3D_2 0x1992 #define PCI_DEVICE_ID_ESS_MAESTRO3 0x1998 #define PCI_DEVICE_ID_ESS_MAESTRO3_1 0x1999 #define PCI_DEVICE_ID_ESS_MAESTRO3_HW 0x199a #define PCI_DEVICE_ID_ESS_MAESTRO3_2 0x199b #define PCI_VENDOR_ID_SATSAGEM 0x1267 #define PCI_DEVICE_ID_SATSAGEM_NICCY 0x1016 #define PCI_VENDOR_ID_ENSONIQ 0x1274 #define PCI_DEVICE_ID_ENSONIQ_CT5880 0x5880 #define PCI_DEVICE_ID_ENSONIQ_ES1370 0x5000 #define PCI_DEVICE_ID_ENSONIQ_ES1371 0x1371 #define PCI_VENDOR_ID_TRANSMETA 0x1279 #define PCI_DEVICE_ID_EFFICEON 0x0060 #define PCI_VENDOR_ID_ROCKWELL 0x127A #define PCI_VENDOR_ID_ITE 0x1283 #define PCI_DEVICE_ID_ITE_8211 0x8211 #define PCI_DEVICE_ID_ITE_8212 0x8212 #define PCI_DEVICE_ID_ITE_8213 0x8213 #define PCI_DEVICE_ID_ITE_8152 0x8152 #define PCI_DEVICE_ID_ITE_8872 0x8872 #define PCI_DEVICE_ID_ITE_IT8330G_0 0xe886 /* formerly Platform Tech */ #define PCI_DEVICE_ID_ESS_ESS0100 0x0100 #define PCI_VENDOR_ID_ALTEON 0x12ae #define PCI_SUBVENDOR_ID_CONNECT_TECH 0x12c4 #define PCI_SUBDEVICE_ID_CONNECT_TECH_BH8_232 0x0001 #define PCI_SUBDEVICE_ID_CONNECT_TECH_BH4_232 0x0002 #define PCI_SUBDEVICE_ID_CONNECT_TECH_BH2_232 0x0003 #define PCI_SUBDEVICE_ID_CONNECT_TECH_BH8_485 0x0004 #define PCI_SUBDEVICE_ID_CONNECT_TECH_BH8_485_4_4 0x0005 #define PCI_SUBDEVICE_ID_CONNECT_TECH_BH4_485 0x0006 #define PCI_SUBDEVICE_ID_CONNECT_TECH_BH4_485_2_2 0x0007 #define PCI_SUBDEVICE_ID_CONNECT_TECH_BH2_485 0x0008 #define PCI_SUBDEVICE_ID_CONNECT_TECH_BH8_485_2_6 0x0009 #define PCI_SUBDEVICE_ID_CONNECT_TECH_BH081101V1 0x000A #define PCI_SUBDEVICE_ID_CONNECT_TECH_BH041101V1 0x000B #define PCI_SUBDEVICE_ID_CONNECT_TECH_BH2_20MHZ 0x000C #define PCI_SUBDEVICE_ID_CONNECT_TECH_BH2_PTM 0x000D #define PCI_SUBDEVICE_ID_CONNECT_TECH_NT960PCI 0x0100 #define PCI_SUBDEVICE_ID_CONNECT_TECH_TITAN_2 0x0201 #define PCI_SUBDEVICE_ID_CONNECT_TECH_TITAN_4 0x0202 #define PCI_SUBDEVICE_ID_CONNECT_TECH_PCI_UART_2_232 0x0300 #define PCI_SUBDEVICE_ID_CONNECT_TECH_PCI_UART_4_232 0x0301 #define PCI_SUBDEVICE_ID_CONNECT_TECH_PCI_UART_8_232 0x0302 #define PCI_SUBDEVICE_ID_CONNECT_TECH_PCI_UART_1_1 0x0310 #define PCI_SUBDEVICE_ID_CONNECT_TECH_PCI_UART_2_2 0x0311 #define PCI_SUBDEVICE_ID_CONNECT_TECH_PCI_UART_4_4 0x0312 #define PCI_SUBDEVICE_ID_CONNECT_TECH_PCI_UART_2 0x0320 #define PCI_SUBDEVICE_ID_CONNECT_TECH_PCI_UART_4 0x0321 #define PCI_SUBDEVICE_ID_CONNECT_TECH_PCI_UART_8 0x0322 #define PCI_SUBDEVICE_ID_CONNECT_TECH_PCI_UART_2_485 0x0330 #define PCI_SUBDEVICE_ID_CONNECT_TECH_PCI_UART_4_485 0x0331 #define PCI_SUBDEVICE_ID_CONNECT_TECH_PCI_UART_8_485 0x0332 #define PCI_VENDOR_ID_NVIDIA_SGS 0x12d2 #define PCI_DEVICE_ID_NVIDIA_SGS_RIVA128 0x0018 #define PCI_SUBVENDOR_ID_CHASE_PCIFAST 0x12E0 #define PCI_SUBDEVICE_ID_CHASE_PCIFAST4 0x0031 #define PCI_SUBDEVICE_ID_CHASE_PCIFAST8 0x0021 #define PCI_SUBDEVICE_ID_CHASE_PCIFAST16 0x0011 #define PCI_SUBDEVICE_ID_CHASE_PCIFAST16FMC 0x0041 #define PCI_SUBVENDOR_ID_CHASE_PCIRAS 0x124D #define PCI_SUBDEVICE_ID_CHASE_PCIRAS4 0xF001 #define PCI_SUBDEVICE_ID_CHASE_PCIRAS8 0xF010 #define PCI_VENDOR_ID_AUREAL 0x12eb #define PCI_DEVICE_ID_AUREAL_VORTEX_1 0x0001 #define PCI_DEVICE_ID_AUREAL_VORTEX_2 0x0002 #define PCI_DEVICE_ID_AUREAL_ADVANTAGE 0x0003 #define PCI_VENDOR_ID_ELECTRONICDESIGNGMBH 0x12f8 #define PCI_DEVICE_ID_LML_33R10 0x8a02 #define PCI_VENDOR_ID_ESDGMBH 0x12fe #define PCI_DEVICE_ID_ESDGMBH_CPCIASIO4 0x0111 #define PCI_VENDOR_ID_SIIG 0x131f #define PCI_SUBVENDOR_ID_SIIG 0x131f #define PCI_DEVICE_ID_SIIG_1S_10x_550 0x1000 #define PCI_DEVICE_ID_SIIG_1S_10x_650 0x1001 #define PCI_DEVICE_ID_SIIG_1S_10x_850 0x1002 #define PCI_DEVICE_ID_SIIG_1S1P_10x_550 0x1010 #define PCI_DEVICE_ID_SIIG_1S1P_10x_650 0x1011 #define PCI_DEVICE_ID_SIIG_1S1P_10x_850 0x1012 #define PCI_DEVICE_ID_SIIG_1P_10x 0x1020 #define PCI_DEVICE_ID_SIIG_2P_10x 0x1021 #define PCI_DEVICE_ID_SIIG_2S_10x_550 0x1030 #define PCI_DEVICE_ID_SIIG_2S_10x_650 0x1031 #define PCI_DEVICE_ID_SIIG_2S_10x_850 0x1032 #define PCI_DEVICE_ID_SIIG_2S1P_10x_550 0x1034 #define PCI_DEVICE_ID_SIIG_2S1P_10x_650 0x1035 #define PCI_DEVICE_ID_SIIG_2S1P_10x_850 0x1036 #define PCI_DEVICE_ID_SIIG_4S_10x_550 0x1050 #define PCI_DEVICE_ID_SIIG_4S_10x_650 0x1051 #define PCI_DEVICE_ID_SIIG_4S_10x_850 0x1052 #define PCI_DEVICE_ID_SIIG_1S_20x_550 0x2000 #define PCI_DEVICE_ID_SIIG_1S_20x_650 0x2001 #define PCI_DEVICE_ID_SIIG_1S_20x_850 0x2002 #define PCI_DEVICE_ID_SIIG_1P_20x 0x2020 #define PCI_DEVICE_ID_SIIG_2P_20x 0x2021 #define PCI_DEVICE_ID_SIIG_2S_20x_550 0x2030 #define PCI_DEVICE_ID_SIIG_2S_20x_650 0x2031 #define PCI_DEVICE_ID_SIIG_2S_20x_850 0x2032 #define PCI_DEVICE_ID_SIIG_2P1S_20x_550 0x2040 #define PCI_DEVICE_ID_SIIG_2P1S_20x_650 0x2041 #define PCI_DEVICE_ID_SIIG_2P1S_20x_850 0x2042 #define PCI_DEVICE_ID_SIIG_1S1P_20x_550 0x2010 #define PCI_DEVICE_ID_SIIG_1S1P_20x_650 0x2011 #define PCI_DEVICE_ID_SIIG_1S1P_20x_850 0x2012 #define PCI_DEVICE_ID_SIIG_4S_20x_550 0x2050 #define PCI_DEVICE_ID_SIIG_4S_20x_650 0x2051 #define PCI_DEVICE_ID_SIIG_4S_20x_850 0x2052 #define PCI_DEVICE_ID_SIIG_2S1P_20x_550 0x2060 #define PCI_DEVICE_ID_SIIG_2S1P_20x_650 0x2061 #define PCI_DEVICE_ID_SIIG_2S1P_20x_850 0x2062 #define PCI_DEVICE_ID_SIIG_8S_20x_550 0x2080 #define PCI_DEVICE_ID_SIIG_8S_20x_650 0x2081 #define PCI_DEVICE_ID_SIIG_8S_20x_850 0x2082 #define PCI_SUBDEVICE_ID_SIIG_QUARTET_SERIAL 0x2050 #define PCI_VENDOR_ID_RADISYS 0x1331 #define PCI_VENDOR_ID_MICRO_MEMORY 0x1332 #define PCI_DEVICE_ID_MICRO_MEMORY_5415CN 0x5415 #define PCI_DEVICE_ID_MICRO_MEMORY_5425CN 0x5425 #define PCI_DEVICE_ID_MICRO_MEMORY_6155 0x6155 #define PCI_VENDOR_ID_DOMEX 0x134a #define PCI_DEVICE_ID_DOMEX_DMX3191D 0x0001 #define PCI_VENDOR_ID_INTASHIELD 0x135a #define PCI_DEVICE_ID_INTASHIELD_IS200 0x0d80 #define PCI_DEVICE_ID_INTASHIELD_IS400 0x0dc0 #define PCI_VENDOR_ID_QUATECH 0x135C #define PCI_DEVICE_ID_QUATECH_QSC100 0x0010 #define PCI_DEVICE_ID_QUATECH_DSC100 0x0020 #define PCI_DEVICE_ID_QUATECH_ESC100D 0x0050 #define PCI_DEVICE_ID_QUATECH_ESC100M 0x0060 #define PCI_DEVICE_ID_QUATECH_SPPXP_100 0x0278 #define PCI_VENDOR_ID_SEALEVEL 0x135e #define PCI_DEVICE_ID_SEALEVEL_U530 0x7101 #define PCI_DEVICE_ID_SEALEVEL_UCOMM2 0x7201 #define PCI_DEVICE_ID_SEALEVEL_UCOMM422 0x7402 #define PCI_DEVICE_ID_SEALEVEL_UCOMM232 0x7202 #define PCI_DEVICE_ID_SEALEVEL_COMM4 0x7401 #define PCI_DEVICE_ID_SEALEVEL_COMM8 0x7801 #define PCI_DEVICE_ID_SEALEVEL_UCOMM8 0x7804 #define PCI_VENDOR_ID_HYPERCOPE 0x1365 #define PCI_DEVICE_ID_HYPERCOPE_PLX 0x9050 #define PCI_SUBDEVICE_ID_HYPERCOPE_OLD_ERGO 0x0104 #define PCI_SUBDEVICE_ID_HYPERCOPE_ERGO 0x0106 #define PCI_SUBDEVICE_ID_HYPERCOPE_METRO 0x0107 #define PCI_SUBDEVICE_ID_HYPERCOPE_CHAMP2 0x0108 #define PCI_VENDOR_ID_KAWASAKI 0x136b #define PCI_DEVICE_ID_MCHIP_KL5A72002 0xff01 #define PCI_VENDOR_ID_CNET 0x1371 #define PCI_DEVICE_ID_CNET_GIGACARD 0x434e #define PCI_VENDOR_ID_LMC 0x1376 #define PCI_DEVICE_ID_LMC_HSSI 0x0003 #define PCI_DEVICE_ID_LMC_DS3 0x0004 #define PCI_DEVICE_ID_LMC_SSI 0x0005 #define PCI_DEVICE_ID_LMC_T1 0x0006 #define PCI_VENDOR_ID_NETGEAR 0x1385 #define PCI_DEVICE_ID_NETGEAR_GA620 0x620a #define PCI_VENDOR_ID_APPLICOM 0x1389 #define PCI_DEVICE_ID_APPLICOM_PCIGENERIC 0x0001 #define PCI_DEVICE_ID_APPLICOM_PCI2000IBS_CAN 0x0002 #define PCI_DEVICE_ID_APPLICOM_PCI2000PFB 0x0003 #define PCI_VENDOR_ID_MOXA 0x1393 #define PCI_DEVICE_ID_MOXA_RC7000 0x0001 #define PCI_DEVICE_ID_MOXA_CP102 0x1020 #define PCI_DEVICE_ID_MOXA_CP102UL 0x1021 #define PCI_DEVICE_ID_MOXA_CP102U 0x1022 #define PCI_DEVICE_ID_MOXA_C104 0x1040 #define PCI_DEVICE_ID_MOXA_CP104U 0x1041 #define PCI_DEVICE_ID_MOXA_CP104JU 0x1042 #define PCI_DEVICE_ID_MOXA_CP104EL 0x1043 #define PCI_DEVICE_ID_MOXA_CT114 0x1140 #define PCI_DEVICE_ID_MOXA_CP114 0x1141 #define PCI_DEVICE_ID_MOXA_CP118U 0x1180 #define PCI_DEVICE_ID_MOXA_CP118EL 0x1181 #define PCI_DEVICE_ID_MOXA_CP132 0x1320 #define PCI_DEVICE_ID_MOXA_CP132U 0x1321 #define PCI_DEVICE_ID_MOXA_CP134U 0x1340 #define PCI_DEVICE_ID_MOXA_C168 0x1680 #define PCI_DEVICE_ID_MOXA_CP168U 0x1681 #define PCI_DEVICE_ID_MOXA_CP168EL 0x1682 #define PCI_DEVICE_ID_MOXA_CP204J 0x2040 #define PCI_DEVICE_ID_MOXA_C218 0x2180 #define PCI_DEVICE_ID_MOXA_C320 0x3200 #define PCI_VENDOR_ID_CCD 0x1397 #define PCI_DEVICE_ID_CCD_HFC4S 0x08B4 #define PCI_SUBDEVICE_ID_CCD_PMX2S 0x1234 #define PCI_DEVICE_ID_CCD_HFC8S 0x16B8 #define PCI_DEVICE_ID_CCD_2BD0 0x2bd0 #define PCI_DEVICE_ID_CCD_HFCE1 0x30B1 #define PCI_SUBDEVICE_ID_CCD_SPD4S 0x3136 #define PCI_SUBDEVICE_ID_CCD_SPDE1 0x3137 #define PCI_DEVICE_ID_CCD_B000 0xb000 #define PCI_DEVICE_ID_CCD_B006 0xb006 #define PCI_DEVICE_ID_CCD_B007 0xb007 #define PCI_DEVICE_ID_CCD_B008 0xb008 #define PCI_DEVICE_ID_CCD_B009 0xb009 #define PCI_DEVICE_ID_CCD_B00A 0xb00a #define PCI_DEVICE_ID_CCD_B00B 0xb00b #define PCI_DEVICE_ID_CCD_B00C 0xb00c #define PCI_DEVICE_ID_CCD_B100 0xb100 #define PCI_SUBDEVICE_ID_CCD_IOB4ST 0xB520 #define PCI_SUBDEVICE_ID_CCD_IOB8STR 0xB521 #define PCI_SUBDEVICE_ID_CCD_IOB8ST 0xB522 #define PCI_SUBDEVICE_ID_CCD_IOB1E1 0xB523 #define PCI_SUBDEVICE_ID_CCD_SWYX4S 0xB540 #define PCI_SUBDEVICE_ID_CCD_JH4S20 0xB550 #define PCI_SUBDEVICE_ID_CCD_IOB8ST_1 0xB552 #define PCI_SUBDEVICE_ID_CCD_BN4S 0xB560 #define PCI_SUBDEVICE_ID_CCD_BN8S 0xB562 #define PCI_SUBDEVICE_ID_CCD_BNE1 0xB563 #define PCI_SUBDEVICE_ID_CCD_BNE1D 0xB564 #define PCI_SUBDEVICE_ID_CCD_BNE1DP 0xB565 #define PCI_SUBDEVICE_ID_CCD_BN2S 0xB566 #define PCI_SUBDEVICE_ID_CCD_BN1SM 0xB567 #define PCI_SUBDEVICE_ID_CCD_BN4SM 0xB568 #define PCI_SUBDEVICE_ID_CCD_BN2SM 0xB569 #define PCI_SUBDEVICE_ID_CCD_BNE1M 0xB56A #define PCI_SUBDEVICE_ID_CCD_BN8SP 0xB56B #define PCI_SUBDEVICE_ID_CCD_HFC4S 0xB620 #define PCI_SUBDEVICE_ID_CCD_HFC8S 0xB622 #define PCI_DEVICE_ID_CCD_B700 0xb700 #define PCI_DEVICE_ID_CCD_B701 0xb701 #define PCI_SUBDEVICE_ID_CCD_HFCE1 0xC523 #define PCI_SUBDEVICE_ID_CCD_OV2S 0xE884 #define PCI_SUBDEVICE_ID_CCD_OV4S 0xE888 #define PCI_SUBDEVICE_ID_CCD_OV8S 0xE998 #define PCI_VENDOR_ID_EXAR 0x13a8 #define PCI_DEVICE_ID_EXAR_XR17C152 0x0152 #define PCI_DEVICE_ID_EXAR_XR17C154 0x0154 #define PCI_DEVICE_ID_EXAR_XR17C158 0x0158 #define PCI_VENDOR_ID_MICROGATE 0x13c0 #define PCI_DEVICE_ID_MICROGATE_USC 0x0010 #define PCI_DEVICE_ID_MICROGATE_SCA 0x0030 #define PCI_VENDOR_ID_3WARE 0x13C1 #define PCI_DEVICE_ID_3WARE_1000 0x1000 #define PCI_DEVICE_ID_3WARE_7000 0x1001 #define PCI_DEVICE_ID_3WARE_9000 0x1002 #define PCI_VENDOR_ID_IOMEGA 0x13ca #define PCI_DEVICE_ID_IOMEGA_BUZ 0x4231 #define PCI_VENDOR_ID_ABOCOM 0x13D1 #define PCI_DEVICE_ID_ABOCOM_2BD1 0x2BD1 #define PCI_VENDOR_ID_SUNDANCE 0x13f0 #define PCI_VENDOR_ID_CMEDIA 0x13f6 #define PCI_DEVICE_ID_CMEDIA_CM8338A 0x0100 #define PCI_DEVICE_ID_CMEDIA_CM8338B 0x0101 #define PCI_DEVICE_ID_CMEDIA_CM8738 0x0111 #define PCI_DEVICE_ID_CMEDIA_CM8738B 0x0112 #define PCI_VENDOR_ID_LAVA 0x1407 #define PCI_DEVICE_ID_LAVA_DSERIAL 0x0100 /* 2x 16550 */ #define PCI_DEVICE_ID_LAVA_QUATRO_A 0x0101 /* 2x 16550, half of 4 port */ #define PCI_DEVICE_ID_LAVA_QUATRO_B 0x0102 /* 2x 16550, half of 4 port */ #define PCI_DEVICE_ID_LAVA_OCTO_A 0x0180 /* 4x 16550A, half of 8 port */ #define PCI_DEVICE_ID_LAVA_OCTO_B 0x0181 /* 4x 16550A, half of 8 port */ #define PCI_DEVICE_ID_LAVA_PORT_PLUS 0x0200 /* 2x 16650 */ #define PCI_DEVICE_ID_LAVA_QUAD_A 0x0201 /* 2x 16650, half of 4 port */ #define PCI_DEVICE_ID_LAVA_QUAD_B 0x0202 /* 2x 16650, half of 4 port */ #define PCI_DEVICE_ID_LAVA_SSERIAL 0x0500 /* 1x 16550 */ #define PCI_DEVICE_ID_LAVA_PORT_650 0x0600 /* 1x 16650 */ #define PCI_DEVICE_ID_LAVA_PARALLEL 0x8000 #define PCI_DEVICE_ID_LAVA_DUAL_PAR_A 0x8002 /* The Lava Dual Parallel is */ #define PCI_DEVICE_ID_LAVA_DUAL_PAR_B 0x8003 /* two PCI devices on a card */ #define PCI_DEVICE_ID_LAVA_BOCA_IOPPAR 0x8800 #define PCI_VENDOR_ID_TIMEDIA 0x1409 #define PCI_DEVICE_ID_TIMEDIA_1889 0x7168 #define PCI_VENDOR_ID_ICE 0x1412 #define PCI_DEVICE_ID_ICE_1712 0x1712 #define PCI_DEVICE_ID_VT1724 0x1724 #define PCI_VENDOR_ID_OXSEMI 0x1415 #define PCI_DEVICE_ID_OXSEMI_12PCI840 0x8403 #define PCI_DEVICE_ID_OXSEMI_PCIe840 0xC000 #define PCI_DEVICE_ID_OXSEMI_PCIe840_G 0xC004 #define PCI_DEVICE_ID_OXSEMI_PCIe952_0 0xC100 #define PCI_DEVICE_ID_OXSEMI_PCIe952_0_G 0xC104 #define PCI_DEVICE_ID_OXSEMI_PCIe952_1 0xC110 #define PCI_DEVICE_ID_OXSEMI_PCIe952_1_G 0xC114 #define PCI_DEVICE_ID_OXSEMI_PCIe952_1_U 0xC118 #define PCI_DEVICE_ID_OXSEMI_PCIe952_1_GU 0xC11C #define PCI_DEVICE_ID_OXSEMI_16PCI954 0x9501 #define PCI_DEVICE_ID_OXSEMI_16PCI95N 0x9511 #define PCI_DEVICE_ID_OXSEMI_16PCI954PP 0x9513 #define PCI_DEVICE_ID_OXSEMI_16PCI952 0x9521 #define PCI_DEVICE_ID_OXSEMI_16PCI952PP 0x9523 #define PCI_VENDOR_ID_CHELSIO 0x1425 #define PCI_VENDOR_ID_SAMSUNG 0x144d #define PCI_VENDOR_ID_MYRICOM 0x14c1 #define PCI_VENDOR_ID_TITAN 0x14D2 #define PCI_DEVICE_ID_TITAN_010L 0x8001 #define PCI_DEVICE_ID_TITAN_100L 0x8010 #define PCI_DEVICE_ID_TITAN_110L 0x8011 #define PCI_DEVICE_ID_TITAN_200L 0x8020 #define PCI_DEVICE_ID_TITAN_210L 0x8021 #define PCI_DEVICE_ID_TITAN_400L 0x8040 #define PCI_DEVICE_ID_TITAN_800L 0x8080 #define PCI_DEVICE_ID_TITAN_100 0xA001 #define PCI_DEVICE_ID_TITAN_200 0xA005 #define PCI_DEVICE_ID_TITAN_400 0xA003 #define PCI_DEVICE_ID_TITAN_800B 0xA004 #define PCI_VENDOR_ID_PANACOM 0x14d4 #define PCI_DEVICE_ID_PANACOM_QUADMODEM 0x0400 #define PCI_DEVICE_ID_PANACOM_DUALMODEM 0x0402 #define PCI_VENDOR_ID_SIPACKETS 0x14d9 #define PCI_DEVICE_ID_SP1011 0x0010 #define PCI_VENDOR_ID_AFAVLAB 0x14db #define PCI_DEVICE_ID_AFAVLAB_P028 0x2180 #define PCI_DEVICE_ID_AFAVLAB_P030 0x2182 #define PCI_SUBDEVICE_ID_AFAVLAB_P061 0x2150 #define PCI_VENDOR_ID_BROADCOM 0x14e4 #define PCI_DEVICE_ID_TIGON3_5752 0x1600 #define PCI_DEVICE_ID_TIGON3_5752M 0x1601 #define PCI_DEVICE_ID_NX2_5709 0x1639 #define PCI_DEVICE_ID_NX2_5709S 0x163a #define PCI_DEVICE_ID_TIGON3_5700 0x1644 #define PCI_DEVICE_ID_TIGON3_5701 0x1645 #define PCI_DEVICE_ID_TIGON3_5702 0x1646 #define PCI_DEVICE_ID_TIGON3_5703 0x1647 #define PCI_DEVICE_ID_TIGON3_5704 0x1648 #define PCI_DEVICE_ID_TIGON3_5704S_2 0x1649 #define PCI_DEVICE_ID_NX2_5706 0x164a #define PCI_DEVICE_ID_NX2_5708 0x164c #define PCI_DEVICE_ID_TIGON3_5702FE 0x164d #define PCI_DEVICE_ID_NX2_57710 0x164e #define PCI_DEVICE_ID_NX2_57711 0x164f #define PCI_DEVICE_ID_NX2_57711E 0x1650 #define PCI_DEVICE_ID_TIGON3_5705 0x1653 #define PCI_DEVICE_ID_TIGON3_5705_2 0x1654 #define PCI_DEVICE_ID_TIGON3_5720 0x1658 #define PCI_DEVICE_ID_TIGON3_5721 0x1659 #define PCI_DEVICE_ID_TIGON3_5722 0x165a #define PCI_DEVICE_ID_TIGON3_5723 0x165b #define PCI_DEVICE_ID_TIGON3_5705M 0x165d #define PCI_DEVICE_ID_TIGON3_5705M_2 0x165e #define PCI_DEVICE_ID_TIGON3_5714 0x1668 #define PCI_DEVICE_ID_TIGON3_5714S 0x1669 #define PCI_DEVICE_ID_TIGON3_5780 0x166a #define PCI_DEVICE_ID_TIGON3_5780S 0x166b #define PCI_DEVICE_ID_TIGON3_5705F 0x166e #define PCI_DEVICE_ID_TIGON3_5754M 0x1672 #define PCI_DEVICE_ID_TIGON3_5755M 0x1673 #define PCI_DEVICE_ID_TIGON3_5756 0x1674 #define PCI_DEVICE_ID_TIGON3_5750 0x1676 #define PCI_DEVICE_ID_TIGON3_5751 0x1677 #define PCI_DEVICE_ID_TIGON3_5715 0x1678 #define PCI_DEVICE_ID_TIGON3_5715S 0x1679 #define PCI_DEVICE_ID_TIGON3_5754 0x167a #define PCI_DEVICE_ID_TIGON3_5755 0x167b #define PCI_DEVICE_ID_TIGON3_5750M 0x167c #define PCI_DEVICE_ID_TIGON3_5751M 0x167d #define PCI_DEVICE_ID_TIGON3_5751F 0x167e #define PCI_DEVICE_ID_TIGON3_5787F 0x167f #define PCI_DEVICE_ID_TIGON3_5761E 0x1680 #define PCI_DEVICE_ID_TIGON3_5761 0x1681 #define PCI_DEVICE_ID_TIGON3_5764 0x1684 #define PCI_DEVICE_ID_TIGON3_5787M 0x1693 #define PCI_DEVICE_ID_TIGON3_5782 0x1696 #define PCI_DEVICE_ID_TIGON3_5784 0x1698 #define PCI_DEVICE_ID_TIGON3_5785 0x1699 #define PCI_DEVICE_ID_TIGON3_5786 0x169a #define PCI_DEVICE_ID_TIGON3_5787 0x169b #define PCI_DEVICE_ID_TIGON3_5788 0x169c #define PCI_DEVICE_ID_TIGON3_5789 0x169d #define PCI_DEVICE_ID_TIGON3_5702X 0x16a6 #define PCI_DEVICE_ID_TIGON3_5703X 0x16a7 #define PCI_DEVICE_ID_TIGON3_5704S 0x16a8 #define PCI_DEVICE_ID_NX2_5706S 0x16aa #define PCI_DEVICE_ID_NX2_5708S 0x16ac #define PCI_DEVICE_ID_TIGON3_5702A3 0x16c6 #define PCI_DEVICE_ID_TIGON3_5703A3 0x16c7 #define PCI_DEVICE_ID_TIGON3_5781 0x16dd #define PCI_DEVICE_ID_TIGON3_5753 0x16f7 #define PCI_DEVICE_ID_TIGON3_5753M 0x16fd #define PCI_DEVICE_ID_TIGON3_5753F 0x16fe #define PCI_DEVICE_ID_TIGON3_5901 0x170d #define PCI_DEVICE_ID_BCM4401B1 0x170c #define PCI_DEVICE_ID_TIGON3_5901_2 0x170e #define PCI_DEVICE_ID_TIGON3_5906 0x1712 #define PCI_DEVICE_ID_TIGON3_5906M 0x1713 #define PCI_DEVICE_ID_BCM4401 0x4401 #define PCI_DEVICE_ID_BCM4401B0 0x4402 #define PCI_VENDOR_ID_TOPIC 0x151f #define PCI_DEVICE_ID_TOPIC_TP560 0x0000 #define PCI_VENDOR_ID_MAINPINE 0x1522 #define PCI_DEVICE_ID_MAINPINE_PBRIDGE 0x0100 #define PCI_VENDOR_ID_ENE 0x1524 #define PCI_DEVICE_ID_ENE_CB712_SD 0x0550 #define PCI_DEVICE_ID_ENE_CB712_SD_2 0x0551 #define PCI_DEVICE_ID_ENE_CB714_SD 0x0750 #define PCI_DEVICE_ID_ENE_CB714_SD_2 0x0751 #define PCI_DEVICE_ID_ENE_1211 0x1211 #define PCI_DEVICE_ID_ENE_1225 0x1225 #define PCI_DEVICE_ID_ENE_1410 0x1410 #define PCI_DEVICE_ID_ENE_710 0x1411 #define PCI_DEVICE_ID_ENE_712 0x1412 #define PCI_DEVICE_ID_ENE_1420 0x1420 #define PCI_DEVICE_ID_ENE_720 0x1421 #define PCI_DEVICE_ID_ENE_722 0x1422 #define PCI_SUBVENDOR_ID_PERLE 0x155f #define PCI_SUBDEVICE_ID_PCI_RAS4 0xf001 #define PCI_SUBDEVICE_ID_PCI_RAS8 0xf010 #define PCI_VENDOR_ID_SYBA 0x1592 #define PCI_DEVICE_ID_SYBA_2P_EPP 0x0782 #define PCI_DEVICE_ID_SYBA_1P_ECP 0x0783 #define PCI_VENDOR_ID_MORETON 0x15aa #define PCI_DEVICE_ID_RASTEL_2PORT 0x2000 #define PCI_VENDOR_ID_ZOLTRIX 0x15b0 #define PCI_DEVICE_ID_ZOLTRIX_2BD0 0x2bd0 #define PCI_VENDOR_ID_MELLANOX 0x15b3 #define PCI_DEVICE_ID_MELLANOX_TAVOR 0x5a44 #define PCI_DEVICE_ID_MELLANOX_TAVOR_BRIDGE 0x5a46 #define PCI_DEVICE_ID_MELLANOX_ARBEL_COMPAT 0x6278 #define PCI_DEVICE_ID_MELLANOX_ARBEL 0x6282 #define PCI_DEVICE_ID_MELLANOX_SINAI_OLD 0x5e8c #define PCI_DEVICE_ID_MELLANOX_SINAI 0x6274 #define PCI_VENDOR_ID_QUICKNET 0x15e2 #define PCI_DEVICE_ID_QUICKNET_XJ 0x0500 /* * ADDI-DATA GmbH communication cards */ #define PCI_VENDOR_ID_ADDIDATA_OLD 0x10E8 #define PCI_VENDOR_ID_ADDIDATA 0x15B8 #define PCI_DEVICE_ID_ADDIDATA_APCI7500 0x7000 #define PCI_DEVICE_ID_ADDIDATA_APCI7420 0x7001 #define PCI_DEVICE_ID_ADDIDATA_APCI7300 0x7002 #define PCI_DEVICE_ID_ADDIDATA_APCI7800 0x818E #define PCI_DEVICE_ID_ADDIDATA_APCI7500_2 0x7009 #define PCI_DEVICE_ID_ADDIDATA_APCI7420_2 0x700A #define PCI_DEVICE_ID_ADDIDATA_APCI7300_2 0x700B #define PCI_DEVICE_ID_ADDIDATA_APCI7500_3 0x700C #define PCI_DEVICE_ID_ADDIDATA_APCI7420_3 0x700D #define PCI_DEVICE_ID_ADDIDATA_APCI7300_3 0x700E #define PCI_DEVICE_ID_ADDIDATA_APCI7800_3 0x700F #define PCI_VENDOR_ID_PDC 0x15e9 #define PCI_VENDOR_ID_FARSITE 0x1619 #define PCI_DEVICE_ID_FARSITE_T2P 0x0400 #define PCI_DEVICE_ID_FARSITE_T4P 0x0440 #define PCI_DEVICE_ID_FARSITE_T1U 0x0610 #define PCI_DEVICE_ID_FARSITE_T2U 0x0620 #define PCI_DEVICE_ID_FARSITE_T4U 0x0640 #define PCI_DEVICE_ID_FARSITE_TE1 0x1610 #define PCI_DEVICE_ID_FARSITE_TE1C 0x1612 #define PCI_VENDOR_ID_ARIMA 0x161f #define PCI_VENDOR_ID_BROCADE 0x1657 #define PCI_VENDOR_ID_SIBYTE 0x166d #define PCI_DEVICE_ID_BCM1250_PCI 0x0001 #define PCI_DEVICE_ID_BCM1250_HT 0x0002 #define PCI_VENDOR_ID_ATHEROS 0x168c #define PCI_VENDOR_ID_NETCELL 0x169c #define PCI_DEVICE_ID_REVOLUTION 0x0044 #define PCI_VENDOR_ID_CENATEK 0x16CA #define PCI_DEVICE_ID_CENATEK_IDE 0x0001 #define PCI_VENDOR_ID_VITESSE 0x1725 #define PCI_DEVICE_ID_VITESSE_VSC7174 0x7174 #define PCI_VENDOR_ID_LINKSYS 0x1737 #define PCI_DEVICE_ID_LINKSYS_EG1064 0x1064 #define PCI_VENDOR_ID_ALTIMA 0x173b #define PCI_DEVICE_ID_ALTIMA_AC1000 0x03e8 #define PCI_DEVICE_ID_ALTIMA_AC1001 0x03e9 #define PCI_DEVICE_ID_ALTIMA_AC9100 0x03ea #define PCI_DEVICE_ID_ALTIMA_AC1003 0x03eb #define PCI_VENDOR_ID_BELKIN 0x1799 #define PCI_DEVICE_ID_BELKIN_F5D7010V7 0x701f #define PCI_VENDOR_ID_RDC 0x17f3 #define PCI_DEVICE_ID_RDC_R6020 0x6020 #define PCI_DEVICE_ID_RDC_R6030 0x6030 #define PCI_DEVICE_ID_RDC_R6040 0x6040 #define PCI_DEVICE_ID_RDC_R6060 0x6060 #define PCI_DEVICE_ID_RDC_R6061 0x6061 #define PCI_VENDOR_ID_LENOVO 0x17aa #define PCI_VENDOR_ID_ARECA 0x17d3 #define PCI_DEVICE_ID_ARECA_1110 0x1110 #define PCI_DEVICE_ID_ARECA_1120 0x1120 #define PCI_DEVICE_ID_ARECA_1130 0x1130 #define PCI_DEVICE_ID_ARECA_1160 0x1160 #define PCI_DEVICE_ID_ARECA_1170 0x1170 #define PCI_DEVICE_ID_ARECA_1200 0x1200 #define PCI_DEVICE_ID_ARECA_1201 0x1201 #define PCI_DEVICE_ID_ARECA_1202 0x1202 #define PCI_DEVICE_ID_ARECA_1210 0x1210 #define PCI_DEVICE_ID_ARECA_1220 0x1220 #define PCI_DEVICE_ID_ARECA_1230 0x1230 #define PCI_DEVICE_ID_ARECA_1260 0x1260 #define PCI_DEVICE_ID_ARECA_1270 0x1270 #define PCI_DEVICE_ID_ARECA_1280 0x1280 #define PCI_DEVICE_ID_ARECA_1380 0x1380 #define PCI_DEVICE_ID_ARECA_1381 0x1381 #define PCI_DEVICE_ID_ARECA_1680 0x1680 #define PCI_DEVICE_ID_ARECA_1681 0x1681 #define PCI_VENDOR_ID_S2IO 0x17d5 #define PCI_DEVICE_ID_S2IO_WIN 0x5731 #define PCI_DEVICE_ID_S2IO_UNI 0x5831 #define PCI_DEVICE_ID_HERC_WIN 0x5732 #define PCI_DEVICE_ID_HERC_UNI 0x5832 #define PCI_VENDOR_ID_SITECOM 0x182d #define PCI_DEVICE_ID_SITECOM_DC105V2 0x3069 #define PCI_VENDOR_ID_TOPSPIN 0x1867 #define PCI_VENDOR_ID_TDI 0x192E #define PCI_DEVICE_ID_TDI_EHCI 0x0101 #define PCI_VENDOR_ID_FREESCALE 0x1957 #define PCI_DEVICE_ID_MPC8548E 0x0012 #define PCI_DEVICE_ID_MPC8548 0x0013 #define PCI_DEVICE_ID_MPC8543E 0x0014 #define PCI_DEVICE_ID_MPC8543 0x0015 #define PCI_DEVICE_ID_MPC8547E 0x0018 #define PCI_DEVICE_ID_MPC8545E 0x0019 #define PCI_DEVICE_ID_MPC8545 0x001a #define PCI_DEVICE_ID_MPC8568E 0x0020 #define PCI_DEVICE_ID_MPC8568 0x0021 #define PCI_DEVICE_ID_MPC8567E 0x0022 #define PCI_DEVICE_ID_MPC8567 0x0023 #define PCI_DEVICE_ID_MPC8533E 0x0030 #define PCI_DEVICE_ID_MPC8533 0x0031 #define PCI_DEVICE_ID_MPC8544E 0x0032 #define PCI_DEVICE_ID_MPC8544 0x0033 #define PCI_DEVICE_ID_MPC8572E 0x0040 #define PCI_DEVICE_ID_MPC8572 0x0041 #define PCI_DEVICE_ID_MPC8536E 0x0050 #define PCI_DEVICE_ID_MPC8536 0x0051 #define PCI_DEVICE_ID_MPC8641 0x7010 #define PCI_DEVICE_ID_MPC8641D 0x7011 #define PCI_DEVICE_ID_MPC8610 0x7018 #define PCI_VENDOR_ID_PASEMI 0x1959 #define PCI_VENDOR_ID_ATTANSIC 0x1969 #define PCI_DEVICE_ID_ATTANSIC_L1 0x1048 #define PCI_DEVICE_ID_ATTANSIC_L2 0x2048 #define PCI_VENDOR_ID_JMICRON 0x197B #define PCI_DEVICE_ID_JMICRON_JMB360 0x2360 #define PCI_DEVICE_ID_JMICRON_JMB361 0x2361 #define PCI_DEVICE_ID_JMICRON_JMB363 0x2363 #define PCI_DEVICE_ID_JMICRON_JMB365 0x2365 #define PCI_DEVICE_ID_JMICRON_JMB366 0x2366 #define PCI_DEVICE_ID_JMICRON_JMB368 0x2368 #define PCI_DEVICE_ID_JMICRON_JMB38X_SD 0x2381 #define PCI_DEVICE_ID_JMICRON_JMB38X_MMC 0x2382 #define PCI_DEVICE_ID_JMICRON_JMB38X_MS 0x2383 #define PCI_VENDOR_ID_KORENIX 0x1982 #define PCI_DEVICE_ID_KORENIX_JETCARDF0 0x1600 #define PCI_DEVICE_ID_KORENIX_JETCARDF1 0x16ff #define PCI_VENDOR_ID_TEKRAM 0x1de1 #define PCI_DEVICE_ID_TEKRAM_DC290 0xdc29 #define PCI_VENDOR_ID_TEHUTI 0x1fc9 #define PCI_DEVICE_ID_TEHUTI_3009 0x3009 #define PCI_DEVICE_ID_TEHUTI_3010 0x3010 #define PCI_DEVICE_ID_TEHUTI_3014 0x3014 #define PCI_VENDOR_ID_HINT 0x3388 #define PCI_DEVICE_ID_HINT_VXPROII_IDE 0x8013 #define PCI_VENDOR_ID_3DLABS 0x3d3d #define PCI_DEVICE_ID_3DLABS_PERMEDIA2 0x0007 #define PCI_DEVICE_ID_3DLABS_PERMEDIA2V 0x0009 #define PCI_VENDOR_ID_NETXEN 0x4040 #define PCI_DEVICE_ID_NX2031_10GXSR 0x0001 #define PCI_DEVICE_ID_NX2031_10GCX4 0x0002 #define PCI_DEVICE_ID_NX2031_4GCU 0x0003 #define PCI_DEVICE_ID_NX2031_IMEZ 0x0004 #define PCI_DEVICE_ID_NX2031_HMEZ 0x0005 #define PCI_DEVICE_ID_NX2031_XG_MGMT 0x0024 #define PCI_DEVICE_ID_NX2031_XG_MGMT2 0x0025 #define PCI_DEVICE_ID_NX3031 0x0100 #define PCI_VENDOR_ID_AKS 0x416c #define PCI_DEVICE_ID_AKS_ALADDINCARD 0x0100 #define PCI_VENDOR_ID_S3 0x5333 #define PCI_DEVICE_ID_S3_TRIO 0x8811 #define PCI_DEVICE_ID_S3_868 0x8880 #define PCI_DEVICE_ID_S3_968 0x88f0 #define PCI_DEVICE_ID_S3_SAVAGE4 0x8a25 #define PCI_DEVICE_ID_S3_PROSAVAGE8 0x8d04 #define PCI_DEVICE_ID_S3_SONICVIBES 0xca00 #define PCI_VENDOR_ID_DUNORD 0x5544 #define PCI_DEVICE_ID_DUNORD_I3000 0x0001 #define PCI_VENDOR_ID_DCI 0x6666 #define PCI_DEVICE_ID_DCI_PCCOM4 0x0001 #define PCI_DEVICE_ID_DCI_PCCOM8 0x0002 #define PCI_DEVICE_ID_DCI_PCCOM2 0x0004 #define PCI_VENDOR_ID_INTEL 0x8086 #define PCI_DEVICE_ID_INTEL_EESSC 0x0008 #define PCI_DEVICE_ID_INTEL_PXHD_0 0x0320 #define PCI_DEVICE_ID_INTEL_PXHD_1 0x0321 #define PCI_DEVICE_ID_INTEL_PXH_0 0x0329 #define PCI_DEVICE_ID_INTEL_PXH_1 0x032A #define PCI_DEVICE_ID_INTEL_PXHV 0x032C #define PCI_DEVICE_ID_INTEL_82375 0x0482 #define PCI_DEVICE_ID_INTEL_82424 0x0483 #define PCI_DEVICE_ID_INTEL_82378 0x0484 #define PCI_DEVICE_ID_INTEL_I960 0x0960 #define PCI_DEVICE_ID_INTEL_I960RM 0x0962 #define PCI_DEVICE_ID_INTEL_82815_MC 0x1130 #define PCI_DEVICE_ID_INTEL_82815_CGC 0x1132 #define PCI_DEVICE_ID_INTEL_82092AA_0 0x1221 #define PCI_DEVICE_ID_INTEL_7505_0 0x2550 #define PCI_DEVICE_ID_INTEL_7205_0 0x255d #define PCI_DEVICE_ID_INTEL_82437 0x122d #define PCI_DEVICE_ID_INTEL_82371FB_0 0x122e #define PCI_DEVICE_ID_INTEL_82371FB_1 0x1230 #define PCI_DEVICE_ID_INTEL_82371MX 0x1234 #define PCI_DEVICE_ID_INTEL_82441 0x1237 #define PCI_DEVICE_ID_INTEL_82380FB 0x124b #define PCI_DEVICE_ID_INTEL_82439 0x1250 #define PCI_DEVICE_ID_INTEL_80960_RP 0x1960 #define PCI_DEVICE_ID_INTEL_82840_HB 0x1a21 #define PCI_DEVICE_ID_INTEL_82845_HB 0x1a30 #define PCI_DEVICE_ID_INTEL_IOAT 0x1a38 #define PCI_DEVICE_ID_INTEL_82801AA_0 0x2410 #define PCI_DEVICE_ID_INTEL_82801AA_1 0x2411 #define PCI_DEVICE_ID_INTEL_82801AA_3 0x2413 #define PCI_DEVICE_ID_INTEL_82801AA_5 0x2415 #define PCI_DEVICE_ID_INTEL_82801AA_6 0x2416 #define PCI_DEVICE_ID_INTEL_82801AA_8 0x2418 #define PCI_DEVICE_ID_INTEL_82801AB_0 0x2420 #define PCI_DEVICE_ID_INTEL_82801AB_1 0x2421 #define PCI_DEVICE_ID_INTEL_82801AB_3 0x2423 #define PCI_DEVICE_ID_INTEL_82801AB_5 0x2425 #define PCI_DEVICE_ID_INTEL_82801AB_6 0x2426 #define PCI_DEVICE_ID_INTEL_82801AB_8 0x2428 #define PCI_DEVICE_ID_INTEL_82801BA_0 0x2440 #define PCI_DEVICE_ID_INTEL_82801BA_2 0x2443 #define PCI_DEVICE_ID_INTEL_82801BA_4 0x2445 #define PCI_DEVICE_ID_INTEL_82801BA_6 0x2448 #define PCI_DEVICE_ID_INTEL_82801BA_8 0x244a #define PCI_DEVICE_ID_INTEL_82801BA_9 0x244b #define PCI_DEVICE_ID_INTEL_82801BA_10 0x244c #define PCI_DEVICE_ID_INTEL_82801BA_11 0x244e #define PCI_DEVICE_ID_INTEL_82801E_0 0x2450 #define PCI_DEVICE_ID_INTEL_82801E_11 0x245b #define PCI_DEVICE_ID_INTEL_82801CA_0 0x2480 #define PCI_DEVICE_ID_INTEL_82801CA_3 0x2483 #define PCI_DEVICE_ID_INTEL_82801CA_5 0x2485 #define PCI_DEVICE_ID_INTEL_82801CA_6 0x2486 #define PCI_DEVICE_ID_INTEL_82801CA_10 0x248a #define PCI_DEVICE_ID_INTEL_82801CA_11 0x248b #define PCI_DEVICE_ID_INTEL_82801CA_12 0x248c #define PCI_DEVICE_ID_INTEL_82801DB_0 0x24c0 #define PCI_DEVICE_ID_INTEL_82801DB_1 0x24c1 #define PCI_DEVICE_ID_INTEL_82801DB_3 0x24c3 #define PCI_DEVICE_ID_INTEL_82801DB_5 0x24c5 #define PCI_DEVICE_ID_INTEL_82801DB_6 0x24c6 #define PCI_DEVICE_ID_INTEL_82801DB_9 0x24c9 #define PCI_DEVICE_ID_INTEL_82801DB_10 0x24ca #define PCI_DEVICE_ID_INTEL_82801DB_11 0x24cb #define PCI_DEVICE_ID_INTEL_82801DB_12 0x24cc #define PCI_DEVICE_ID_INTEL_82801EB_0 0x24d0 #define PCI_DEVICE_ID_INTEL_82801EB_1 0x24d1 #define PCI_DEVICE_ID_INTEL_82801EB_3 0x24d3 #define PCI_DEVICE_ID_INTEL_82801EB_5 0x24d5 #define PCI_DEVICE_ID_INTEL_82801EB_6 0x24d6 #define PCI_DEVICE_ID_INTEL_82801EB_11 0x24db #define PCI_DEVICE_ID_INTEL_82801EB_12 0x24dc #define PCI_DEVICE_ID_INTEL_82801EB_13 0x24dd #define PCI_DEVICE_ID_INTEL_ESB_1 0x25a1 #define PCI_DEVICE_ID_INTEL_ESB_2 0x25a2 #define PCI_DEVICE_ID_INTEL_ESB_4 0x25a4 #define PCI_DEVICE_ID_INTEL_ESB_5 0x25a6 #define PCI_DEVICE_ID_INTEL_ESB_9 0x25ab #define PCI_DEVICE_ID_INTEL_82820_HB 0x2500 #define PCI_DEVICE_ID_INTEL_82820_UP_HB 0x2501 #define PCI_DEVICE_ID_INTEL_82850_HB 0x2530 #define PCI_DEVICE_ID_INTEL_82860_HB 0x2531 #define PCI_DEVICE_ID_INTEL_E7501_MCH 0x254c #define PCI_DEVICE_ID_INTEL_82845G_HB 0x2560 #define PCI_DEVICE_ID_INTEL_82845G_IG 0x2562 #define PCI_DEVICE_ID_INTEL_82865_HB 0x2570 #define PCI_DEVICE_ID_INTEL_82865_IG 0x2572 #define PCI_DEVICE_ID_INTEL_82875_HB 0x2578 #define PCI_DEVICE_ID_INTEL_82915G_HB 0x2580 #define PCI_DEVICE_ID_INTEL_82915G_IG 0x2582 #define PCI_DEVICE_ID_INTEL_82915GM_HB 0x2590 #define PCI_DEVICE_ID_INTEL_82915GM_IG 0x2592 #define PCI_DEVICE_ID_INTEL_5000_ERR 0x25F0 #define PCI_DEVICE_ID_INTEL_5000_FBD0 0x25F5 #define PCI_DEVICE_ID_INTEL_5000_FBD1 0x25F6 #define PCI_DEVICE_ID_INTEL_82945G_HB 0x2770 #define PCI_DEVICE_ID_INTEL_82945G_IG 0x2772 #define PCI_DEVICE_ID_INTEL_3000_HB 0x2778 #define PCI_DEVICE_ID_INTEL_82945GM_HB 0x27A0 #define PCI_DEVICE_ID_INTEL_82945GM_IG 0x27A2 #define PCI_DEVICE_ID_INTEL_ICH6_0 0x2640 #define PCI_DEVICE_ID_INTEL_ICH6_1 0x2641 #define PCI_DEVICE_ID_INTEL_ICH6_2 0x2642 #define PCI_DEVICE_ID_INTEL_ICH6_16 0x266a #define PCI_DEVICE_ID_INTEL_ICH6_17 0x266d #define PCI_DEVICE_ID_INTEL_ICH6_18 0x266e #define PCI_DEVICE_ID_INTEL_ICH6_19 0x266f #define PCI_DEVICE_ID_INTEL_ESB2_0 0x2670 #define PCI_DEVICE_ID_INTEL_ESB2_14 0x2698 #define PCI_DEVICE_ID_INTEL_ESB2_17 0x269b #define PCI_DEVICE_ID_INTEL_ESB2_18 0x269e #define PCI_DEVICE_ID_INTEL_ICH7_0 0x27b8 #define PCI_DEVICE_ID_INTEL_ICH7_1 0x27b9 #define PCI_DEVICE_ID_INTEL_ICH7_30 0x27b0 #define PCI_DEVICE_ID_INTEL_ICH7_31 0x27bd #define PCI_DEVICE_ID_INTEL_ICH7_17 0x27da #define PCI_DEVICE_ID_INTEL_ICH7_19 0x27dd #define PCI_DEVICE_ID_INTEL_ICH7_20 0x27de #define PCI_DEVICE_ID_INTEL_ICH7_21 0x27df #define PCI_DEVICE_ID_INTEL_ICH8_0 0x2810 #define PCI_DEVICE_ID_INTEL_ICH8_1 0x2811 #define PCI_DEVICE_ID_INTEL_ICH8_2 0x2812 #define PCI_DEVICE_ID_INTEL_ICH8_3 0x2814 #define PCI_DEVICE_ID_INTEL_ICH8_4 0x2815 #define PCI_DEVICE_ID_INTEL_ICH8_5 0x283e #define PCI_DEVICE_ID_INTEL_ICH8_6 0x2850 #define PCI_DEVICE_ID_INTEL_ICH9_0 0x2910 #define PCI_DEVICE_ID_INTEL_ICH9_1 0x2917 #define PCI_DEVICE_ID_INTEL_ICH9_2 0x2912 #define PCI_DEVICE_ID_INTEL_ICH9_3 0x2913 #define PCI_DEVICE_ID_INTEL_ICH9_4 0x2914 #define PCI_DEVICE_ID_INTEL_ICH9_5 0x2919 #define PCI_DEVICE_ID_INTEL_ICH9_6 0x2930 #define PCI_DEVICE_ID_INTEL_ICH9_7 0x2916 #define PCI_DEVICE_ID_INTEL_ICH9_8 0x2918 #define PCI_DEVICE_ID_INTEL_82855PM_HB 0x3340 #define PCI_DEVICE_ID_INTEL_IOAT_TBG4 0x3429 #define PCI_DEVICE_ID_INTEL_IOAT_TBG5 0x342a #define PCI_DEVICE_ID_INTEL_IOAT_TBG6 0x342b #define PCI_DEVICE_ID_INTEL_IOAT_TBG7 0x342c #define PCI_DEVICE_ID_INTEL_IOAT_TBG0 0x3430 #define PCI_DEVICE_ID_INTEL_IOAT_TBG1 0x3431 #define PCI_DEVICE_ID_INTEL_IOAT_TBG2 0x3432 #define PCI_DEVICE_ID_INTEL_IOAT_TBG3 0x3433 #define PCI_DEVICE_ID_INTEL_82830_HB 0x3575 #define PCI_DEVICE_ID_INTEL_82830_CGC 0x3577 #define PCI_DEVICE_ID_INTEL_82855GM_HB 0x3580 #define PCI_DEVICE_ID_INTEL_82855GM_IG 0x3582 #define PCI_DEVICE_ID_INTEL_E7520_MCH 0x3590 #define PCI_DEVICE_ID_INTEL_E7320_MCH 0x3592 #define PCI_DEVICE_ID_INTEL_MCH_PA 0x3595 #define PCI_DEVICE_ID_INTEL_MCH_PA1 0x3596 #define PCI_DEVICE_ID_INTEL_MCH_PB 0x3597 #define PCI_DEVICE_ID_INTEL_MCH_PB1 0x3598 #define PCI_DEVICE_ID_INTEL_MCH_PC 0x3599 #define PCI_DEVICE_ID_INTEL_MCH_PC1 0x359a #define PCI_DEVICE_ID_INTEL_E7525_MCH 0x359e #define PCI_DEVICE_ID_INTEL_IOAT_CNB 0x360b #define PCI_DEVICE_ID_INTEL_FBD_CNB 0x360c #define PCI_DEVICE_ID_INTEL_ICH10_0 0x3a14 #define PCI_DEVICE_ID_INTEL_ICH10_1 0x3a16 #define PCI_DEVICE_ID_INTEL_ICH10_2 0x3a18 #define PCI_DEVICE_ID_INTEL_ICH10_3 0x3a1a #define PCI_DEVICE_ID_INTEL_ICH10_4 0x3a30 #define PCI_DEVICE_ID_INTEL_ICH10_5 0x3a60 #define PCI_DEVICE_ID_INTEL_PCH_LPC_MIN 0x3b00 #define PCI_DEVICE_ID_INTEL_PCH_LPC_MAX 0x3b1f #define PCI_DEVICE_ID_INTEL_PCH_SMBUS 0x3b30 #define PCI_DEVICE_ID_INTEL_IOAT_SNB 0x402f #define PCI_DEVICE_ID_INTEL_5100_16 0x65f0 #define PCI_DEVICE_ID_INTEL_5100_21 0x65f5 #define PCI_DEVICE_ID_INTEL_5100_22 0x65f6 #define PCI_DEVICE_ID_INTEL_5400_ERR 0x4030 #define PCI_DEVICE_ID_INTEL_5400_FBD0 0x4035 #define PCI_DEVICE_ID_INTEL_5400_FBD1 0x4036 #define PCI_DEVICE_ID_INTEL_IOAT_SCNB 0x65ff #define PCI_DEVICE_ID_INTEL_TOLAPAI_0 0x5031 #define PCI_DEVICE_ID_INTEL_TOLAPAI_1 0x5032 #define PCI_DEVICE_ID_INTEL_82371SB_0 0x7000 #define PCI_DEVICE_ID_INTEL_82371SB_1 0x7010 #define PCI_DEVICE_ID_INTEL_82371SB_2 0x7020 #define PCI_DEVICE_ID_INTEL_82437VX 0x7030 #define PCI_DEVICE_ID_INTEL_82439TX 0x7100 #define PCI_DEVICE_ID_INTEL_82371AB_0 0x7110 #define PCI_DEVICE_ID_INTEL_82371AB 0x7111 #define PCI_DEVICE_ID_INTEL_82371AB_2 0x7112 #define PCI_DEVICE_ID_INTEL_82371AB_3 0x7113 #define PCI_DEVICE_ID_INTEL_82810_MC1 0x7120 #define PCI_DEVICE_ID_INTEL_82810_IG1 0x7121 #define PCI_DEVICE_ID_INTEL_82810_MC3 0x7122 #define PCI_DEVICE_ID_INTEL_82810_IG3 0x7123 #define PCI_DEVICE_ID_INTEL_82810E_MC 0x7124 #define PCI_DEVICE_ID_INTEL_82810E_IG 0x7125 #define PCI_DEVICE_ID_INTEL_82443LX_0 0x7180 #define PCI_DEVICE_ID_INTEL_82443LX_1 0x7181 #define PCI_DEVICE_ID_INTEL_82443BX_0 0x7190 #define PCI_DEVICE_ID_INTEL_82443BX_1 0x7191 #define PCI_DEVICE_ID_INTEL_82443BX_2 0x7192 #define PCI_DEVICE_ID_INTEL_440MX 0x7195 #define PCI_DEVICE_ID_INTEL_440MX_6 0x7196 #define PCI_DEVICE_ID_INTEL_82443MX_0 0x7198 #define PCI_DEVICE_ID_INTEL_82443MX_1 0x7199 #define PCI_DEVICE_ID_INTEL_82443MX_3 0x719b #define PCI_DEVICE_ID_INTEL_82443GX_0 0x71a0 #define PCI_DEVICE_ID_INTEL_82443GX_2 0x71a2 #define PCI_DEVICE_ID_INTEL_82372FB_1 0x7601 #define PCI_DEVICE_ID_INTEL_SCH_LPC 0x8119 #define PCI_DEVICE_ID_INTEL_SCH_IDE 0x811a #define PCI_DEVICE_ID_INTEL_82454GX 0x84c4 #define PCI_DEVICE_ID_INTEL_82450GX 0x84c5 #define PCI_DEVICE_ID_INTEL_82451NX 0x84ca #define PCI_DEVICE_ID_INTEL_82454NX 0x84cb #define PCI_DEVICE_ID_INTEL_84460GX 0x84ea #define PCI_DEVICE_ID_INTEL_IXP4XX 0x8500 #define PCI_DEVICE_ID_INTEL_IXP2800 0x9004 #define PCI_DEVICE_ID_INTEL_S21152BB 0xb152 #define PCI_VENDOR_ID_SCALEMP 0x8686 #define PCI_DEVICE_ID_SCALEMP_VSMP_CTL 0x1010 #define PCI_VENDOR_ID_COMPUTONE 0x8e0e #define PCI_DEVICE_ID_COMPUTONE_IP2EX 0x0291 #define PCI_DEVICE_ID_COMPUTONE_PG 0x0302 #define PCI_SUBVENDOR_ID_COMPUTONE 0x8e0e #define PCI_SUBDEVICE_ID_COMPUTONE_PG4 0x0001 #define PCI_SUBDEVICE_ID_COMPUTONE_PG8 0x0002 #define PCI_SUBDEVICE_ID_COMPUTONE_PG6 0x0003 #define PCI_VENDOR_ID_KTI 0x8e2e #define PCI_VENDOR_ID_ADAPTEC 0x9004 #define PCI_DEVICE_ID_ADAPTEC_7810 0x1078 #define PCI_DEVICE_ID_ADAPTEC_7821 0x2178 #define PCI_DEVICE_ID_ADAPTEC_38602 0x3860 #define PCI_DEVICE_ID_ADAPTEC_7850 0x5078 #define PCI_DEVICE_ID_ADAPTEC_7855 0x5578 #define PCI_DEVICE_ID_ADAPTEC_3860 0x6038 #define PCI_DEVICE_ID_ADAPTEC_1480A 0x6075 #define PCI_DEVICE_ID_ADAPTEC_7860 0x6078 #define PCI_DEVICE_ID_ADAPTEC_7861 0x6178 #define PCI_DEVICE_ID_ADAPTEC_7870 0x7078 #define PCI_DEVICE_ID_ADAPTEC_7871 0x7178 #define PCI_DEVICE_ID_ADAPTEC_7872 0x7278 #define PCI_DEVICE_ID_ADAPTEC_7873 0x7378 #define PCI_DEVICE_ID_ADAPTEC_7874 0x7478 #define PCI_DEVICE_ID_ADAPTEC_7895 0x7895 #define PCI_DEVICE_ID_ADAPTEC_7880 0x8078 #define PCI_DEVICE_ID_ADAPTEC_7881 0x8178 #define PCI_DEVICE_ID_ADAPTEC_7882 0x8278 #define PCI_DEVICE_ID_ADAPTEC_7883 0x8378 #define PCI_DEVICE_ID_ADAPTEC_7884 0x8478 #define PCI_DEVICE_ID_ADAPTEC_7885 0x8578 #define PCI_DEVICE_ID_ADAPTEC_7886 0x8678 #define PCI_DEVICE_ID_ADAPTEC_7887 0x8778 #define PCI_DEVICE_ID_ADAPTEC_7888 0x8878 #define PCI_VENDOR_ID_ADAPTEC2 0x9005 #define PCI_DEVICE_ID_ADAPTEC2_2940U2 0x0010 #define PCI_DEVICE_ID_ADAPTEC2_2930U2 0x0011 #define PCI_DEVICE_ID_ADAPTEC2_7890B 0x0013 #define PCI_DEVICE_ID_ADAPTEC2_7890 0x001f #define PCI_DEVICE_ID_ADAPTEC2_3940U2 0x0050 #define PCI_DEVICE_ID_ADAPTEC2_3950U2D 0x0051 #define PCI_DEVICE_ID_ADAPTEC2_7896 0x005f #define PCI_DEVICE_ID_ADAPTEC2_7892A 0x0080 #define PCI_DEVICE_ID_ADAPTEC2_7892B 0x0081 #define PCI_DEVICE_ID_ADAPTEC2_7892D 0x0083 #define PCI_DEVICE_ID_ADAPTEC2_7892P 0x008f #define PCI_DEVICE_ID_ADAPTEC2_7899A 0x00c0 #define PCI_DEVICE_ID_ADAPTEC2_7899B 0x00c1 #define PCI_DEVICE_ID_ADAPTEC2_7899D 0x00c3 #define PCI_DEVICE_ID_ADAPTEC2_7899P 0x00cf #define PCI_DEVICE_ID_ADAPTEC2_OBSIDIAN 0x0500 #define PCI_DEVICE_ID_ADAPTEC2_SCAMP 0x0503 #define PCI_VENDOR_ID_HOLTEK 0x9412 #define PCI_DEVICE_ID_HOLTEK_6565 0x6565 #define PCI_VENDOR_ID_NETMOS 0x9710 #define PCI_DEVICE_ID_NETMOS_9705 0x9705 #define PCI_DEVICE_ID_NETMOS_9715 0x9715 #define PCI_DEVICE_ID_NETMOS_9735 0x9735 #define PCI_DEVICE_ID_NETMOS_9745 0x9745 #define PCI_DEVICE_ID_NETMOS_9755 0x9755 #define PCI_DEVICE_ID_NETMOS_9805 0x9805 #define PCI_DEVICE_ID_NETMOS_9815 0x9815 #define PCI_DEVICE_ID_NETMOS_9835 0x9835 #define PCI_DEVICE_ID_NETMOS_9845 0x9845 #define PCI_DEVICE_ID_NETMOS_9855 0x9855 #define PCI_VENDOR_ID_3COM_2 0xa727 #define PCI_VENDOR_ID_DIGIUM 0xd161 #define PCI_DEVICE_ID_DIGIUM_HFC4S 0xb410 #define PCI_SUBVENDOR_ID_EXSYS 0xd84d #define PCI_SUBDEVICE_ID_EXSYS_4014 0x4014 #define PCI_SUBDEVICE_ID_EXSYS_4055 0x4055 #define PCI_VENDOR_ID_TIGERJET 0xe159 #define PCI_DEVICE_ID_TIGERJET_300 0x0001 #define PCI_DEVICE_ID_TIGERJET_100 0x0002 #define PCI_VENDOR_ID_XILINX_RME 0xea60 #define PCI_DEVICE_ID_RME_DIGI32 0x9896 #define PCI_DEVICE_ID_RME_DIGI32_PRO 0x9897 #define PCI_DEVICE_ID_RME_DIGI32_8 0x9898 #define PCI_VENDOR_ID_REDHAT_QUMRANET 0x1af4 #define PCI_DEVICE_ID_VIRTIO_BLK 0x1001 #define PCI_DEVICE_ID_VIRTIO_SCSI 0x1004 tinyvisor/bios/src/usb-uhci.h0000644006644000001440000001250112172661303016477 0ustar yuichi_xyusers#ifndef __USB_UHCI_H #define __USB_UHCI_H // usb-uhci.c void uhci_setup(struct pci_device *pci, int busid); struct usbdevice_s; struct usb_endpoint_descriptor; struct usb_pipe *uhci_alloc_pipe(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc); struct usb_pipe; int uhci_control(struct usb_pipe *p, int dir, const void *cmd, int cmdsize , void *data, int datasize); int uhci_send_bulk(struct usb_pipe *p, int dir, void *data, int datasize); int uhci_poll_intr(struct usb_pipe *p, void *data); /**************************************************************** * uhci structs and flags ****************************************************************/ /* USB port status and control registers */ #define USBPORTSC1 16 #define USBPORTSC2 18 #define USBPORTSC_CCS 0x0001 /* Current Connect Status * ("device present") */ #define USBPORTSC_CSC 0x0002 /* Connect Status Change */ #define USBPORTSC_PE 0x0004 /* Port Enable */ #define USBPORTSC_PEC 0x0008 /* Port Enable Change */ #define USBPORTSC_DPLUS 0x0010 /* D+ high (line status) */ #define USBPORTSC_DMINUS 0x0020 /* D- high (line status) */ #define USBPORTSC_RD 0x0040 /* Resume Detect */ #define USBPORTSC_RES1 0x0080 /* reserved, always 1 */ #define USBPORTSC_LSDA 0x0100 /* Low Speed Device Attached */ #define USBPORTSC_PR 0x0200 /* Port Reset */ /* Legacy support register */ #define USBLEGSUP 0xc0 #define USBLEGSUP_RWC 0x8f00 /* the R/WC bits */ /* Command register */ #define USBCMD 0 #define USBCMD_RS 0x0001 /* Run/Stop */ #define USBCMD_HCRESET 0x0002 /* Host reset */ #define USBCMD_GRESET 0x0004 /* Global reset */ #define USBCMD_EGSM 0x0008 /* Global Suspend Mode */ #define USBCMD_FGR 0x0010 /* Force Global Resume */ #define USBCMD_SWDBG 0x0020 /* SW Debug mode */ #define USBCMD_CF 0x0040 /* Config Flag (sw only) */ #define USBCMD_MAXP 0x0080 /* Max Packet (0 = 32, 1 = 64) */ /* Status register */ #define USBSTS 2 #define USBSTS_USBINT 0x0001 /* Interrupt due to IOC */ #define USBSTS_ERROR 0x0002 /* Interrupt due to error */ #define USBSTS_RD 0x0004 /* Resume Detect */ #define USBSTS_HSE 0x0008 /* Host System Error: PCI problems */ #define USBSTS_HCPE 0x0010 /* Host Controller Process Error: * the schedule is buggy */ #define USBSTS_HCH 0x0020 /* HC Halted */ /* Interrupt enable register */ #define USBINTR 4 #define USBINTR_TIMEOUT 0x0001 /* Timeout/CRC error enable */ #define USBINTR_RESUME 0x0002 /* Resume interrupt enable */ #define USBINTR_IOC 0x0004 /* Interrupt On Complete enable */ #define USBINTR_SP 0x0008 /* Short packet interrupt enable */ #define USBFRNUM 6 #define USBFLBASEADD 8 #define USBSOF 12 #define USBSOF_DEFAULT 64 /* Frame length is exactly 1 ms */ struct uhci_framelist { u32 links[1024]; } PACKED; #define TD_CTRL_SPD (1 << 29) /* Short Packet Detect */ #define TD_CTRL_C_ERR_MASK (3 << 27) /* Error Counter bits */ #define TD_CTRL_C_ERR_SHIFT 27 #define TD_CTRL_LS (1 << 26) /* Low Speed Device */ #define TD_CTRL_IOS (1 << 25) /* Isochronous Select */ #define TD_CTRL_IOC (1 << 24) /* Interrupt on Complete */ #define TD_CTRL_ACTIVE (1 << 23) /* TD Active */ #define TD_CTRL_STALLED (1 << 22) /* TD Stalled */ #define TD_CTRL_DBUFERR (1 << 21) /* Data Buffer Error */ #define TD_CTRL_BABBLE (1 << 20) /* Babble Detected */ #define TD_CTRL_NAK (1 << 19) /* NAK Received */ #define TD_CTRL_CRCTIMEO (1 << 18) /* CRC/Time Out Error */ #define TD_CTRL_BITSTUFF (1 << 17) /* Bit Stuff Error */ #define TD_CTRL_ACTLEN_MASK 0x7FF /* actual length, encoded as n - 1 */ #define TD_CTRL_ANY_ERROR (TD_CTRL_STALLED | TD_CTRL_DBUFERR | \ TD_CTRL_BABBLE | TD_CTRL_CRCTIMEO | \ TD_CTRL_BITSTUFF) #define uhci_maxerr(err) ((err) << TD_CTRL_C_ERR_SHIFT) #define TD_TOKEN_DEVADDR_SHIFT 8 #define TD_TOKEN_TOGGLE_SHIFT 19 #define TD_TOKEN_TOGGLE (1 << 19) #define TD_TOKEN_EXPLEN_SHIFT 21 #define TD_TOKEN_EXPLEN_MASK 0x7FF /* expected length, encoded as n-1 */ #define TD_TOKEN_PID_MASK 0xFF #define uhci_explen(len) ((((len) - 1) & TD_TOKEN_EXPLEN_MASK) << \ TD_TOKEN_EXPLEN_SHIFT) #define uhci_expected_length(token) ((((token) >> TD_TOKEN_EXPLEN_SHIFT) + \ 1) & TD_TOKEN_EXPLEN_MASK) struct uhci_td { u32 link; u32 status; u32 token; void *buffer; } PACKED; struct uhci_qh { u32 link; u32 element; } PACKED; #define UHCI_PTR_BITS 0x000F #define UHCI_PTR_TERM 0x0001 #define UHCI_PTR_QH 0x0002 #define UHCI_PTR_DEPTH 0x0004 #define UHCI_PTR_BREADTH 0x0000 #endif // usb-uhci.h tinyvisor/bios/src/lzmadecode.c0000644006644000001440000002502411733243570017072 0ustar yuichi_xyusers/* LzmaDecode.c LZMA Decoder (optimized for Speed version) LZMA SDK 4.40 Copyright (c) 1999-2006 Igor Pavlov (2006-05-01) http://www.7-zip.org/ LZMA SDK is licensed under two licenses: 1) GNU Lesser General Public License (GNU LGPL) 2) Common Public License (CPL) It means that you can select one of these two licenses and follow rules of that license. SPECIAL EXCEPTION: Igor Pavlov, as the author of this Code, expressly permits you to statically or dynamically link your Code (or bind by name) to the interfaces of this file without subjecting your linked Code to the terms of the CPL or GNU LGPL. Any modifications or additions to this file, however, are subject to the LGPL or CPL terms. */ #include "lzmadecode.h" #define kNumTopBits 24 #define kTopValue ((UInt32)1 << kNumTopBits) #define kNumBitModelTotalBits 11 #define kBitModelTotal (1 << kNumBitModelTotalBits) #define kNumMoveBits 5 #define RC_READ_BYTE (*Buffer++) #define RC_INIT2 Code = 0; Range = 0xFFFFFFFF; \ { int i; for(i = 0; i < 5; i++) { RC_TEST; Code = (Code << 8) | RC_READ_BYTE; }} #define RC_TEST { if (Buffer == BufferLim) return LZMA_RESULT_DATA_ERROR; } #define RC_INIT(buffer, bufferSize) Buffer = buffer; BufferLim = buffer + bufferSize; RC_INIT2 #define RC_NORMALIZE if (Range < kTopValue) { RC_TEST; Range <<= 8; Code = (Code << 8) | RC_READ_BYTE; } #define IfBit0(p) RC_NORMALIZE; bound = (Range >> kNumBitModelTotalBits) * *(p); if (Code < bound) #define UpdateBit0(p) Range = bound; *(p) += (kBitModelTotal - *(p)) >> kNumMoveBits; #define UpdateBit1(p) Range -= bound; Code -= bound; *(p) -= (*(p)) >> kNumMoveBits; #define RC_GET_BIT2(p, mi, A0, A1) IfBit0(p) \ { UpdateBit0(p); mi <<= 1; A0; } else \ { UpdateBit1(p); mi = (mi + mi) + 1; A1; } #define RC_GET_BIT(p, mi) RC_GET_BIT2(p, mi, ; , ;) #define RangeDecoderBitTreeDecode(probs, numLevels, res) \ { int i = numLevels; res = 1; \ do { CProb *cp = probs + res; RC_GET_BIT(cp, res) } while(--i != 0); \ res -= (1 << numLevels); } #define kNumPosBitsMax 4 #define kNumPosStatesMax (1 << kNumPosBitsMax) #define kLenNumLowBits 3 #define kLenNumLowSymbols (1 << kLenNumLowBits) #define kLenNumMidBits 3 #define kLenNumMidSymbols (1 << kLenNumMidBits) #define kLenNumHighBits 8 #define kLenNumHighSymbols (1 << kLenNumHighBits) #define LenChoice 0 #define LenChoice2 (LenChoice + 1) #define LenLow (LenChoice2 + 1) #define LenMid (LenLow + (kNumPosStatesMax << kLenNumLowBits)) #define LenHigh (LenMid + (kNumPosStatesMax << kLenNumMidBits)) #define kNumLenProbs (LenHigh + kLenNumHighSymbols) #define kNumStates 12 #define kNumLitStates 7 #define kStartPosModelIndex 4 #define kEndPosModelIndex 14 #define kNumFullDistances (1 << (kEndPosModelIndex >> 1)) #define kNumPosSlotBits 6 #define kNumLenToPosStates 4 #define kNumAlignBits 4 #define kAlignTableSize (1 << kNumAlignBits) #define kMatchMinLen 2 #define IsMatch 0 #define IsRep (IsMatch + (kNumStates << kNumPosBitsMax)) #define IsRepG0 (IsRep + kNumStates) #define IsRepG1 (IsRepG0 + kNumStates) #define IsRepG2 (IsRepG1 + kNumStates) #define IsRep0Long (IsRepG2 + kNumStates) #define PosSlot (IsRep0Long + (kNumStates << kNumPosBitsMax)) #define SpecPos (PosSlot + (kNumLenToPosStates << kNumPosSlotBits)) #define Align (SpecPos + kNumFullDistances - kEndPosModelIndex) #define LenCoder (Align + kAlignTableSize) #define RepLenCoder (LenCoder + kNumLenProbs) #define Literal (RepLenCoder + kNumLenProbs) #if Literal != LZMA_BASE_SIZE StopCompilingDueBUG #endif int LzmaDecodeProperties(CLzmaProperties *propsRes, const unsigned char *propsData, int size) { unsigned char prop0; if (size < LZMA_PROPERTIES_SIZE) return LZMA_RESULT_DATA_ERROR; prop0 = propsData[0]; if (prop0 >= (9 * 5 * 5)) return LZMA_RESULT_DATA_ERROR; { for (propsRes->pb = 0; prop0 >= (9 * 5); propsRes->pb++, prop0 -= (9 * 5)); for (propsRes->lp = 0; prop0 >= 9; propsRes->lp++, prop0 -= 9); propsRes->lc = prop0; /* unsigned char remainder = (unsigned char)(prop0 / 9); propsRes->lc = prop0 % 9; propsRes->pb = remainder / 5; propsRes->lp = remainder % 5; */ } return LZMA_RESULT_OK; } #define kLzmaStreamWasFinishedId (-1) int LzmaDecode(CLzmaDecoderState *vs, const unsigned char *inStream, SizeT inSize, SizeT *inSizeProcessed, unsigned char *outStream, SizeT outSize, SizeT *outSizeProcessed) { CProb *p = vs->Probs; SizeT nowPos = 0; Byte previousByte = 0; UInt32 posStateMask = (1 << (vs->Properties.pb)) - 1; UInt32 literalPosMask = (1 << (vs->Properties.lp)) - 1; int lc = vs->Properties.lc; int state = 0; UInt32 rep0 = 1, rep1 = 1, rep2 = 1, rep3 = 1; int len = 0; const Byte *Buffer; const Byte *BufferLim; UInt32 Range; UInt32 Code; *inSizeProcessed = 0; *outSizeProcessed = 0; { UInt32 i; UInt32 numProbs = Literal + ((UInt32)LZMA_LIT_SIZE << (lc + vs->Properties.lp)); for (i = 0; i < numProbs; i++) p[i] = kBitModelTotal >> 1; } RC_INIT(inStream, inSize); while(nowPos < outSize) { CProb *prob; UInt32 bound; int posState = (int)( (nowPos ) & posStateMask); prob = p + IsMatch + (state << kNumPosBitsMax) + posState; IfBit0(prob) { int symbol = 1; UpdateBit0(prob) prob = p + Literal + (LZMA_LIT_SIZE * ((( (nowPos ) & literalPosMask) << lc) + (previousByte >> (8 - lc)))); if (state >= kNumLitStates) { int matchByte; matchByte = outStream[nowPos - rep0]; do { int bit; CProb *probLit; matchByte <<= 1; bit = (matchByte & 0x100); probLit = prob + 0x100 + bit + symbol; RC_GET_BIT2(probLit, symbol, if (bit != 0) break, if (bit == 0) break) } while (symbol < 0x100); } while (symbol < 0x100) { CProb *probLit = prob + symbol; RC_GET_BIT(probLit, symbol) } previousByte = (Byte)symbol; outStream[nowPos++] = previousByte; if (state < 4) state = 0; else if (state < 10) state -= 3; else state -= 6; } else { UpdateBit1(prob); prob = p + IsRep + state; IfBit0(prob) { UpdateBit0(prob); rep3 = rep2; rep2 = rep1; rep1 = rep0; state = state < kNumLitStates ? 0 : 3; prob = p + LenCoder; } else { UpdateBit1(prob); prob = p + IsRepG0 + state; IfBit0(prob) { UpdateBit0(prob); prob = p + IsRep0Long + (state << kNumPosBitsMax) + posState; IfBit0(prob) { UpdateBit0(prob); if (nowPos == 0) return LZMA_RESULT_DATA_ERROR; state = state < kNumLitStates ? 9 : 11; previousByte = outStream[nowPos - rep0]; outStream[nowPos++] = previousByte; continue; } else { UpdateBit1(prob); } } else { UInt32 distance; UpdateBit1(prob); prob = p + IsRepG1 + state; IfBit0(prob) { UpdateBit0(prob); distance = rep1; } else { UpdateBit1(prob); prob = p + IsRepG2 + state; IfBit0(prob) { UpdateBit0(prob); distance = rep2; } else { UpdateBit1(prob); distance = rep3; rep3 = rep2; } rep2 = rep1; } rep1 = rep0; rep0 = distance; } state = state < kNumLitStates ? 8 : 11; prob = p + RepLenCoder; } { int numBits, offset; CProb *probLen = prob + LenChoice; IfBit0(probLen) { UpdateBit0(probLen); probLen = prob + LenLow + (posState << kLenNumLowBits); offset = 0; numBits = kLenNumLowBits; } else { UpdateBit1(probLen); probLen = prob + LenChoice2; IfBit0(probLen) { UpdateBit0(probLen); probLen = prob + LenMid + (posState << kLenNumMidBits); offset = kLenNumLowSymbols; numBits = kLenNumMidBits; } else { UpdateBit1(probLen); probLen = prob + LenHigh; offset = kLenNumLowSymbols + kLenNumMidSymbols; numBits = kLenNumHighBits; } } RangeDecoderBitTreeDecode(probLen, numBits, len); len += offset; } if (state < 4) { int posSlot; state += kNumLitStates; prob = p + PosSlot + ((len < kNumLenToPosStates ? len : kNumLenToPosStates - 1) << kNumPosSlotBits); RangeDecoderBitTreeDecode(prob, kNumPosSlotBits, posSlot); if (posSlot >= kStartPosModelIndex) { int numDirectBits = ((posSlot >> 1) - 1); rep0 = (2 | ((UInt32)posSlot & 1)); if (posSlot < kEndPosModelIndex) { rep0 <<= numDirectBits; prob = p + SpecPos + rep0 - posSlot - 1; } else { numDirectBits -= kNumAlignBits; do { RC_NORMALIZE Range >>= 1; rep0 <<= 1; if (Code >= Range) { Code -= Range; rep0 |= 1; } } while (--numDirectBits != 0); prob = p + Align; rep0 <<= kNumAlignBits; numDirectBits = kNumAlignBits; } { int i = 1; int mi = 1; do { CProb *prob3 = prob + mi; RC_GET_BIT2(prob3, mi, ; , rep0 |= i); i <<= 1; } while(--numDirectBits != 0); } } else rep0 = posSlot; if (++rep0 == (UInt32)(0)) { /* it's for stream version */ len = kLzmaStreamWasFinishedId; break; } } len += kMatchMinLen; if (rep0 > nowPos) return LZMA_RESULT_DATA_ERROR; do { previousByte = outStream[nowPos - rep0]; len--; outStream[nowPos++] = previousByte; } while(len != 0 && nowPos < outSize); } } RC_NORMALIZE; *inSizeProcessed = (SizeT)(Buffer - inStream); *outSizeProcessed = nowPos; return LZMA_RESULT_OK; } tinyvisor/bios/src/jpeg.c0000644006644000001440000007306411733243570015717 0ustar yuichi_xyusers/* * Copyright (C) 2001, Novell Inc. * Copyright (C) 2010 Kevin O'Connor * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * 3. Neither the name of Novell nor the names of the contributors may * be used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR "AS IS" AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. * */ /* * a tiny jpeg decoder. * * written in August 2001 by Michael Schroeder * */ #define __LITTLE_ENDIAN #include "util.h" #include "jpeg.h" #define ISHIFT 11 #define IFIX(a) ((int)((a) * (1 << ISHIFT) + .5)) #define IMULT(a, b) (((a) * (b)) >> ISHIFT) #define ITOINT(a) ((a) >> ISHIFT) #ifndef __P # define __P(x) x #endif /* special markers */ #define M_BADHUFF -1 #define M_EOF 0x80 struct in { unsigned char *p; unsigned int bits; int left; int marker; int (*func) __P((void *)); void *data; }; /*********************************/ struct dec_hufftbl; struct enc_hufftbl; union hufftblp { struct dec_hufftbl *dhuff; struct enc_hufftbl *ehuff; }; struct scan { int dc; /* old dc value */ union hufftblp hudc; union hufftblp huac; int next; /* when to switch to next scan */ int cid; /* component id */ int hv; /* horiz/vert, copied from comp */ int tq; /* quant tbl, copied from comp */ }; /*********************************/ #define DECBITS 10 /* seems to be the optimum */ struct dec_hufftbl { int maxcode[17]; int valptr[16]; unsigned char vals[256]; unsigned int llvals[1 << DECBITS]; }; static void decode_mcus __P((struct in *, int *, int, struct scan *, int *)); static int dec_readmarker __P((struct in *)); static void dec_makehuff __P((struct dec_hufftbl *, int *, unsigned char *)); static void setinput __P((struct in *, unsigned char *)); /*********************************/ #undef PREC #define PREC int static void idctqtab __P((unsigned char *, PREC *)); static void idct __P((int *, int *, PREC *, PREC, int)); static void scaleidctqtab __P((PREC *, PREC)); /*********************************/ static void initcol __P((PREC[][64])); static void col221111 __P((int *, unsigned char *, int)); static void col221111_16 __P((int *, unsigned char *, int)); static void col221111_32 __P((int *, unsigned char *, int)); /*********************************/ #define ERR_NO_SOI 1 #define ERR_NOT_8BIT 2 #define ERR_HEIGHT_MISMATCH 3 #define ERR_WIDTH_MISMATCH 4 #define ERR_BAD_WIDTH_OR_HEIGHT 5 #define ERR_TOO_MANY_COMPPS 6 #define ERR_ILLEGAL_HV 7 #define ERR_QUANT_TABLE_SELECTOR 8 #define ERR_NOT_YCBCR_221111 9 #define ERR_UNKNOWN_CID_IN_SCAN 10 #define ERR_NOT_SEQUENTIAL_DCT 11 #define ERR_WRONG_MARKER 12 #define ERR_NO_EOI 13 #define ERR_BAD_TABLES 14 #define ERR_DEPTH_MISMATCH 15 /*********************************/ #define M_SOI 0xd8 #define M_APP0 0xe0 #define M_DQT 0xdb #define M_SOF0 0xc0 #define M_DHT 0xc4 #define M_DRI 0xdd #define M_SOS 0xda #define M_RST0 0xd0 #define M_EOI 0xd9 #define M_COM 0xfe struct comp { int cid; int hv; int tq; }; #define MAXCOMP 4 struct jpginfo { int nc; /* number of components */ int ns; /* number of scans */ int dri; /* restart interval */ int nm; /* mcus til next marker */ int rm; /* next restart marker */ }; struct jpeg_decdata { int dcts[6 * 64 + 16]; int out[64 * 6]; int dquant[3][64]; unsigned char *datap; struct jpginfo info; struct comp comps[MAXCOMP]; struct scan dscans[MAXCOMP]; unsigned char quant[4][64]; struct dec_hufftbl dhuff[4]; struct in in; int height, width; }; static int getbyte(struct jpeg_decdata *jpeg) { return *jpeg->datap++; } static int getword(struct jpeg_decdata *jpeg) { int c1, c2; c1 = *jpeg->datap++; c2 = *jpeg->datap++; return c1 << 8 | c2; } static int readtables(struct jpeg_decdata *jpeg, int till) { int m, l, i, j, lq, pq, tq; int tc, th, tt; for (;;) { if (getbyte(jpeg) != 0xff) return -1; if ((m = getbyte(jpeg)) == till) break; switch (m) { case 0xc2: return 0; case M_DQT: lq = getword(jpeg); while (lq > 2) { pq = getbyte(jpeg); tq = pq & 15; if (tq > 3) return -1; pq >>= 4; if (pq != 0) return -1; for (i = 0; i < 64; i++) jpeg->quant[tq][i] = getbyte(jpeg); lq -= 64 + 1; } break; case M_DHT: l = getword(jpeg); while (l > 2) { int hufflen[16], k; unsigned char huffvals[256]; tc = getbyte(jpeg); th = tc & 15; tc >>= 4; tt = tc * 2 + th; if (tc > 1 || th > 1) return -1; for (i = 0; i < 16; i++) hufflen[i] = getbyte(jpeg); l -= 1 + 16; k = 0; for (i = 0; i < 16; i++) { for (j = 0; j < hufflen[i]; j++) huffvals[k++] = getbyte(jpeg); l -= hufflen[i]; } dec_makehuff(jpeg->dhuff + tt, hufflen, huffvals); } break; case M_DRI: l = getword(jpeg); jpeg->info.dri = getword(jpeg); break; default: l = getword(jpeg); while (l-- > 2) getbyte(jpeg); break; } } return 0; } static void dec_initscans(struct jpeg_decdata *jpeg) { int i; jpeg->info.nm = jpeg->info.dri + 1; jpeg->info.rm = M_RST0; for (i = 0; i < jpeg->info.ns; i++) jpeg->dscans[i].dc = 0; } static int dec_checkmarker(struct jpeg_decdata *jpeg) { int i; if (dec_readmarker(&jpeg->in) != jpeg->info.rm) return -1; jpeg->info.nm = jpeg->info.dri; jpeg->info.rm = (jpeg->info.rm + 1) & ~0x08; for (i = 0; i < jpeg->info.ns; i++) jpeg->dscans[i].dc = 0; return 0; } struct jpeg_decdata *jpeg_alloc(void) { struct jpeg_decdata *jpeg = malloc_tmphigh(sizeof(*jpeg)); return jpeg; } int jpeg_decode(struct jpeg_decdata *jpeg, unsigned char *buf) { int i, j, m, tac, tdc; if (!jpeg || !buf) return -1; jpeg->datap = buf; if (getbyte(jpeg) != 0xff) return ERR_NO_SOI; if (getbyte(jpeg) != M_SOI) return ERR_NO_SOI; if (readtables(jpeg, M_SOF0)) return ERR_BAD_TABLES; getword(jpeg); i = getbyte(jpeg); if (i != 8) return ERR_NOT_8BIT; jpeg->height = getword(jpeg); jpeg->width = getword(jpeg); if ((jpeg->height & 15) || (jpeg->width & 15)) return ERR_BAD_WIDTH_OR_HEIGHT; jpeg->info.nc = getbyte(jpeg); if (jpeg->info.nc > MAXCOMP) return ERR_TOO_MANY_COMPPS; for (i = 0; i < jpeg->info.nc; i++) { int h, v; jpeg->comps[i].cid = getbyte(jpeg); jpeg->comps[i].hv = getbyte(jpeg); v = jpeg->comps[i].hv & 15; h = jpeg->comps[i].hv >> 4; jpeg->comps[i].tq = getbyte(jpeg); if (h > 3 || v > 3) return ERR_ILLEGAL_HV; if (jpeg->comps[i].tq > 3) return ERR_QUANT_TABLE_SELECTOR; } if (readtables(jpeg, M_SOS)) return ERR_BAD_TABLES; getword(jpeg); jpeg->info.ns = getbyte(jpeg); if (jpeg->info.ns != 3) return ERR_NOT_YCBCR_221111; for (i = 0; i < 3; i++) { jpeg->dscans[i].cid = getbyte(jpeg); tdc = getbyte(jpeg); tac = tdc & 15; tdc >>= 4; if (tdc > 1 || tac > 1) return ERR_QUANT_TABLE_SELECTOR; for (j = 0; j < jpeg->info.nc; j++) if (jpeg->comps[j].cid == jpeg->dscans[i].cid) break; if (j == jpeg->info.nc) return ERR_UNKNOWN_CID_IN_SCAN; jpeg->dscans[i].hv = jpeg->comps[j].hv; jpeg->dscans[i].tq = jpeg->comps[j].tq; jpeg->dscans[i].hudc.dhuff = &jpeg->dhuff[tdc]; jpeg->dscans[i].huac.dhuff = &jpeg->dhuff[2 + tac]; } i = getbyte(jpeg); j = getbyte(jpeg); m = getbyte(jpeg); if (i != 0 || j != 63 || m != 0) return ERR_NOT_SEQUENTIAL_DCT; if (jpeg->dscans[0].cid != 1 || jpeg->dscans[1].cid != 2 || jpeg->dscans[2].cid != 3) return ERR_NOT_YCBCR_221111; if (jpeg->dscans[0].hv != 0x22 || jpeg->dscans[1].hv != 0x11 || jpeg->dscans[2].hv != 0x11) return ERR_NOT_YCBCR_221111; idctqtab(jpeg->quant[jpeg->dscans[0].tq], jpeg->dquant[0]); idctqtab(jpeg->quant[jpeg->dscans[1].tq], jpeg->dquant[1]); idctqtab(jpeg->quant[jpeg->dscans[2].tq], jpeg->dquant[2]); initcol(jpeg->dquant); setinput(&jpeg->in, jpeg->datap); #if 0 /* landing zone */ img[len] = 0; img[len + 1] = 0xff; img[len + 2] = M_EOF; #endif dec_initscans(jpeg); return 0; } void jpeg_get_size(struct jpeg_decdata *jpeg, int *width, int *height) { *width = jpeg->width; *height = jpeg->height; } int jpeg_show(struct jpeg_decdata *jpeg, unsigned char *pic, int width , int height, int depth, int bytes_per_line_dest) { int m, mcusx, mcusy, mx, my, mloffset, jpgbpl; int max[6]; if (jpeg->height != height) return ERR_HEIGHT_MISMATCH; if (jpeg->width != width) return ERR_WIDTH_MISMATCH; jpgbpl = width * depth / 8; mloffset = bytes_per_line_dest > jpgbpl ? bytes_per_line_dest : jpgbpl; mcusx = jpeg->width >> 4; mcusy = jpeg->height >> 4; jpeg->dscans[0].next = 6 - 4; jpeg->dscans[1].next = 6 - 4 - 1; jpeg->dscans[2].next = 6 - 4 - 1 - 1; /* 411 encoding */ for (my = 0; my < mcusy; my++) { for (mx = 0; mx < mcusx; mx++) { if (jpeg->info.dri && !--jpeg->info.nm) if (dec_checkmarker(jpeg)) return ERR_WRONG_MARKER; decode_mcus(&jpeg->in, jpeg->dcts, 6, jpeg->dscans, max); idct(jpeg->dcts, jpeg->out, jpeg->dquant[0], IFIX(128.5), max[0]); idct(jpeg->dcts + 64, jpeg->out + 64, jpeg->dquant[0], IFIX(128.5), max[1]); idct(jpeg->dcts + 128, jpeg->out + 128, jpeg->dquant[0], IFIX(128.5), max[2]); idct(jpeg->dcts + 192, jpeg->out + 192, jpeg->dquant[0], IFIX(128.5), max[3]); idct(jpeg->dcts + 256, jpeg->out + 256, jpeg->dquant[1], IFIX(0.5), max[4]); idct(jpeg->dcts + 320, jpeg->out + 320, jpeg->dquant[2], IFIX(0.5), max[5]); switch (depth) { case 32: col221111_32(jpeg->out, pic + (my * 16 * mloffset + mx * 16 * 4), mloffset); break; case 24: col221111(jpeg->out, pic + (my * 16 * mloffset + mx * 16 * 3), mloffset); break; case 16: col221111_16(jpeg->out, pic + (my * 16 * mloffset + mx * 16 * 2), mloffset); break; default: return ERR_DEPTH_MISMATCH; break; } } } m = dec_readmarker(&jpeg->in); if (m != M_EOI) return ERR_NO_EOI; return 0; } /****************************************************************/ /************** huffman decoder ***************/ /****************************************************************/ static int fillbits __P((struct in *, int, unsigned int)); static int dec_rec2 __P((struct in *, struct dec_hufftbl *, int *, int, int)); static void setinput(struct in *in, unsigned char *p) { in->p = p; in->left = 0; in->bits = 0; in->marker = 0; } static int fillbits(struct in *in, int le, unsigned int bi) { int b, m; if (in->marker) { if (le <= 16) in->bits = bi << 16, le += 16; return le; } while (le <= 24) { b = *in->p++; if (b == 0xff && (m = *in->p++) != 0) { if (m == M_EOF) { if (in->func && (m = in->func(in->data)) == 0) continue; } in->marker = m; if (le <= 16) bi = bi << 16, le += 16; break; } bi = bi << 8 | b; le += 8; } in->bits = bi; /* tmp... 2 return values needed */ return le; } static int dec_readmarker(struct in *in) { int m; in->left = fillbits(in, in->left, in->bits); if ((m = in->marker) == 0) return 0; in->left = 0; in->marker = 0; return m; } #define LEBI_DCL int le, bi #define LEBI_GET(in) (le = in->left, bi = in->bits) #define LEBI_PUT(in) (in->left = le, in->bits = bi) #define GETBITS(in, n) ( \ (le < (n) ? le = fillbits(in, le, bi), bi = in->bits : 0), \ (le -= (n)), \ bi >> le & ((1 << (n)) - 1) \ ) #define UNGETBITS(in, n) ( \ le += (n) \ ) static int dec_rec2(struct in *in, struct dec_hufftbl *hu, int *runp, int c, int i) { LEBI_DCL; LEBI_GET(in); if (i) { UNGETBITS(in, i & 127); *runp = i >> 8 & 15; i >>= 16; } else { for (i = DECBITS; (c = ((c << 1) | GETBITS(in, 1))) >= (hu->maxcode[i]); i++); if (i >= 16) { in->marker = M_BADHUFF; return 0; } i = hu->vals[hu->valptr[i] + c - hu->maxcode[i - 1] * 2]; *runp = i >> 4; i &= 15; } if (i == 0) { /* sigh, 0xf0 is 11 bit */ LEBI_PUT(in); return 0; } /* receive part */ c = GETBITS(in, i); if (c < (1 << (i - 1))) c += (-1 << i) + 1; LEBI_PUT(in); return c; } #define DEC_REC(in, hu, r, i) ( \ r = GETBITS(in, DECBITS), \ i = hu->llvals[r], \ i & 128 ? \ ( \ UNGETBITS(in, i & 127), \ r = i >> 8 & 15, \ i >> 16 \ ) \ : \ ( \ LEBI_PUT(in), \ i = dec_rec2(in, hu, &r, r, i), \ LEBI_GET(in), \ i \ ) \ ) static void decode_mcus(struct in *in, int *dct, int n, struct scan *sc, int *maxp) { struct dec_hufftbl *hu; int i, r, t; LEBI_DCL; memset(dct, 0, n * 64 * sizeof(*dct)); LEBI_GET(in); while (n-- > 0) { hu = sc->hudc.dhuff; *dct++ = (sc->dc += DEC_REC(in, hu, r, t)); hu = sc->huac.dhuff; i = 63; while (i > 0) { t = DEC_REC(in, hu, r, t); if (t == 0 && r == 0) { dct += i; break; } dct += r; *dct++ = t; i -= r + 1; } *maxp++ = 64 - i; if (n == sc->next) sc++; } LEBI_PUT(in); } static void dec_makehuff(struct dec_hufftbl *hu, int *hufflen, unsigned char *huffvals) { int code, k, i, j, d, x, c, v; for (i = 0; i < (1 << DECBITS); i++) hu->llvals[i] = 0; /* * llvals layout: * * value v already known, run r, backup u bits: * vvvvvvvvvvvvvvvv 0000 rrrr 1 uuuuuuu * value unknown, size b bits, run r, backup u bits: * 000000000000bbbb 0000 rrrr 0 uuuuuuu * value and size unknown: * 0000000000000000 0000 0000 0 0000000 */ code = 0; k = 0; for (i = 0; i < 16; i++, code <<= 1) { /* sizes */ hu->valptr[i] = k; for (j = 0; j < hufflen[i]; j++) { hu->vals[k] = *huffvals++; if (i < DECBITS) { c = code << (DECBITS - 1 - i); v = hu->vals[k] & 0x0f; /* size */ for (d = 1 << (DECBITS - 1 - i); --d >= 0;) { if (v + i < DECBITS) { /* both fit in table */ x = d >> (DECBITS - 1 - v - i); if (v && x < (1 << (v - 1))) x += (-1 << v) + 1; x = x << 16 | (hu->vals[k] & 0xf0) << 4 | (DECBITS - (i + 1 + v)) | 128; } else x = v << 16 | (hu->vals[k] & 0xf0) << 4 | (DECBITS - (i + 1)); hu->llvals[c | d] = x; } } code++; k++; } hu->maxcode[i] = code; } hu->maxcode[16] = 0x20000; /* always terminate decode */ } /****************************************************************/ /************** idct ***************/ /****************************************************************/ #define ONE ((PREC)IFIX(1.)) #define S2 ((PREC)IFIX(0.382683432)) #define C2 ((PREC)IFIX(0.923879532)) #define C4 ((PREC)IFIX(0.707106781)) #define S22 ((PREC)IFIX(2 * 0.382683432)) #define C22 ((PREC)IFIX(2 * 0.923879532)) #define IC4 ((PREC)IFIX(1 / 0.707106781)) #define C3IC1 ((PREC)IFIX(0.847759065)) /* c3/c1 */ #define C5IC1 ((PREC)IFIX(0.566454497)) /* c5/c1 */ #define C7IC1 ((PREC)IFIX(0.198912367)) /* c7/c1 */ #define XPP(a,b) (t = a + b, b = a - b, a = t) #define XMP(a,b) (t = a - b, b = a + b, a = t) #define XPM(a,b) (t = a + b, b = b - a, a = t) #define ROT(a,b,s,c) ( t = IMULT(a + b, s), \ a = IMULT(a, c - s) + t, \ b = IMULT(b, c + s) - t) #define IDCT \ ( \ XPP(t0, t1), \ XMP(t2, t3), \ t2 = IMULT(t2, IC4) - t3, \ XPP(t0, t3), \ XPP(t1, t2), \ XMP(t4, t7), \ XPP(t5, t6), \ XMP(t5, t7), \ t5 = IMULT(t5, IC4), \ ROT(t4, t6, S22, C22), \ t6 -= t7, \ t5 -= t6, \ t4 -= t5, \ XPP(t0, t7), \ XPP(t1, t6), \ XPP(t2, t5), \ XPP(t3, t4) \ ) static unsigned char zig2[64] = { 0, 2, 3, 9, 10, 20, 21, 35, 14, 16, 25, 31, 39, 46, 50, 57, 5, 7, 12, 18, 23, 33, 37, 48, 27, 29, 41, 44, 52, 55, 59, 62, 15, 26, 30, 40, 45, 51, 56, 58, 1, 4, 8, 11, 19, 22, 34, 36, 28, 42, 43, 53, 54, 60, 61, 63, 6, 13, 17, 24, 32, 38, 47, 49 }; static void idct(int *in, int *out, PREC * quant, PREC off, int max) { PREC t0, t1, t2, t3, t4, t5, t6, t7, t; PREC tmp[64], *tmpp; int i, j; unsigned char *zig2p; t0 = off; if (max == 1) { t0 += in[0] * quant[0]; for (i = 0; i < 64; i++) out[i] = ITOINT(t0); return; } zig2p = zig2; tmpp = tmp; for (i = 0; i < 8; i++) { j = *zig2p++; t0 += in[j] * quant[j]; j = *zig2p++; t5 = in[j] * quant[j]; j = *zig2p++; t2 = in[j] * quant[j]; j = *zig2p++; t7 = in[j] * quant[j]; j = *zig2p++; t1 = in[j] * quant[j]; j = *zig2p++; t4 = in[j] * quant[j]; j = *zig2p++; t3 = in[j] * quant[j]; j = *zig2p++; t6 = in[j] * quant[j]; IDCT; tmpp[0 * 8] = t0; tmpp[1 * 8] = t1; tmpp[2 * 8] = t2; tmpp[3 * 8] = t3; tmpp[4 * 8] = t4; tmpp[5 * 8] = t5; tmpp[6 * 8] = t6; tmpp[7 * 8] = t7; tmpp++; t0 = 0; } for (i = 0; i < 8; i++) { t0 = tmp[8 * i + 0]; t1 = tmp[8 * i + 1]; t2 = tmp[8 * i + 2]; t3 = tmp[8 * i + 3]; t4 = tmp[8 * i + 4]; t5 = tmp[8 * i + 5]; t6 = tmp[8 * i + 6]; t7 = tmp[8 * i + 7]; IDCT; out[8 * i + 0] = ITOINT(t0); out[8 * i + 1] = ITOINT(t1); out[8 * i + 2] = ITOINT(t2); out[8 * i + 3] = ITOINT(t3); out[8 * i + 4] = ITOINT(t4); out[8 * i + 5] = ITOINT(t5); out[8 * i + 6] = ITOINT(t6); out[8 * i + 7] = ITOINT(t7); } } static unsigned char zig[64] = { 0, 1, 5, 6, 14, 15, 27, 28, 2, 4, 7, 13, 16, 26, 29, 42, 3, 8, 12, 17, 25, 30, 41, 43, 9, 11, 18, 24, 31, 40, 44, 53, 10, 19, 23, 32, 39, 45, 52, 54, 20, 22, 33, 38, 46, 51, 55, 60, 21, 34, 37, 47, 50, 56, 59, 61, 35, 36, 48, 49, 57, 58, 62, 63 }; static PREC aaidct[8] = { IFIX(0.3535533906), IFIX(0.4903926402), IFIX(0.4619397663), IFIX(0.4157348062), IFIX(0.3535533906), IFIX(0.2777851165), IFIX(0.1913417162), IFIX(0.0975451610) }; static void idctqtab(unsigned char *qin, PREC * qout) { int i, j; for (i = 0; i < 8; i++) for (j = 0; j < 8; j++) qout[zig[i * 8 + j]] = qin[zig[i * 8 + j]] * IMULT(aaidct[i], aaidct[j]); } static void scaleidctqtab(PREC * q, PREC sc) { int i; for (i = 0; i < 64; i++) q[i] = IMULT(q[i], sc); } /****************************************************************/ /************** color decoder ***************/ /****************************************************************/ #define ROUND /* * YCbCr Color transformation: * * y:0..255 Cb:-128..127 Cr:-128..127 * * R = Y + 1.40200 * Cr * G = Y - 0.34414 * Cb - 0.71414 * Cr * B = Y + 1.77200 * Cb * * => * Cr *= 1.40200; * Cb *= 1.77200; * Cg = 0.19421 * Cb + .50937 * Cr; * R = Y + Cr; * G = Y - Cg; * B = Y + Cb; * * => * Cg = (50 * Cb + 130 * Cr + 128) >> 8; */ static void initcol(PREC q[][64]) { scaleidctqtab(q[1], IFIX(1.77200)); scaleidctqtab(q[2], IFIX(1.40200)); } /* This is optimized for the stupid sun SUNWspro compiler. */ #define STORECLAMP(a,x) \ ( \ (a) = (x), \ (unsigned int)(x) >= 256 ? \ ((a) = (x) < 0 ? 0 : 255) \ : \ 0 \ ) #define CLAMP(x) ((unsigned int)(x) >= 256 ? ((x) < 0 ? 0 : 255) : (x)) #ifdef ROUND #define CBCRCG(yin, xin) \ ( \ cb = outc[0 +yin*8+xin], \ cr = outc[64+yin*8+xin], \ cg = (50 * cb + 130 * cr + 128) >> 8 \ ) #else #define CBCRCG(yin, xin) \ ( \ cb = outc[0 +yin*8+xin], \ cr = outc[64+yin*8+xin], \ cg = (3 * cb + 8 * cr) >> 4 \ ) #endif #ifdef __LITTLE_ENDIAN #define PIC(yin, xin, p, xout) \ ( \ y = outy[(yin) * 8 + xin], \ STORECLAMP(p[(xout) * 3 + 2], y + cr), \ STORECLAMP(p[(xout) * 3 + 1], y - cg), \ STORECLAMP(p[(xout) * 3 + 0], y + cb) \ ) #else #define PIC(yin, xin, p, xout) \ ( \ y = outy[(yin) * 8 + xin], \ STORECLAMP(p[(xout) * 3 + 0], y + cr), \ STORECLAMP(p[(xout) * 3 + 1], y - cg), \ STORECLAMP(p[(xout) * 3 + 2], y + cb) \ ) #endif #ifdef __LITTLE_ENDIAN #define PIC_16(yin, xin, p, xout, add) \ ( \ y = outy[(yin) * 8 + xin], \ y = ((CLAMP(y + cr + add*2+1) & 0xf8) << 8) | \ ((CLAMP(y - cg + add ) & 0xfc) << 3) | \ ((CLAMP(y + cb + add*2+1) ) >> 3), \ p[(xout) * 2 + 0] = y & 0xff, \ p[(xout) * 2 + 1] = y >> 8 \ ) #else #ifdef CONFIG_PPC #define PIC_16(yin, xin, p, xout, add) \ ( \ y = outy[(yin) * 8 + xin], \ y = ((CLAMP(y + cr + add*2+1) & 0xf8) << 7) | \ ((CLAMP(y - cg + add*2+1) & 0xf8) << 2) | \ ((CLAMP(y + cb + add*2+1) ) >> 3), \ p[(xout) * 2 + 0] = y >> 8, \ p[(xout) * 2 + 1] = y & 0xff \ ) #else #define PIC_16(yin, xin, p, xout, add) \ ( \ y = outy[(yin) * 8 + xin], \ y = ((CLAMP(y + cr + add*2+1) & 0xf8) << 8) | \ ((CLAMP(y - cg + add ) & 0xfc) << 3) | \ ((CLAMP(y + cb + add*2+1) ) >> 3), \ p[(xout) * 2 + 0] = y >> 8, \ p[(xout) * 2 + 1] = y & 0xff \ ) #endif #endif #define PIC_32(yin, xin, p, xout) \ ( \ y = outy[(yin) * 8 + xin], \ STORECLAMP(p[(xout) * 4 + 0], y + cr), \ STORECLAMP(p[(xout) * 4 + 1], y - cg), \ STORECLAMP(p[(xout) * 4 + 2], y + cb), \ p[(xout) * 4 + 3] = 0 \ ) #define PIC221111(xin) \ ( \ CBCRCG(0, xin), \ PIC(xin / 4 * 8 + 0, (xin & 3) * 2 + 0, pic0, xin * 2 + 0), \ PIC(xin / 4 * 8 + 0, (xin & 3) * 2 + 1, pic0, xin * 2 + 1), \ PIC(xin / 4 * 8 + 1, (xin & 3) * 2 + 0, pic1, xin * 2 + 0), \ PIC(xin / 4 * 8 + 1, (xin & 3) * 2 + 1, pic1, xin * 2 + 1) \ ) #define PIC221111_16(xin) \ ( \ CBCRCG(0, xin), \ PIC_16(xin / 4 * 8 + 0, (xin & 3) * 2 + 0, pic0, xin * 2 + 0, 3), \ PIC_16(xin / 4 * 8 + 0, (xin & 3) * 2 + 1, pic0, xin * 2 + 1, 0), \ PIC_16(xin / 4 * 8 + 1, (xin & 3) * 2 + 0, pic1, xin * 2 + 0, 1), \ PIC_16(xin / 4 * 8 + 1, (xin & 3) * 2 + 1, pic1, xin * 2 + 1, 2) \ ) #define PIC221111_32(xin) \ ( \ CBCRCG(0, xin), \ PIC_32(xin / 4 * 8 + 0, (xin & 3) * 2 + 0, pic0, xin * 2 + 0), \ PIC_32(xin / 4 * 8 + 0, (xin & 3) * 2 + 1, pic0, xin * 2 + 1), \ PIC_32(xin / 4 * 8 + 1, (xin & 3) * 2 + 0, pic1, xin * 2 + 0), \ PIC_32(xin / 4 * 8 + 1, (xin & 3) * 2 + 1, pic1, xin * 2 + 1) \ ) static void col221111(int *out, unsigned char *pic, int width) { int i, j, k; unsigned char *pic0, *pic1; int *outy, *outc; int cr, cg, cb, y; pic0 = pic; pic1 = pic + width; outy = out; outc = out + 64 * 4; for (i = 2; i > 0; i--) { for (j = 4; j > 0; j--) { for (k = 0; k < 8; k++) { PIC221111(k); } outc += 8; outy += 16; pic0 += 2 * width; pic1 += 2 * width; } outy += 64 * 2 - 16 * 4; } } static void col221111_16(int *out, unsigned char *pic, int width) { int i, j, k; unsigned char *pic0, *pic1; int *outy, *outc; int cr, cg, cb, y; pic0 = pic; pic1 = pic + width; outy = out; outc = out + 64 * 4; for (i = 2; i > 0; i--) { for (j = 4; j > 0; j--) { for (k = 0; k < 8; k++) { PIC221111_16(k); } outc += 8; outy += 16; pic0 += 2 * width; pic1 += 2 * width; } outy += 64 * 2 - 16 * 4; } } static void col221111_32(int *out, unsigned char *pic, int width) { int i, j, k; unsigned char *pic0, *pic1; int *outy, *outc; int cr, cg, cb, y; pic0 = pic; pic1 = pic + width; outy = out; outc = out + 64 * 4; for (i = 2; i > 0; i--) { for (j = 4; j > 0; j--) { for (k = 0; k < 8; k++) { PIC221111_32(k); } outc += 8; outy += 16; pic0 += 2 * width; pic1 += 2 * width; } outy += 64 * 2 - 16 * 4; } } tinyvisor/bios/src/blockcmd.h0000644006644000001440000000462712172661303016550 0ustar yuichi_xyusers// Definitions for SCSI style command data blocks. #ifndef __BLOCKCMD_H #define __BLOCKCMD_H #include "types.h" // u8 #define CDB_CMD_READ_10 0x28 #define CDB_CMD_VERIFY_10 0x2f #define CDB_CMD_WRITE_10 0x2a struct cdb_rwdata_10 { u8 command; u8 flags; u32 lba; u8 resreved_06; u16 count; u8 reserved_09; u8 pad[6]; } PACKED; #define CDB_CMD_READ_CAPACITY 0x25 struct cdb_read_capacity { u8 command; u8 flags; u8 resreved_02[8]; u8 pad[6]; } PACKED; struct cdbres_read_capacity { u32 sectors; u32 blksize; } PACKED; #define CDB_CMD_TEST_UNIT_READY 0x00 #define CDB_CMD_INQUIRY 0x12 #define CDB_CMD_REQUEST_SENSE 0x03 struct cdb_request_sense { u8 command; u8 flags; u16 reserved_02; u8 length; u8 reserved_05; u8 pad[10]; } PACKED; struct cdbres_request_sense { u8 errcode; u8 segment; u8 flags; u32 info; u8 additional; u32 specific; u8 asc; u8 ascq; u32 reserved_0e; } PACKED; #define SCSI_TYPE_DISK 0x00 #define SCSI_TYPE_CDROM 0x05 struct cdbres_inquiry { u8 pdt; u8 removable; u8 reserved_02[2]; u8 additional; u8 reserved_05[3]; char vendor[8]; char product[16]; char rev[4]; } PACKED; #define CDB_CMD_MODE_SENSE 0x5A #define MODE_PAGE_HD_GEOMETRY 0x04 struct cdb_mode_sense { u8 command; u8 flags; u8 page; u32 reserved_03; u16 count; u8 reserved_09; u8 pad[6]; } PACKED; struct cdbres_mode_sense_geom { u8 unused_00[3]; u8 read_only; u32 unused_04; u8 page; u8 length; u8 cyl[3]; u8 heads; u8 precomp[3]; u8 reduced[3]; u16 step_rate; u8 landing[3]; u16 rpm; } PACKED; // blockcmd.c int cdb_is_read(u8 *cdbcmd, u16 blocksize); struct disk_op_s; int cdb_get_inquiry(struct disk_op_s *op, struct cdbres_inquiry *data); int cdb_get_sense(struct disk_op_s *op, struct cdbres_request_sense *data); int cdb_test_unit_ready(struct disk_op_s *op); int cdb_read_capacity(struct disk_op_s *op, struct cdbres_read_capacity *data); int cdb_mode_sense_geom(struct disk_op_s *op, struct cdbres_mode_sense_geom *data); int cdb_inquiry(struct disk_op_s *op, struct cdbres_inquiry *data); int cdb_read(struct disk_op_s *op); int cdb_write(struct disk_op_s *op); int scsi_is_ready(struct disk_op_s *op); struct drive_s; int scsi_drive_setup(struct drive_s *drive, const char *s, int prio); #endif // blockcmd.h tinyvisor/bios/src/serial.c0000644006644000001440000001567712172661303016253 0ustar yuichi_xyusers// 16bit code to handle serial and printer services. // // Copyright (C) 2008,2009 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "biosvar.h" // SET_BDA #include "util.h" // debug_enter #include "bregs.h" // struct bregs /**************************************************************** * COM ports ****************************************************************/ static u16 detect_serial(u16 port, u8 timeout, u8 count) { outb(0x02, port+SEROFF_IER); u8 ier = inb(port+SEROFF_IER); if (ier != 0x02) return 0; u8 iir = inb(port+SEROFF_IIR); if ((iir & 0x3f) != 0x02) return 0; outb(0x00, port+SEROFF_IER); SET_BDA(port_com[count], port); SET_BDA(com_timeout[count], timeout); return 1; } void serial_setup(void) { if (! CONFIG_SERIAL) return; dprintf(3, "init serial\n"); u16 count = 0; count += detect_serial(PORT_SERIAL1, 0x0a, count); count += detect_serial(PORT_SERIAL2, 0x0a, count); count += detect_serial(PORT_SERIAL3, 0x0a, count); count += detect_serial(PORT_SERIAL4, 0x0a, count); dprintf(1, "Found %d serial ports\n", count); // Equipment word bits 9..11 determing # serial ports set_equipment_flags(0xe00, count << 9); } static u16 getComAddr(struct bregs *regs) { if (regs->dx >= 4) { set_invalid(regs); return 0; } u16 addr = GET_BDA(port_com[regs->dx]); if (! addr) set_invalid(regs); return addr; } // SERIAL - INITIALIZE PORT static void handle_1400(struct bregs *regs) { u16 addr = getComAddr(regs); if (!addr) return; outb(inb(addr+SEROFF_LCR) | 0x80, addr+SEROFF_LCR); if ((regs->al & 0xE0) == 0) { outb(0x17, addr+SEROFF_DLL); outb(0x04, addr+SEROFF_DLH); } else { u16 val16 = 0x600 >> ((regs->al & 0xE0) >> 5); outb(val16 & 0xFF, addr+SEROFF_DLL); outb(val16 >> 8, addr+SEROFF_DLH); } outb(regs->al & 0x1F, addr+SEROFF_LCR); regs->ah = inb(addr+SEROFF_LSR); regs->al = inb(addr+SEROFF_MSR); set_success(regs); } // SERIAL - WRITE CHARACTER TO PORT static void handle_1401(struct bregs *regs) { u16 addr = getComAddr(regs); if (!addr) return; u32 end = calc_future_timer_ticks(GET_BDA(com_timeout[regs->dx])); for (;;) { u8 lsr = inb(addr+SEROFF_LSR); if ((lsr & 0x60) == 0x60) { // Success - can write data outb(regs->al, addr+SEROFF_DATA); // XXX - reread lsr? regs->ah = lsr; break; } if (check_timer(end)) { // Timed out - can't write data. regs->ah = lsr | 0x80; break; } yield(); } set_success(regs); } // SERIAL - READ CHARACTER FROM PORT static void handle_1402(struct bregs *regs) { u16 addr = getComAddr(regs); if (!addr) return; u32 end = calc_future_timer_ticks(GET_BDA(com_timeout[regs->dx])); for (;;) { u8 lsr = inb(addr+SEROFF_LSR); if (lsr & 0x01) { // Success - can read data regs->al = inb(addr+SEROFF_DATA); regs->ah = lsr; break; } if (check_timer(end)) { // Timed out - can't read data. regs->ah = lsr | 0x80; break; } yield(); } set_success(regs); } // SERIAL - GET PORT STATUS static void handle_1403(struct bregs *regs) { u16 addr = getComAddr(regs); if (!addr) return; regs->ah = inb(addr+SEROFF_LSR); regs->al = inb(addr+SEROFF_MSR); set_success(regs); } static void handle_14XX(struct bregs *regs) { set_unimplemented(regs); } // INT 14h Serial Communications Service Entry Point void VISIBLE16 handle_14(struct bregs *regs) { debug_enter(regs, DEBUG_HDL_14); if (! CONFIG_SERIAL) { handle_14XX(regs); return; } switch (regs->ah) { case 0x00: handle_1400(regs); break; case 0x01: handle_1401(regs); break; case 0x02: handle_1402(regs); break; case 0x03: handle_1403(regs); break; default: handle_14XX(regs); break; } } // XXX - Baud Rate Generator Table u8 BaudTable[16] VAR16FIXED(0xe729); /**************************************************************** * LPT ports ****************************************************************/ static u16 detect_parport(u16 port, u8 timeout, u8 count) { // clear input mode outb(inb(port+2) & 0xdf, port+2); outb(0xaa, port); if (inb(port) != 0xaa) // Not present return 0; SET_BDA(port_lpt[count], port); SET_BDA(lpt_timeout[count], timeout); return 1; } void lpt_setup(void) { if (! CONFIG_LPT) return; dprintf(3, "init lpt\n"); u16 count = 0; count += detect_parport(PORT_LPT1, 0x14, count); count += detect_parport(PORT_LPT2, 0x14, count); dprintf(1, "Found %d lpt ports\n", count); // Equipment word bits 14..15 determing # parallel ports set_equipment_flags(0xc000, count << 14); } static u16 getLptAddr(struct bregs *regs) { if (regs->dx >= 3) { set_invalid(regs); return 0; } u16 addr = GET_BDA(port_lpt[regs->dx]); if (! addr) set_invalid(regs); return addr; } // INT 17 - PRINTER - WRITE CHARACTER static void handle_1700(struct bregs *regs) { u16 addr = getLptAddr(regs); if (!addr) return; u32 end = calc_future_timer_ticks(GET_BDA(lpt_timeout[regs->dx])); outb(regs->al, addr); u8 val8 = inb(addr+2); outb(val8 | 0x01, addr+2); // send strobe udelay(5); outb(val8 & ~0x01, addr+2); for (;;) { u8 v = inb(addr+1); if (!(v & 0x40)) { // Success regs->ah = v ^ 0x48; break; } if (check_timer(end)) { // Timeout regs->ah = (v ^ 0x48) | 0x01; break; } yield(); } set_success(regs); } // INT 17 - PRINTER - INITIALIZE PORT static void handle_1701(struct bregs *regs) { u16 addr = getLptAddr(regs); if (!addr) return; u8 val8 = inb(addr+2); outb(val8 & ~0x04, addr+2); // send init udelay(5); outb(val8 | 0x04, addr+2); regs->ah = inb(addr+1) ^ 0x48; set_success(regs); } // INT 17 - PRINTER - GET STATUS static void handle_1702(struct bregs *regs) { u16 addr = getLptAddr(regs); if (!addr) return; regs->ah = inb(addr+1) ^ 0x48; set_success(regs); } static void handle_17XX(struct bregs *regs) { set_unimplemented(regs); } // INT17h : Printer Service Entry Point void VISIBLE16 handle_17(struct bregs *regs) { debug_enter(regs, DEBUG_HDL_17); if (! CONFIG_LPT) { handle_17XX(regs); return; } switch (regs->ah) { case 0x00: handle_1700(regs); break; case 0x01: handle_1701(regs); break; case 0x02: handle_1702(regs); break; default: handle_17XX(regs); break; } } tinyvisor/bios/src/smp.c0000644006644000001440000000735112172661303015561 0ustar yuichi_xyusers// CPU count detection // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2006 Fabrice Bellard // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "config.h" // CONFIG_* #include "cmos.h" // CMOS_BIOS_SMP_COUNT #define APIC_ICR_LOW ((u8*)BUILD_APIC_ADDR + 0x300) #define APIC_SVR ((u8*)BUILD_APIC_ADDR + 0x0F0) #define APIC_LINT0 ((u8*)BUILD_APIC_ADDR + 0x350) #define APIC_LINT1 ((u8*)BUILD_APIC_ADDR + 0x360) #define APIC_ENABLED 0x0100 struct { u32 ecx, eax, edx; } smp_mtrr[32] VARFSEG; u32 smp_mtrr_count VARFSEG; void wrmsr_smp(u32 index, u64 val) { wrmsr(index, val); if (smp_mtrr_count >= ARRAY_SIZE(smp_mtrr)) { warn_noalloc(); return; } smp_mtrr[smp_mtrr_count].ecx = index; smp_mtrr[smp_mtrr_count].eax = val; smp_mtrr[smp_mtrr_count].edx = val >> 32; smp_mtrr_count++; } u32 CountCPUs VARFSEG; u32 MaxCountCPUs VARFSEG; // 256 bits for the found APIC IDs u32 FoundAPICIDs[256/32] VARFSEG; extern void smp_ap_boot_code(void); ASM16( " .global smp_ap_boot_code\n" "smp_ap_boot_code:\n" // Setup data segment " movw $" __stringify(SEG_BIOS) ", %ax\n" " movw %ax, %ds\n" // MTRR setup " movl $smp_mtrr, %esi\n" " movl smp_mtrr_count, %ebx\n" "1:testl %ebx, %ebx\n" " jz 2f\n" " movl 0(%esi), %ecx\n" " movl 4(%esi), %eax\n" " movl 8(%esi), %edx\n" " wrmsr\n" " addl $12, %esi\n" " decl %ebx\n" " jmp 1b\n" "2:\n" // get apic ID on EBX, set bit on FoundAPICIDs " movl $1, %eax\n" " cpuid\n" " shrl $24, %ebx\n" " lock btsl %ebx, FoundAPICIDs\n" // Increment the cpu counter " lock incl CountCPUs\n" // Halt the processor. "1:hlt\n" " jmp 1b\n" ); int apic_id_is_present(u8 apic_id) { return !!(FoundAPICIDs[apic_id/32] & (1ul << (apic_id % 32))); } // find and initialize the CPUs by launching a SIPI to them void smp_setup(void) { if (!CONFIG_QEMU) return; ASSERT32FLAT(); u32 eax, ebx, ecx, cpuid_features; cpuid(1, &eax, &ebx, &ecx, &cpuid_features); if (eax < 1 || !(cpuid_features & CPUID_APIC)) { // No apic - only the main cpu is present. dprintf(1, "No apic - only the main cpu is present.\n"); CountCPUs= 1; MaxCountCPUs = 1; return; } // mark the BSP initial APIC ID as found, too: u8 apic_id = ebx>>24; FoundAPICIDs[apic_id/32] |= (1 << (apic_id % 32)); // Init the counter. writel(&CountCPUs, 1); // Setup jump trampoline to counter code. u64 old = *(u64*)BUILD_AP_BOOT_ADDR; // ljmpw $SEG_BIOS, $(smp_ap_boot_code - BUILD_BIOS_ADDR) u64 new = (0xea | ((u64)SEG_BIOS<<24) | (((u32)smp_ap_boot_code - BUILD_BIOS_ADDR) << 8)); *(u64*)BUILD_AP_BOOT_ADDR = new; // enable local APIC u32 val = readl(APIC_SVR); writel(APIC_SVR, val | APIC_ENABLED); /* Set LINT0 as Ext_INT, level triggered */ writel(APIC_LINT0, 0x8700); /* Set LINT1 as NMI, level triggered */ writel(APIC_LINT1, 0x8400); // broadcast SIPI barrier(); writel(APIC_ICR_LOW, 0x000C4500); u32 sipi_vector = BUILD_AP_BOOT_ADDR >> 12; writel(APIC_ICR_LOW, 0x000C4600 | sipi_vector); // Wait for other CPUs to process the SIPI. u8 cmos_smp_count = inb_cmos(CMOS_BIOS_SMP_COUNT); while (cmos_smp_count + 1 != readl(&CountCPUs)) yield(); // Restore memory. *(u64*)BUILD_AP_BOOT_ADDR = old; MaxCountCPUs = romfile_loadint("etc/max-cpus", 0); if (!MaxCountCPUs || MaxCountCPUs < CountCPUs) MaxCountCPUs = CountCPUs; dprintf(1, "Found %d cpu(s) max supported %d cpu(s)\n", readl(&CountCPUs), MaxCountCPUs); } tinyvisor/bios/src/esp-scsi.h0000644006644000001440000000027512172661303016513 0ustar yuichi_xyusers#ifndef __ESP_SCSI_H #define __ESP_SCSI_H struct disk_op_s; int esp_scsi_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize); void esp_scsi_setup(void); #endif /* __ESP_SCSI_H */ tinyvisor/bios/src/virtio-scsi.c0000644006644000001440000001131312172661303017226 0ustar yuichi_xyusers// Virtio SCSI boot support. // // Copyright (C) 2012 Red Hat Inc. // // Authors: // Paolo Bonzini // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "pci.h" // foreachpci #include "config.h" // CONFIG_* #include "biosvar.h" // GET_GLOBAL #include "pci_ids.h" // PCI_DEVICE_ID_VIRTIO_BLK #include "pci_regs.h" // PCI_VENDOR_ID #include "boot.h" // bootprio_find_scsi_device #include "blockcmd.h" // scsi_drive_setup #include "virtio-pci.h" #include "virtio-ring.h" #include "virtio-scsi.h" #include "disk.h" struct virtio_lun_s { struct drive_s drive; struct pci_device *pci; struct vring_virtqueue *vq; u16 ioaddr; u16 target; u16 lun; }; static int virtio_scsi_cmd(u16 ioaddr, struct vring_virtqueue *vq, struct disk_op_s *op, void *cdbcmd, u16 target, u16 lun, u16 blocksize) { struct virtio_scsi_req_cmd req; struct virtio_scsi_resp_cmd resp; struct vring_list sg[3]; memset(&req, 0, sizeof(req)); req.lun[0] = 1; req.lun[1] = target; req.lun[2] = (lun >> 8) | 0x40; req.lun[3] = (lun & 0xff); memcpy(req.cdb, cdbcmd, 16); u32 len = op->count * blocksize; int datain = cdb_is_read(cdbcmd, blocksize); int in_num = (datain ? 2 : 1); int out_num = (len ? 3 : 2) - in_num; sg[0].addr = MAKE_FLATPTR(GET_SEG(SS), &req); sg[0].length = sizeof(req); sg[out_num].addr = MAKE_FLATPTR(GET_SEG(SS), &resp); sg[out_num].length = sizeof(resp); if (len) { int data_idx = (datain ? 2 : 1); sg[data_idx].addr = op->buf_fl; sg[data_idx].length = len; } /* Add to virtqueue and kick host */ vring_add_buf(vq, sg, out_num, in_num, 0, 0); vring_kick(ioaddr, vq, 1); /* Wait for reply */ while (!vring_more_used(vq)) usleep(5); /* Reclaim virtqueue element */ vring_get_buf(vq, NULL); /* Clear interrupt status register. Avoid leaving interrupts stuck if * VRING_AVAIL_F_NO_INTERRUPT was ignored and interrupts were raised. */ vp_get_isr(ioaddr); if (resp.response == VIRTIO_SCSI_S_OK && resp.status == 0) { return DISK_RET_SUCCESS; } return DISK_RET_EBADTRACK; } int virtio_scsi_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize) { struct virtio_lun_s *vlun = container_of(op->drive_g, struct virtio_lun_s, drive); return virtio_scsi_cmd(GET_GLOBAL(vlun->ioaddr), GET_GLOBAL(vlun->vq), op, cdbcmd, GET_GLOBAL(vlun->target), GET_GLOBAL(vlun->lun), blocksize); } static int virtio_scsi_add_lun(struct pci_device *pci, u16 ioaddr, struct vring_virtqueue *vq, u16 target, u16 lun) { struct virtio_lun_s *vlun = malloc_fseg(sizeof(*vlun)); if (!vlun) { warn_noalloc(); return -1; } memset(vlun, 0, sizeof(*vlun)); vlun->drive.type = DTYPE_VIRTIO_SCSI; vlun->drive.cntl_id = pci->bdf; vlun->pci = pci; vlun->ioaddr = ioaddr; vlun->vq = vq; vlun->target = target; vlun->lun = lun; int prio = bootprio_find_scsi_device(pci, target, lun); int ret = scsi_drive_setup(&vlun->drive, "virtio-scsi", prio); if (ret) goto fail; return 0; fail: free(vlun); return -1; } static int virtio_scsi_scan_target(struct pci_device *pci, u16 ioaddr, struct vring_virtqueue *vq, u16 target) { /* TODO: send REPORT LUNS. For now, only LUN 0 is recognized. */ int ret = virtio_scsi_add_lun(pci, ioaddr, vq, target, 0); return ret < 0 ? 0 : 1; } static void init_virtio_scsi(struct pci_device *pci) { u16 bdf = pci->bdf; dprintf(1, "found virtio-scsi at %x:%x\n", pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf)); struct vring_virtqueue *vq = NULL; u16 ioaddr = vp_init_simple(bdf); if (vp_find_vq(ioaddr, 2, &vq) < 0 ) { dprintf(1, "fail to find vq for virtio-scsi %x:%x\n", pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf)); goto fail; } vp_set_status(ioaddr, VIRTIO_CONFIG_S_ACKNOWLEDGE | VIRTIO_CONFIG_S_DRIVER | VIRTIO_CONFIG_S_DRIVER_OK); int i, tot; for (tot = 0, i = 0; i < 256; i++) tot += virtio_scsi_scan_target(pci, ioaddr, vq, i); if (!tot) goto fail; return; fail: free(vq); } void virtio_scsi_setup(void) { ASSERT32FLAT(); if (! CONFIG_VIRTIO_SCSI) return; dprintf(3, "init virtio-scsi\n"); struct pci_device *pci; foreachpci(pci) { if (pci->vendor != PCI_VENDOR_ID_REDHAT_QUMRANET || pci->device != PCI_DEVICE_ID_VIRTIO_SCSI) continue; init_virtio_scsi(pci); } } tinyvisor/bios/src/usb-msc.h0000644006644000001440000000034512172661303016334 0ustar yuichi_xyusers#ifndef __USB_MSC_H #define __USB_MSC_H // usb-msc.c struct disk_op_s; int usb_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize); struct usbdevice_s; int usb_msc_setup(struct usbdevice_s *usbdev); #endif // ush-msc.h tinyvisor/bios/src/usb-hub.h0000644006644000001440000000366112172661303016334 0ustar yuichi_xyusers#ifndef __USB_HUB_H #define __USB_HUB_H // usb-hub.c struct usbdevice_s; int usb_hub_setup(struct usbdevice_s *usbdev); /**************************************************************** * hub flags ****************************************************************/ #define USB_DT_HUB (USB_TYPE_CLASS | 0x09) struct usb_hub_descriptor { u8 bDescLength; u8 bDescriptorType; u8 bNbrPorts; u16 wHubCharacteristics; u8 bPwrOn2PwrGood; u8 bHubContrCurrent; // Variable length fields for DeviceRemovable[], PortPwrCtrlMask[] follow. } PACKED; #define USB_PORT_FEAT_CONNECTION 0 #define USB_PORT_FEAT_ENABLE 1 #define USB_PORT_FEAT_SUSPEND 2 #define USB_PORT_FEAT_OVER_CURRENT 3 #define USB_PORT_FEAT_RESET 4 #define USB_PORT_FEAT_POWER 8 #define USB_PORT_FEAT_LOWSPEED 9 #define USB_PORT_FEAT_C_CONNECTION 16 #define USB_PORT_FEAT_C_ENABLE 17 #define USB_PORT_FEAT_C_SUSPEND 18 #define USB_PORT_FEAT_C_OVER_CURRENT 19 #define USB_PORT_FEAT_C_RESET 20 #define USB_PORT_FEAT_TEST 21 #define USB_PORT_FEAT_INDICATOR 22 #define USB_PORT_FEAT_C_PORT_L1 23 struct usb_port_status { u16 wPortStatus; u16 wPortChange; } PACKED; #define USB_PORT_STAT_CONNECTION 0x0001 #define USB_PORT_STAT_ENABLE 0x0002 #define USB_PORT_STAT_SUSPEND 0x0004 #define USB_PORT_STAT_OVERCURRENT 0x0008 #define USB_PORT_STAT_RESET 0x0010 #define USB_PORT_STAT_L1 0x0020 #define USB_PORT_STAT_POWER 0x0100 #define USB_PORT_STAT_SPEED_SHIFT 9 #define USB_PORT_STAT_SPEED_MASK (0x3 << USB_PORT_STAT_SPEED_SHIFT) #define USB_PORT_STAT_LOW_SPEED 0x0200 #define USB_PORT_STAT_HIGH_SPEED 0x0400 #define USB_PORT_STAT_TEST 0x0800 #define USB_PORT_STAT_INDICATOR 0x1000 #endif // ush-hid.h tinyvisor/bios/src/csm.h0000644006644000001440000000055012172661303015543 0ustar yuichi_xyusers#ifndef __CSM_H #define __CSM_H #include "types.h" #include "pci.h" #define UINT8 u8 #define UINT16 u16 #define UINT32 u32 // csm.c int csm_bootprio_fdc(struct pci_device *pci, int port, int fdid); int csm_bootprio_ata(struct pci_device *pci, int chanid, int slave); int csm_bootprio_pci(struct pci_device *pci); #include "LegacyBios.h" #endif // __CSM_H tinyvisor/bios/src/megasas.h0000644006644000001440000000027012172661303016400 0ustar yuichi_xyusers#ifndef __MEGASAS_H #define __MEGASAS_H struct disk_op_s; int megasas_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize); void megasas_setup(void); #endif /* __MEGASAS_H */ tinyvisor/bios/src/usb-ohci.h0000644006644000001440000000717412172661303016503 0ustar yuichi_xyusers#ifndef __USB_OHCI_H #define __USB_OHCI_H // usb-ohci.c void ohci_setup(struct pci_device *pci, int busid); struct usbdevice_s; struct usb_endpoint_descriptor; struct usb_pipe *ohci_alloc_pipe(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc); struct usb_pipe; int ohci_control(struct usb_pipe *p, int dir, const void *cmd, int cmdsize , void *data, int datasize); int ohci_send_bulk(struct usb_pipe *p, int dir, void *data, int datasize); int ohci_poll_intr(struct usb_pipe *p, void *data); /**************************************************************** * ohci structs and flags ****************************************************************/ struct ohci_ed { u32 hwINFO; u32 hwTailP; u32 hwHeadP; u32 hwNextED; } PACKED; #define ED_ISO (1 << 15) #define ED_SKIP (1 << 14) #define ED_LOWSPEED (1 << 13) #define ED_OUT (0x01 << 11) #define ED_IN (0x02 << 11) #define ED_C (0x02) #define ED_H (0x01) struct ohci_td { u32 hwINFO; u32 hwCBP; u32 hwNextTD; u32 hwBE; } PACKED; #define TD_CC 0xf0000000 #define TD_CC_GET(td_p) ((td_p >>28) & 0x0f) #define TD_DI 0x00E00000 #define TD_DONE 0x00020000 #define TD_ISO 0x00010000 #define TD_EC 0x0C000000 #define TD_T 0x03000000 #define TD_T_DATA0 0x02000000 #define TD_T_DATA1 0x03000000 #define TD_T_TOGGLE 0x00000000 #define TD_DP 0x00180000 #define TD_DP_SETUP 0x00000000 #define TD_DP_IN 0x00100000 #define TD_DP_OUT 0x00080000 #define TD_R 0x00040000 struct ohci_hcca { u32 int_table[32]; u32 frame_no; u32 done_head; u8 reserved[120]; } PACKED; struct ohci_regs { u32 revision; u32 control; u32 cmdstatus; u32 intrstatus; u32 intrenable; u32 intrdisable; u32 hcca; u32 ed_periodcurrent; u32 ed_controlhead; u32 ed_controlcurrent; u32 ed_bulkhead; u32 ed_bulkcurrent; u32 donehead; u32 fminterval; u32 fmremaining; u32 fmnumber; u32 periodicstart; u32 lsthresh; u32 roothub_a; u32 roothub_b; u32 roothub_status; u32 roothub_portstatus[15]; } PACKED; #define OHCI_CTRL_CBSR (3 << 0) #define OHCI_CTRL_PLE (1 << 2) #define OHCI_CTRL_CLE (1 << 4) #define OHCI_CTRL_BLE (1 << 5) #define OHCI_CTRL_HCFS (3 << 6) # define OHCI_USB_RESET (0 << 6) # define OHCI_USB_OPER (2 << 6) #define OHCI_CTRL_RWC (1 << 9) #define OHCI_HCR (1 << 0) #define OHCI_CLF (1 << 1) #define OHCI_INTR_MIE (1 << 31) #define RH_PS_CCS 0x00000001 #define RH_PS_PES 0x00000002 #define RH_PS_PSS 0x00000004 #define RH_PS_POCI 0x00000008 #define RH_PS_PRS 0x00000010 #define RH_PS_PPS 0x00000100 #define RH_PS_LSDA 0x00000200 #define RH_PS_CSC 0x00010000 #define RH_PS_PESC 0x00020000 #define RH_PS_PSSC 0x00040000 #define RH_PS_OCIC 0x00080000 #define RH_PS_PRSC 0x00100000 #define RH_HS_LPS 0x00000001 #define RH_HS_OCI 0x00000002 #define RH_HS_DRWE 0x00008000 #define RH_HS_LPSC 0x00010000 #define RH_HS_OCIC 0x00020000 #define RH_HS_CRWE 0x80000000 #define RH_B_DR 0x0000ffff #define RH_B_PPCM 0xffff0000 #define RH_A_NDP (0xff << 0) #define RH_A_PSM (1 << 8) #define RH_A_NPS (1 << 9) #define RH_A_DT (1 << 10) #define RH_A_OCPM (1 << 11) #define RH_A_NOCP (1 << 12) #define RH_A_POTPGT (0xff << 24) #endif // usb-ohci.h tinyvisor/bios/src/apm.c0000644006644000001440000001151012174763154015540 0ustar yuichi_xyusers// Basic support for apmbios callbacks. // // Copyright (C) 2008 Kevin O'Connor // Copyright (C) 2005 Struan Bartlett // Copyright (C) 2004 Fabrice Bellard // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "bregs.h" // struct bregs #include "ioport.h" // outb #include "util.h" // dprintf #include "config.h" // CONFIG_* #include "biosvar.h" // GET_GLOBAL #include "paravirt.h" // runningOnQEMU static void out_str(const char *str_cs) { if (!runningOnQEMU()) { dprintf(1, "APM request '%s'\n", str_cs); return; } if (CONFIG_DISABLE_APM_PORT) { return; } u8 *s = (u8*)str_cs; for (;;) { u8 c = GET_GLOBAL(*s); if (!c) break; outb(c, PORT_BIOS_APM); s++; } } // APM installation check static void handle_155300(struct bregs *regs) { regs->ah = 1; // APM major version regs->al = 2; // APM minor version regs->bh = 'P'; regs->bl = 'M'; // bit 0 : 16 bit interface supported // bit 1 : 32 bit interface supported regs->cx = 0x03; set_success(regs); } // APM real mode interface connect static void handle_155301(struct bregs *regs) { set_success(regs); } // Assembler entry points defined in romlayout.S extern void entry_apm16(void); extern void entry_apm32(void); // APM 16 bit protected mode interface connect static void handle_155302(struct bregs *regs) { regs->bx = (u32)entry_apm16; regs->ax = SEG_BIOS; // 16 bit code segment base regs->si = 0xfff0; // 16 bit code segment size regs->cx = SEG_BIOS; // data segment address regs->di = 0xfff0; // data segment length set_success(regs); } // APM 32 bit protected mode interface connect static void handle_155303(struct bregs *regs) { regs->ax = SEG_BIOS; // 32 bit code segment base regs->ebx = (u32)entry_apm32; regs->cx = SEG_BIOS; // 16 bit code segment base // 32 bit code segment size (low 16 bits) // 16 bit code segment size (high 16 bits) regs->esi = 0xfff0fff0; regs->dx = SEG_BIOS; // data segment address regs->di = 0xfff0; // data segment length set_success(regs); } // APM interface disconnect static void handle_155304(struct bregs *regs) { set_success(regs); } // APM cpu idle static void handle_155305(struct bregs *regs) { yield_toirq(); set_success(regs); } // APM cpu busy static void handle_155306(struct bregs *regs) { set_success(regs); } void apm_shutdown(void) { irq_disable(); out_str("Shutdown"); for (;;) hlt(); } // APM Set Power State static void handle_155307(struct bregs *regs) { if (regs->bx != 1) { set_success(regs); return; } switch (regs->cx) { case 1: out_str("Standby"); break; case 2: out_str("Suspend"); break; case 3: apm_shutdown(); break; } set_success(regs); } static void handle_155308(struct bregs *regs) { set_success(regs); } // Get Power Status static void handle_15530a(struct bregs *regs) { regs->bh = 0x01; // on line regs->bl = 0xff; // unknown battery status regs->ch = 0x80; // no system battery regs->cl = 0xff; // unknown remaining time regs->dx = 0xffff; // unknown remaining time regs->si = 0x00; // zero battery set_success(regs); } #define RET_ENOEVENT 0x80 // Get PM Event static void handle_15530b(struct bregs *regs) { set_code_invalid_silent(regs, RET_ENOEVENT); } // APM Driver Version static void handle_15530e(struct bregs *regs) { regs->ah = 1; regs->al = 2; set_success(regs); } // APM Engage / Disengage static void handle_15530f(struct bregs *regs) { set_success(regs); } // APM Get Capabilities static void handle_155310(struct bregs *regs) { regs->bl = 0; regs->cx = 0; set_success(regs); } static void handle_1553XX(struct bregs *regs) { set_unimplemented(regs); } void handle_1553(struct bregs *regs) { if (! CONFIG_APMBIOS) { set_code_invalid(regs, RET_EUNSUPPORTED); return; } //debug_stub(regs); switch (regs->al) { case 0x00: handle_155300(regs); break; case 0x01: handle_155301(regs); break; case 0x02: handle_155302(regs); break; case 0x03: handle_155303(regs); break; case 0x04: handle_155304(regs); break; case 0x05: handle_155305(regs); break; case 0x06: handle_155306(regs); break; case 0x07: handle_155307(regs); break; case 0x08: handle_155308(regs); break; case 0x0a: handle_15530a(regs); break; case 0x0b: handle_15530b(regs); break; case 0x0e: handle_15530e(regs); break; case 0x0f: handle_15530f(regs); break; case 0x10: handle_155310(regs); break; default: handle_1553XX(regs); break; } } void VISIBLE16 VISIBLE32SEG handle_apm(struct bregs *regs) { debug_enter(regs, DEBUG_HDL_apm); handle_1553(regs); } tinyvisor/bios/src/post.c0000644006644000001440000002065512172661303015751 0ustar yuichi_xyusers// 32bit code to Power On Self Test (POST) a machine. // // Copyright (C) 2008-2013 Kevin O'Connor // Copyright (C) 2002 MandrakeSoft S.A. // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "config.h" // CONFIG_* #include "cmos.h" // CMOS_* #include "util.h" // memset #include "biosvar.h" // struct bios_data_area_s #include "disk.h" // floppy_setup #include "ata.h" // ata_setup #include "ahci.h" // ahci_setup #include "memmap.h" // add_e820 #include "pic.h" // pic_setup #include "bregs.h" // struct bregs #include "boot.h" // boot_init #include "usb.h" // usb_setup #include "paravirt.h" // qemu_cfg_preinit #include "xen.h" // xen_preinit #include "ps2port.h" // ps2port_setup #include "virtio-blk.h" // virtio_blk_setup #include "virtio-scsi.h" // virtio_scsi_setup #include "lsi-scsi.h" // lsi_scsi_setup #include "esp-scsi.h" // esp_scsi_setup #include "megasas.h" // megasas_setup #include "post.h" // interface_init /**************************************************************** * BIOS initialization and hardware setup ****************************************************************/ static void ivt_init(void) { dprintf(3, "init ivt\n"); // Setup reset-vector entry point (controls legacy reboots). HaveRunPost = 1; outb_cmos(0, CMOS_RESET_CODE); // Initialize all vectors to the default handler. int i; for (i=0; i<256; i++) SET_IVT(i, FUNC16(entry_iret_official)); // Initialize all hw vectors to a default hw handler. for (i=BIOS_HWIRQ0_VECTOR; isize = esize; add_e820((u32)MAKE_FLATPTR(ebda_seg, 0), GET_EBDA(ebda_seg, size) * 1024 , E820_RESERVED); // Init extra stack StackPos = (void*)(&ExtraStack[BUILD_EXTRA_STACK_SIZE] - zonelow_base); } void interface_init(void) { // Running at new code address - do code relocation fixups malloc_init(); // Setup romfile items. qemu_cfg_init(); coreboot_cbfs_init(); // Setup ivt/bda/ebda ivt_init(); bda_init(); // Other interfaces boot_init(); bios32_init(); pmm_init(); pnp_init(); kbd_init(); mouse_init(); } // Initialize hardware devices void device_hardware_setup(void) { usb_setup(); ps2port_setup(); lpt_setup(); serial_setup(); floppy_setup(); ata_setup(); ahci_setup(); cbfs_payload_setup(); ramdisk_setup(); virtio_blk_setup(); virtio_scsi_setup(); lsi_scsi_setup(); esp_scsi_setup(); megasas_setup(); } static void platform_hardware_setup(void) { // Enable CPU caching setcr0(getcr0() & ~(CR0_CD|CR0_NW)); // Make sure legacy DMA isn't running. dma_setup(); // Init base pc hardware. pic_setup(); mathcp_setup(); timer_setup(); // Platform specific setup qemu_platform_setup(); coreboot_platform_setup(); } void prepareboot(void) { // Run BCVs bcv_prepboot(); // Finalize data structures before boot cdrom_prepboot(); pmm_prepboot(); malloc_prepboot(); memmap_prepboot(); // Setup bios checksum. BiosChecksum -= checksum((u8*)BUILD_BIOS_ADDR, BUILD_BIOS_SIZE); } // Begin the boot process by invoking an int0x19 in 16bit mode. void VISIBLE32FLAT startBoot(void) { // Clear low-memory allocations (required by PMM spec). memset((void*)BUILD_STACK_ADDR, 0, BUILD_EBDA_MINIMUM - BUILD_STACK_ADDR); dprintf(3, "Jump to int19\n"); struct bregs br; memset(&br, 0, sizeof(br)); br.flags = F_IF; call16_int(0x19, &br); } // Main setup code. static void maininit(void) { // Initialize internal interfaces. interface_init(); // Setup platform devices. platform_hardware_setup(); // Start hardware initialization (if optionrom threading) if (CONFIG_THREAD_OPTIONROMS) device_hardware_setup(); // Run vga option rom vgarom_setup(); // Do hardware initialization (if running synchronously) if (!CONFIG_THREAD_OPTIONROMS) { device_hardware_setup(); wait_threads(); } // Run option roms optionrom_setup(); // Allow user to modify overall boot order. interactive_bootmenu(); wait_threads(); // Prepare for boot. prepareboot(); // Write protect bios memory. make_bios_readonly(); // Invoke int 19 to start boot process. startBoot(); } /**************************************************************** * POST entry and code relocation ****************************************************************/ // Update given relocs for the code at 'dest' with a given 'delta' static void updateRelocs(void *dest, u32 *rstart, u32 *rend, u32 delta) { u32 *reloc; for (reloc = rstart; reloc < rend; reloc++) *((u32*)(dest + *reloc)) += delta; } // Relocate init code and then call a function at its new address. // The passed function should be in the "init" section and must not // return. void __noreturn reloc_preinit(void *f, void *arg) { void (*func)(void *) __noreturn = f; if (!CONFIG_RELOCATE_INIT) func(arg); // Symbols populated by the build. extern u8 code32flat_start[]; extern u8 _reloc_min_align; extern u32 _reloc_abs_start[], _reloc_abs_end[]; extern u32 _reloc_rel_start[], _reloc_rel_end[]; extern u32 _reloc_init_start[], _reloc_init_end[]; extern u8 code32init_start[], code32init_end[]; // Allocate space for init code. u32 initsize = code32init_end - code32init_start; u32 codealign = (u32)&_reloc_min_align; void *codedest = memalign_tmp(codealign, initsize); if (!codedest) panic("No space for init relocation.\n"); // Copy code and update relocs (init absolute, init relative, and runtime) dprintf(1, "Relocating init from %p to %p (size %d)\n" , code32init_start, codedest, initsize); s32 delta = codedest - (void*)code32init_start; memcpy(codedest, code32init_start, initsize); updateRelocs(codedest, _reloc_abs_start, _reloc_abs_end, delta); updateRelocs(codedest, _reloc_rel_start, _reloc_rel_end, -delta); updateRelocs(code32flat_start, _reloc_init_start, _reloc_init_end, delta); if (f >= (void*)code32init_start && f < (void*)code32init_end) func = f + delta; // Call function in relocated code. barrier(); func(arg); } // Setup for code relocation and then relocate. void VISIBLE32INIT dopost(void) { // Detect ram and setup internal malloc. qemu_preinit(); coreboot_preinit(); malloc_preinit(); // Relocate initialization code and call maininit(). reloc_preinit(maininit, NULL); } // Entry point for Power On Self Test (POST) - the BIOS initilization // phase. This function makes the memory at 0xc0000-0xfffff // read/writable and then calls dopost(). void VISIBLE32FLAT handle_post(void) { if (!CONFIG_QEMU && !CONFIG_COREBOOT) return; debug_serial_preinit(); dprintf(1, "Start bios (version %s)\n", VERSION); // Check if we are running under Xen. xen_preinit(); // Allow writes to modify bios area (0xf0000) make_bios_writable(); // Now that memory is read/writable - start post process. dopost(); } tinyvisor/bios/src/LegacyBios.h0000644006644000001440000010024212172661303017001 0ustar yuichi_xyusers/** @file The EFI Legacy BIOS Protocol is used to abstract legacy Option ROM usage under EFI and Legacy OS boot. This file also includes all the related COMPATIBILIY16 structures and defintions. Note: The names for EFI_IA32_REGISTER_SET elements were picked to follow well known naming conventions. Thunk is the code that switches from 32-bit protected environment into the 16-bit real-mode environment. Reverse thunk is the code that does the opposite. Copyright (c) 2007 - 2010, Intel Corporation. All rights reserved.
This program and the accompanying materials are licensed and made available under the terms and conditions of the BSD License that accompanies this distribution. The full text of the license may be found at http://opensource.org/licenses/bsd-license.php. THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. @par Revision Reference: This protocol is defined in Framework for EFI Compatibility Support Module spec Version 0.97. **/ #ifndef _EFI_LEGACY_BIOS_H_ #define _EFI_LEGACY_BIOS_H_ /// /// /// #pragma pack(1) typedef UINT8 SERIAL_MODE; typedef UINT8 PARALLEL_MODE; #define EFI_COMPATIBILITY16_TABLE_SIGNATURE SIGNATURE_32 ('I', 'F', 'E', '$') /// /// There is a table located within the traditional BIOS in either the 0xF000:xxxx or 0xE000:xxxx /// physical address range. It is located on a 16-byte boundary and provides the physical address of the /// entry point for the Compatibility16 functions. These functions provide the platform-specific /// information that is required by the generic EfiCompatibility code. The functions are invoked via /// thunking by using EFI_LEGACY_BIOS_PROTOCOL.FarCall86() with the 32-bit physical /// entry point. /// typedef struct { /// /// The string "$EFI" denotes the start of the EfiCompatibility table. Byte 0 is "I," byte /// 1 is "F," byte 2 is "E," and byte 3 is "$" and is normally accessed as a DWORD or UINT32. /// UINT32 Signature; /// /// The value required such that byte checksum of TableLength equals zero. /// UINT8 TableChecksum; /// /// The length of this table. /// UINT8 TableLength; /// /// The major EFI revision for which this table was generated. /// UINT8 EfiMajorRevision; /// /// The minor EFI revision for which this table was generated. /// UINT8 EfiMinorRevision; /// /// The major revision of this table. /// UINT8 TableMajorRevision; /// /// The minor revision of this table. /// UINT8 TableMinorRevision; /// /// Reserved for future usage. /// UINT16 Reserved; /// /// The segment of the entry point within the traditional BIOS for Compatibility16 functions. /// UINT16 Compatibility16CallSegment; /// /// The offset of the entry point within the traditional BIOS for Compatibility16 functions. /// UINT16 Compatibility16CallOffset; /// /// The segment of the entry point within the traditional BIOS for EfiCompatibility /// to invoke the PnP installation check. /// UINT16 PnPInstallationCheckSegment; /// /// The Offset of the entry point within the traditional BIOS for EfiCompatibility /// to invoke the PnP installation check. /// UINT16 PnPInstallationCheckOffset; /// /// EFI system resources table. Type EFI_SYSTEM_TABLE is defined in the IntelPlatform ///Innovation Framework for EFI Driver Execution Environment Core Interface Specification (DXE CIS). /// UINT32 EfiSystemTable; /// /// The address of an OEM-provided identifier string. The string is null terminated. /// UINT32 OemIdStringPointer; /// /// The 32-bit physical address where ACPI RSD PTR is stored within the traditional /// BIOS. The remained of the ACPI tables are located at their EFI addresses. The size /// reserved is the maximum for ACPI 2.0. The EfiCompatibility will fill in the ACPI /// RSD PTR with either the ACPI 1.0b or 2.0 values. /// UINT32 AcpiRsdPtrPointer; /// /// The OEM revision number. Usage is undefined but provided for OEM module usage. /// UINT16 OemRevision; /// /// The 32-bit physical address where INT15 E820 data is stored within the traditional /// BIOS. The EfiCompatibility code will fill in the E820Pointer value and copy the /// data to the indicated area. /// UINT32 E820Pointer; /// /// The length of the E820 data and is filled in by the EfiCompatibility code. /// UINT32 E820Length; /// /// The 32-bit physical address where the $PIR table is stored in the traditional BIOS. /// The EfiCompatibility code will fill in the IrqRoutingTablePointer value and /// copy the data to the indicated area. /// UINT32 IrqRoutingTablePointer; /// /// The length of the $PIR table and is filled in by the EfiCompatibility code. /// UINT32 IrqRoutingTableLength; /// /// The 32-bit physical address where the MP table is stored in the traditional BIOS. /// The EfiCompatibility code will fill in the MpTablePtr value and copy the data /// to the indicated area. /// UINT32 MpTablePtr; /// /// The length of the MP table and is filled in by the EfiCompatibility code. /// UINT32 MpTableLength; /// /// The segment of the OEM-specific INT table/code. /// UINT16 OemIntSegment; /// /// The offset of the OEM-specific INT table/code. /// UINT16 OemIntOffset; /// /// The segment of the OEM-specific 32-bit table/code. /// UINT16 Oem32Segment; /// /// The offset of the OEM-specific 32-bit table/code. /// UINT16 Oem32Offset; /// /// The segment of the OEM-specific 16-bit table/code. /// UINT16 Oem16Segment; /// /// The offset of the OEM-specific 16-bit table/code. /// UINT16 Oem16Offset; /// /// The segment of the TPM binary passed to 16-bit CSM. /// UINT16 TpmSegment; /// /// The offset of the TPM binary passed to 16-bit CSM. /// UINT16 TpmOffset; /// /// A pointer to a string identifying the independent BIOS vendor. /// UINT32 IbvPointer; /// /// This field is NULL for all systems not supporting PCI Express. This field is the base /// value of the start of the PCI Express memory-mapped configuration registers and /// must be filled in prior to EfiCompatibility code issuing the Compatibility16 function /// Compatibility16InitializeYourself(). /// Compatibility16InitializeYourself() is defined in Compatability16 /// Functions. /// UINT32 PciExpressBase; /// /// Maximum PCI bus number assigned. /// UINT8 LastPciBus; } EFI_COMPATIBILITY16_TABLE; /// /// Functions provided by the CSM binary which communicate between the EfiCompatibility /// and Compatability16 code. /// /// Inconsistent with the specification here: /// The member's name started with "Compatibility16" [defined in Intel Framework /// Compatibility Support Module Specification / 0.97 version] /// has been changed to "Legacy16" since keeping backward compatible. /// typedef enum { /// /// Causes the Compatibility16 code to do any internal initialization required. /// Input: /// AX = Compatibility16InitializeYourself /// ES:BX = Pointer to EFI_TO_COMPATIBILITY16_INIT_TABLE /// Return: /// AX = Return Status codes /// Legacy16InitializeYourself = 0x0000, /// /// Causes the Compatibility16 BIOS to perform any drive number translations to match the boot sequence. /// Input: /// AX = Compatibility16UpdateBbs /// ES:BX = Pointer to EFI_TO_COMPATIBILITY16_BOOT_TABLE /// Return: /// AX = Returned status codes /// Legacy16UpdateBbs = 0x0001, /// /// Allows the Compatibility16 code to perform any final actions before booting. The Compatibility16 /// code is read/write. /// Input: /// AX = Compatibility16PrepareToBoot /// ES:BX = Pointer to EFI_TO_COMPATIBILITY16_BOOT_TABLE structure /// Return: /// AX = Returned status codes /// Legacy16PrepareToBoot = 0x0002, /// /// Causes the Compatibility16 BIOS to boot. The Compatibility16 code is Read/Only. /// Input: /// AX = Compatibility16Boot /// Output: /// AX = Returned status codes /// Legacy16Boot = 0x0003, /// /// Allows the Compatibility16 code to get the last device from which a boot was attempted. This is /// stored in CMOS and is the priority number of the last attempted boot device. /// Input: /// AX = Compatibility16RetrieveLastBootDevice /// Output: /// AX = Returned status codes /// BX = Priority number of the boot device. /// Legacy16RetrieveLastBootDevice = 0x0004, /// /// Allows the Compatibility16 code rehook INT13, INT18, and/or INT19 after dispatching a legacy OpROM. /// Input: /// AX = Compatibility16DispatchOprom /// ES:BX = Pointer to EFI_DISPATCH_OPROM_TABLE /// Output: /// AX = Returned status codes /// BX = Number of non-BBS-compliant devices found. Equals 0 if BBS compliant. /// Legacy16DispatchOprom = 0x0005, /// /// Finds a free area in the 0xFxxxx or 0xExxxx region of the specified length and returns the address /// of that region. /// Input: /// AX = Compatibility16GetTableAddress /// BX = Allocation region /// 00 = Allocate from either 0xE0000 or 0xF0000 64 KB blocks. /// Bit 0 = 1 Allocate from 0xF0000 64 KB block /// Bit 1 = 1 Allocate from 0xE0000 64 KB block /// CX = Requested length in bytes. /// DX = Required address alignment. Bit mapped. First non-zero bit from the right is the alignment. /// Output: /// AX = Returned status codes /// DS:BX = Address of the region /// Legacy16GetTableAddress = 0x0006, /// /// Enables the EfiCompatibility module to do any nonstandard processing of keyboard LEDs or state. /// Input: /// AX = Compatibility16SetKeyboardLeds /// CL = LED status. /// Bit 0 Scroll Lock 0 = Off /// Bit 1 NumLock /// Bit 2 Caps Lock /// Output: /// AX = Returned status codes /// Legacy16SetKeyboardLeds = 0x0007, /// /// Enables the EfiCompatibility module to install an interrupt handler for PCI mass media devices that /// do not have an OpROM associated with them. An example is SATA. /// Input: /// AX = Compatibility16InstallPciHandler /// ES:BX = Pointer to EFI_LEGACY_INSTALL_PCI_HANDLER structure /// Output: /// AX = Returned status codes /// Legacy16InstallPciHandler = 0x0008 } EFI_COMPATIBILITY_FUNCTIONS; /// /// EFI_DISPATCH_OPROM_TABLE /// typedef struct { UINT16 PnPInstallationCheckSegment; ///< A pointer to the PnpInstallationCheck data structure. UINT16 PnPInstallationCheckOffset; ///< A pointer to the PnpInstallationCheck data structure. UINT16 OpromSegment; ///< The segment where the OpROM was placed. Offset is assumed to be 3. UINT8 PciBus; ///< The PCI bus. UINT8 PciDeviceFunction; ///< The PCI device * 0x08 | PCI function. UINT8 NumberBbsEntries; ///< The number of valid BBS table entries upon entry and exit. The IBV code may ///< increase this number, if BBS-compliant devices also hook INTs in order to force the ///< OpROM BIOS Setup to be executed. UINT32 BbsTablePointer; ///< A pointer to the BBS table. UINT16 RuntimeSegment; ///< The segment where the OpROM can be relocated to. If this value is 0x0000, this ///< means that the relocation of this run time code is not supported. ///< Inconsistent with specification here: ///< The member's name "OpromDestinationSegment" [defined in Intel Framework Compatibility Support Module Specification / 0.97 version] ///< has been changed to "RuntimeSegment" since keeping backward compatible. } EFI_DISPATCH_OPROM_TABLE; /// /// EFI_TO_COMPATIBILITY16_INIT_TABLE /// typedef struct { /// /// Starting address of memory under 1 MB. The ending address is assumed to be 640 KB or 0x9FFFF. /// UINT32 BiosLessThan1MB; /// /// The starting address of the high memory block. /// UINT32 HiPmmMemory; /// /// The length of high memory block. /// UINT32 HiPmmMemorySizeInBytes; /// /// The segment of the reverse thunk call code. /// UINT16 ReverseThunkCallSegment; /// /// The offset of the reverse thunk call code. /// UINT16 ReverseThunkCallOffset; /// /// The number of E820 entries copied to the Compatibility16 BIOS. /// UINT32 NumberE820Entries; /// /// The amount of usable memory above 1 MB, e.g., E820 type 1 memory. /// UINT32 OsMemoryAbove1Mb; /// /// The start of thunk code in main memory. Memory cannot be used by BIOS or PMM. /// UINT32 ThunkStart; /// /// The size of the thunk code. /// UINT32 ThunkSizeInBytes; /// /// Starting address of memory under 1 MB. /// UINT32 LowPmmMemory; /// /// The length of low Memory block. /// UINT32 LowPmmMemorySizeInBytes; } EFI_TO_COMPATIBILITY16_INIT_TABLE; /// /// DEVICE_PRODUCER_SERIAL. /// typedef struct { UINT16 Address; ///< I/O address assigned to the serial port. UINT8 Irq; ///< IRQ assigned to the serial port. SERIAL_MODE Mode; ///< Mode of serial port. Values are defined below. } DEVICE_PRODUCER_SERIAL; /// /// DEVICE_PRODUCER_SERIAL's modes. ///@{ #define DEVICE_SERIAL_MODE_NORMAL 0x00 #define DEVICE_SERIAL_MODE_IRDA 0x01 #define DEVICE_SERIAL_MODE_ASK_IR 0x02 #define DEVICE_SERIAL_MODE_DUPLEX_HALF 0x00 #define DEVICE_SERIAL_MODE_DUPLEX_FULL 0x10 ///@) /// /// DEVICE_PRODUCER_PARALLEL. /// typedef struct { UINT16 Address; ///< I/O address assigned to the parallel port. UINT8 Irq; ///< IRQ assigned to the parallel port. UINT8 Dma; ///< DMA assigned to the parallel port. PARALLEL_MODE Mode; ///< Mode of the parallel port. Values are defined below. } DEVICE_PRODUCER_PARALLEL; /// /// DEVICE_PRODUCER_PARALLEL's modes. ///@{ #define DEVICE_PARALLEL_MODE_MODE_OUTPUT_ONLY 0x00 #define DEVICE_PARALLEL_MODE_MODE_BIDIRECTIONAL 0x01 #define DEVICE_PARALLEL_MODE_MODE_EPP 0x02 #define DEVICE_PARALLEL_MODE_MODE_ECP 0x03 ///@} /// /// DEVICE_PRODUCER_FLOPPY /// typedef struct { UINT16 Address; ///< I/O address assigned to the floppy. UINT8 Irq; ///< IRQ assigned to the floppy. UINT8 Dma; ///< DMA assigned to the floppy. UINT8 NumberOfFloppy; ///< Number of floppies in the system. } DEVICE_PRODUCER_FLOPPY; /// /// LEGACY_DEVICE_FLAGS /// typedef struct { UINT32 A20Kybd : 1; ///< A20 controller by keyboard controller. UINT32 A20Port90 : 1; ///< A20 controlled by port 0x92. UINT32 Reserved : 30; ///< Reserved for future usage. } LEGACY_DEVICE_FLAGS; /// /// DEVICE_PRODUCER_DATA_HEADER /// typedef struct { DEVICE_PRODUCER_SERIAL Serial[4]; ///< Data for serial port x. Type DEVICE_PRODUCER_SERIAL is defined below. DEVICE_PRODUCER_PARALLEL Parallel[3]; ///< Data for parallel port x. Type DEVICE_PRODUCER_PARALLEL is defined below. DEVICE_PRODUCER_FLOPPY Floppy; ///< Data for floppy. Type DEVICE_PRODUCER_FLOPPY is defined below. UINT8 MousePresent; ///< Flag to indicate if mouse is present. LEGACY_DEVICE_FLAGS Flags; ///< Miscellaneous Boolean state information passed to CSM. } DEVICE_PRODUCER_DATA_HEADER; /// /// ATAPI_IDENTIFY /// typedef struct { UINT16 Raw[256]; ///< Raw data from the IDE IdentifyDrive command. } ATAPI_IDENTIFY; /// /// HDD_INFO /// typedef struct { /// /// Status of IDE device. Values are defined below. There is one HDD_INFO structure /// per IDE controller. The IdentifyDrive is per drive. Index 0 is master and index /// 1 is slave. /// UINT16 Status; /// /// PCI bus of IDE controller. /// UINT32 Bus; /// /// PCI device of IDE controller. /// UINT32 Device; /// /// PCI function of IDE controller. /// UINT32 Function; /// /// Command ports base address. /// UINT16 CommandBaseAddress; /// /// Control ports base address. /// UINT16 ControlBaseAddress; /// /// Bus master address. /// UINT16 BusMasterAddress; UINT8 HddIrq; /// /// Data that identifies the drive data; one per possible attached drive. /// ATAPI_IDENTIFY IdentifyDrive[2]; } HDD_INFO; /// /// HDD_INFO status bits /// #define HDD_PRIMARY 0x01 #define HDD_SECONDARY 0x02 #define HDD_MASTER_ATAPI_CDROM 0x04 #define HDD_SLAVE_ATAPI_CDROM 0x08 #define HDD_MASTER_IDE 0x20 #define HDD_SLAVE_IDE 0x40 #define HDD_MASTER_ATAPI_ZIPDISK 0x10 #define HDD_SLAVE_ATAPI_ZIPDISK 0x80 /// /// BBS_STATUS_FLAGS;\. /// typedef struct { UINT16 OldPosition : 4; ///< Prior priority. UINT16 Reserved1 : 4; ///< Reserved for future use. UINT16 Enabled : 1; ///< If 0, ignore this entry. UINT16 Failed : 1; ///< 0 = Not known if boot failure occurred. ///< 1 = Boot attempted failed. /// /// State of media present. /// 00 = No bootable media is present in the device. /// 01 = Unknown if a bootable media present. /// 10 = Media is present and appears bootable. /// 11 = Reserved. /// UINT16 MediaPresent : 2; UINT16 Reserved2 : 4; ///< Reserved for future use. } BBS_STATUS_FLAGS; /// /// BBS_TABLE, device type values & boot priority values. /// typedef struct { /// /// The boot priority for this boot device. Values are defined below. /// UINT16 BootPriority; /// /// The PCI bus for this boot device. /// UINT32 Bus; /// /// The PCI device for this boot device. /// UINT32 Device; /// /// The PCI function for the boot device. /// UINT32 Function; /// /// The PCI class for this boot device. /// UINT8 Class; /// /// The PCI Subclass for this boot device. /// UINT8 SubClass; /// /// Segment:offset address of an ASCIIZ description string describing the manufacturer. /// UINT16 MfgStringOffset; /// /// Segment:offset address of an ASCIIZ description string describing the manufacturer. /// UINT16 MfgStringSegment; /// /// BBS device type. BBS device types are defined below. /// UINT16 DeviceType; /// /// Status of this boot device. Type BBS_STATUS_FLAGS is defined below. /// BBS_STATUS_FLAGS StatusFlags; /// /// Segment:Offset address of boot loader for IPL devices or install INT13 handler for /// BCV devices. /// UINT16 BootHandlerOffset; /// /// Segment:Offset address of boot loader for IPL devices or install INT13 handler for /// BCV devices. /// UINT16 BootHandlerSegment; /// /// Segment:offset address of an ASCIIZ description string describing this device. /// UINT16 DescStringOffset; /// /// Segment:offset address of an ASCIIZ description string describing this device. /// UINT16 DescStringSegment; /// /// Reserved. /// UINT32 InitPerReserved; /// /// The use of these fields is IBV dependent. They can be used to flag that an OpROM /// has hooked the specified IRQ. The OpROM may be BBS compliant as some SCSI /// BBS-compliant OpROMs also hook IRQ vectors in order to run their BIOS Setup /// UINT32 AdditionalIrq13Handler; /// /// The use of these fields is IBV dependent. They can be used to flag that an OpROM /// has hooked the specified IRQ. The OpROM may be BBS compliant as some SCSI /// BBS-compliant OpROMs also hook IRQ vectors in order to run their BIOS Setup /// UINT32 AdditionalIrq18Handler; /// /// The use of these fields is IBV dependent. They can be used to flag that an OpROM /// has hooked the specified IRQ. The OpROM may be BBS compliant as some SCSI /// BBS-compliant OpROMs also hook IRQ vectors in order to run their BIOS Setup /// UINT32 AdditionalIrq19Handler; /// /// The use of these fields is IBV dependent. They can be used to flag that an OpROM /// has hooked the specified IRQ. The OpROM may be BBS compliant as some SCSI /// BBS-compliant OpROMs also hook IRQ vectors in order to run their BIOS Setup /// UINT32 AdditionalIrq40Handler; UINT8 AssignedDriveNumber; UINT32 AdditionalIrq41Handler; UINT32 AdditionalIrq46Handler; UINT32 IBV1; UINT32 IBV2; } BBS_TABLE; /// /// BBS device type values ///@{ #define BBS_FLOPPY 0x01 #define BBS_HARDDISK 0x02 #define BBS_CDROM 0x03 #define BBS_PCMCIA 0x04 #define BBS_USB 0x05 #define BBS_EMBED_NETWORK 0x06 #define BBS_BEV_DEVICE 0x80 #define BBS_UNKNOWN 0xff ///@} /// /// BBS boot priority values ///@{ #define BBS_DO_NOT_BOOT_FROM 0xFFFC #define BBS_LOWEST_PRIORITY 0xFFFD #define BBS_UNPRIORITIZED_ENTRY 0xFFFE #define BBS_IGNORE_ENTRY 0xFFFF ///@} /// /// SMM_ATTRIBUTES /// typedef struct { /// /// Access mechanism used to generate the soft SMI. Defined types are below. The other /// values are reserved for future usage. /// UINT16 Type : 3; /// /// The size of "port" in bits. Defined values are below. /// UINT16 PortGranularity : 3; /// /// The size of data in bits. Defined values are below. /// UINT16 DataGranularity : 3; /// /// Reserved for future use. /// UINT16 Reserved : 7; } SMM_ATTRIBUTES; /// /// SMM_ATTRIBUTES type values. ///@{ #define STANDARD_IO 0x00 #define STANDARD_MEMORY 0x01 ///@} /// /// SMM_ATTRIBUTES port size constants. ///@{ #define PORT_SIZE_8 0x00 #define PORT_SIZE_16 0x01 #define PORT_SIZE_32 0x02 #define PORT_SIZE_64 0x03 ///@} /// /// SMM_ATTRIBUTES data size constants. ///@{ #define DATA_SIZE_8 0x00 #define DATA_SIZE_16 0x01 #define DATA_SIZE_32 0x02 #define DATA_SIZE_64 0x03 ///@} /// /// SMM_FUNCTION & relating constants. /// typedef struct { UINT16 Function : 15; UINT16 Owner : 1; } SMM_FUNCTION; /// /// SMM_FUNCTION Function constants. ///@{ #define INT15_D042 0x0000 #define GET_USB_BOOT_INFO 0x0001 #define DMI_PNP_50_57 0x0002 ///@} /// /// SMM_FUNCTION Owner constants. ///@{ #define STANDARD_OWNER 0x0 #define OEM_OWNER 0x1 ///@} /// /// This structure assumes both port and data sizes are 1. SmmAttribute must be /// properly to reflect that assumption. /// typedef struct { /// /// Describes the access mechanism, SmmPort, and SmmData sizes. Type /// SMM_ATTRIBUTES is defined below. /// SMM_ATTRIBUTES SmmAttributes; /// /// Function Soft SMI is to perform. Type SMM_FUNCTION is defined below. /// SMM_FUNCTION SmmFunction; /// /// SmmPort size depends upon SmmAttributes and ranges from2 bytes to 16 bytes. /// UINT8 SmmPort; /// /// SmmData size depends upon SmmAttributes and ranges from2 bytes to 16 bytes. /// UINT8 SmmData; } SMM_ENTRY; /// /// SMM_TABLE /// typedef struct { UINT16 NumSmmEntries; ///< Number of entries represented by SmmEntry. SMM_ENTRY SmmEntry; ///< One entry per function. Type SMM_ENTRY is defined below. } SMM_TABLE; /// /// UDC_ATTRIBUTES /// typedef struct { /// /// This bit set indicates that the ServiceAreaData is valid. /// UINT8 DirectoryServiceValidity : 1; /// /// This bit set indicates to use the Reserve Area Boot Code Address (RACBA) only if /// DirectoryServiceValidity is 0. /// UINT8 RabcaUsedFlag : 1; /// /// This bit set indicates to execute hard disk diagnostics. /// UINT8 ExecuteHddDiagnosticsFlag : 1; /// /// Reserved for future use. Set to 0. /// UINT8 Reserved : 5; } UDC_ATTRIBUTES; /// /// UD_TABLE /// typedef struct { /// /// This field contains the bit-mapped attributes of the PARTIES information. Type /// UDC_ATTRIBUTES is defined below. /// UDC_ATTRIBUTES Attributes; /// /// This field contains the zero-based device on which the selected /// ServiceDataArea is present. It is 0 for master and 1 for the slave device. /// UINT8 DeviceNumber; /// /// This field contains the zero-based index into the BbsTable for the parent device. /// This index allows the user to reference the parent device information such as PCI /// bus, device function. /// UINT8 BbsTableEntryNumberForParentDevice; /// /// This field contains the zero-based index into the BbsTable for the boot entry. /// UINT8 BbsTableEntryNumberForBoot; /// /// This field contains the zero-based index into the BbsTable for the HDD diagnostics entry. /// UINT8 BbsTableEntryNumberForHddDiag; /// /// The raw Beer data. /// UINT8 BeerData[128]; /// /// The raw data of selected service area. /// UINT8 ServiceAreaData[64]; } UD_TABLE; #define EFI_TO_LEGACY_MAJOR_VERSION 0x02 #define EFI_TO_LEGACY_MINOR_VERSION 0x00 #define MAX_IDE_CONTROLLER 8 /// /// EFI_TO_COMPATIBILITY16_BOOT_TABLE /// typedef struct { UINT16 MajorVersion; ///< The EfiCompatibility major version number. UINT16 MinorVersion; ///< The EfiCompatibility minor version number. UINT32 AcpiTable; ///< The location of the RSDT ACPI table. < 4G range. UINT32 SmbiosTable; ///< The location of the SMBIOS table in EFI memory. < 4G range. UINT32 SmbiosTableLength; // // Legacy SIO state // DEVICE_PRODUCER_DATA_HEADER SioData; ///< Standard traditional device information. UINT16 DevicePathType; ///< The default boot type. UINT16 PciIrqMask; ///< Mask of which IRQs have been assigned to PCI. UINT32 NumberE820Entries; ///< Number of E820 entries. The number can change from the ///< Compatibility16InitializeYourself() function. // // Controller & Drive Identify[2] per controller information // HDD_INFO HddInfo[MAX_IDE_CONTROLLER]; ///< Hard disk drive information, including raw Identify Drive data. UINT32 NumberBbsEntries; ///< Number of entries in the BBS table UINT32 BbsTable; ///< A pointer to the BBS table. Type BBS_TABLE is defined below. UINT32 SmmTable; ///< A pointer to the SMM table. Type SMM_TABLE is defined below. UINT32 OsMemoryAbove1Mb; ///< The amount of usable memory above 1 MB, i.e. E820 type 1 memory. This value can ///< differ from the value in EFI_TO_COMPATIBILITY16_INIT_TABLE as more ///< memory may have been discovered. UINT32 UnconventionalDeviceTable; ///< Information to boot off an unconventional device like a PARTIES partition. Type ///< UD_TABLE is defined below. } EFI_TO_COMPATIBILITY16_BOOT_TABLE; /// /// EFI_LEGACY_INSTALL_PCI_HANDLER /// typedef struct { UINT8 PciBus; ///< The PCI bus of the device. UINT8 PciDeviceFun; ///< The PCI device in bits 7:3 and function in bits 2:0. UINT8 PciSegment; ///< The PCI segment of the device. UINT8 PciClass; ///< The PCI class code of the device. UINT8 PciSubclass; ///< The PCI subclass code of the device. UINT8 PciInterface; ///< The PCI interface code of the device. // // Primary section // UINT8 PrimaryIrq; ///< The primary device IRQ. UINT8 PrimaryReserved; ///< Reserved. UINT16 PrimaryControl; ///< The primary device control I/O base. UINT16 PrimaryBase; ///< The primary device I/O base. UINT16 PrimaryBusMaster; ///< The primary device bus master I/O base. // // Secondary Section // UINT8 SecondaryIrq; ///< The secondary device IRQ. UINT8 SecondaryReserved; ///< Reserved. UINT16 SecondaryControl; ///< The secondary device control I/O base. UINT16 SecondaryBase; ///< The secondary device I/O base. UINT16 SecondaryBusMaster; ///< The secondary device bus master I/O base. } EFI_LEGACY_INSTALL_PCI_HANDLER; #endif tinyvisor/bios/src/pnpbios.c0000644006644000001440000000433712172661303016435 0ustar yuichi_xyusers// PNP BIOS calls // // Copyright (C) 2008 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // checksum #include "config.h" // BUILD_BIOS_ADDR #include "farptr.h" // SET_FARVAR struct pnpheader { u32 signature; u8 version; u8 length; u16 control; u8 checksum; u32 eventloc; u16 real_ip; u16 real_cs; u16 prot_ip; u32 prot_base; u32 oemid; u16 real_ds; u32 prot_database; } PACKED; extern struct pnpheader PNPHEADER; extern char pnp_string[]; #if CONFIG_PNPBIOS struct pnpheader PNPHEADER __aligned(16) VARFSEG = { .signature = PNP_SIGNATURE, .version = 0x10, .length = sizeof(PNPHEADER), .real_cs = SEG_BIOS, .prot_base = BUILD_BIOS_ADDR, .real_ds = SEG_BIOS, .prot_database = BUILD_BIOS_ADDR, }; #else // We need a copy of this string in the 0xf000 segment, but we are not // actually a PnP BIOS, so make sure it is *not* aligned, so OSes will // not see it if they scan. char pnp_string[] __aligned(2) VARFSEG = " $PnP"; #endif #define FUNCTION_NOT_SUPPORTED 0x82 // BBS - Get Version and Installation Check static u16 handle_pnp60(u16 *args) { u16 version_ptr = args[1]; u16 version_seg = args[2]; SET_FARVAR(version_seg, *(u16*)(version_ptr+0), 0x0101); return 0; } static u16 handle_pnpXX(u16 *args) { return FUNCTION_NOT_SUPPORTED; } u16 VISIBLE16 handle_pnp(u16 *args) { if (! CONFIG_PNPBIOS) return FUNCTION_NOT_SUPPORTED; u16 arg1 = args[0]; dprintf(DEBUG_HDL_pnp, "pnp call arg1=%x\n", arg1); switch (arg1) { case 0x60: return handle_pnp60(args); default: return handle_pnpXX(args); } } u16 get_pnp_offset(void) { if (! CONFIG_PNPBIOS) return (u32)pnp_string + 1 - BUILD_BIOS_ADDR; return (u32)&PNPHEADER - BUILD_BIOS_ADDR; } // romlayout.S extern void entry_pnp_real(void); extern void entry_pnp_prot(void); void pnp_init(void) { if (! CONFIG_PNPBIOS) return; dprintf(3, "init PNPBIOS table\n"); PNPHEADER.real_ip = (u32)entry_pnp_real - BUILD_BIOS_ADDR; PNPHEADER.prot_ip = (u32)entry_pnp_prot - BUILD_BIOS_ADDR; PNPHEADER.checksum -= checksum(&PNPHEADER, sizeof(PNPHEADER)); } tinyvisor/bios/src/megasas.c0000644006644000001440000003013212172661303016373 0ustar yuichi_xyusers// MegaRAID SAS boot support. // // Copyright (C) 2012 Hannes Reinecke, SUSE Linux Products GmbH // // Authors: // Hannes Reinecke // // based on virtio-scsi.c which is written by: // Paolo Bonzini // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "pci.h" // foreachpci #include "config.h" // CONFIG_* #include "biosvar.h" // GET_GLOBAL #include "pci_ids.h" // PCI_DEVICE_ID_XXX #include "pci_regs.h" // PCI_VENDOR_ID #include "boot.h" // bootprio_find_scsi_device #include "blockcmd.h" // scsi_drive_setup #include "disk.h" #define MFI_DB 0x0 // Doorbell #define MFI_OMSG0 0x18 // Outbound message 0 #define MFI_IDB 0x20 // Inbound doorbell #define MFI_ODB 0x2c // Outbound doorbell #define MFI_IQP 0x40 // Inbound queue port #define MFI_OSP0 0xb0 // Outbound scratch pad0 #define MFI_IQPL 0xc0 // Inbound queue port (low bytes) #define MFI_IQPH 0xc4 // Inbound queue port (high bytes) #define MFI_STATE_MASK 0xf0000000 #define MFI_STATE_WAIT_HANDSHAKE 0x60000000 #define MFI_STATE_BOOT_MESSAGE_PENDING 0x90000000 #define MFI_STATE_READY 0xb0000000 #define MFI_STATE_OPERATIONAL 0xc0000000 #define MFI_STATE_FAULT 0xf0000000 /* MFI Commands */ typedef enum { MFI_CMD_INIT = 0x00, MFI_CMD_LD_READ, MFI_CMD_LD_WRITE, MFI_CMD_LD_SCSI_IO, MFI_CMD_PD_SCSI_IO, MFI_CMD_DCMD, MFI_CMD_ABORT, MFI_CMD_SMP, MFI_CMD_STP } mfi_cmd_t; struct megasas_cmd_frame { u8 cmd; /*00h */ u8 sense_len; /*01h */ u8 cmd_status; /*02h */ u8 scsi_status; /*03h */ u8 target_id; /*04h */ u8 lun; /*05h */ u8 cdb_len; /*06h */ u8 sge_count; /*07h */ u32 context; /*08h */ u32 context_64; /*0Ch */ u16 flags; /*10h */ u16 timeout; /*12h */ u32 data_xfer_len; /*14h */ union { struct { u32 opcode; /*18h */ u8 mbox[12]; /*1Ch */ u32 sgl_addr; /*28h */ u32 sgl_len; /*32h */ u32 pad; /*34h */ } dcmd; struct { u32 sense_buf_lo; /*18h */ u32 sense_buf_hi; /*1Ch */ u8 cdb[16]; /*20h */ u32 sgl_addr; /*30h */ u32 sgl_len; /*34h */ } pthru; struct { u8 pad[22]; /*18h */ } gen; }; } __attribute__ ((packed)); struct mfi_ld_list_s { u32 count; u32 reserved_0; struct { u8 target; u8 lun; u16 seq; u8 state; u8 reserved_1[3]; u64 size; } lds[64]; } __attribute__ ((packed)); #define MEGASAS_POLL_TIMEOUT 60000 // 60 seconds polling timeout struct megasas_lun_s { struct drive_s drive; struct pci_device *pci; struct megasas_cmd_frame *frame; u32 iobase; u8 target; u8 lun; }; static int megasas_fire_cmd(u16 pci_id, u32 ioaddr, struct megasas_cmd_frame *frame) { u32 frame_addr = (u32)frame; int frame_count = 1; u8 cmd_state; u64 end; dprintf(2, "Frame 0x%x\n", frame_addr); if (pci_id == PCI_DEVICE_ID_LSI_SAS2004 || pci_id == PCI_DEVICE_ID_LSI_SAS2008) { outl(0, ioaddr + MFI_IQPH); outl(frame_addr | frame_count << 1 | 1, ioaddr + MFI_IQPL); } else if (pci_id == PCI_DEVICE_ID_DELL_PERC5 || pci_id == PCI_DEVICE_ID_LSI_SAS1064R || pci_id == PCI_DEVICE_ID_LSI_VERDE_ZCR) { outl(frame_addr >> 3 | frame_count, ioaddr + MFI_IQP); } else { outl(frame_addr | frame_count << 1 | 1, ioaddr + MFI_IQP); } end = calc_future_tsc(MEGASAS_POLL_TIMEOUT); do { for (;;) { cmd_state = GET_LOWFLAT(frame->cmd_status); if (cmd_state != 0xff) break; if (check_tsc(end)) { warn_timeout(); return -1; } yield(); } } while (cmd_state == 0xff); if (cmd_state == 0 || cmd_state == 0x2d) return 0; dprintf(1, "ERROR: Frame 0x%x, status 0x%x\n", frame_addr, cmd_state); return -1; } int megasas_cmd_data(struct disk_op_s *op, void *cdbcmd, u16 blocksize) { struct megasas_lun_s *mlun = container_of(op->drive_g, struct megasas_lun_s, drive); u8 *cdb = cdbcmd; struct megasas_cmd_frame *frame = GET_GLOBAL(mlun->frame); u16 pci_id = GET_GLOBAL(mlun->pci->device); int i; if (!CONFIG_MEGASAS) return DISK_RET_EBADTRACK; memset_fl(frame, 0, sizeof(*frame)); SET_LOWFLAT(frame->cmd, MFI_CMD_LD_SCSI_IO); SET_LOWFLAT(frame->cmd_status, 0xFF); SET_LOWFLAT(frame->target_id, GET_GLOBAL(mlun->target)); SET_LOWFLAT(frame->lun, GET_GLOBAL(mlun->lun)); SET_LOWFLAT(frame->flags, 0x0001); SET_LOWFLAT(frame->data_xfer_len, op->count * blocksize); SET_LOWFLAT(frame->cdb_len, 16); for (i = 0; i < 16; i++) { SET_LOWFLAT(frame->pthru.cdb[i], cdb[i]); } dprintf(2, "pthru cmd 0x%x count %d bs %d\n", cdb[0], op->count, blocksize); if (op->count) { SET_LOWFLAT(frame->pthru.sgl_addr, (u32)op->buf_fl); SET_LOWFLAT(frame->pthru.sgl_len, op->count * blocksize); SET_LOWFLAT(frame->sge_count, 1); } SET_LOWFLAT(frame->context, (u32)frame); if (megasas_fire_cmd(pci_id, GET_GLOBAL(mlun->iobase), frame) == 0) return DISK_RET_SUCCESS; dprintf(2, "pthru cmd 0x%x failed\n", cdb[0]); return DISK_RET_EBADTRACK; } static int megasas_add_lun(struct pci_device *pci, u32 iobase, u8 target, u8 lun) { struct megasas_lun_s *mlun = malloc_fseg(sizeof(*mlun)); char *name; int prio, ret = 0; if (!mlun) { warn_noalloc(); return -1; } memset(mlun, 0, sizeof(*mlun)); mlun->drive.type = DTYPE_MEGASAS; mlun->drive.cntl_id = pci->bdf; mlun->pci = pci; mlun->target = target; mlun->lun = lun; mlun->iobase = iobase; mlun->frame = memalign_low(256, sizeof(struct megasas_cmd_frame)); if (!mlun->frame) { warn_noalloc(); free(mlun); return -1; } name = znprintf(36, "MegaRAID SAS (PCI %02x:%02x.%x) LD %d:%d", pci_bdf_to_bus(pci->bdf), pci_bdf_to_dev(pci->bdf), pci_bdf_to_fn(pci->bdf), target, lun); prio = bootprio_find_scsi_device(pci, target, lun); ret = scsi_drive_setup(&mlun->drive, name, prio); free(name); if (ret) { free(mlun->frame); free(mlun); ret = -1; } return ret; } static void megasas_scan_target(struct pci_device *pci, u32 iobase) { struct mfi_ld_list_s ld_list; struct megasas_cmd_frame *frame = memalign_tmp(256, sizeof(*frame)); int i; memset(&ld_list, 0, sizeof(ld_list)); memset_fl(frame, 0, sizeof(*frame)); frame->cmd = MFI_CMD_DCMD; frame->cmd_status = 0xFF; frame->sge_count = 1; frame->flags = 0x0011; frame->data_xfer_len = sizeof(ld_list); frame->dcmd.opcode = 0x03010000; frame->dcmd.sgl_addr = (u32)MAKE_FLATPTR(GET_SEG(SS), &ld_list); frame->dcmd.sgl_len = sizeof(ld_list); frame->context = (u32)frame; if (megasas_fire_cmd(pci->device, iobase, frame) == 0) { dprintf(2, "%d LD found\n", ld_list.count); for (i = 0; i < ld_list.count; i++) { dprintf(2, "LD %d:%d state 0x%x\n", ld_list.lds[i].target, ld_list.lds[i].lun, ld_list.lds[i].state); if (ld_list.lds[i].state != 0) { megasas_add_lun(pci, iobase, ld_list.lds[i].target, ld_list.lds[i].lun); } } } } static int megasas_transition_to_ready(struct pci_device *pci, u32 ioaddr) { u32 fw_state = 0, new_state, mfi_flags = 0; u64 end; if (pci->device == PCI_DEVICE_ID_LSI_SAS1064R || pci->device == PCI_DEVICE_ID_DELL_PERC5) new_state = inl(ioaddr + MFI_OMSG0) & MFI_STATE_MASK; else new_state = inl(ioaddr + MFI_OSP0) & MFI_STATE_MASK; while (fw_state != new_state) { switch (new_state) { case MFI_STATE_FAULT: dprintf(1, "ERROR: fw in fault state\n"); return -1; break; case MFI_STATE_WAIT_HANDSHAKE: mfi_flags = 0x08; /* fallthrough */ case MFI_STATE_BOOT_MESSAGE_PENDING: mfi_flags |= 0x10; if (pci->device == PCI_DEVICE_ID_LSI_SAS2004 || pci->device == PCI_DEVICE_ID_LSI_SAS2008 || pci->device == PCI_DEVICE_ID_LSI_SAS2208 || pci->device == PCI_DEVICE_ID_LSI_SAS3108) { outl(ioaddr + MFI_DB, mfi_flags); } else { outl(ioaddr + MFI_IDB, mfi_flags); } break; case MFI_STATE_OPERATIONAL: mfi_flags = 0x07; if (pci->device == PCI_DEVICE_ID_LSI_SAS2004 || pci->device == PCI_DEVICE_ID_LSI_SAS2008 || pci->device == PCI_DEVICE_ID_LSI_SAS2208 || pci->device == PCI_DEVICE_ID_LSI_SAS3108) { outl(ioaddr + MFI_DB, mfi_flags); if (pci->device == PCI_DEVICE_ID_LSI_SAS2208 || pci->device == PCI_DEVICE_ID_LSI_SAS3108) { int j = 0; u32 doorbell; while (j < MEGASAS_POLL_TIMEOUT) { doorbell = inl(ioaddr + MFI_DB) & 1; if (!doorbell) break; msleep(20); j++; } } } else { outw(ioaddr + MFI_IDB, mfi_flags); } break; case MFI_STATE_READY: dprintf(2, "MegaRAID SAS fw ready\n"); return 0; } // The current state should not last longer than poll timeout end = calc_future_tsc(MEGASAS_POLL_TIMEOUT); for (;;) { if (check_tsc(end)) { break; } yield(); fw_state = new_state; if (pci->device == PCI_DEVICE_ID_LSI_SAS1064R || pci->device == PCI_DEVICE_ID_DELL_PERC5) new_state = inl(ioaddr + MFI_OMSG0) & MFI_STATE_MASK; else new_state = inl(ioaddr + MFI_OSP0) & MFI_STATE_MASK; if (new_state != fw_state) { break; } } } dprintf(1, "ERROR: fw in state %x\n", new_state & MFI_STATE_MASK); return -1; } static void init_megasas(struct pci_device *pci) { u16 bdf = pci->bdf; u32 iobase = pci_config_readl(pci->bdf, PCI_BASE_ADDRESS_2) & PCI_BASE_ADDRESS_IO_MASK; dprintf(1, "found MegaRAID SAS at %02x:%02x.%x, io @ %x\n", pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf), pci_bdf_to_fn(bdf), iobase); pci_config_maskw(pci->bdf, PCI_COMMAND, 0, PCI_COMMAND_IO | PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER); // reset if (megasas_transition_to_ready(pci, iobase) == 0) megasas_scan_target(pci, iobase); return; } void megasas_setup(void) { ASSERT32FLAT(); if (!CONFIG_MEGASAS) return; dprintf(3, "init megasas\n"); struct pci_device *pci; foreachpci(pci) { if (pci->vendor != PCI_VENDOR_ID_LSI_LOGIC && pci->vendor != PCI_VENDOR_ID_DELL) continue; if (pci->device == PCI_DEVICE_ID_LSI_SAS1064R || pci->device == PCI_DEVICE_ID_LSI_SAS1078 || pci->device == PCI_DEVICE_ID_LSI_SAS1078DE || pci->device == PCI_DEVICE_ID_LSI_SAS2108 || pci->device == PCI_DEVICE_ID_LSI_SAS2108E || pci->device == PCI_DEVICE_ID_LSI_SAS2004 || pci->device == PCI_DEVICE_ID_LSI_SAS2008 || pci->device == PCI_DEVICE_ID_LSI_VERDE_ZCR || pci->device == PCI_DEVICE_ID_DELL_PERC5 || pci->device == PCI_DEVICE_ID_LSI_SAS2208 || pci->device == PCI_DEVICE_ID_LSI_SAS3108) init_megasas(pci); } } tinyvisor/bios/src/code16gcc.s0000644006644000001440000000001312172661303016524 0ustar yuichi_xyusers.code16gcc tinyvisor/bios/src/memmap.c0000644006644000001440000000751512172661303016240 0ustar yuichi_xyusers// Support for building memory maps suitable for int 15 e820 calls. // // Copyright (C) 2008,2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "memmap.h" // struct e820entry #include "config.h" // BUILD_MAX_E820 #include "util.h" // dprintf.h /**************************************************************** * e820 memory map ****************************************************************/ // Info on e820 map location and size. struct e820entry e820_list[BUILD_MAX_E820] VARFSEG; int e820_count VARFSEG; // Remove an entry from the e820_list. static void remove_e820(int i) { e820_count--; memmove(&e820_list[i], &e820_list[i+1] , sizeof(e820_list[0]) * (e820_count - i)); } // Insert an entry in the e820_list at the given position. static void insert_e820(int i, u64 start, u64 size, u32 type) { if (e820_count >= BUILD_MAX_E820) { warn_noalloc(); return; } memmove(&e820_list[i+1], &e820_list[i] , sizeof(e820_list[0]) * (e820_count - i)); e820_count++; struct e820entry *e = &e820_list[i]; e->start = start; e->size = size; e->type = type; } static const char * e820_type_name(u32 type) { switch (type) { case E820_RAM: return "RAM"; case E820_RESERVED: return "RESERVED"; case E820_ACPI: return "ACPI"; case E820_NVS: return "NVS"; case E820_UNUSABLE: return "UNUSABLE"; case E820_HOLE: return "HOLE"; default: return "UNKNOWN"; } } // Show the current e820_list. static void dump_map(void) { dprintf(1, "e820 map has %d items:\n", e820_count); int i; for (i=0; istart + e->size; dprintf(1, " %d: %016llx - %016llx = %d %s\n", i , e->start, e_end, e->type, e820_type_name(e->type)); } } // Add a new entry to the list. This scans for overlaps and keeps the // list sorted. void add_e820(u64 start, u64 size, u32 type) { dprintf(8, "Add to e820 map: %08x %08x %d\n", (u32)start, (u32)size, type); if (! size) // Huh? Nothing to do. return; // Find position of new item (splitting existing item if needed). u64 end = start + size; int i; for (i=0; istart + e->size; if (start > e_end) continue; // Found position - check if an existing item needs to be split. if (start > e->start) { if (type == e->type) { // Same type - merge them. size += start - e->start; start = e->start; } else { // Split existing item. e->size = start - e->start; i++; if (e_end > end) insert_e820(i, end, e_end - end, e->type); } } break; } // Remove/adjust existing items that are overlapping. while (istart) // No overlap - done. break; u64 e_end = e->start + e->size; if (end >= e_end) { // Existing item completely overlapped - remove it. remove_e820(i); continue; } // Not completely overlapped - adjust its start. e->start = end; e->size = e_end - end; if (type == e->type) { // Same type - merge them. size += e->size; remove_e820(i); } break; } // Insert new item. if (type != E820_HOLE) insert_e820(i, start, size, type); //dump_map(); } // Report on final memory locations. void memmap_prepboot(void) { dump_map(); } tinyvisor/bios/src/config.h0000644006644000001440000000705012174763154016241 0ustar yuichi_xyusers#ifndef __CONFIG_H #define __CONFIG_H #include "autoconf.h" // Configuration definitions. //#define BUILD_APPNAME "QEMU" //#define BUILD_CPUNAME8 "QEMUCPU " //#define BUILD_APPNAME6 "QEMU " //#define BUILD_APPNAME4 "QEMU" #define BUILD_APPNAME "Bochs" #define BUILD_CPUNAME8 "BOCHSCPU" #define BUILD_APPNAME6 "BOCHS " #define BUILD_APPNAME4 "BXPC" // Force to generate ACPI tables even if PIIX4 power management device // does not exists. #define CONFIG_FORCE_ACPI 1 #define CONFIG_NO_PCI_SETUP 1 #define CONFIG_IRQ0_OVERRIDE 1 #define CONFIG_FORCE_APIC_PHYSICAL_DESTINATION_MODE 1 #define CONFIG_USE_TSC_FOR_INT15_86 1 #define CONFIG_GET_ACPI_PM_BASE_FROM_RTC 1 #define CONFIG_DISABLE_APM_PORT 1 #define CONFIG_SCREEN_AND_DEBUG 0 // Maximum number of map entries in the e820 map #define BUILD_MAX_E820 32 // Space to reserve in high-memory for tables #define BUILD_MAX_HIGHTABLE (64*1024) // Largest supported externaly facing drive id #define BUILD_MAX_EXTDRIVE 16 // Number of bytes the smbios may be and still live in the f-segment #define BUILD_MAX_SMBIOS_FSEG 600 #define BUILD_MODEL_ID 0xFC #define BUILD_SUBMODEL_ID 0x00 #define BUILD_BIOS_REVISION 0x01 // Various memory addresses used by the code. #define BUILD_STACK_ADDR 0x7000 #define BUILD_S3RESUME_STACK_ADDR 0x1000 #define BUILD_AP_BOOT_ADDR 0x10000 #define BUILD_EBDA_MINIMUM 0x90000 #define BUILD_LOWRAM_END 0xa0000 #define BUILD_ROM_START 0xc0000 #define BUILD_BIOS_ADDR 0xf0000 #define BUILD_BIOS_SIZE 0x10000 #define BUILD_EXTRA_STACK_SIZE 0x800 // 32KB for shadow ram copying (works around emulator deficiencies) #define BUILD_BIOS_TMP_ADDR 0x30000 #define BUILD_SMM_INIT_ADDR 0x38000 #define BUILD_SMM_ADDR 0xa8000 #define BUILD_SMM_SIZE 0x8000 #define BUILD_PCIMEM_START 0xe0000000 #define BUILD_PCIMEM_END 0xfec00000 /* IOAPIC is mapped at */ #define BUILD_PCIMEM64_START 0x8000000000ULL #define BUILD_PCIMEM64_END 0x10000000000ULL #define BUILD_IOAPIC_ADDR 0xfec00000 #define BUILD_IOAPIC_ID 0 #define BUILD_HPET_ADDRESS 0xfed00000 #define BUILD_APIC_ADDR 0xfee00000 // PCI IRQS #define BUILD_PCI_IRQS ((1<<5) | (1<<9) | (1<<10) | (1<<11)) // Important real-mode segments #define SEG_IVT 0x0000 #define SEG_BDA 0x0040 #define SEG_BIOS 0xf000 // Segment definitions in protected mode (see rombios32_gdt in misc.c) #define SEG32_MODE32_CS (1 << 3) #define SEG32_MODE32_DS (2 << 3) #define SEG32_MODE16_CS (3 << 3) #define SEG32_MODE16_DS (4 << 3) #define SEG32_MODE16BIG_CS (5 << 3) #define SEG32_MODE16BIG_DS (6 << 3) // Debugging levels. If non-zero and CONFIG_DEBUG_LEVEL is greater // than the specified value, then the corresponding irq handler will // report every enter event. #define DEBUG_ISR_02 1 #define DEBUG_HDL_05 1 #define DEBUG_ISR_08 20 #define DEBUG_ISR_09 9 #define DEBUG_ISR_0e 9 #define DEBUG_HDL_10 20 #define DEBUG_HDL_11 2 #define DEBUG_HDL_12 2 #define DEBUG_HDL_13 10 #define DEBUG_HDL_14 2 #define DEBUG_HDL_15 9 #define DEBUG_HDL_16 9 #define DEBUG_HDL_17 2 #define DEBUG_HDL_18 1 #define DEBUG_HDL_19 1 #define DEBUG_HDL_1a 9 #define DEBUG_HDL_40 1 #define DEBUG_ISR_70 9 #define DEBUG_ISR_74 9 #define DEBUG_ISR_75 1 #define DEBUG_ISR_76 10 #define DEBUG_ISR_hwpic1 5 #define DEBUG_ISR_hwpic2 5 #define DEBUG_HDL_pnp 1 #define DEBUG_HDL_pmm 1 #define DEBUG_HDL_pcibios 9 #define DEBUG_HDL_apm 9 #define DEBUG_unimplemented 2 #define DEBUG_invalid 3 #define DEBUG_thread 2 #endif // config.h tinyvisor/bios/src/usb-hub.c0000644006644000001440000001143612172661303016326 0ustar yuichi_xyusers// Code for handling standard USB hubs. // // Copyright (C) 2010 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "util.h" // dprintf #include "config.h" // CONFIG_USB_HUB #include "usb-hub.h" // struct usb_hub_descriptor #include "usb.h" // struct usb_s static int get_hub_desc(struct usb_pipe *pipe, struct usb_hub_descriptor *desc) { struct usb_ctrlrequest req; req.bRequestType = USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_DEVICE; req.bRequest = USB_REQ_GET_DESCRIPTOR; req.wValue = USB_DT_HUB<<8; req.wIndex = 0; req.wLength = sizeof(*desc); return send_default_control(pipe, &req, desc); } static int set_port_feature(struct usbhub_s *hub, int port, int feature) { struct usb_ctrlrequest req; req.bRequestType = USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_OTHER; req.bRequest = USB_REQ_SET_FEATURE; req.wValue = feature; req.wIndex = port + 1; req.wLength = 0; mutex_lock(&hub->lock); int ret = send_default_control(hub->usbdev->defpipe, &req, NULL); mutex_unlock(&hub->lock); return ret; } static int clear_port_feature(struct usbhub_s *hub, int port, int feature) { struct usb_ctrlrequest req; req.bRequestType = USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_OTHER; req.bRequest = USB_REQ_CLEAR_FEATURE; req.wValue = feature; req.wIndex = port + 1; req.wLength = 0; mutex_lock(&hub->lock); int ret = send_default_control(hub->usbdev->defpipe, &req, NULL); mutex_unlock(&hub->lock); return ret; } static int get_port_status(struct usbhub_s *hub, int port, struct usb_port_status *sts) { struct usb_ctrlrequest req; req.bRequestType = USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_OTHER; req.bRequest = USB_REQ_GET_STATUS; req.wValue = 0; req.wIndex = port + 1; req.wLength = sizeof(*sts); mutex_lock(&hub->lock); int ret = send_default_control(hub->usbdev->defpipe, &req, sts); mutex_unlock(&hub->lock); return ret; } // Check if device attached to port static int usb_hub_detect(struct usbhub_s *hub, u32 port) { // Turn on power to port. int ret = set_port_feature(hub, port, USB_PORT_FEAT_POWER); if (ret) goto fail; // Wait for port power to stabilize. msleep(hub->powerwait); // Check periodically for a device connect. struct usb_port_status sts; u64 end = calc_future_tsc(USB_TIME_SIGATT); for (;;) { ret = get_port_status(hub, port, &sts); if (ret) goto fail; if (sts.wPortStatus & USB_PORT_STAT_CONNECTION) // Device connected. break; if (check_tsc(end)) // No device found. return -1; msleep(5); } // XXX - wait USB_TIME_ATTDB time? return 0; fail: dprintf(1, "Failure on hub port %d detect\n", port); return -1; } // Disable port static void usb_hub_disconnect(struct usbhub_s *hub, u32 port) { int ret = clear_port_feature(hub, port, USB_PORT_FEAT_ENABLE); if (ret) dprintf(1, "Failure on hub port %d disconnect\n", port); } // Reset device on port static int usb_hub_reset(struct usbhub_s *hub, u32 port) { int ret = set_port_feature(hub, port, USB_PORT_FEAT_RESET); if (ret) goto fail; // Wait for reset to complete. struct usb_port_status sts; u64 end = calc_future_tsc(USB_TIME_DRST * 2); for (;;) { ret = get_port_status(hub, port, &sts); if (ret) goto fail; if (!(sts.wPortStatus & USB_PORT_STAT_RESET)) break; if (check_tsc(end)) { warn_timeout(); goto fail; } msleep(5); } // Reset complete. if (!(sts.wPortStatus & USB_PORT_STAT_CONNECTION)) // Device no longer present return -1; return ((sts.wPortStatus & USB_PORT_STAT_SPEED_MASK) >> USB_PORT_STAT_SPEED_SHIFT); fail: dprintf(1, "Failure on hub port %d reset\n", port); usb_hub_disconnect(hub, port); return -1; } static struct usbhub_op_s HubOp = { .detect = usb_hub_detect, .reset = usb_hub_reset, .disconnect = usb_hub_disconnect, }; // Configure a usb hub and then find devices connected to it. int usb_hub_setup(struct usbdevice_s *usbdev) { ASSERT32FLAT(); if (!CONFIG_USB_HUB) return -1; struct usb_hub_descriptor desc; int ret = get_hub_desc(usbdev->defpipe, &desc); if (ret) return ret; struct usbhub_s hub; memset(&hub, 0, sizeof(hub)); hub.usbdev = usbdev; hub.cntl = usbdev->defpipe->cntl; hub.powerwait = desc.bPwrOn2PwrGood * 2; hub.portcount = desc.bNbrPorts; hub.op = &HubOp; usb_enumerate(&hub); dprintf(1, "Initialized USB HUB (%d ports used)\n", hub.devcount); if (hub.devcount) return 0; return -1; } tinyvisor/bios/README0000644006644000001440000001654412172661303014713 0ustar yuichi_xyusersThis code implements an X86 legacy bios. It is intended to be compiled using standard gnu tools (eg, gas and gcc). To build, one should be able to run "make" in the main directory. The resulting file "out/bios.bin" contains the processed bios image. Testing of images: To test the bios under bochs, one will need to instruct bochs to use the new bios image. Use the 'romimage' option - for example: bochs -q 'floppya: 1_44=myfdimage.img' 'romimage: file=out/bios.bin' To test under qemu, one will need to create a directory with all the bios images and then overwrite the main bios image. For example: cp /usr/share/qemu/*.bin mybiosdir/ cp out/bios.bin mybiosdir/ cp out/*.aml mybiosdir/ Once this is setup, one can instruct qemu to use the newly created directory for rom images. For example: qemu -L mybiosdir/ -fda myfdimage.img Overview of files: The src/ directory contains the bios source code. Several of the files are compiled twice - once for 16bit mode and once for 32bit mode. (The build system will remove code that is not needed for a particular mode.) The tools/ directory contains helper utilities for manipulating and building the final rom. The out/ directory is created by the build process - it contains all temporary and final files. Build overview: The 16bit code is compiled via gcc to assembler (file out/ccode.16.s). The gcc "-fwhole-program" and "-ffunction-sections -fdata-sections" options are used to optimize the process so that gcc can efficiently compile and discard unneeded code. (In the code, one can use the macros 'VISIBLE16' and 'VISIBLE32FLAT' to instruct a symbol to be outputted in 16bit and 32bit mode respectively.) This resulting assembler code is pulled into romlayout.S. The gas option ".code16gcc" is used prior to including the gcc generated assembler - this option enables gcc to generate valid 16 bit code. The post code (post.c) is entered, via the function handle_post(), in 32bit mode. The 16bit post vector (in romlayout.S) transitions the cpu into 32 bit mode before calling the post.c code. In the last step of compilation, the 32 bit code is merged into the 16 bit code so that one binary file contains both. Currently, both 16bit and 32bit code will be located in the memory at 0xe0000-0xfffff. GCC 16 bit limitations: Although the 16bit code is compiled with gcc, developers need to be aware of the environment. In particular, global variables _must_ be treated specially. The code has full access to stack variables and general purpose registers. The entry code in romlayout.S will push the original registers on the stack before calling the C code and then pop them off (including any required changes) before returning from the interrupt. Changes to CS, DS, and ES segment registers in C code is also safe. Changes to other segment registers (SS, FS, GS) need to be restored manually. Stack variables (and pointers to stack variables) work as they normally do in standard C code. However, variables stored outside the stack need to be accessed via the GET_VAR and SET_VAR macros (or one of the helper macros described below). This is due to the 16bit segment nature of the X86 cpu when it is in "real mode". The C entry code will set DS and SS to point to the stack segment. Variables not on the stack need to be accessed via an explicit segment register. Any other access requires altering one of the other segment registers (usually ES) and then accessing the variable via that segment register. There are three low-level ways to access a remote variable: GET/SET_VAR, GET/SET_FARVAR, and GET/SET_FLATPTR. The first set takes an explicit segment descriptor (eg, "CS") and offset. The second set will take a segment id and offset, set ES to the segment id, and then make the access via the ES segment. The last method is similar to the second, except it takes a pointer that would be valid in 32-bit flat mode instead of a segment/offset pair. Most BIOS variables are stored in global variables, the "BDA", or "EBDA" memory areas. Because this is common, three sets of helper macros (GET/SET_GLOBAL, GET/SET_BDA, and GET/SET_EBDA) are available to simplify these accesses. Global variables defined in the C code can be read in 16bit mode if the variable declaration is marked with VAR16, VAR16VISIBLE, VAR16EXPORT, or VAR16FIXED. The GET_GLOBAL macro will then allow read access to the variable. Global variables are stored in the 0xf000 segment. Because the f-segment is marked read-only during run-time, the 16bit code is not permitted to change the value of 16bit variables (use of the SET_GLOBAL macro from 16bit mode will cause a link error). Code running in 32bit mode can not access variables with VAR16, but can access variables marked with VAR16VISIBLE, VAR16EXPORT, VAR16FIXED, or with no marking at all. The 32bit code can use the GET/SET_GLOBAL macros, but they are not required. GCC 16 bit stack limitations: Another limitation of gcc is its use of 32-bit temporaries. Gcc will allocate 32-bits of space for every variable - even if that variable is only defined as a 'u8' or 'u16'. If one is not careful, using too much stack space can break old DOS applications. There does not appear to be explicit documentation on the minimum stack space available for bios calls. However, Freedos has been observed to call into the bios with less than 150 bytes available. Note that the post code and boot code (irq 18/19) do not have a stack limitation because the entry points for these functions transition the cpu to 32bit mode and reset the stack to a known state. Only the general purpose 16-bit service entry points are affected. There are some ways to reduce stack usage: making sure functions are tail-recursive often helps, reducing the number of parameters passed to functions often helps, sometimes reordering variable declarations helps, inlining of functions can sometimes help, and passing of packed structures can also help. It is also possible to transition to/from an extra stack stored in the EBDA using the stack_hop helper function. Some useful stats: the overhead for the entry to a bios handler that takes a 'struct bregs' is 42 bytes of stack space (6 bytes from interrupt insn, 32 bytes to store registers, and 4 bytes for call insn). An entry to an ISR handler without args takes 30 bytes (6 + 20 + 4). Debugging the bios: The bios will output information messages to a special debug port. Under qemu, one can view these messages by adding '-chardev stdio,id=seabios -device isa-debugcon,iobase=0x402,chardev=seabios' to the qemu command line. Once this is done, one should see status messages on the console. The gdb-server mechanism of qemu is also useful. One can use gdb with qemu to debug system images. To use this, add '-s -S' to the qemu command line. For example: qemu -L mybiosdir/ -fda myfdimage.img -s -S Then, in another session, run gdb with either out/rom16.o (to debug bios 16bit code) or out/rom32.o (to debug bios 32bit code). For example: gdb out/rom16.o Once in gdb, use the command "target remote localhost:1234" to have gdb connect to qemu. See the qemu documentation for more information on using gdb and qemu in this mode. Note that gdb seems to get breakpoints confused when the cpu is in 16-bit real mode. This makes stepping through the program difficult (though 'step instruction' still works). Also, one may need to set 16bit break points at both the cpu address and memory address (eg, break *0x1234 ; break *0xf1234). tinyvisor/bios/coreboot-config0000644006644000001440000000245312172661303017027 0ustar yuichi_xyusers# # Automatically generated make config: don't edit # SeaBIOS Configuration # Sun Jul 7 21:33:35 2013 # # # General Features # CONFIG_COREBOOT=y # CONFIG_QEMU is not set # CONFIG_CSM is not set # CONFIG_QEMU_HARDWARE is not set CONFIG_THREADS=y CONFIG_THREAD_OPTIONROMS=y CONFIG_RELOCATE_INIT=y CONFIG_BOOTMENU=y CONFIG_BOOTSPLASH=y CONFIG_BOOTORDER=y CONFIG_COREBOOT_FLASH=y CONFIG_LZMA=y CONFIG_FLASH_FLOPPY=y CONFIG_ENTRY_EXTRASTACK=y # # Hardware support # CONFIG_ATA=y CONFIG_ATA_DMA=y # CONFIG_ATA_PIO32 is not set CONFIG_AHCI=y CONFIG_MEGASAS=y CONFIG_FLOPPY=y CONFIG_PS2PORT=y CONFIG_USB=y CONFIG_USB_UHCI=y CONFIG_USB_OHCI=y CONFIG_USB_EHCI=y CONFIG_USB_MSC=y CONFIG_USB_UAS=y CONFIG_USB_HUB=y CONFIG_USB_KEYBOARD=y CONFIG_USB_MOUSE=y CONFIG_SERIAL=y CONFIG_LPT=y CONFIG_PMTIMER=y # # BIOS interfaces # CONFIG_DRIVES=y CONFIG_CDROM_BOOT=y CONFIG_CDROM_EMU=y CONFIG_PCIBIOS=y CONFIG_APMBIOS=y CONFIG_PNPBIOS=y CONFIG_OPTIONROMS=y CONFIG_PMM=y CONFIG_BOOT=y CONFIG_KEYBOARD=y CONFIG_KBD_CALL_INT15_4F=y CONFIG_MOUSE=y CONFIG_S3_RESUME=y CONFIG_VGAHOOKS=y # CONFIG_DISABLE_A20 is not set # # VGA ROM # CONFIG_NO_VGABIOS=y # CONFIG_VGA_GEODEGX2 is not set # CONFIG_VGA_GEODELX is not set # CONFIG_BUILD_VGABIOS is not set # # Debugging # CONFIG_DEBUG_LEVEL=1 CONFIG_DEBUG_SERIAL=y CONFIG_DEBUG_SERIAL_PORT=0x3f8 tinyvisor/bios/COPYING.LESSER0000644006644000001440000001672711733243570016071 0ustar yuichi_xyusers GNU LESSER GENERAL PUBLIC LICENSE Version 3, 29 June 2007 Copyright (C) 2007 Free Software Foundation, Inc. Everyone is permitted to copy and distribute verbatim copies of this license document, but changing it is not allowed. This version of the GNU Lesser General Public License incorporates the terms and conditions of version 3 of the GNU General Public License, supplemented by the additional permissions listed below. 0. Additional Definitions. As used herein, "this License" refers to version 3 of the GNU Lesser General Public License, and the "GNU GPL" refers to version 3 of the GNU General Public License. "The Library" refers to a covered work governed by this License, other than an Application or a Combined Work as defined below. An "Application" is any work that makes use of an interface provided by the Library, but which is not otherwise based on the Library. Defining a subclass of a class defined by the Library is deemed a mode of using an interface provided by the Library. A "Combined Work" is a work produced by combining or linking an Application with the Library. The particular version of the Library with which the Combined Work was made is also called the "Linked Version". The "Minimal Corresponding Source" for a Combined Work means the Corresponding Source for the Combined Work, excluding any source code for portions of the Combined Work that, considered in isolation, are based on the Application, and not on the Linked Version. The "Corresponding Application Code" for a Combined Work means the object code and/or source code for the Application, including any data and utility programs needed for reproducing the Combined Work from the Application, but excluding the System Libraries of the Combined Work. 1. Exception to Section 3 of the GNU GPL. You may convey a covered work under sections 3 and 4 of this License without being bound by section 3 of the GNU GPL. 2. Conveying Modified Versions. If you modify a copy of the Library, and, in your modifications, a facility refers to a function or data to be supplied by an Application that uses the facility (other than as an argument passed when the facility is invoked), then you may convey a copy of the modified version: a) under this License, provided that you make a good faith effort to ensure that, in the event an Application does not supply the function or data, the facility still operates, and performs whatever part of its purpose remains meaningful, or b) under the GNU GPL, with none of the additional permissions of this License applicable to that copy. 3. Object Code Incorporating Material from Library Header Files. The object code form of an Application may incorporate material from a header file that is part of the Library. You may convey such object code under terms of your choice, provided that, if the incorporated material is not limited to numerical parameters, data structure layouts and accessors, or small macros, inline functions and templates (ten or fewer lines in length), you do both of the following: a) Give prominent notice with each copy of the object code that the Library is used in it and that the Library and its use are covered by this License. b) Accompany the object code with a copy of the GNU GPL and this license document. 4. Combined Works. You may convey a Combined Work under terms of your choice that, taken together, effectively do not restrict modification of the portions of the Library contained in the Combined Work and reverse engineering for debugging such modifications, if you also do each of the following: a) Give prominent notice with each copy of the Combined Work that the Library is used in it and that the Library and its use are covered by this License. b) Accompany the Combined Work with a copy of the GNU GPL and this license document. c) For a Combined Work that displays copyright notices during execution, include the copyright notice for the Library among these notices, as well as a reference directing the user to the copies of the GNU GPL and this license document. d) Do one of the following: 0) Convey the Minimal Corresponding Source under the terms of this License, and the Corresponding Application Code in a form suitable for, and under terms that permit, the user to recombine or relink the Application with a modified version of the Linked Version to produce a modified Combined Work, in the manner specified by section 6 of the GNU GPL for conveying Corresponding Source. 1) Use a suitable shared library mechanism for linking with the Library. A suitable mechanism is one that (a) uses at run time a copy of the Library already present on the user's computer system, and (b) will operate properly with a modified version of the Library that is interface-compatible with the Linked Version. e) Provide Installation Information, but only if you would otherwise be required to provide such information under section 6 of the GNU GPL, and only to the extent that such information is necessary to install and execute a modified version of the Combined Work produced by recombining or relinking the Application with a modified version of the Linked Version. (If you use option 4d0, the Installation Information must accompany the Minimal Corresponding Source and Corresponding Application Code. If you use option 4d1, you must provide the Installation Information in the manner specified by section 6 of the GNU GPL for conveying Corresponding Source.) 5. Combined Libraries. You may place library facilities that are a work based on the Library side by side in a single library together with other library facilities that are not Applications and are not covered by this License, and convey such a combined library under terms of your choice, if you do both of the following: a) Accompany the combined library with a copy of the same work based on the Library, uncombined with any other library facilities, conveyed under the terms of this License. b) Give prominent notice with the combined library that part of it is a work based on the Library, and explaining where to find the accompanying uncombined form of the same work. 6. Revised Versions of the GNU Lesser General Public License. The Free Software Foundation may publish revised and/or new versions of the GNU Lesser General Public License from time to time. Such new versions will be similar in spirit to the present version, but may differ in detail to address new problems or concerns. Each version is given a distinguishing version number. If the Library as you received it specifies that a certain numbered version of the GNU Lesser General Public License "or any later version" applies to it, you have the option of following the terms and conditions either of that published version or of any later version published by the Free Software Foundation. If the Library as you received it does not specify a version number of the GNU Lesser General Public License, you may choose any version of the GNU Lesser General Public License ever published by the Free Software Foundation. If the Library as you received it specifies that a proxy can decide whether future versions of the GNU Lesser General Public License shall apply, that proxy's public statement of acceptance of any version is permanent authorization for you to choose that version for the Library. tinyvisor/bios/COPYING0000644006644000001440000010451311733243570015064 0ustar yuichi_xyusers GNU GENERAL PUBLIC LICENSE Version 3, 29 June 2007 Copyright (C) 2007 Free Software Foundation, Inc. Everyone is permitted to copy and distribute verbatim copies of this license document, but changing it is not allowed. Preamble The GNU General Public License is a free, copyleft license for software and other kinds of works. The licenses for most software and other practical works are designed to take away your freedom to share and change the works. By contrast, the GNU General Public License is intended to guarantee your freedom to share and change all versions of a program--to make sure it remains free software for all its users. We, the Free Software Foundation, use the GNU General Public License for most of our software; it applies also to any other work released this way by its authors. You can apply it to your programs, too. When we speak of free software, we are referring to freedom, not price. Our General Public Licenses are designed to make sure that you have the freedom to distribute copies of free software (and charge for them if you wish), that you receive source code or can get it if you want it, that you can change the software or use pieces of it in new free programs, and that you know you can do these things. To protect your rights, we need to prevent others from denying you these rights or asking you to surrender the rights. Therefore, you have certain responsibilities if you distribute copies of the software, or if you modify it: responsibilities to respect the freedom of others. For example, if you distribute copies of such a program, whether gratis or for a fee, you must pass on to the recipients the same freedoms that you received. You must make sure that they, too, receive or can get the source code. And you must show them these terms so they know their rights. Developers that use the GNU GPL protect your rights with two steps: (1) assert copyright on the software, and (2) offer you this License giving you legal permission to copy, distribute and/or modify it. For the developers' and authors' protection, the GPL clearly explains that there is no warranty for this free software. For both users' and authors' sake, the GPL requires that modified versions be marked as changed, so that their problems will not be attributed erroneously to authors of previous versions. Some devices are designed to deny users access to install or run modified versions of the software inside them, although the manufacturer can do so. This is fundamentally incompatible with the aim of protecting users' freedom to change the software. The systematic pattern of such abuse occurs in the area of products for individuals to use, which is precisely where it is most unacceptable. Therefore, we have designed this version of the GPL to prohibit the practice for those products. If such problems arise substantially in other domains, we stand ready to extend this provision to those domains in future versions of the GPL, as needed to protect the freedom of users. Finally, every program is threatened constantly by software patents. States should not allow patents to restrict development and use of software on general-purpose computers, but in those that do, we wish to avoid the special danger that patents applied to a free program could make it effectively proprietary. To prevent this, the GPL assures that patents cannot be used to render the program non-free. The precise terms and conditions for copying, distribution and modification follow. TERMS AND CONDITIONS 0. Definitions. "This License" refers to version 3 of the GNU General Public License. "Copyright" also means copyright-like laws that apply to other kinds of works, such as semiconductor masks. "The Program" refers to any copyrightable work licensed under this License. Each licensee is addressed as "you". "Licensees" and "recipients" may be individuals or organizations. To "modify" a work means to copy from or adapt all or part of the work in a fashion requiring copyright permission, other than the making of an exact copy. The resulting work is called a "modified version" of the earlier work or a work "based on" the earlier work. A "covered work" means either the unmodified Program or a work based on the Program. To "propagate" a work means to do anything with it that, without permission, would make you directly or secondarily liable for infringement under applicable copyright law, except executing it on a computer or modifying a private copy. Propagation includes copying, distribution (with or without modification), making available to the public, and in some countries other activities as well. To "convey" a work means any kind of propagation that enables other parties to make or receive copies. Mere interaction with a user through a computer network, with no transfer of a copy, is not conveying. An interactive user interface displays "Appropriate Legal Notices" to the extent that it includes a convenient and prominently visible feature that (1) displays an appropriate copyright notice, and (2) tells the user that there is no warranty for the work (except to the extent that warranties are provided), that licensees may convey the work under this License, and how to view a copy of this License. If the interface presents a list of user commands or options, such as a menu, a prominent item in the list meets this criterion. 1. Source Code. The "source code" for a work means the preferred form of the work for making modifications to it. "Object code" means any non-source form of a work. A "Standard Interface" means an interface that either is an official standard defined by a recognized standards body, or, in the case of interfaces specified for a particular programming language, one that is widely used among developers working in that language. The "System Libraries" of an executable work include anything, other than the work as a whole, that (a) is included in the normal form of packaging a Major Component, but which is not part of that Major Component, and (b) serves only to enable use of the work with that Major Component, or to implement a Standard Interface for which an implementation is available to the public in source code form. A "Major Component", in this context, means a major essential component (kernel, window system, and so on) of the specific operating system (if any) on which the executable work runs, or a compiler used to produce the work, or an object code interpreter used to run it. The "Corresponding Source" for a work in object code form means all the source code needed to generate, install, and (for an executable work) run the object code and to modify the work, including scripts to control those activities. However, it does not include the work's System Libraries, or general-purpose tools or generally available free programs which are used unmodified in performing those activities but which are not part of the work. For example, Corresponding Source includes interface definition files associated with source files for the work, and the source code for shared libraries and dynamically linked subprograms that the work is specifically designed to require, such as by intimate data communication or control flow between those subprograms and other parts of the work. The Corresponding Source need not include anything that users can regenerate automatically from other parts of the Corresponding Source. The Corresponding Source for a work in source code form is that same work. 2. Basic Permissions. All rights granted under this License are granted for the term of copyright on the Program, and are irrevocable provided the stated conditions are met. This License explicitly affirms your unlimited permission to run the unmodified Program. The output from running a covered work is covered by this License only if the output, given its content, constitutes a covered work. This License acknowledges your rights of fair use or other equivalent, as provided by copyright law. You may make, run and propagate covered works that you do not convey, without conditions so long as your license otherwise remains in force. You may convey covered works to others for the sole purpose of having them make modifications exclusively for you, or provide you with facilities for running those works, provided that you comply with the terms of this License in conveying all material for which you do not control copyright. Those thus making or running the covered works for you must do so exclusively on your behalf, under your direction and control, on terms that prohibit them from making any copies of your copyrighted material outside their relationship with you. Conveying under any other circumstances is permitted solely under the conditions stated below. Sublicensing is not allowed; section 10 makes it unnecessary. 3. Protecting Users' Legal Rights From Anti-Circumvention Law. No covered work shall be deemed part of an effective technological measure under any applicable law fulfilling obligations under article 11 of the WIPO copyright treaty adopted on 20 December 1996, or similar laws prohibiting or restricting circumvention of such measures. When you convey a covered work, you waive any legal power to forbid circumvention of technological measures to the extent such circumvention is effected by exercising rights under this License with respect to the covered work, and you disclaim any intention to limit operation or modification of the work as a means of enforcing, against the work's users, your or third parties' legal rights to forbid circumvention of technological measures. 4. Conveying Verbatim Copies. You may convey verbatim copies of the Program's source code as you receive it, in any medium, provided that you conspicuously and appropriately publish on each copy an appropriate copyright notice; keep intact all notices stating that this License and any non-permissive terms added in accord with section 7 apply to the code; keep intact all notices of the absence of any warranty; and give all recipients a copy of this License along with the Program. You may charge any price or no price for each copy that you convey, and you may offer support or warranty protection for a fee. 5. Conveying Modified Source Versions. You may convey a work based on the Program, or the modifications to produce it from the Program, in the form of source code under the terms of section 4, provided that you also meet all of these conditions: a) The work must carry prominent notices stating that you modified it, and giving a relevant date. b) The work must carry prominent notices stating that it is released under this License and any conditions added under section 7. This requirement modifies the requirement in section 4 to "keep intact all notices". c) You must license the entire work, as a whole, under this License to anyone who comes into possession of a copy. This License will therefore apply, along with any applicable section 7 additional terms, to the whole of the work, and all its parts, regardless of how they are packaged. This License gives no permission to license the work in any other way, but it does not invalidate such permission if you have separately received it. d) If the work has interactive user interfaces, each must display Appropriate Legal Notices; however, if the Program has interactive interfaces that do not display Appropriate Legal Notices, your work need not make them do so. A compilation of a covered work with other separate and independent works, which are not by their nature extensions of the covered work, and which are not combined with it such as to form a larger program, in or on a volume of a storage or distribution medium, is called an "aggregate" if the compilation and its resulting copyright are not used to limit the access or legal rights of the compilation's users beyond what the individual works permit. Inclusion of a covered work in an aggregate does not cause this License to apply to the other parts of the aggregate. 6. Conveying Non-Source Forms. You may convey a covered work in object code form under the terms of sections 4 and 5, provided that you also convey the machine-readable Corresponding Source under the terms of this License, in one of these ways: a) Convey the object code in, or embodied in, a physical product (including a physical distribution medium), accompanied by the Corresponding Source fixed on a durable physical medium customarily used for software interchange. b) Convey the object code in, or embodied in, a physical product (including a physical distribution medium), accompanied by a written offer, valid for at least three years and valid for as long as you offer spare parts or customer support for that product model, to give anyone who possesses the object code either (1) a copy of the Corresponding Source for all the software in the product that is covered by this License, on a durable physical medium customarily used for software interchange, for a price no more than your reasonable cost of physically performing this conveying of source, or (2) access to copy the Corresponding Source from a network server at no charge. c) Convey individual copies of the object code with a copy of the written offer to provide the Corresponding Source. This alternative is allowed only occasionally and noncommercially, and only if you received the object code with such an offer, in accord with subsection 6b. d) Convey the object code by offering access from a designated place (gratis or for a charge), and offer equivalent access to the Corresponding Source in the same way through the same place at no further charge. You need not require recipients to copy the Corresponding Source along with the object code. If the place to copy the object code is a network server, the Corresponding Source may be on a different server (operated by you or a third party) that supports equivalent copying facilities, provided you maintain clear directions next to the object code saying where to find the Corresponding Source. Regardless of what server hosts the Corresponding Source, you remain obligated to ensure that it is available for as long as needed to satisfy these requirements. e) Convey the object code using peer-to-peer transmission, provided you inform other peers where the object code and Corresponding Source of the work are being offered to the general public at no charge under subsection 6d. A separable portion of the object code, whose source code is excluded from the Corresponding Source as a System Library, need not be included in conveying the object code work. A "User Product" is either (1) a "consumer product", which means any tangible personal property which is normally used for personal, family, or household purposes, or (2) anything designed or sold for incorporation into a dwelling. In determining whether a product is a consumer product, doubtful cases shall be resolved in favor of coverage. For a particular product received by a particular user, "normally used" refers to a typical or common use of that class of product, regardless of the status of the particular user or of the way in which the particular user actually uses, or expects or is expected to use, the product. A product is a consumer product regardless of whether the product has substantial commercial, industrial or non-consumer uses, unless such uses represent the only significant mode of use of the product. "Installation Information" for a User Product means any methods, procedures, authorization keys, or other information required to install and execute modified versions of a covered work in that User Product from a modified version of its Corresponding Source. The information must suffice to ensure that the continued functioning of the modified object code is in no case prevented or interfered with solely because modification has been made. If you convey an object code work under this section in, or with, or specifically for use in, a User Product, and the conveying occurs as part of a transaction in which the right of possession and use of the User Product is transferred to the recipient in perpetuity or for a fixed term (regardless of how the transaction is characterized), the Corresponding Source conveyed under this section must be accompanied by the Installation Information. But this requirement does not apply if neither you nor any third party retains the ability to install modified object code on the User Product (for example, the work has been installed in ROM). The requirement to provide Installation Information does not include a requirement to continue to provide support service, warranty, or updates for a work that has been modified or installed by the recipient, or for the User Product in which it has been modified or installed. Access to a network may be denied when the modification itself materially and adversely affects the operation of the network or violates the rules and protocols for communication across the network. Corresponding Source conveyed, and Installation Information provided, in accord with this section must be in a format that is publicly documented (and with an implementation available to the public in source code form), and must require no special password or key for unpacking, reading or copying. 7. Additional Terms. "Additional permissions" are terms that supplement the terms of this License by making exceptions from one or more of its conditions. Additional permissions that are applicable to the entire Program shall be treated as though they were included in this License, to the extent that they are valid under applicable law. If additional permissions apply only to part of the Program, that part may be used separately under those permissions, but the entire Program remains governed by this License without regard to the additional permissions. When you convey a copy of a covered work, you may at your option remove any additional permissions from that copy, or from any part of it. (Additional permissions may be written to require their own removal in certain cases when you modify the work.) You may place additional permissions on material, added by you to a covered work, for which you have or can give appropriate copyright permission. Notwithstanding any other provision of this License, for material you add to a covered work, you may (if authorized by the copyright holders of that material) supplement the terms of this License with terms: a) Disclaiming warranty or limiting liability differently from the terms of sections 15 and 16 of this License; or b) Requiring preservation of specified reasonable legal notices or author attributions in that material or in the Appropriate Legal Notices displayed by works containing it; or c) Prohibiting misrepresentation of the origin of that material, or requiring that modified versions of such material be marked in reasonable ways as different from the original version; or d) Limiting the use for publicity purposes of names of licensors or authors of the material; or e) Declining to grant rights under trademark law for use of some trade names, trademarks, or service marks; or f) Requiring indemnification of licensors and authors of that material by anyone who conveys the material (or modified versions of it) with contractual assumptions of liability to the recipient, for any liability that these contractual assumptions directly impose on those licensors and authors. All other non-permissive additional terms are considered "further restrictions" within the meaning of section 10. If the Program as you received it, or any part of it, contains a notice stating that it is governed by this License along with a term that is a further restriction, you may remove that term. If a license document contains a further restriction but permits relicensing or conveying under this License, you may add to a covered work material governed by the terms of that license document, provided that the further restriction does not survive such relicensing or conveying. If you add terms to a covered work in accord with this section, you must place, in the relevant source files, a statement of the additional terms that apply to those files, or a notice indicating where to find the applicable terms. Additional terms, permissive or non-permissive, may be stated in the form of a separately written license, or stated as exceptions; the above requirements apply either way. 8. Termination. You may not propagate or modify a covered work except as expressly provided under this License. Any attempt otherwise to propagate or modify it is void, and will automatically terminate your rights under this License (including any patent licenses granted under the third paragraph of section 11). However, if you cease all violation of this License, then your license from a particular copyright holder is reinstated (a) provisionally, unless and until the copyright holder explicitly and finally terminates your license, and (b) permanently, if the copyright holder fails to notify you of the violation by some reasonable means prior to 60 days after the cessation. Moreover, your license from a particular copyright holder is reinstated permanently if the copyright holder notifies you of the violation by some reasonable means, this is the first time you have received notice of violation of this License (for any work) from that copyright holder, and you cure the violation prior to 30 days after your receipt of the notice. Termination of your rights under this section does not terminate the licenses of parties who have received copies or rights from you under this License. If your rights have been terminated and not permanently reinstated, you do not qualify to receive new licenses for the same material under section 10. 9. Acceptance Not Required for Having Copies. You are not required to accept this License in order to receive or run a copy of the Program. Ancillary propagation of a covered work occurring solely as a consequence of using peer-to-peer transmission to receive a copy likewise does not require acceptance. However, nothing other than this License grants you permission to propagate or modify any covered work. These actions infringe copyright if you do not accept this License. Therefore, by modifying or propagating a covered work, you indicate your acceptance of this License to do so. 10. Automatic Licensing of Downstream Recipients. Each time you convey a covered work, the recipient automatically receives a license from the original licensors, to run, modify and propagate that work, subject to this License. You are not responsible for enforcing compliance by third parties with this License. An "entity transaction" is a transaction transferring control of an organization, or substantially all assets of one, or subdividing an organization, or merging organizations. If propagation of a covered work results from an entity transaction, each party to that transaction who receives a copy of the work also receives whatever licenses to the work the party's predecessor in interest had or could give under the previous paragraph, plus a right to possession of the Corresponding Source of the work from the predecessor in interest, if the predecessor has it or can get it with reasonable efforts. You may not impose any further restrictions on the exercise of the rights granted or affirmed under this License. For example, you may not impose a license fee, royalty, or other charge for exercise of rights granted under this License, and you may not initiate litigation (including a cross-claim or counterclaim in a lawsuit) alleging that any patent claim is infringed by making, using, selling, offering for sale, or importing the Program or any portion of it. 11. Patents. A "contributor" is a copyright holder who authorizes use under this License of the Program or a work on which the Program is based. The work thus licensed is called the contributor's "contributor version". A contributor's "essential patent claims" are all patent claims owned or controlled by the contributor, whether already acquired or hereafter acquired, that would be infringed by some manner, permitted by this License, of making, using, or selling its contributor version, but do not include claims that would be infringed only as a consequence of further modification of the contributor version. For purposes of this definition, "control" includes the right to grant patent sublicenses in a manner consistent with the requirements of this License. Each contributor grants you a non-exclusive, worldwide, royalty-free patent license under the contributor's essential patent claims, to make, use, sell, offer for sale, import and otherwise run, modify and propagate the contents of its contributor version. In the following three paragraphs, a "patent license" is any express agreement or commitment, however denominated, not to enforce a patent (such as an express permission to practice a patent or covenant not to sue for patent infringement). To "grant" such a patent license to a party means to make such an agreement or commitment not to enforce a patent against the party. If you convey a covered work, knowingly relying on a patent license, and the Corresponding Source of the work is not available for anyone to copy, free of charge and under the terms of this License, through a publicly available network server or other readily accessible means, then you must either (1) cause the Corresponding Source to be so available, or (2) arrange to deprive yourself of the benefit of the patent license for this particular work, or (3) arrange, in a manner consistent with the requirements of this License, to extend the patent license to downstream recipients. "Knowingly relying" means you have actual knowledge that, but for the patent license, your conveying the covered work in a country, or your recipient's use of the covered work in a country, would infringe one or more identifiable patents in that country that you have reason to believe are valid. If, pursuant to or in connection with a single transaction or arrangement, you convey, or propagate by procuring conveyance of, a covered work, and grant a patent license to some of the parties receiving the covered work authorizing them to use, propagate, modify or convey a specific copy of the covered work, then the patent license you grant is automatically extended to all recipients of the covered work and works based on it. A patent license is "discriminatory" if it does not include within the scope of its coverage, prohibits the exercise of, or is conditioned on the non-exercise of one or more of the rights that are specifically granted under this License. You may not convey a covered work if you are a party to an arrangement with a third party that is in the business of distributing software, under which you make payment to the third party based on the extent of your activity of conveying the work, and under which the third party grants, to any of the parties who would receive the covered work from you, a discriminatory patent license (a) in connection with copies of the covered work conveyed by you (or copies made from those copies), or (b) primarily for and in connection with specific products or compilations that contain the covered work, unless you entered into that arrangement, or that patent license was granted, prior to 28 March 2007. Nothing in this License shall be construed as excluding or limiting any implied license or other defenses to infringement that may otherwise be available to you under applicable patent law. 12. No Surrender of Others' Freedom. If conditions are imposed on you (whether by court order, agreement or otherwise) that contradict the conditions of this License, they do not excuse you from the conditions of this License. If you cannot convey a covered work so as to satisfy simultaneously your obligations under this License and any other pertinent obligations, then as a consequence you may not convey it at all. For example, if you agree to terms that obligate you to collect a royalty for further conveying from those to whom you convey the Program, the only way you could satisfy both those terms and this License would be to refrain entirely from conveying the Program. 13. Use with the GNU Affero General Public License. Notwithstanding any other provision of this License, you have permission to link or combine any covered work with a work licensed under version 3 of the GNU Affero General Public License into a single combined work, and to convey the resulting work. The terms of this License will continue to apply to the part which is the covered work, but the special requirements of the GNU Affero General Public License, section 13, concerning interaction through a network will apply to the combination as such. 14. Revised Versions of this License. The Free Software Foundation may publish revised and/or new versions of the GNU General Public License from time to time. Such new versions will be similar in spirit to the present version, but may differ in detail to address new problems or concerns. Each version is given a distinguishing version number. If the Program specifies that a certain numbered version of the GNU General Public License "or any later version" applies to it, you have the option of following the terms and conditions either of that numbered version or of any later version published by the Free Software Foundation. If the Program does not specify a version number of the GNU General Public License, you may choose any version ever published by the Free Software Foundation. If the Program specifies that a proxy can decide which future versions of the GNU General Public License can be used, that proxy's public statement of acceptance of a version permanently authorizes you to choose that version for the Program. Later license versions may give you additional or different permissions. However, no additional obligations are imposed on any author or copyright holder as a result of your choosing to follow a later version. 15. Disclaimer of Warranty. THERE IS NO WARRANTY FOR THE PROGRAM, TO THE EXTENT PERMITTED BY APPLICABLE LAW. EXCEPT WHEN OTHERWISE STATED IN WRITING THE COPYRIGHT HOLDERS AND/OR OTHER PARTIES PROVIDE THE PROGRAM "AS IS" WITHOUT WARRANTY OF ANY KIND, EITHER EXPRESSED OR IMPLIED, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. THE ENTIRE RISK AS TO THE QUALITY AND PERFORMANCE OF THE PROGRAM IS WITH YOU. SHOULD THE PROGRAM PROVE DEFECTIVE, YOU ASSUME THE COST OF ALL NECESSARY SERVICING, REPAIR OR CORRECTION. 16. Limitation of Liability. IN NO EVENT UNLESS REQUIRED BY APPLICABLE LAW OR AGREED TO IN WRITING WILL ANY COPYRIGHT HOLDER, OR ANY OTHER PARTY WHO MODIFIES AND/OR CONVEYS THE PROGRAM AS PERMITTED ABOVE, BE LIABLE TO YOU FOR DAMAGES, INCLUDING ANY GENERAL, SPECIAL, INCIDENTAL OR CONSEQUENTIAL DAMAGES ARISING OUT OF THE USE OR INABILITY TO USE THE PROGRAM (INCLUDING BUT NOT LIMITED TO LOSS OF DATA OR DATA BEING RENDERED INACCURATE OR LOSSES SUSTAINED BY YOU OR THIRD PARTIES OR A FAILURE OF THE PROGRAM TO OPERATE WITH ANY OTHER PROGRAMS), EVEN IF SUCH HOLDER OR OTHER PARTY HAS BEEN ADVISED OF THE POSSIBILITY OF SUCH DAMAGES. 17. Interpretation of Sections 15 and 16. If the disclaimer of warranty and limitation of liability provided above cannot be given local legal effect according to their terms, reviewing courts shall apply local law that most closely approximates an absolute waiver of all civil liability in connection with the Program, unless a warranty or assumption of liability accompanies a copy of the Program in return for a fee. END OF TERMS AND CONDITIONS How to Apply These Terms to Your New Programs If you develop a new program, and you want it to be of the greatest possible use to the public, the best way to achieve this is to make it free software which everyone can redistribute and change under these terms. To do so, attach the following notices to the program. It is safest to attach them to the start of each source file to most effectively state the exclusion of warranty; and each file should have at least the "copyright" line and a pointer to where the full notice is found. Copyright (C) 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, either version 3 of the License, or (at your option) any later version. 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. You should have received a copy of the GNU General Public License along with this program. If not, see . Also add information on how to contact you by electronic and paper mail. If the program does terminal interaction, make it output a short notice like this when it starts in an interactive mode: Copyright (C) This program comes with ABSOLUTELY NO WARRANTY; for details type `show w'. This is free software, and you are welcome to redistribute it under certain conditions; type `show c' for details. The hypothetical commands `show w' and `show c' should show the appropriate parts of the General Public License. Of course, your program's commands might be different; for a GUI interface, you would use an "about box". You should also get your employer (if you work as a programmer) or school, if any, to sign a "copyright disclaimer" for the program, if necessary. For more information on this, and how to apply and follow the GNU GPL, see . The GNU General Public License does not permit incorporating your program into proprietary programs. If your program is a subroutine library, you may consider it more useful to permit linking proprietary applications with the library. If this is what you want to do, use the GNU Lesser General Public License instead of this License. But first, please read . tinyvisor/bios/vgasrc/0000755006644000001440000000000012206363326015310 5ustar yuichi_xyuserstinyvisor/bios/vgasrc/vgahw.h0000644006644000001440000001022412172661303016572 0ustar yuichi_xyusers#ifndef __VGAHW_H #define __VGAHW_H #include "types.h" // u8 #include "config.h" // CONFIG_* #include "clext.h" // clext_set_mode #include "bochsvga.h" // bochsvga_set_mode #include "stdvga.h" // stdvga_set_mode #include "geodevga.h" // geodevga_setup static inline struct vgamode_s *vgahw_find_mode(int mode) { if (CONFIG_VGA_CIRRUS) return clext_find_mode(mode); if (CONFIG_VGA_BOCHS) return bochsvga_find_mode(mode); return stdvga_find_mode(mode); } static inline int vgahw_set_mode(struct vgamode_s *vmode_g, int flags) { if (CONFIG_VGA_CIRRUS) return clext_set_mode(vmode_g, flags); if (CONFIG_VGA_BOCHS) return bochsvga_set_mode(vmode_g, flags); return stdvga_set_mode(vmode_g, flags); } static inline void vgahw_list_modes(u16 seg, u16 *dest, u16 *last) { if (CONFIG_VGA_CIRRUS) clext_list_modes(seg, dest, last); else if (CONFIG_VGA_BOCHS) bochsvga_list_modes(seg, dest, last); else stdvga_list_modes(seg, dest, last); } static inline int vgahw_setup(void) { if (CONFIG_VGA_CIRRUS) return clext_setup(); if (CONFIG_VGA_BOCHS) return bochsvga_setup(); if (CONFIG_VGA_GEODEGX2 || CONFIG_VGA_GEODELX) return geodevga_setup(); return stdvga_setup(); } static inline int vgahw_get_window(struct vgamode_s *vmode_g, int window) { if (CONFIG_VGA_CIRRUS) return clext_get_window(vmode_g, window); if (CONFIG_VGA_BOCHS) return bochsvga_get_window(vmode_g, window); return stdvga_get_window(vmode_g, window); } static inline int vgahw_set_window(struct vgamode_s *vmode_g, int window , int val) { if (CONFIG_VGA_CIRRUS) return clext_set_window(vmode_g, window, val); if (CONFIG_VGA_BOCHS) return bochsvga_set_window(vmode_g, window, val); return stdvga_set_window(vmode_g, window, val); } static inline int vgahw_get_linelength(struct vgamode_s *vmode_g) { if (CONFIG_VGA_CIRRUS) return clext_get_linelength(vmode_g); if (CONFIG_VGA_BOCHS) return bochsvga_get_linelength(vmode_g); return stdvga_get_linelength(vmode_g); } static inline int vgahw_set_linelength(struct vgamode_s *vmode_g, int val) { if (CONFIG_VGA_CIRRUS) return clext_set_linelength(vmode_g, val); if (CONFIG_VGA_BOCHS) return bochsvga_set_linelength(vmode_g, val); return stdvga_set_linelength(vmode_g, val); } static inline int vgahw_get_displaystart(struct vgamode_s *vmode_g) { if (CONFIG_VGA_CIRRUS) return clext_get_displaystart(vmode_g); if (CONFIG_VGA_BOCHS) return bochsvga_get_displaystart(vmode_g); return stdvga_get_displaystart(vmode_g); } static inline int vgahw_set_displaystart(struct vgamode_s *vmode_g, int val) { if (CONFIG_VGA_CIRRUS) return clext_set_displaystart(vmode_g, val); if (CONFIG_VGA_BOCHS) return bochsvga_set_displaystart(vmode_g, val); return stdvga_set_displaystart(vmode_g, val); } static inline int vgahw_get_dacformat(struct vgamode_s *vmode_g) { if (CONFIG_VGA_BOCHS) return bochsvga_get_dacformat(vmode_g); return stdvga_get_dacformat(vmode_g); } static inline int vgahw_set_dacformat(struct vgamode_s *vmode_g, int val) { if (CONFIG_VGA_BOCHS) return bochsvga_set_dacformat(vmode_g, val); return stdvga_set_dacformat(vmode_g, val); } static inline int vgahw_size_state(int states) { if (CONFIG_VGA_CIRRUS) return clext_size_state(states); if (CONFIG_VGA_BOCHS) return bochsvga_size_state(states); return stdvga_size_state(states); } static inline int vgahw_save_state(u16 seg, void *data, int states) { if (CONFIG_VGA_CIRRUS) return clext_save_state(seg, data, states); if (CONFIG_VGA_BOCHS) return bochsvga_save_state(seg, data, states); return stdvga_save_state(seg, data, states); } static inline int vgahw_restore_state(u16 seg, void *data, int states) { if (CONFIG_VGA_CIRRUS) return clext_restore_state(seg, data, states); if (CONFIG_VGA_BOCHS) return bochsvga_restore_state(seg, data, states); return stdvga_restore_state(seg, data, states); } #endif // vgahw.h tinyvisor/bios/vgasrc/vgabios.h0000644006644000001440000000540112172661303017111 0ustar yuichi_xyusers#ifndef __VGABIOS_H #define __VGABIOS_H #include "types.h" // u8 #include "farptr.h" // struct segoff_s // standard BIOS Video Parameter Table struct VideoParam_s { u8 twidth; u8 theightm1; u8 cheight; u16 slength; u8 sequ_regs[4]; u8 miscreg; u8 crtc_regs[25]; u8 actl_regs[20]; u8 grdc_regs[9]; } PACKED; extern struct VideoParam_s video_param_table[29]; struct saveBDAstate { u16 video_mode; u16 video_cols; u16 video_pagesize; u16 crtc_address; u8 video_rows; u16 char_height; u8 video_ctl; u8 video_switches; u8 modeset_ctl; u16 cursor_type; u16 cursor_pos[8]; u16 video_pagestart; u8 video_page; /* current font */ struct segoff_s font0; struct segoff_s font1; }; // Mode flags #define MF_LEGACY 0x0001 #define MF_GRAYSUM 0x0002 #define MF_NOPALETTE 0x0008 #define MF_CUSTOMCRTC 0x0800 #define MF_LINEARFB 0x4000 #define MF_NOCLEARMEM 0x8000 #define MF_VBEFLAGS 0xfe00 // Memory model types #define MM_TEXT 0x00 #define MM_CGA 0x01 #define MM_HERCULES 0x02 #define MM_PLANAR 0x03 #define MM_PACKED 0x04 #define MM_NON_CHAIN_4_256 0x05 #define MM_DIRECT 0x06 #define MM_YUV 0x07 struct vgamode_s { u8 memmodel; u16 width; u16 height; u8 depth; u8 cwidth; u8 cheight; u16 sstart; }; // vgafonts.c extern u8 vgafont8[]; extern u8 vgafont14[]; extern u8 vgafont16[]; extern u8 vgafont14alt[]; extern u8 vgafont16alt[]; // Debug settings #define DEBUG_VGA_POST 1 #define DEBUG_VGA_10 3 // vgabios.c extern int VgaBDF; extern int HaveRunInit; #define SET_VGA(var, val) SET_FARVAR(get_global_seg(), (var), (val)) struct carattr { u8 car, attr, use_attr, pad; }; struct cursorpos { u8 x, y, page, pad; }; int vga_bpp(struct vgamode_s *vmode_g); u16 calc_page_size(u8 memmodel, u16 width, u16 height); void save_bda_state(u16 seg, struct saveBDAstate *info); void restore_bda_state(u16 seg, struct saveBDAstate *info); struct vgamode_s *get_current_mode(void); int vga_set_mode(int mode, int flags); // vgafb.c void vgafb_scroll(int nblines, int attr , struct cursorpos ul, struct cursorpos lr); void vgafb_write_char(struct cursorpos cp, struct carattr ca); struct carattr vgafb_read_char(struct cursorpos cp); void vgafb_write_pixel(u8 color, u16 x, u16 y); u8 vgafb_read_pixel(u16 x, u16 y); // vbe.c extern u32 VBE_total_memory; extern u32 VBE_capabilities; extern u32 VBE_framebuffer; extern u16 VBE_win_granularity; #define VBE_OEM_STRING "SeaBIOS VBE(C) 2011" #define VBE_VENDOR_STRING "SeaBIOS Developers" #define VBE_PRODUCT_STRING "SeaBIOS VBE Adapter" #define VBE_REVISION_STRING "Rev. 1" struct bregs; void handle_104f(struct bregs *regs); #endif // vgabios.h tinyvisor/bios/vgasrc/Kconfig0000644006644000001440000000600612172661303016613 0ustar yuichi_xyusers# Kconfig SeaBIOS VGA BIOS configuration menu "VGA ROM" choice prompt "VGA Hardware Type" default NO_VGABIOS config NO_VGABIOS bool "None" help Do not build a VGA BIOS. config VGA_STANDARD_VGA depends on QEMU bool "QEMU/Bochs Original IBM 256K VGA" help Build basic VGA BIOS support (pre Super-VGA) for use on emulators. config VGA_CIRRUS depends on QEMU bool "QEMU/Bochs Cirrus SVGA" help Build support for Cirrus VGA emulation found on QEMU and Bochs emulators. This is for emulators; it is not intended for use on real Cirrus hardware. config VGA_BOCHS depends on QEMU bool "QEMU/Bochs VBE SVGA" help Build support for Bochs DISPI interface (a custom VBE protocol) found on QEMU and Bochs emulators. config VGA_GEODEGX2 bool "GeodeGX2" help Build support for Geode GX2 vga. config VGA_GEODELX bool "GeodeLX" help Build support for Geode LX vga. endchoice choice depends on VGA_GEODEGX2 || VGA_GEODELX prompt "Output Mode" default VGA_OUTPUT_CRT config VGA_OUTPUT_CRT bool "CRT" help Use CRT for output. config VGA_OUTPUT_PANEL bool "Flat Panel" help Use flat panel for output. config VGA_OUTPUT_CRT_PANEL bool "CRT and Flat Panel" help Use CRT and flat panel for output. endchoice config BUILD_VGABIOS bool default !NO_VGABIOS config VGA_VBE depends on BUILD_VGABIOS bool "Video BIOS Extensions (VBE)" default y help Support VBE. config VGA_PCI depends on BUILD_VGABIOS bool "PCI ROM Headers" default y help Build PCI ROM headers so the vga rom can be extracted from a PCI device. config OVERRIDE_PCI_ID depends on VGA_PCI bool "Override PCI Vendor and Device IDs" help Specify specific values for the PCI Vendor and Device IDs. config VGA_VID depends on VGA_PCI hex prompt "PCI Vendor ID" if OVERRIDE_PCI_ID default 0x1013 if VGA_CIRRUS default 0x1234 if VGA_BOCHS default 0x100b if VGA_GEODEGX2 default 0x1022 if VGA_GEODELX default 0x0000 help Vendor ID for the PCI ROM config VGA_DID depends on VGA_PCI hex prompt "PCI Vendor ID" if OVERRIDE_PCI_ID default 0x00b8 if VGA_CIRRUS default 0x1111 if VGA_BOCHS default 0x0030 if VGA_GEODEGX2 default 0x2081 if VGA_GEODELX default 0x0000 help Device ID for the PCI ROM endmenu tinyvisor/bios/vgasrc/vgabios.c0000644006644000001440000007647612172661303017130 0ustar yuichi_xyusers// VGA bios implementation // // Copyright (C) 2009-2012 Kevin O'Connor // Copyright (C) 2001-2008 the LGPL VGABios developers Team // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "bregs.h" // struct bregs #include "biosvar.h" // GET_BDA #include "util.h" // memset #include "vgabios.h" // calc_page_size #include "optionroms.h" // struct pci_data #include "config.h" // CONFIG_* #include "stdvga.h" // stdvga_set_cursor_shape #include "clext.h" // clext_1012 #include "vgahw.h" // vgahw_set_mode #include "vbe.h" // VBE_RETURN_STATUS_FAILED #include "pci.h" // pci_config_readw #include "pci_regs.h" // PCI_VENDOR_ID // Standard Video Save Pointer Table struct VideoSavePointer_s { struct segoff_s videoparam; struct segoff_s paramdynamicsave; struct segoff_s textcharset; struct segoff_s graphcharset; struct segoff_s secsavepointer; u8 reserved[8]; } PACKED; static struct VideoSavePointer_s video_save_pointer_table VAR16; struct VideoParam_s video_param_table[29] VAR16; /**************************************************************** * PCI Data ****************************************************************/ struct pci_data rom_pci_data VAR16 VISIBLE16 = { .signature = PCI_ROM_SIGNATURE, .vendor = CONFIG_VGA_VID, .device = CONFIG_VGA_DID, .dlen = 0x18, .class_hi = 0x300, .irevision = 1, .type = PCIROM_CODETYPE_X86, .indicator = 0x80, }; /**************************************************************** * Helper functions ****************************************************************/ // Return the bits per pixel in system memory for a given mode. int vga_bpp(struct vgamode_s *vmode_g) { switch (GET_GLOBAL(vmode_g->memmodel)) { case MM_TEXT: return 16; case MM_PLANAR: return 1; } u8 depth = GET_GLOBAL(vmode_g->depth); if (depth > 8) return ALIGN(depth, 8); return depth; } u16 calc_page_size(u8 memmodel, u16 width, u16 height) { switch (memmodel) { case MM_TEXT: return ALIGN(width * height * 2, 2*1024); case MM_CGA: return 16*1024; default: return ALIGN(width * height / 8, 8*1024); } } static void set_cursor_shape(u8 start, u8 end) { start &= 0x3f; end &= 0x1f; u16 curs = (start << 8) + end; SET_BDA(cursor_type, curs); u8 modeset_ctl = GET_BDA(modeset_ctl); u16 cheight = GET_BDA(char_height); if ((modeset_ctl & 0x01) && (cheight > 8) && (end < 8) && (start < 0x20)) { if (end != (start + 1)) start = ((start + 1) * cheight / 8) - 1; else start = ((end + 1) * cheight / 8) - 2; end = ((end + 1) * cheight / 8) - 1; } stdvga_set_cursor_shape(start, end); } static u16 get_cursor_shape(u8 page) { if (page > 7) return 0; // FIXME should handle VGA 14/16 lines return GET_BDA(cursor_type); } static void set_cursor_pos(struct cursorpos cp) { u8 page = cp.page, x = cp.x, y = cp.y; // Should not happen... if (page > 7) return; // Bios cursor pos SET_BDA(cursor_pos[page], (y << 8) | x); // Set the hardware cursor u8 current = GET_BDA(video_page); if (cp.page != current) return; // Calculate the memory address int address = (GET_BDA(video_pagesize) * page + (x + y * GET_BDA(video_cols)) * 2); stdvga_set_cursor_pos(address); } static struct cursorpos get_cursor_pos(u8 page) { if (page == 0xff) // special case - use current page page = GET_BDA(video_page); if (page > 7) { struct cursorpos cp = { 0, 0, 0xfe }; return cp; } // FIXME should handle VGA 14/16 lines u16 xy = GET_BDA(cursor_pos[page]); struct cursorpos cp = {xy, xy>>8, page}; return cp; } static void set_active_page(u8 page) { if (page > 7) return; // Get the mode struct vgamode_s *vmode_g = get_current_mode(); if (!vmode_g) return; // Get cursor pos for the given page struct cursorpos cp = get_cursor_pos(page); // Calculate memory address of start of page int address = GET_BDA(video_pagesize) * page; vgahw_set_displaystart(vmode_g, address); // And change the BIOS page SET_BDA(video_pagestart, address); SET_BDA(video_page, page); dprintf(1, "Set active page %02x address %04x\n", page, address); // Display the cursor, now the page is active set_cursor_pos(cp); } static void set_scan_lines(u8 lines) { stdvga_set_scan_lines(lines); if (lines == 8) set_cursor_shape(0x06, 0x07); else set_cursor_shape(lines - 4, lines - 3); SET_BDA(char_height, lines); u16 vde = stdvga_get_vde(); u8 rows = vde / lines; SET_BDA(video_rows, rows - 1); u16 cols = GET_BDA(video_cols); SET_BDA(video_pagesize, calc_page_size(MM_TEXT, cols, rows)); } /**************************************************************** * Character writing ****************************************************************/ // Scroll the screen one line. This function is designed to be called // tail-recursive to reduce stack usage. static void noinline scroll_one(u16 nbrows, u16 nbcols, u8 page) { struct cursorpos ul = {0, 0, page}; struct cursorpos lr = {nbcols-1, nbrows-1, page}; vgafb_scroll(1, -1, ul, lr); } // Write a character to the screen at a given position. Implement // special characters and scroll the screen if necessary. static void write_teletype(struct cursorpos *pcp, struct carattr ca) { struct cursorpos cp = *pcp; // Get the dimensions u16 nbrows = GET_BDA(video_rows) + 1; u16 nbcols = GET_BDA(video_cols); switch (ca.car) { case 7: //FIXME should beep break; case 8: if (cp.x > 0) cp.x--; break; case '\r': cp.x = 0; break; case '\n': cp.y++; break; case '\t': ca.car = ' '; do { vgafb_write_char(cp, ca); cp.x++; } while (cp.x < nbcols && cp.x % 8); break; default: vgafb_write_char(cp, ca); cp.x++; } // Do we need to wrap ? if (cp.x == nbcols) { cp.x = 0; cp.y++; } // Do we need to scroll ? if (cp.y < nbrows) { *pcp = cp; return; } // Scroll screen cp.y--; *pcp = cp; scroll_one(nbrows, nbcols, cp.page); } /**************************************************************** * Save and restore bda state ****************************************************************/ void save_bda_state(u16 seg, struct saveBDAstate *info) { SET_FARVAR(seg, info->video_mode, GET_BDA(vbe_mode)); SET_FARVAR(seg, info->video_cols, GET_BDA(video_cols)); SET_FARVAR(seg, info->video_pagesize, GET_BDA(video_pagesize)); SET_FARVAR(seg, info->crtc_address, GET_BDA(crtc_address)); SET_FARVAR(seg, info->video_rows, GET_BDA(video_rows)); SET_FARVAR(seg, info->char_height, GET_BDA(char_height)); SET_FARVAR(seg, info->video_ctl, GET_BDA(video_ctl)); SET_FARVAR(seg, info->video_switches, GET_BDA(video_switches)); SET_FARVAR(seg, info->modeset_ctl, GET_BDA(modeset_ctl)); SET_FARVAR(seg, info->cursor_type, GET_BDA(cursor_type)); int i; for (i=0; i<8; i++) SET_FARVAR(seg, info->cursor_pos[i], GET_BDA(cursor_pos[i])); SET_FARVAR(seg, info->video_pagestart, GET_BDA(video_pagestart)); SET_FARVAR(seg, info->video_page, GET_BDA(video_page)); /* current font */ SET_FARVAR(seg, info->font0, GET_IVT(0x1f)); SET_FARVAR(seg, info->font1, GET_IVT(0x43)); } void restore_bda_state(u16 seg, struct saveBDAstate *info) { u16 mode = GET_FARVAR(seg, info->video_mode); SET_BDA(vbe_mode, mode); if (mode < 0x100) SET_BDA(video_mode, mode); else SET_BDA(video_mode, 0xff); SET_BDA(video_cols, GET_FARVAR(seg, info->video_cols)); SET_BDA(video_pagesize, GET_FARVAR(seg, info->video_pagesize)); SET_BDA(crtc_address, GET_FARVAR(seg, info->crtc_address)); SET_BDA(video_rows, GET_FARVAR(seg, info->video_rows)); SET_BDA(char_height, GET_FARVAR(seg, info->char_height)); SET_BDA(video_ctl, GET_FARVAR(seg, info->video_ctl)); SET_BDA(video_switches, GET_FARVAR(seg, info->video_switches)); SET_BDA(modeset_ctl, GET_FARVAR(seg, info->modeset_ctl)); SET_BDA(cursor_type, GET_FARVAR(seg, info->cursor_type)); int i; for (i = 0; i < 8; i++) SET_BDA(cursor_pos[i], GET_FARVAR(seg, info->cursor_pos[i])); SET_BDA(video_pagestart, GET_FARVAR(seg, info->video_pagestart)); SET_BDA(video_page, GET_FARVAR(seg, info->video_page)); /* current font */ SET_IVT(0x1f, GET_FARVAR(seg, info->font0)); SET_IVT(0x43, GET_FARVAR(seg, info->font1)); } /**************************************************************** * Mode setting ****************************************************************/ struct vgamode_s * get_current_mode(void) { return vgahw_find_mode(GET_BDA(vbe_mode) & ~MF_VBEFLAGS); } // Setup BDA after a mode switch. int vga_set_mode(int mode, int flags) { dprintf(1, "set VGA mode %x\n", mode); struct vgamode_s *vmode_g = vgahw_find_mode(mode); if (!vmode_g) return VBE_RETURN_STATUS_FAILED; int ret = vgahw_set_mode(vmode_g, flags); if (ret) return ret; // Set the BIOS mem int width = GET_GLOBAL(vmode_g->width); int height = GET_GLOBAL(vmode_g->height); u8 memmodel = GET_GLOBAL(vmode_g->memmodel); int cheight = GET_GLOBAL(vmode_g->cheight); if (mode < 0x100) SET_BDA(video_mode, mode); else SET_BDA(video_mode, 0xff); SET_BDA(vbe_mode, mode | (flags & MF_VBEFLAGS)); if (memmodel == MM_TEXT) { SET_BDA(video_cols, width); SET_BDA(video_rows, height-1); SET_BDA(cursor_type, 0x0607); } else { int cwidth = GET_GLOBAL(vmode_g->cwidth); SET_BDA(video_cols, width / cwidth); SET_BDA(video_rows, (height / cheight) - 1); SET_BDA(cursor_type, 0x0000); } SET_BDA(video_pagesize, calc_page_size(memmodel, width, height)); SET_BDA(crtc_address, stdvga_get_crtc()); SET_BDA(char_height, cheight); SET_BDA(video_ctl, 0x60 | (flags & MF_NOCLEARMEM ? 0x80 : 0x00)); SET_BDA(video_switches, 0xF9); SET_BDA(modeset_ctl, GET_BDA(modeset_ctl) & 0x7f); int i; for (i=0; i<8; i++) SET_BDA(cursor_pos[i], 0x0000); SET_BDA(video_pagestart, 0x0000); SET_BDA(video_page, 0x00); // FIXME We nearly have the good tables. to be reworked SET_BDA(dcc_index, 0x08); // 8 is VGA should be ok for now SET_BDA(video_savetable , SEGOFF(get_global_seg(), (u32)&video_save_pointer_table)); // FIXME SET_BDA(video_msr, 0x00); // Unavailable on vanilla vga, but... SET_BDA(video_pal, 0x00); // Unavailable on vanilla vga, but... // Set the ints 0x1F and 0x43 SET_IVT(0x1f, SEGOFF(get_global_seg(), (u32)&vgafont8[128 * 8])); switch (cheight) { case 8: SET_IVT(0x43, SEGOFF(get_global_seg(), (u32)vgafont8)); break; case 14: SET_IVT(0x43, SEGOFF(get_global_seg(), (u32)vgafont14)); break; case 16: SET_IVT(0x43, SEGOFF(get_global_seg(), (u32)vgafont16)); break; } return 0; } /**************************************************************** * VGA int 10 handler ****************************************************************/ static void handle_1000(struct bregs *regs) { int mode = regs->al & 0x7f; // Set regs->al if (mode > 7) regs->al = 0x20; else if (mode == 6) regs->al = 0x3f; else regs->al = 0x30; int flags = MF_LEGACY | (GET_BDA(modeset_ctl) & (MF_NOPALETTE|MF_GRAYSUM)); if (regs->al & 0x80) flags |= MF_NOCLEARMEM; vga_set_mode(mode, flags); } static void handle_1001(struct bregs *regs) { set_cursor_shape(regs->ch, regs->cl); } static void handle_1002(struct bregs *regs) { struct cursorpos cp = {regs->dl, regs->dh, regs->bh}; set_cursor_pos(cp); } static void handle_1003(struct bregs *regs) { regs->cx = get_cursor_shape(regs->bh); struct cursorpos cp = get_cursor_pos(regs->bh); regs->dl = cp.x; regs->dh = cp.y; } // Read light pen pos (unimplemented) static void handle_1004(struct bregs *regs) { debug_stub(regs); regs->ax = regs->bx = regs->cx = regs->dx = 0; } static void handle_1005(struct bregs *regs) { set_active_page(regs->al); } static void verify_scroll(struct bregs *regs, int dir) { u8 ulx = regs->cl, uly = regs->ch, lrx = regs->dl, lry = regs->dh; u16 nbrows = GET_BDA(video_rows) + 1; if (lry >= nbrows) lry = nbrows - 1; u16 nbcols = GET_BDA(video_cols); if (lrx >= nbcols) lrx = nbcols - 1; if (ulx > lrx || uly > lry) return; int nblines = regs->al; if (!nblines || nblines > lry - uly + 1) nblines = lry - uly + 1; u8 page = GET_BDA(video_page); struct cursorpos ul = {ulx, uly, page}; struct cursorpos lr = {lrx, lry, page}; vgafb_scroll(dir * nblines, regs->bh, ul, lr); } static void handle_1006(struct bregs *regs) { verify_scroll(regs, 1); } static void handle_1007(struct bregs *regs) { verify_scroll(regs, -1); } static void handle_1008(struct bregs *regs) { struct carattr ca = vgafb_read_char(get_cursor_pos(regs->bh)); regs->al = ca.car; regs->ah = ca.attr; } static void noinline write_chars(u8 page, struct carattr ca, u16 count) { u16 nbcols = GET_BDA(video_cols); struct cursorpos cp = get_cursor_pos(page); while (count--) { vgafb_write_char(cp, ca); cp.x++; if (cp.x >= nbcols) { cp.x -= nbcols; cp.y++; } } } static void handle_1009(struct bregs *regs) { struct carattr ca = {regs->al, regs->bl, 1}; write_chars(regs->bh, ca, regs->cx); } static void handle_100a(struct bregs *regs) { struct carattr ca = {regs->al, regs->bl, 0}; write_chars(regs->bh, ca, regs->cx); } static void handle_100b00(struct bregs *regs) { stdvga_set_border_color(regs->bl); } static void handle_100b01(struct bregs *regs) { stdvga_set_palette(regs->bl); } static void handle_100bXX(struct bregs *regs) { debug_stub(regs); } static void handle_100b(struct bregs *regs) { switch (regs->bh) { case 0x00: handle_100b00(regs); break; case 0x01: handle_100b01(regs); break; default: handle_100bXX(regs); break; } } static void handle_100c(struct bregs *regs) { // XXX - page (regs->bh) is unused vgafb_write_pixel(regs->al, regs->cx, regs->dx); } static void handle_100d(struct bregs *regs) { // XXX - page (regs->bh) is unused regs->al = vgafb_read_pixel(regs->cx, regs->dx); } static void noinline handle_100e(struct bregs *regs) { // Ralf Brown Interrupt list is WRONG on bh(page) // We do output only on the current page ! struct carattr ca = {regs->al, regs->bl, 0}; struct cursorpos cp = get_cursor_pos(0xff); write_teletype(&cp, ca); set_cursor_pos(cp); } static void handle_100f(struct bregs *regs) { regs->bh = GET_BDA(video_page); regs->al = GET_BDA(video_mode) | (GET_BDA(video_ctl) & 0x80); regs->ah = GET_BDA(video_cols); } static void handle_101000(struct bregs *regs) { if (regs->bl > 0x14) return; stdvga_attr_write(regs->bl, regs->bh); } static void handle_101001(struct bregs *regs) { stdvga_set_overscan_border_color(regs->bh); } static void handle_101002(struct bregs *regs) { stdvga_set_all_palette_reg(regs->es, (u8*)(regs->dx + 0)); } static void handle_101003(struct bregs *regs) { stdvga_toggle_intensity(regs->bl); } static void handle_101007(struct bregs *regs) { if (regs->bl > 0x14) return; regs->bh = stdvga_attr_read(regs->bl); } static void handle_101008(struct bregs *regs) { regs->bh = stdvga_get_overscan_border_color(); } static void handle_101009(struct bregs *regs) { stdvga_get_all_palette_reg(regs->es, (u8*)(regs->dx + 0)); } static void noinline handle_101010(struct bregs *regs) { u8 rgb[3] = {regs->dh, regs->ch, regs->cl}; stdvga_dac_write(GET_SEG(SS), rgb, regs->bx, 1); } static void handle_101012(struct bregs *regs) { stdvga_dac_write(regs->es, (u8*)(regs->dx + 0), regs->bx, regs->cx); } static void handle_101013(struct bregs *regs) { stdvga_select_video_dac_color_page(regs->bl, regs->bh); } static void noinline handle_101015(struct bregs *regs) { u8 rgb[3]; stdvga_dac_read(GET_SEG(SS), rgb, regs->bx, 1); regs->dh = rgb[0]; regs->ch = rgb[1]; regs->cl = rgb[2]; } static void handle_101017(struct bregs *regs) { stdvga_dac_read(regs->es, (u8*)(regs->dx + 0), regs->bx, regs->cx); } static void handle_101018(struct bregs *regs) { stdvga_pelmask_write(regs->bl); } static void handle_101019(struct bregs *regs) { regs->bl = stdvga_pelmask_read(); } static void handle_10101a(struct bregs *regs) { stdvga_read_video_dac_state(®s->bl, ®s->bh); } static void handle_10101b(struct bregs *regs) { stdvga_perform_gray_scale_summing(regs->bx, regs->cx); } static void handle_1010XX(struct bregs *regs) { debug_stub(regs); } static void handle_1010(struct bregs *regs) { switch (regs->al) { case 0x00: handle_101000(regs); break; case 0x01: handle_101001(regs); break; case 0x02: handle_101002(regs); break; case 0x03: handle_101003(regs); break; case 0x07: handle_101007(regs); break; case 0x08: handle_101008(regs); break; case 0x09: handle_101009(regs); break; case 0x10: handle_101010(regs); break; case 0x12: handle_101012(regs); break; case 0x13: handle_101013(regs); break; case 0x15: handle_101015(regs); break; case 0x17: handle_101017(regs); break; case 0x18: handle_101018(regs); break; case 0x19: handle_101019(regs); break; case 0x1a: handle_10101a(regs); break; case 0x1b: handle_10101b(regs); break; default: handle_1010XX(regs); break; } } static void handle_101100(struct bregs *regs) { stdvga_load_font(regs->es, (void*)(regs->bp+0), regs->cx , regs->dx, regs->bl, regs->bh); } static void handle_101101(struct bregs *regs) { stdvga_load_font(get_global_seg(), vgafont14, 0x100, 0, regs->bl, 14); } static void handle_101102(struct bregs *regs) { stdvga_load_font(get_global_seg(), vgafont8, 0x100, 0, regs->bl, 8); } static void handle_101103(struct bregs *regs) { stdvga_set_text_block_specifier(regs->bl); } static void handle_101104(struct bregs *regs) { stdvga_load_font(get_global_seg(), vgafont16, 0x100, 0, regs->bl, 16); } static void handle_101110(struct bregs *regs) { stdvga_load_font(regs->es, (void*)(regs->bp+0), regs->cx , regs->dx, regs->bl, regs->bh); set_scan_lines(regs->bh); } static void handle_101111(struct bregs *regs) { stdvga_load_font(get_global_seg(), vgafont14, 0x100, 0, regs->bl, 14); set_scan_lines(14); } static void handle_101112(struct bregs *regs) { stdvga_load_font(get_global_seg(), vgafont8, 0x100, 0, regs->bl, 8); set_scan_lines(8); } static void handle_101114(struct bregs *regs) { stdvga_load_font(get_global_seg(), vgafont16, 0x100, 0, regs->bl, 16); set_scan_lines(16); } static void handle_101120(struct bregs *regs) { SET_IVT(0x1f, SEGOFF(regs->es, regs->bp)); } void load_gfx_font(u16 seg, u16 off, u8 height, u8 bl, u8 dl) { u8 rows; SET_IVT(0x43, SEGOFF(seg, off)); switch(bl) { case 0: rows = dl; break; case 1: rows = 14; break; case 3: rows = 43; break; case 2: default: rows = 25; break; } SET_BDA(video_rows, rows - 1); SET_BDA(char_height, height); } static void handle_101121(struct bregs *regs) { load_gfx_font(regs->es, regs->bp, regs->cx, regs->bl, regs->dl); } static void handle_101122(struct bregs *regs) { load_gfx_font(get_global_seg(), (u32)vgafont14, 14, regs->bl, regs->dl); } static void handle_101123(struct bregs *regs) { load_gfx_font(get_global_seg(), (u32)vgafont8, 8, regs->bl, regs->dl); } static void handle_101124(struct bregs *regs) { load_gfx_font(get_global_seg(), (u32)vgafont16, 16, regs->bl, regs->dl); } static void handle_101130(struct bregs *regs) { switch (regs->bh) { case 0x00: { struct segoff_s so = GET_IVT(0x1f); regs->es = so.seg; regs->bp = so.offset; break; } case 0x01: { struct segoff_s so = GET_IVT(0x43); regs->es = so.seg; regs->bp = so.offset; break; } case 0x02: regs->es = get_global_seg(); regs->bp = (u32)vgafont14; break; case 0x03: regs->es = get_global_seg(); regs->bp = (u32)vgafont8; break; case 0x04: regs->es = get_global_seg(); regs->bp = (u32)vgafont8 + 128 * 8; break; case 0x05: regs->es = get_global_seg(); regs->bp = (u32)vgafont14alt; break; case 0x06: regs->es = get_global_seg(); regs->bp = (u32)vgafont16; break; case 0x07: regs->es = get_global_seg(); regs->bp = (u32)vgafont16alt; break; default: dprintf(1, "Get font info BH(%02x) was discarded\n", regs->bh); return; } // Set byte/char of on screen font regs->cx = GET_BDA(char_height) & 0xff; // Set Highest char row regs->dl = GET_BDA(video_rows); } static void handle_1011XX(struct bregs *regs) { debug_stub(regs); } static void handle_1011(struct bregs *regs) { switch (regs->al) { case 0x00: handle_101100(regs); break; case 0x01: handle_101101(regs); break; case 0x02: handle_101102(regs); break; case 0x03: handle_101103(regs); break; case 0x04: handle_101104(regs); break; case 0x10: handle_101110(regs); break; case 0x11: handle_101111(regs); break; case 0x12: handle_101112(regs); break; case 0x14: handle_101114(regs); break; case 0x30: handle_101130(regs); break; case 0x20: handle_101120(regs); break; case 0x21: handle_101121(regs); break; case 0x22: handle_101122(regs); break; case 0x23: handle_101123(regs); break; case 0x24: handle_101124(regs); break; default: handle_1011XX(regs); break; } } static void handle_101210(struct bregs *regs) { u16 crtc_addr = GET_BDA(crtc_address); if (crtc_addr == VGAREG_MDA_CRTC_ADDRESS) regs->bx = 0x0103; else regs->bx = 0x0003; regs->cx = GET_BDA(video_switches) & 0x0f; } static void handle_101230(struct bregs *regs) { u8 mctl = GET_BDA(modeset_ctl); u8 vswt = GET_BDA(video_switches); switch (regs->al) { case 0x00: // 200 lines mctl = (mctl & ~0x10) | 0x80; vswt = (vswt & ~0x0f) | 0x08; break; case 0x01: // 350 lines mctl &= ~0x90; vswt = (vswt & ~0x0f) | 0x09; break; case 0x02: // 400 lines mctl = (mctl & ~0x80) | 0x10; vswt = (vswt & ~0x0f) | 0x09; break; default: dprintf(1, "Select vert res (%02x) was discarded\n", regs->al); break; } SET_BDA(modeset_ctl, mctl); SET_BDA(video_switches, vswt); regs->al = 0x12; } static void handle_101231(struct bregs *regs) { u8 v = (regs->al & 0x01) << 3; u8 mctl = GET_BDA(video_ctl) & ~0x08; SET_BDA(video_ctl, mctl | v); regs->al = 0x12; } static void handle_101232(struct bregs *regs) { stdvga_enable_video_addressing(regs->al); regs->al = 0x12; } static void handle_101233(struct bregs *regs) { u8 v = ((regs->al << 1) & 0x02) ^ 0x02; u8 v2 = GET_BDA(modeset_ctl) & ~0x02; SET_BDA(modeset_ctl, v | v2); regs->al = 0x12; } static void handle_101234(struct bregs *regs) { u8 v = (regs->al & 0x01) ^ 0x01; u8 v2 = GET_BDA(modeset_ctl) & ~0x01; SET_BDA(modeset_ctl, v | v2); regs->al = 0x12; } static void handle_101235(struct bregs *regs) { debug_stub(regs); regs->al = 0x12; } static void handle_101236(struct bregs *regs) { debug_stub(regs); regs->al = 0x12; } static void handle_1012XX(struct bregs *regs) { debug_stub(regs); } static void handle_1012(struct bregs *regs) { if (CONFIG_VGA_CIRRUS && regs->bl >= 0x80) { clext_1012(regs); return; } switch (regs->bl) { case 0x10: handle_101210(regs); break; case 0x30: handle_101230(regs); break; case 0x31: handle_101231(regs); break; case 0x32: handle_101232(regs); break; case 0x33: handle_101233(regs); break; case 0x34: handle_101234(regs); break; case 0x35: handle_101235(regs); break; case 0x36: handle_101236(regs); break; default: handle_1012XX(regs); break; } } // Write string static void noinline handle_1013(struct bregs *regs) { struct cursorpos cp; if (regs->dh == 0xff) // if row=0xff special case : use current cursor position cp = get_cursor_pos(regs->bh); else cp = (struct cursorpos) {regs->dl, regs->dh, regs->bh}; u16 count = regs->cx; u8 *offset_far = (void*)(regs->bp + 0); u8 attr = regs->bl; while (count--) { u8 car = GET_FARVAR(regs->es, *offset_far); offset_far++; if (regs->al & 2) { attr = GET_FARVAR(regs->es, *offset_far); offset_far++; } struct carattr ca = {car, attr, 1}; write_teletype(&cp, ca); } if (regs->al & 1) set_cursor_pos(cp); } static void handle_101a00(struct bregs *regs) { regs->bx = GET_BDA(dcc_index); regs->al = 0x1a; } static void handle_101a01(struct bregs *regs) { SET_BDA(dcc_index, regs->bl); dprintf(1, "Alternate Display code (%02x) was discarded\n", regs->bh); regs->al = 0x1a; } static void handle_101aXX(struct bregs *regs) { debug_stub(regs); } static void handle_101a(struct bregs *regs) { switch (regs->al) { case 0x00: handle_101a00(regs); break; case 0x01: handle_101a01(regs); break; default: handle_101aXX(regs); break; } } static u8 static_functionality[0x10] VAR16 = { /* 0 */ 0xff, // All modes supported #1 /* 1 */ 0xe0, // All modes supported #2 /* 2 */ 0x0f, // All modes supported #3 /* 3 */ 0x00, 0x00, 0x00, 0x00, // reserved /* 7 */ 0x07, // 200, 350, 400 scan lines /* 8 */ 0x02, // mamimum number of visible charsets in text mode /* 9 */ 0x08, // total number of charset blocks in text mode /* a */ 0xe7, // Change to add new functions /* b */ 0x0c, // Change to add new functions /* c */ 0x00, // reserved /* d */ 0x00, // reserved /* e */ 0x00, // Change to add new functions /* f */ 0x00 // reserved }; struct funcInfo { struct segoff_s static_functionality; u8 bda_0x49[30]; u8 bda_0x84[3]; u8 dcc_index; u8 dcc_alt; u16 colors; u8 pages; u8 scan_lines; u8 primary_char; u8 secondar_char; u8 misc; u8 non_vga_mode; u8 reserved_2f[2]; u8 video_mem; u8 save_flags; u8 disp_info; u8 reserved_34[12]; }; static void handle_101b(struct bregs *regs) { u16 seg = regs->es; struct funcInfo *info = (void*)(regs->di+0); memset_far(seg, info, 0, sizeof(*info)); // Address of static functionality table SET_FARVAR(seg, info->static_functionality , SEGOFF(get_global_seg(), (u32)static_functionality)); // Hard coded copy from BIOS area. Should it be cleaner ? memcpy_far(seg, info->bda_0x49, SEG_BDA, (void*)0x49 , sizeof(info->bda_0x49)); memcpy_far(seg, info->bda_0x84, SEG_BDA, (void*)0x84 , sizeof(info->bda_0x84)); SET_FARVAR(seg, info->dcc_index, GET_BDA(dcc_index)); SET_FARVAR(seg, info->colors, 16); SET_FARVAR(seg, info->pages, 8); SET_FARVAR(seg, info->scan_lines, 2); SET_FARVAR(seg, info->video_mem, 3); regs->al = 0x1B; } static void handle_101c(struct bregs *regs) { u16 seg = regs->es; void *data = (void*)(regs->bx+0); u16 states = regs->cx; if (states & ~0x07) goto fail; int ret; switch (regs->al) { case 0x00: ret = vgahw_size_state(states); if (ret < 0) goto fail; regs->bx = ret / 64; break; case 0x01: ret = vgahw_save_state(seg, data, states); if (ret) goto fail; break; case 0x02: ret = vgahw_restore_state(seg, data, states); if (ret) goto fail; break; default: goto fail; } regs->al = 0x1c; fail: return; } static void handle_10XX(struct bregs *regs) { debug_stub(regs); } // INT 10h Video Support Service Entry Point void VISIBLE16 handle_10(struct bregs *regs) { debug_enter(regs, DEBUG_VGA_10); switch (regs->ah) { case 0x00: handle_1000(regs); break; case 0x01: handle_1001(regs); break; case 0x02: handle_1002(regs); break; case 0x03: handle_1003(regs); break; case 0x04: handle_1004(regs); break; case 0x05: handle_1005(regs); break; case 0x06: handle_1006(regs); break; case 0x07: handle_1007(regs); break; case 0x08: handle_1008(regs); break; case 0x09: handle_1009(regs); break; case 0x0a: handle_100a(regs); break; case 0x0b: handle_100b(regs); break; case 0x0c: handle_100c(regs); break; case 0x0d: handle_100d(regs); break; case 0x0e: handle_100e(regs); break; case 0x0f: handle_100f(regs); break; case 0x10: handle_1010(regs); break; case 0x11: handle_1011(regs); break; case 0x12: handle_1012(regs); break; case 0x13: handle_1013(regs); break; case 0x1a: handle_101a(regs); break; case 0x1b: handle_101b(regs); break; case 0x1c: handle_101c(regs); break; case 0x4f: handle_104f(regs); break; default: handle_10XX(regs); break; } } /**************************************************************** * VGA post ****************************************************************/ static void init_bios_area(void) { // init detected hardware BIOS Area // set 80x25 color (not clear from RBIL but usual) set_equipment_flags(0x30, 0x20); // the default char height SET_BDA(char_height, 0x10); // Clear the screen SET_BDA(video_ctl, 0x60); // Set the basic screen we have SET_BDA(video_switches, 0xf9); // Set the basic modeset options SET_BDA(modeset_ctl, 0x51); // Set the default MSR SET_BDA(video_msr, 0x09); } int VgaBDF VAR16 = -1; int HaveRunInit VAR16; void VISIBLE16 vga_post(struct bregs *regs) { debug_serial_preinit(); dprintf(1, "Start SeaVGABIOS (version %s)\n", VERSION); debug_enter(regs, DEBUG_VGA_POST); if (CONFIG_VGA_PCI && !GET_GLOBAL(HaveRunInit)) { u16 bdf = regs->ax; if ((pci_config_readw(bdf, PCI_VENDOR_ID) == GET_GLOBAL(rom_pci_data.vendor)) && (pci_config_readw(bdf, PCI_DEVICE_ID) == GET_GLOBAL(rom_pci_data.device))) SET_VGA(VgaBDF, bdf); } int ret = vgahw_setup(); if (ret) { dprintf(1, "Failed to initialize VGA hardware. Exiting.\n"); return; } if (GET_GLOBAL(HaveRunInit)) return; init_bios_area(); SET_VGA(video_save_pointer_table.videoparam , SEGOFF(get_global_seg(), (u32)video_param_table)); stdvga_build_video_param(); extern void entry_10(void); SET_IVT(0x10, SEGOFF(get_global_seg(), (u32)entry_10)); SET_VGA(HaveRunInit, 1); // Fixup checksum extern u8 _rom_header_size, _rom_header_checksum; SET_VGA(_rom_header_checksum, 0); u8 sum = -checksum_far(get_global_seg(), 0, GET_GLOBAL(_rom_header_size) * 512); SET_VGA(_rom_header_checksum, sum); } tinyvisor/bios/vgasrc/bochsvga.h0000644006644000001440000000507312172661303017260 0ustar yuichi_xyusers#ifndef __BOCHSVGA_H #define __BOCHSVGA_H #include "types.h" // u8 #include "ioport.h" // outw #define VBE_DISPI_BANK_ADDRESS 0xA0000 #define VBE_DISPI_BANK_SIZE_KB 64 #define VBE_DISPI_MAX_XRES 2560 #define VBE_DISPI_MAX_YRES 1600 #define VBE_DISPI_IOPORT_INDEX 0x01CE #define VBE_DISPI_IOPORT_DATA 0x01CF #define VBE_DISPI_INDEX_ID 0x0 #define VBE_DISPI_INDEX_XRES 0x1 #define VBE_DISPI_INDEX_YRES 0x2 #define VBE_DISPI_INDEX_BPP 0x3 #define VBE_DISPI_INDEX_ENABLE 0x4 #define VBE_DISPI_INDEX_BANK 0x5 #define VBE_DISPI_INDEX_VIRT_WIDTH 0x6 #define VBE_DISPI_INDEX_VIRT_HEIGHT 0x7 #define VBE_DISPI_INDEX_X_OFFSET 0x8 #define VBE_DISPI_INDEX_Y_OFFSET 0x9 #define VBE_DISPI_INDEX_VIDEO_MEMORY_64K 0xa #define VBE_DISPI_ID0 0xB0C0 #define VBE_DISPI_ID1 0xB0C1 #define VBE_DISPI_ID2 0xB0C2 #define VBE_DISPI_ID3 0xB0C3 #define VBE_DISPI_ID4 0xB0C4 #define VBE_DISPI_ID5 0xB0C5 #define VBE_DISPI_DISABLED 0x00 #define VBE_DISPI_ENABLED 0x01 #define VBE_DISPI_GETCAPS 0x02 #define VBE_DISPI_8BIT_DAC 0x20 #define VBE_DISPI_LFB_ENABLED 0x40 #define VBE_DISPI_NOCLEARMEM 0x80 #define VBE_DISPI_LFB_PHYSICAL_ADDRESS 0xE0000000 static inline u16 dispi_read(u16 reg) { outw(reg, VBE_DISPI_IOPORT_INDEX); return inw(VBE_DISPI_IOPORT_DATA); } static inline void dispi_write(u16 reg, u16 val) { outw(reg, VBE_DISPI_IOPORT_INDEX); outw(val, VBE_DISPI_IOPORT_DATA); } struct vgamode_s *bochsvga_find_mode(int mode); void bochsvga_list_modes(u16 seg, u16 *dest, u16 *last); int bochsvga_get_window(struct vgamode_s *vmode_g, int window); int bochsvga_set_window(struct vgamode_s *vmode_g, int window, int val); int bochsvga_get_linelength(struct vgamode_s *vmode_g); int bochsvga_set_linelength(struct vgamode_s *vmode_g, int val); int bochsvga_get_displaystart(struct vgamode_s *vmode_g); int bochsvga_set_displaystart(struct vgamode_s *vmode_g, int val); int bochsvga_get_dacformat(struct vgamode_s *vmode_g); int bochsvga_set_dacformat(struct vgamode_s *vmode_g, int val); int bochsvga_size_state(int states); int bochsvga_save_state(u16 seg, void *data, int states); int bochsvga_restore_state(u16 seg, void *data, int states); int bochsvga_set_mode(struct vgamode_s *vmode_g, int flags); int bochsvga_setup(void); #endif // bochsvga.h tinyvisor/bios/vgasrc/vgafonts.c0000644006644000001440000016555211733243570017323 0ustar yuichi_xyusers#include "vgabios.h" // vgafont8 /* * These fonts come from ftp://ftp.simtel.net/pub/simtelnet/msdos/screen/fntcol16.zip * The package is (c) by Joseph Gil * The individual fonts are public domain */ u8 vgafont8[256 * 8] VAR16 = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0x81, 0xa5, 0x81, 0xbd, 0x99, 0x81, 0x7e, 0x7e, 0xff, 0xdb, 0xff, 0xc3, 0xe7, 0xff, 0x7e, 0x6c, 0xfe, 0xfe, 0xfe, 0x7c, 0x38, 0x10, 0x00, 0x10, 0x38, 0x7c, 0xfe, 0x7c, 0x38, 0x10, 0x00, 0x38, 0x7c, 0x38, 0xfe, 0xfe, 0x7c, 0x38, 0x7c, 0x10, 0x10, 0x38, 0x7c, 0xfe, 0x7c, 0x38, 0x7c, 0x00, 0x00, 0x18, 0x3c, 0x3c, 0x18, 0x00, 0x00, 0xff, 0xff, 0xe7, 0xc3, 0xc3, 0xe7, 0xff, 0xff, 0x00, 0x3c, 0x66, 0x42, 0x42, 0x66, 0x3c, 0x00, 0xff, 0xc3, 0x99, 0xbd, 0xbd, 0x99, 0xc3, 0xff, 0x0f, 0x07, 0x0f, 0x7d, 0xcc, 0xcc, 0xcc, 0x78, 0x3c, 0x66, 0x66, 0x66, 0x3c, 0x18, 0x7e, 0x18, 0x3f, 0x33, 0x3f, 0x30, 0x30, 0x70, 0xf0, 0xe0, 0x7f, 0x63, 0x7f, 0x63, 0x63, 0x67, 0xe6, 0xc0, 0x99, 0x5a, 0x3c, 0xe7, 0xe7, 0x3c, 0x5a, 0x99, 0x80, 0xe0, 0xf8, 0xfe, 0xf8, 0xe0, 0x80, 0x00, 0x02, 0x0e, 0x3e, 0xfe, 0x3e, 0x0e, 0x02, 0x00, 0x18, 0x3c, 0x7e, 0x18, 0x18, 0x7e, 0x3c, 0x18, 0x66, 0x66, 0x66, 0x66, 0x66, 0x00, 0x66, 0x00, 0x7f, 0xdb, 0xdb, 0x7b, 0x1b, 0x1b, 0x1b, 0x00, 0x3e, 0x63, 0x38, 0x6c, 0x6c, 0x38, 0xcc, 0x78, 0x00, 0x00, 0x00, 0x00, 0x7e, 0x7e, 0x7e, 0x00, 0x18, 0x3c, 0x7e, 0x18, 0x7e, 0x3c, 0x18, 0xff, 0x18, 0x3c, 0x7e, 0x18, 0x18, 0x18, 0x18, 0x00, 0x18, 0x18, 0x18, 0x18, 0x7e, 0x3c, 0x18, 0x00, 0x00, 0x18, 0x0c, 0xfe, 0x0c, 0x18, 0x00, 0x00, 0x00, 0x30, 0x60, 0xfe, 0x60, 0x30, 0x00, 0x00, 0x00, 0x00, 0xc0, 0xc0, 0xc0, 0xfe, 0x00, 0x00, 0x00, 0x24, 0x66, 0xff, 0x66, 0x24, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x7e, 0xff, 0xff, 0x00, 0x00, 0x00, 0xff, 0xff, 0x7e, 0x3c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x78, 0x78, 0x30, 0x30, 0x00, 0x30, 0x00, 0x6c, 0x6c, 0x6c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x6c, 0x6c, 0xfe, 0x6c, 0xfe, 0x6c, 0x6c, 0x00, 0x30, 0x7c, 0xc0, 0x78, 0x0c, 0xf8, 0x30, 0x00, 0x00, 0xc6, 0xcc, 0x18, 0x30, 0x66, 0xc6, 0x00, 0x38, 0x6c, 0x38, 0x76, 0xdc, 0xcc, 0x76, 0x00, 0x60, 0x60, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x30, 0x60, 0x60, 0x60, 0x30, 0x18, 0x00, 0x60, 0x30, 0x18, 0x18, 0x18, 0x30, 0x60, 0x00, 0x00, 0x66, 0x3c, 0xff, 0x3c, 0x66, 0x00, 0x00, 0x00, 0x30, 0x30, 0xfc, 0x30, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x30, 0x60, 0x00, 0x00, 0x00, 0xfc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x30, 0x00, 0x06, 0x0c, 0x18, 0x30, 0x60, 0xc0, 0x80, 0x00, 0x7c, 0xc6, 0xce, 0xde, 0xf6, 0xe6, 0x7c, 0x00, 0x30, 0x70, 0x30, 0x30, 0x30, 0x30, 0xfc, 0x00, 0x78, 0xcc, 0x0c, 0x38, 0x60, 0xcc, 0xfc, 0x00, 0x78, 0xcc, 0x0c, 0x38, 0x0c, 0xcc, 0x78, 0x00, 0x1c, 0x3c, 0x6c, 0xcc, 0xfe, 0x0c, 0x1e, 0x00, 0xfc, 0xc0, 0xf8, 0x0c, 0x0c, 0xcc, 0x78, 0x00, 0x38, 0x60, 0xc0, 0xf8, 0xcc, 0xcc, 0x78, 0x00, 0xfc, 0xcc, 0x0c, 0x18, 0x30, 0x30, 0x30, 0x00, 0x78, 0xcc, 0xcc, 0x78, 0xcc, 0xcc, 0x78, 0x00, 0x78, 0xcc, 0xcc, 0x7c, 0x0c, 0x18, 0x70, 0x00, 0x00, 0x30, 0x30, 0x00, 0x00, 0x30, 0x30, 0x00, 0x00, 0x30, 0x30, 0x00, 0x00, 0x30, 0x30, 0x60, 0x18, 0x30, 0x60, 0xc0, 0x60, 0x30, 0x18, 0x00, 0x00, 0x00, 0xfc, 0x00, 0x00, 0xfc, 0x00, 0x00, 0x60, 0x30, 0x18, 0x0c, 0x18, 0x30, 0x60, 0x00, 0x78, 0xcc, 0x0c, 0x18, 0x30, 0x00, 0x30, 0x00, 0x7c, 0xc6, 0xde, 0xde, 0xde, 0xc0, 0x78, 0x00, 0x30, 0x78, 0xcc, 0xcc, 0xfc, 0xcc, 0xcc, 0x00, 0xfc, 0x66, 0x66, 0x7c, 0x66, 0x66, 0xfc, 0x00, 0x3c, 0x66, 0xc0, 0xc0, 0xc0, 0x66, 0x3c, 0x00, 0xf8, 0x6c, 0x66, 0x66, 0x66, 0x6c, 0xf8, 0x00, 0xfe, 0x62, 0x68, 0x78, 0x68, 0x62, 0xfe, 0x00, 0xfe, 0x62, 0x68, 0x78, 0x68, 0x60, 0xf0, 0x00, 0x3c, 0x66, 0xc0, 0xc0, 0xce, 0x66, 0x3e, 0x00, 0xcc, 0xcc, 0xcc, 0xfc, 0xcc, 0xcc, 0xcc, 0x00, 0x78, 0x30, 0x30, 0x30, 0x30, 0x30, 0x78, 0x00, 0x1e, 0x0c, 0x0c, 0x0c, 0xcc, 0xcc, 0x78, 0x00, 0xe6, 0x66, 0x6c, 0x78, 0x6c, 0x66, 0xe6, 0x00, 0xf0, 0x60, 0x60, 0x60, 0x62, 0x66, 0xfe, 0x00, 0xc6, 0xee, 0xfe, 0xfe, 0xd6, 0xc6, 0xc6, 0x00, 0xc6, 0xe6, 0xf6, 0xde, 0xce, 0xc6, 0xc6, 0x00, 0x38, 0x6c, 0xc6, 0xc6, 0xc6, 0x6c, 0x38, 0x00, 0xfc, 0x66, 0x66, 0x7c, 0x60, 0x60, 0xf0, 0x00, 0x78, 0xcc, 0xcc, 0xcc, 0xdc, 0x78, 0x1c, 0x00, 0xfc, 0x66, 0x66, 0x7c, 0x6c, 0x66, 0xe6, 0x00, 0x78, 0xcc, 0xe0, 0x70, 0x1c, 0xcc, 0x78, 0x00, 0xfc, 0xb4, 0x30, 0x30, 0x30, 0x30, 0x78, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xfc, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x78, 0x30, 0x00, 0xc6, 0xc6, 0xc6, 0xd6, 0xfe, 0xee, 0xc6, 0x00, 0xc6, 0xc6, 0x6c, 0x38, 0x38, 0x6c, 0xc6, 0x00, 0xcc, 0xcc, 0xcc, 0x78, 0x30, 0x30, 0x78, 0x00, 0xfe, 0xc6, 0x8c, 0x18, 0x32, 0x66, 0xfe, 0x00, 0x78, 0x60, 0x60, 0x60, 0x60, 0x60, 0x78, 0x00, 0xc0, 0x60, 0x30, 0x18, 0x0c, 0x06, 0x02, 0x00, 0x78, 0x18, 0x18, 0x18, 0x18, 0x18, 0x78, 0x00, 0x10, 0x38, 0x6c, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x30, 0x30, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0x76, 0x00, 0xe0, 0x60, 0x60, 0x7c, 0x66, 0x66, 0xdc, 0x00, 0x00, 0x00, 0x78, 0xcc, 0xc0, 0xcc, 0x78, 0x00, 0x1c, 0x0c, 0x0c, 0x7c, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x78, 0xcc, 0xfc, 0xc0, 0x78, 0x00, 0x38, 0x6c, 0x60, 0xf0, 0x60, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x76, 0xcc, 0xcc, 0x7c, 0x0c, 0xf8, 0xe0, 0x60, 0x6c, 0x76, 0x66, 0x66, 0xe6, 0x00, 0x30, 0x00, 0x70, 0x30, 0x30, 0x30, 0x78, 0x00, 0x0c, 0x00, 0x0c, 0x0c, 0x0c, 0xcc, 0xcc, 0x78, 0xe0, 0x60, 0x66, 0x6c, 0x78, 0x6c, 0xe6, 0x00, 0x70, 0x30, 0x30, 0x30, 0x30, 0x30, 0x78, 0x00, 0x00, 0x00, 0xcc, 0xfe, 0xfe, 0xd6, 0xc6, 0x00, 0x00, 0x00, 0xf8, 0xcc, 0xcc, 0xcc, 0xcc, 0x00, 0x00, 0x00, 0x78, 0xcc, 0xcc, 0xcc, 0x78, 0x00, 0x00, 0x00, 0xdc, 0x66, 0x66, 0x7c, 0x60, 0xf0, 0x00, 0x00, 0x76, 0xcc, 0xcc, 0x7c, 0x0c, 0x1e, 0x00, 0x00, 0xdc, 0x76, 0x66, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x7c, 0xc0, 0x78, 0x0c, 0xf8, 0x00, 0x10, 0x30, 0x7c, 0x30, 0x30, 0x34, 0x18, 0x00, 0x00, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0xcc, 0xcc, 0xcc, 0x78, 0x30, 0x00, 0x00, 0x00, 0xc6, 0xd6, 0xfe, 0xfe, 0x6c, 0x00, 0x00, 0x00, 0xc6, 0x6c, 0x38, 0x6c, 0xc6, 0x00, 0x00, 0x00, 0xcc, 0xcc, 0xcc, 0x7c, 0x0c, 0xf8, 0x00, 0x00, 0xfc, 0x98, 0x30, 0x64, 0xfc, 0x00, 0x1c, 0x30, 0x30, 0xe0, 0x30, 0x30, 0x1c, 0x00, 0x18, 0x18, 0x18, 0x00, 0x18, 0x18, 0x18, 0x00, 0xe0, 0x30, 0x30, 0x1c, 0x30, 0x30, 0xe0, 0x00, 0x76, 0xdc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0xc6, 0xc6, 0xfe, 0x00, 0x78, 0xcc, 0xc0, 0xcc, 0x78, 0x18, 0x0c, 0x78, 0x00, 0xcc, 0x00, 0xcc, 0xcc, 0xcc, 0x7e, 0x00, 0x1c, 0x00, 0x78, 0xcc, 0xfc, 0xc0, 0x78, 0x00, 0x7e, 0xc3, 0x3c, 0x06, 0x3e, 0x66, 0x3f, 0x00, 0xcc, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0x7e, 0x00, 0xe0, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0x7e, 0x00, 0x30, 0x30, 0x78, 0x0c, 0x7c, 0xcc, 0x7e, 0x00, 0x00, 0x00, 0x78, 0xc0, 0xc0, 0x78, 0x0c, 0x38, 0x7e, 0xc3, 0x3c, 0x66, 0x7e, 0x60, 0x3c, 0x00, 0xcc, 0x00, 0x78, 0xcc, 0xfc, 0xc0, 0x78, 0x00, 0xe0, 0x00, 0x78, 0xcc, 0xfc, 0xc0, 0x78, 0x00, 0xcc, 0x00, 0x70, 0x30, 0x30, 0x30, 0x78, 0x00, 0x7c, 0xc6, 0x38, 0x18, 0x18, 0x18, 0x3c, 0x00, 0xe0, 0x00, 0x70, 0x30, 0x30, 0x30, 0x78, 0x00, 0xc6, 0x38, 0x6c, 0xc6, 0xfe, 0xc6, 0xc6, 0x00, 0x30, 0x30, 0x00, 0x78, 0xcc, 0xfc, 0xcc, 0x00, 0x1c, 0x00, 0xfc, 0x60, 0x78, 0x60, 0xfc, 0x00, 0x00, 0x00, 0x7f, 0x0c, 0x7f, 0xcc, 0x7f, 0x00, 0x3e, 0x6c, 0xcc, 0xfe, 0xcc, 0xcc, 0xce, 0x00, 0x78, 0xcc, 0x00, 0x78, 0xcc, 0xcc, 0x78, 0x00, 0x00, 0xcc, 0x00, 0x78, 0xcc, 0xcc, 0x78, 0x00, 0x00, 0xe0, 0x00, 0x78, 0xcc, 0xcc, 0x78, 0x00, 0x78, 0xcc, 0x00, 0xcc, 0xcc, 0xcc, 0x7e, 0x00, 0x00, 0xe0, 0x00, 0xcc, 0xcc, 0xcc, 0x7e, 0x00, 0x00, 0xcc, 0x00, 0xcc, 0xcc, 0x7c, 0x0c, 0xf8, 0xc3, 0x18, 0x3c, 0x66, 0x66, 0x3c, 0x18, 0x00, 0xcc, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0x78, 0x00, 0x18, 0x18, 0x7e, 0xc0, 0xc0, 0x7e, 0x18, 0x18, 0x38, 0x6c, 0x64, 0xf0, 0x60, 0xe6, 0xfc, 0x00, 0xcc, 0xcc, 0x78, 0xfc, 0x30, 0xfc, 0x30, 0x30, 0xf8, 0xcc, 0xcc, 0xfa, 0xc6, 0xcf, 0xc6, 0xc7, 0x0e, 0x1b, 0x18, 0x3c, 0x18, 0x18, 0xd8, 0x70, 0x1c, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0x7e, 0x00, 0x38, 0x00, 0x70, 0x30, 0x30, 0x30, 0x78, 0x00, 0x00, 0x1c, 0x00, 0x78, 0xcc, 0xcc, 0x78, 0x00, 0x00, 0x1c, 0x00, 0xcc, 0xcc, 0xcc, 0x7e, 0x00, 0x00, 0xf8, 0x00, 0xf8, 0xcc, 0xcc, 0xcc, 0x00, 0xfc, 0x00, 0xcc, 0xec, 0xfc, 0xdc, 0xcc, 0x00, 0x3c, 0x6c, 0x6c, 0x3e, 0x00, 0x7e, 0x00, 0x00, 0x38, 0x6c, 0x6c, 0x38, 0x00, 0x7c, 0x00, 0x00, 0x30, 0x00, 0x30, 0x60, 0xc0, 0xcc, 0x78, 0x00, 0x00, 0x00, 0x00, 0xfc, 0xc0, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfc, 0x0c, 0x0c, 0x00, 0x00, 0xc3, 0xc6, 0xcc, 0xde, 0x33, 0x66, 0xcc, 0x0f, 0xc3, 0xc6, 0xcc, 0xdb, 0x37, 0x6f, 0xcf, 0x03, 0x18, 0x18, 0x00, 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x33, 0x66, 0xcc, 0x66, 0x33, 0x00, 0x00, 0x00, 0xcc, 0x66, 0x33, 0x66, 0xcc, 0x00, 0x00, 0x22, 0x88, 0x22, 0x88, 0x22, 0x88, 0x22, 0x88, 0x55, 0xaa, 0x55, 0xaa, 0x55, 0xaa, 0x55, 0xaa, 0xdb, 0x77, 0xdb, 0xee, 0xdb, 0x77, 0xdb, 0xee, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xf8, 0x18, 0x18, 0x18, 0x18, 0x18, 0xf8, 0x18, 0xf8, 0x18, 0x18, 0x18, 0x36, 0x36, 0x36, 0x36, 0xf6, 0x36, 0x36, 0x36, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x36, 0x36, 0x36, 0x00, 0x00, 0xf8, 0x18, 0xf8, 0x18, 0x18, 0x18, 0x36, 0x36, 0xf6, 0x06, 0xf6, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x00, 0x00, 0xfe, 0x06, 0xf6, 0x36, 0x36, 0x36, 0x36, 0x36, 0xf6, 0x06, 0xfe, 0x00, 0x00, 0x00, 0x36, 0x36, 0x36, 0x36, 0xfe, 0x00, 0x00, 0x00, 0x18, 0x18, 0xf8, 0x18, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf8, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x1f, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x1f, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0xff, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0xff, 0x18, 0x18, 0x18, 0x18, 0x18, 0x1f, 0x18, 0x1f, 0x18, 0x18, 0x18, 0x36, 0x36, 0x36, 0x36, 0x37, 0x36, 0x36, 0x36, 0x36, 0x36, 0x37, 0x30, 0x3f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3f, 0x30, 0x37, 0x36, 0x36, 0x36, 0x36, 0x36, 0xf7, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x00, 0xf7, 0x36, 0x36, 0x36, 0x36, 0x36, 0x37, 0x30, 0x37, 0x36, 0x36, 0x36, 0x00, 0x00, 0xff, 0x00, 0xff, 0x00, 0x00, 0x00, 0x36, 0x36, 0xf7, 0x00, 0xf7, 0x36, 0x36, 0x36, 0x18, 0x18, 0xff, 0x00, 0xff, 0x00, 0x00, 0x00, 0x36, 0x36, 0x36, 0x36, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x00, 0xff, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0xff, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x3f, 0x00, 0x00, 0x00, 0x18, 0x18, 0x1f, 0x18, 0x1f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1f, 0x18, 0x1f, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x3f, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0xff, 0x36, 0x36, 0x36, 0x18, 0x18, 0xff, 0x18, 0xff, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1f, 0x18, 0x18, 0x18, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0xff, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xdc, 0xc8, 0xdc, 0x76, 0x00, 0x00, 0x78, 0xcc, 0xf8, 0xcc, 0xf8, 0xc0, 0xc0, 0x00, 0xfc, 0xcc, 0xc0, 0xc0, 0xc0, 0xc0, 0x00, 0x00, 0xfe, 0x6c, 0x6c, 0x6c, 0x6c, 0x6c, 0x00, 0xfc, 0xcc, 0x60, 0x30, 0x60, 0xcc, 0xfc, 0x00, 0x00, 0x00, 0x7e, 0xd8, 0xd8, 0xd8, 0x70, 0x00, 0x00, 0x66, 0x66, 0x66, 0x66, 0x7c, 0x60, 0xc0, 0x00, 0x76, 0xdc, 0x18, 0x18, 0x18, 0x18, 0x00, 0xfc, 0x30, 0x78, 0xcc, 0xcc, 0x78, 0x30, 0xfc, 0x38, 0x6c, 0xc6, 0xfe, 0xc6, 0x6c, 0x38, 0x00, 0x38, 0x6c, 0xc6, 0xc6, 0x6c, 0x6c, 0xee, 0x00, 0x1c, 0x30, 0x18, 0x7c, 0xcc, 0xcc, 0x78, 0x00, 0x00, 0x00, 0x7e, 0xdb, 0xdb, 0x7e, 0x00, 0x00, 0x06, 0x0c, 0x7e, 0xdb, 0xdb, 0x7e, 0x60, 0xc0, 0x38, 0x60, 0xc0, 0xf8, 0xc0, 0x60, 0x38, 0x00, 0x78, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x00, 0x00, 0xfc, 0x00, 0xfc, 0x00, 0xfc, 0x00, 0x00, 0x30, 0x30, 0xfc, 0x30, 0x30, 0x00, 0xfc, 0x00, 0x60, 0x30, 0x18, 0x30, 0x60, 0x00, 0xfc, 0x00, 0x18, 0x30, 0x60, 0x30, 0x18, 0x00, 0xfc, 0x00, 0x0e, 0x1b, 0x1b, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xd8, 0xd8, 0x70, 0x30, 0x30, 0x00, 0xfc, 0x00, 0x30, 0x30, 0x00, 0x00, 0x76, 0xdc, 0x00, 0x76, 0xdc, 0x00, 0x00, 0x38, 0x6c, 0x6c, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x00, 0x00, 0x00, 0x0f, 0x0c, 0x0c, 0x0c, 0xec, 0x6c, 0x3c, 0x1c, 0x78, 0x6c, 0x6c, 0x6c, 0x6c, 0x00, 0x00, 0x00, 0x70, 0x18, 0x30, 0x60, 0x78, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x3c, 0x3c, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; u8 vgafont14[256 * 14] VAR16 = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0x81, 0xa5, 0x81, 0x81, 0xbd, 0x99, 0x81, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0xff, 0xdb, 0xff, 0xff, 0xc3, 0xe7, 0xff, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x6c, 0xfe, 0xfe, 0xfe, 0xfe, 0x7c, 0x38, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x7c, 0xfe, 0x7c, 0x38, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x3c, 0xe7, 0xe7, 0xe7, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x7e, 0xff, 0xff, 0x7e, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x3c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xe7, 0xc3, 0xc3, 0xe7, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x66, 0x42, 0x42, 0x66, 0x3c, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0xff, 0xc3, 0x99, 0xbd, 0xbd, 0x99, 0xc3, 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x1e, 0x0e, 0x1a, 0x32, 0x78, 0xcc, 0xcc, 0xcc, 0x78, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x66, 0x66, 0x66, 0x3c, 0x18, 0x7e, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3f, 0x33, 0x3f, 0x30, 0x30, 0x30, 0x70, 0xf0, 0xe0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7f, 0x63, 0x7f, 0x63, 0x63, 0x63, 0x67, 0xe7, 0xe6, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0xdb, 0x3c, 0xe7, 0x3c, 0xdb, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0xc0, 0xe0, 0xf8, 0xfe, 0xf8, 0xe0, 0xc0, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x06, 0x0e, 0x3e, 0xfe, 0x3e, 0x0e, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x7e, 0x18, 0x18, 0x18, 0x7e, 0x3c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x66, 0x66, 0x66, 0x66, 0x66, 0x66, 0x00, 0x66, 0x66, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7f, 0xdb, 0xdb, 0xdb, 0x7b, 0x1b, 0x1b, 0x1b, 0x1b, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0x60, 0x38, 0x6c, 0xc6, 0xc6, 0x6c, 0x38, 0x0c, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xfe, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x7e, 0x18, 0x18, 0x18, 0x7e, 0x3c, 0x18, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x7e, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x7e, 0x3c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x0c, 0xfe, 0x0c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x60, 0xfe, 0x60, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc0, 0xc0, 0xc0, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x28, 0x6c, 0xfe, 0x6c, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x38, 0x7c, 0x7c, 0xfe, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xfe, 0x7c, 0x7c, 0x38, 0x38, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x3c, 0x3c, 0x18, 0x18, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x66, 0x66, 0x66, 0x24, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x6c, 0x6c, 0xfe, 0x6c, 0x6c, 0x6c, 0xfe, 0x6c, 0x6c, 0x00, 0x00, 0x00, 0x18, 0x18, 0x7c, 0xc6, 0xc2, 0xc0, 0x7c, 0x06, 0x86, 0xc6, 0x7c, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc2, 0xc6, 0x0c, 0x18, 0x30, 0x66, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x6c, 0x38, 0x76, 0xdc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x30, 0x30, 0x30, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0c, 0x18, 0x30, 0x30, 0x30, 0x30, 0x30, 0x18, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x18, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x18, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x66, 0x3c, 0xff, 0x3c, 0x66, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x7e, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x06, 0x0c, 0x18, 0x30, 0x60, 0xc0, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xce, 0xde, 0xf6, 0xe6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x38, 0x78, 0x18, 0x18, 0x18, 0x18, 0x18, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0x06, 0x0c, 0x18, 0x30, 0x60, 0xc6, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0x06, 0x06, 0x3c, 0x06, 0x06, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0c, 0x1c, 0x3c, 0x6c, 0xcc, 0xfe, 0x0c, 0x0c, 0x1e, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xc0, 0xc0, 0xc0, 0xfc, 0x06, 0x06, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x60, 0xc0, 0xc0, 0xfc, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xc6, 0x06, 0x0c, 0x18, 0x30, 0x30, 0x30, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0x7c, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0x7e, 0x06, 0x06, 0x0c, 0x78, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x18, 0x18, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x06, 0x0c, 0x18, 0x30, 0x60, 0x30, 0x18, 0x0c, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0x00, 0x00, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x60, 0x30, 0x18, 0x0c, 0x06, 0x0c, 0x18, 0x30, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0x0c, 0x18, 0x18, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xde, 0xde, 0xde, 0xdc, 0xc0, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0xc6, 0xc6, 0xfe, 0xc6, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfc, 0x66, 0x66, 0x66, 0x7c, 0x66, 0x66, 0x66, 0xfc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x66, 0xc2, 0xc0, 0xc0, 0xc0, 0xc2, 0x66, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf8, 0x6c, 0x66, 0x66, 0x66, 0x66, 0x66, 0x6c, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x66, 0x62, 0x68, 0x78, 0x68, 0x62, 0x66, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x66, 0x62, 0x68, 0x78, 0x68, 0x60, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x66, 0xc2, 0xc0, 0xc0, 0xde, 0xc6, 0x66, 0x3a, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0xc6, 0xc6, 0xfe, 0xc6, 0xc6, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1e, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0xcc, 0xcc, 0x78, 0x00, 0x00, 0x00, 0x00, 0x00, 0xe6, 0x66, 0x6c, 0x6c, 0x78, 0x6c, 0x6c, 0x66, 0xe6, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf0, 0x60, 0x60, 0x60, 0x60, 0x60, 0x62, 0x66, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xee, 0xfe, 0xfe, 0xd6, 0xc6, 0xc6, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xe6, 0xf6, 0xfe, 0xde, 0xce, 0xc6, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x6c, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfc, 0x66, 0x66, 0x66, 0x7c, 0x60, 0x60, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0xd6, 0xde, 0x7c, 0x0c, 0x0e, 0x00, 0x00, 0x00, 0x00, 0xfc, 0x66, 0x66, 0x66, 0x7c, 0x6c, 0x66, 0x66, 0xe6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0x60, 0x38, 0x0c, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0x7e, 0x5a, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x6c, 0x38, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0xc6, 0xc6, 0xd6, 0xd6, 0xfe, 0x7c, 0x6c, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0x6c, 0x38, 0x38, 0x38, 0x6c, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x66, 0x66, 0x66, 0x66, 0x3c, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xc6, 0x8c, 0x18, 0x30, 0x60, 0xc2, 0xc6, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x30, 0x30, 0x30, 0x30, 0x30, 0x30, 0x30, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0xc0, 0xe0, 0x70, 0x38, 0x1c, 0x0e, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x3c, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x00, 0x30, 0x30, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0xe0, 0x60, 0x60, 0x78, 0x6c, 0x66, 0x66, 0x66, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc0, 0xc0, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1c, 0x0c, 0x0c, 0x3c, 0x6c, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xfe, 0xc0, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x64, 0x60, 0xf0, 0x60, 0x60, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xcc, 0xcc, 0xcc, 0x7c, 0x0c, 0xcc, 0x78, 0x00, 0x00, 0x00, 0xe0, 0x60, 0x60, 0x6c, 0x76, 0x66, 0x66, 0x66, 0xe6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x38, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x06, 0x06, 0x00, 0x0e, 0x06, 0x06, 0x06, 0x06, 0x66, 0x66, 0x3c, 0x00, 0x00, 0x00, 0xe0, 0x60, 0x60, 0x66, 0x6c, 0x78, 0x6c, 0x66, 0xe6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xec, 0xfe, 0xd6, 0xd6, 0xd6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xdc, 0x66, 0x66, 0x66, 0x66, 0x66, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xdc, 0x66, 0x66, 0x66, 0x7c, 0x60, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xcc, 0xcc, 0xcc, 0x7c, 0x0c, 0x0c, 0x1e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xdc, 0x76, 0x66, 0x60, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0x70, 0x1c, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x30, 0x30, 0xfc, 0x30, 0x30, 0x30, 0x36, 0x1c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x66, 0x66, 0x66, 0x66, 0x3c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0xd6, 0xd6, 0xfe, 0x6c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0x6c, 0x38, 0x38, 0x6c, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0xc6, 0xc6, 0x7e, 0x06, 0x0c, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xcc, 0x18, 0x30, 0x66, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0e, 0x18, 0x18, 0x18, 0x70, 0x18, 0x18, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0x00, 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x70, 0x18, 0x18, 0x18, 0x0e, 0x18, 0x18, 0x18, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xdc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0xc6, 0xc6, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x66, 0xc2, 0xc0, 0xc0, 0xc2, 0x66, 0x3c, 0x0c, 0x06, 0x7c, 0x00, 0x00, 0x00, 0xcc, 0xcc, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x0c, 0x18, 0x30, 0x00, 0x7c, 0xc6, 0xfe, 0xc0, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0xcc, 0xcc, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x60, 0x30, 0x18, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x38, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x66, 0x60, 0x66, 0x3c, 0x0c, 0x06, 0x3c, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0x00, 0x7c, 0xc6, 0xfe, 0xc0, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0xcc, 0xcc, 0x00, 0x7c, 0xc6, 0xfe, 0xc0, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x60, 0x30, 0x18, 0x00, 0x7c, 0xc6, 0xfe, 0xc0, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x66, 0x66, 0x00, 0x38, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x66, 0x00, 0x38, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x60, 0x30, 0x18, 0x00, 0x38, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0x10, 0x38, 0x6c, 0xc6, 0xc6, 0xfe, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x38, 0x00, 0x38, 0x6c, 0xc6, 0xc6, 0xfe, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x18, 0x30, 0x60, 0x00, 0xfe, 0x66, 0x60, 0x7c, 0x60, 0x66, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xcc, 0x76, 0x36, 0x7e, 0xd8, 0xd8, 0x6e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3e, 0x6c, 0xcc, 0xcc, 0xfe, 0xcc, 0xcc, 0xcc, 0xce, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x60, 0x30, 0x18, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x30, 0x78, 0xcc, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x60, 0x30, 0x18, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0x00, 0xc6, 0xc6, 0xc6, 0xc6, 0x7e, 0x06, 0x0c, 0x78, 0x00, 0x00, 0xc6, 0xc6, 0x38, 0x6c, 0xc6, 0xc6, 0xc6, 0xc6, 0x6c, 0x38, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0x00, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x3c, 0x66, 0x60, 0x60, 0x66, 0x3c, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x64, 0x60, 0xf0, 0x60, 0x60, 0x60, 0xe6, 0xfc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x66, 0x66, 0x3c, 0x18, 0x7e, 0x18, 0x7e, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0xf8, 0xcc, 0xcc, 0xf8, 0xc4, 0xcc, 0xde, 0xcc, 0xcc, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x0e, 0x1b, 0x18, 0x18, 0x18, 0x7e, 0x18, 0x18, 0x18, 0x18, 0xd8, 0x70, 0x00, 0x00, 0x18, 0x30, 0x60, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x0c, 0x18, 0x30, 0x00, 0x38, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x18, 0x30, 0x60, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x18, 0x30, 0x60, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xdc, 0x00, 0xdc, 0x66, 0x66, 0x66, 0x66, 0x66, 0x00, 0x00, 0x00, 0x76, 0xdc, 0x00, 0xc6, 0xe6, 0xf6, 0xfe, 0xde, 0xce, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x6c, 0x6c, 0x3e, 0x00, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x6c, 0x38, 0x00, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x30, 0x00, 0x30, 0x30, 0x60, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xc0, 0xc0, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x06, 0x06, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc0, 0xc0, 0xc6, 0xcc, 0xd8, 0x30, 0x60, 0xdc, 0x86, 0x0c, 0x18, 0x3e, 0x00, 0x00, 0xc0, 0xc0, 0xc6, 0xcc, 0xd8, 0x30, 0x66, 0xce, 0x9e, 0x3e, 0x06, 0x06, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x18, 0x18, 0x3c, 0x3c, 0x3c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x36, 0x6c, 0xd8, 0x6c, 0x36, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xd8, 0x6c, 0x36, 0x6c, 0xd8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x11, 0x44, 0x11, 0x44, 0x11, 0x44, 0x11, 0x44, 0x11, 0x44, 0x11, 0x44, 0x11, 0x44, 0x55, 0xaa, 0x55, 0xaa, 0x55, 0xaa, 0x55, 0xaa, 0x55, 0xaa, 0x55, 0xaa, 0x55, 0xaa, 0xdd, 0x77, 0xdd, 0x77, 0xdd, 0x77, 0xdd, 0x77, 0xdd, 0x77, 0xdd, 0x77, 0xdd, 0x77, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xf8, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xf8, 0x18, 0xf8, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0xf6, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf8, 0x18, 0xf8, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x36, 0x36, 0x36, 0x36, 0x36, 0xf6, 0x06, 0xf6, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x06, 0xf6, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0xf6, 0x06, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0x18, 0xf8, 0x18, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf8, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x1f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x1f, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xff, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x1f, 0x18, 0x1f, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x37, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x37, 0x30, 0x3f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3f, 0x30, 0x37, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0xf7, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x00, 0xf7, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x37, 0x30, 0x37, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x36, 0x36, 0x36, 0x36, 0x36, 0xf7, 0x00, 0xf7, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x18, 0x18, 0x18, 0x18, 0x18, 0xff, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x00, 0xff, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x3f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0x18, 0x1f, 0x18, 0x1f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1f, 0x18, 0x1f, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3f, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0xff, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x18, 0x18, 0x18, 0x18, 0x18, 0xff, 0x18, 0xff, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1f, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xdc, 0xd8, 0xd8, 0xdc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xfc, 0xc6, 0xc6, 0xfc, 0xc0, 0xc0, 0x40, 0x00, 0x00, 0x00, 0xfe, 0xc6, 0xc6, 0xc0, 0xc0, 0xc0, 0xc0, 0xc0, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x6c, 0x6c, 0x6c, 0x6c, 0x6c, 0x6c, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xc6, 0x60, 0x30, 0x18, 0x30, 0x60, 0xc6, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0xd8, 0xd8, 0xd8, 0xd8, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x66, 0x66, 0x66, 0x66, 0x7c, 0x60, 0x60, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xdc, 0x18, 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0x18, 0x3c, 0x66, 0x66, 0x66, 0x3c, 0x18, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0xc6, 0xc6, 0xfe, 0xc6, 0xc6, 0x6c, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0xc6, 0xc6, 0xc6, 0x6c, 0x6c, 0x6c, 0xee, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1e, 0x30, 0x18, 0x0c, 0x3e, 0x66, 0x66, 0x66, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0xdb, 0xdb, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0x06, 0x7e, 0xdb, 0xdb, 0xf3, 0x7e, 0x60, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1c, 0x30, 0x60, 0x60, 0x7c, 0x60, 0x60, 0x30, 0x1c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x00, 0x00, 0xfe, 0x00, 0x00, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x7e, 0x18, 0x18, 0x00, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x18, 0x0c, 0x06, 0x0c, 0x18, 0x30, 0x00, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0c, 0x18, 0x30, 0x60, 0x30, 0x18, 0x0c, 0x00, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0e, 0x1b, 0x1b, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xd8, 0xd8, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x7e, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xdc, 0x00, 0x76, 0xdc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x6c, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0f, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0xec, 0x6c, 0x3c, 0x1c, 0x00, 0x00, 0x00, 0x00, 0xd8, 0x6c, 0x6c, 0x6c, 0x6c, 0x6c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x70, 0xd8, 0x30, 0x60, 0xc8, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0x7c, 0x7c, 0x7c, 0x7c, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; u8 vgafont16[256 * 16] VAR16 = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0x81, 0xa5, 0x81, 0x81, 0xbd, 0x99, 0x81, 0x81, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0xff, 0xdb, 0xff, 0xff, 0xc3, 0xe7, 0xff, 0xff, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x6c, 0xfe, 0xfe, 0xfe, 0xfe, 0x7c, 0x38, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x7c, 0xfe, 0x7c, 0x38, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x3c, 0xe7, 0xe7, 0xe7, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x7e, 0xff, 0xff, 0x7e, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x3c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xe7, 0xc3, 0xc3, 0xe7, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x66, 0x42, 0x42, 0x66, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xc3, 0x99, 0xbd, 0xbd, 0x99, 0xc3, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x1e, 0x0e, 0x1a, 0x32, 0x78, 0xcc, 0xcc, 0xcc, 0xcc, 0x78, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x66, 0x66, 0x66, 0x66, 0x3c, 0x18, 0x7e, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3f, 0x33, 0x3f, 0x30, 0x30, 0x30, 0x30, 0x70, 0xf0, 0xe0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7f, 0x63, 0x7f, 0x63, 0x63, 0x63, 0x63, 0x67, 0xe7, 0xe6, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0xdb, 0x3c, 0xe7, 0x3c, 0xdb, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0xc0, 0xe0, 0xf0, 0xf8, 0xfe, 0xf8, 0xf0, 0xe0, 0xc0, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x06, 0x0e, 0x1e, 0x3e, 0xfe, 0x3e, 0x1e, 0x0e, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x7e, 0x18, 0x18, 0x18, 0x7e, 0x3c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x66, 0x66, 0x66, 0x66, 0x66, 0x66, 0x66, 0x00, 0x66, 0x66, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7f, 0xdb, 0xdb, 0xdb, 0x7b, 0x1b, 0x1b, 0x1b, 0x1b, 0x1b, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0x60, 0x38, 0x6c, 0xc6, 0xc6, 0x6c, 0x38, 0x0c, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xfe, 0xfe, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x7e, 0x18, 0x18, 0x18, 0x7e, 0x3c, 0x18, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x7e, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x7e, 0x3c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x0c, 0xfe, 0x0c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x60, 0xfe, 0x60, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc0, 0xc0, 0xc0, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x24, 0x66, 0xff, 0x66, 0x24, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x38, 0x7c, 0x7c, 0xfe, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xfe, 0x7c, 0x7c, 0x38, 0x38, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x3c, 0x3c, 0x18, 0x18, 0x18, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x66, 0x66, 0x66, 0x24, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x6c, 0x6c, 0xfe, 0x6c, 0x6c, 0x6c, 0xfe, 0x6c, 0x6c, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x7c, 0xc6, 0xc2, 0xc0, 0x7c, 0x06, 0x06, 0x86, 0xc6, 0x7c, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc2, 0xc6, 0x0c, 0x18, 0x30, 0x60, 0xc6, 0x86, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x6c, 0x38, 0x76, 0xdc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x30, 0x30, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0c, 0x18, 0x30, 0x30, 0x30, 0x30, 0x30, 0x30, 0x18, 0x0c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x18, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x18, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x66, 0x3c, 0xff, 0x3c, 0x66, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x7e, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x06, 0x0c, 0x18, 0x30, 0x60, 0xc0, 0x80, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x66, 0xc3, 0xc3, 0xdb, 0xdb, 0xc3, 0xc3, 0x66, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x38, 0x78, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0x06, 0x0c, 0x18, 0x30, 0x60, 0xc0, 0xc6, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0x06, 0x06, 0x3c, 0x06, 0x06, 0x06, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0c, 0x1c, 0x3c, 0x6c, 0xcc, 0xfe, 0x0c, 0x0c, 0x0c, 0x1e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xc0, 0xc0, 0xc0, 0xfc, 0x06, 0x06, 0x06, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x60, 0xc0, 0xc0, 0xfc, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xc6, 0x06, 0x06, 0x0c, 0x18, 0x30, 0x30, 0x30, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0x7e, 0x06, 0x06, 0x06, 0x0c, 0x78, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x18, 0x18, 0x30, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x06, 0x0c, 0x18, 0x30, 0x60, 0x30, 0x18, 0x0c, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0x00, 0x00, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x60, 0x30, 0x18, 0x0c, 0x06, 0x0c, 0x18, 0x30, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0x0c, 0x18, 0x18, 0x18, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xde, 0xde, 0xde, 0xdc, 0xc0, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0xc6, 0xc6, 0xfe, 0xc6, 0xc6, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfc, 0x66, 0x66, 0x66, 0x7c, 0x66, 0x66, 0x66, 0x66, 0xfc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x66, 0xc2, 0xc0, 0xc0, 0xc0, 0xc0, 0xc2, 0x66, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf8, 0x6c, 0x66, 0x66, 0x66, 0x66, 0x66, 0x66, 0x6c, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x66, 0x62, 0x68, 0x78, 0x68, 0x60, 0x62, 0x66, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x66, 0x62, 0x68, 0x78, 0x68, 0x60, 0x60, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x66, 0xc2, 0xc0, 0xc0, 0xde, 0xc6, 0xc6, 0x66, 0x3a, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0xc6, 0xc6, 0xfe, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1e, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0xcc, 0xcc, 0xcc, 0x78, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xe6, 0x66, 0x66, 0x6c, 0x78, 0x78, 0x6c, 0x66, 0x66, 0xe6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf0, 0x60, 0x60, 0x60, 0x60, 0x60, 0x60, 0x62, 0x66, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc3, 0xe7, 0xff, 0xff, 0xdb, 0xc3, 0xc3, 0xc3, 0xc3, 0xc3, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xe6, 0xf6, 0xfe, 0xde, 0xce, 0xc6, 0xc6, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfc, 0x66, 0x66, 0x66, 0x7c, 0x60, 0x60, 0x60, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xd6, 0xde, 0x7c, 0x0c, 0x0e, 0x00, 0x00, 0x00, 0x00, 0xfc, 0x66, 0x66, 0x66, 0x7c, 0x6c, 0x66, 0x66, 0x66, 0xe6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0x60, 0x38, 0x0c, 0x06, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xdb, 0x99, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc3, 0xc3, 0xc3, 0xc3, 0xc3, 0xc3, 0xc3, 0x66, 0x3c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc3, 0xc3, 0xc3, 0xc3, 0xc3, 0xdb, 0xdb, 0xff, 0x66, 0x66, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc3, 0xc3, 0x66, 0x3c, 0x18, 0x18, 0x3c, 0x66, 0xc3, 0xc3, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc3, 0xc3, 0xc3, 0x66, 0x3c, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xc3, 0x86, 0x0c, 0x18, 0x30, 0x60, 0xc1, 0xc3, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x30, 0x30, 0x30, 0x30, 0x30, 0x30, 0x30, 0x30, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0xc0, 0xe0, 0x70, 0x38, 0x1c, 0x0e, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x00, 0x00, 0x30, 0x30, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xe0, 0x60, 0x60, 0x78, 0x6c, 0x66, 0x66, 0x66, 0x66, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc0, 0xc0, 0xc0, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1c, 0x0c, 0x0c, 0x3c, 0x6c, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xfe, 0xc0, 0xc0, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x64, 0x60, 0xf0, 0x60, 0x60, 0x60, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x7c, 0x0c, 0xcc, 0x78, 0x00, 0x00, 0x00, 0xe0, 0x60, 0x60, 0x6c, 0x76, 0x66, 0x66, 0x66, 0x66, 0xe6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x38, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x06, 0x06, 0x00, 0x0e, 0x06, 0x06, 0x06, 0x06, 0x06, 0x06, 0x66, 0x66, 0x3c, 0x00, 0x00, 0x00, 0xe0, 0x60, 0x60, 0x66, 0x6c, 0x78, 0x78, 0x6c, 0x66, 0xe6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xe6, 0xff, 0xdb, 0xdb, 0xdb, 0xdb, 0xdb, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xdc, 0x66, 0x66, 0x66, 0x66, 0x66, 0x66, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xdc, 0x66, 0x66, 0x66, 0x66, 0x66, 0x7c, 0x60, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x7c, 0x0c, 0x0c, 0x1e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xdc, 0x76, 0x66, 0x60, 0x60, 0x60, 0xf0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0x60, 0x38, 0x0c, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x30, 0x30, 0xfc, 0x30, 0x30, 0x30, 0x30, 0x36, 0x1c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc3, 0xc3, 0xc3, 0xc3, 0x66, 0x3c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc3, 0xc3, 0xc3, 0xdb, 0xdb, 0xff, 0x66, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc3, 0x66, 0x3c, 0x18, 0x3c, 0x66, 0xc3, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x7e, 0x06, 0x0c, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xcc, 0x18, 0x30, 0x60, 0xc6, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0e, 0x18, 0x18, 0x18, 0x70, 0x18, 0x18, 0x18, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0x00, 0x18, 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x70, 0x18, 0x18, 0x18, 0x0e, 0x18, 0x18, 0x18, 0x18, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xdc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0xc6, 0xc6, 0xc6, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x66, 0xc2, 0xc0, 0xc0, 0xc0, 0xc2, 0x66, 0x3c, 0x0c, 0x06, 0x7c, 0x00, 0x00, 0x00, 0x00, 0xcc, 0x00, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0c, 0x18, 0x30, 0x00, 0x7c, 0xc6, 0xfe, 0xc0, 0xc0, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xcc, 0x00, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x60, 0x30, 0x18, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x38, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x66, 0x60, 0x60, 0x66, 0x3c, 0x0c, 0x06, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0x00, 0x7c, 0xc6, 0xfe, 0xc0, 0xc0, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0x00, 0x00, 0x7c, 0xc6, 0xfe, 0xc0, 0xc0, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x60, 0x30, 0x18, 0x00, 0x7c, 0xc6, 0xfe, 0xc0, 0xc0, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x66, 0x00, 0x00, 0x38, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x3c, 0x66, 0x00, 0x38, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x60, 0x30, 0x18, 0x00, 0x38, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0x00, 0x10, 0x38, 0x6c, 0xc6, 0xc6, 0xfe, 0xc6, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x38, 0x00, 0x38, 0x6c, 0xc6, 0xc6, 0xfe, 0xc6, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x18, 0x30, 0x60, 0x00, 0xfe, 0x66, 0x60, 0x7c, 0x60, 0x60, 0x66, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x6e, 0x3b, 0x1b, 0x7e, 0xd8, 0xdc, 0x77, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3e, 0x6c, 0xcc, 0xcc, 0xfe, 0xcc, 0xcc, 0xcc, 0xcc, 0xce, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x38, 0x6c, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x60, 0x30, 0x18, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x78, 0xcc, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x60, 0x30, 0x18, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0x00, 0x00, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x7e, 0x06, 0x0c, 0x78, 0x00, 0x00, 0xc6, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc6, 0x00, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x7e, 0xc3, 0xc0, 0xc0, 0xc0, 0xc3, 0x7e, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x64, 0x60, 0xf0, 0x60, 0x60, 0x60, 0x60, 0xe6, 0xfc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc3, 0x66, 0x3c, 0x18, 0xff, 0x18, 0xff, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfc, 0x66, 0x66, 0x7c, 0x62, 0x66, 0x6f, 0x66, 0x66, 0x66, 0xf3, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0e, 0x1b, 0x18, 0x18, 0x18, 0x7e, 0x18, 0x18, 0x18, 0x18, 0x18, 0xd8, 0x70, 0x00, 0x00, 0x00, 0x18, 0x30, 0x60, 0x00, 0x78, 0x0c, 0x7c, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0c, 0x18, 0x30, 0x00, 0x38, 0x18, 0x18, 0x18, 0x18, 0x18, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x30, 0x60, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x30, 0x60, 0x00, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0xcc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xdc, 0x00, 0xdc, 0x66, 0x66, 0x66, 0x66, 0x66, 0x66, 0x00, 0x00, 0x00, 0x00, 0x76, 0xdc, 0x00, 0xc6, 0xe6, 0xf6, 0xfe, 0xde, 0xce, 0xc6, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3c, 0x6c, 0x6c, 0x3e, 0x00, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x6c, 0x38, 0x00, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x30, 0x00, 0x30, 0x30, 0x60, 0xc0, 0xc6, 0xc6, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xc0, 0xc0, 0xc0, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x06, 0x06, 0x06, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc0, 0xc0, 0xc2, 0xc6, 0xcc, 0x18, 0x30, 0x60, 0xce, 0x9b, 0x06, 0x0c, 0x1f, 0x00, 0x00, 0x00, 0xc0, 0xc0, 0xc2, 0xc6, 0xcc, 0x18, 0x30, 0x66, 0xce, 0x96, 0x3e, 0x06, 0x06, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x18, 0x18, 0x18, 0x3c, 0x3c, 0x3c, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x36, 0x6c, 0xd8, 0x6c, 0x36, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xd8, 0x6c, 0x36, 0x6c, 0xd8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x11, 0x44, 0x11, 0x44, 0x11, 0x44, 0x11, 0x44, 0x11, 0x44, 0x11, 0x44, 0x11, 0x44, 0x11, 0x44, 0x55, 0xaa, 0x55, 0xaa, 0x55, 0xaa, 0x55, 0xaa, 0x55, 0xaa, 0x55, 0xaa, 0x55, 0xaa, 0x55, 0xaa, 0xdd, 0x77, 0xdd, 0x77, 0xdd, 0x77, 0xdd, 0x77, 0xdd, 0x77, 0xdd, 0x77, 0xdd, 0x77, 0xdd, 0x77, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xf8, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xf8, 0x18, 0xf8, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0xf6, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf8, 0x18, 0xf8, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x36, 0x36, 0x36, 0x36, 0x36, 0xf6, 0x06, 0xf6, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x06, 0xf6, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0xf6, 0x06, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0x18, 0xf8, 0x18, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf8, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x1f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x1f, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xff, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x1f, 0x18, 0x1f, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x37, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x37, 0x30, 0x3f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3f, 0x30, 0x37, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0xf7, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x00, 0xf7, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x37, 0x30, 0x37, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x36, 0x36, 0x36, 0x36, 0x36, 0xf7, 0x00, 0xf7, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x18, 0x18, 0x18, 0x18, 0x18, 0xff, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x00, 0xff, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x3f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x18, 0x18, 0x18, 0x1f, 0x18, 0x1f, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1f, 0x18, 0x1f, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3f, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0xff, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x36, 0x18, 0x18, 0x18, 0x18, 0x18, 0xff, 0x18, 0xff, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1f, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0xf0, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0x0f, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xdc, 0xd8, 0xd8, 0xd8, 0xdc, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x78, 0xcc, 0xcc, 0xcc, 0xd8, 0xcc, 0xc6, 0xc6, 0xc6, 0xcc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xc6, 0xc6, 0xc0, 0xc0, 0xc0, 0xc0, 0xc0, 0xc0, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x6c, 0x6c, 0x6c, 0x6c, 0x6c, 0x6c, 0x6c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0xc6, 0x60, 0x30, 0x18, 0x30, 0x60, 0xc6, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0xd8, 0xd8, 0xd8, 0xd8, 0xd8, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x66, 0x66, 0x66, 0x66, 0x66, 0x7c, 0x60, 0x60, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xdc, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0x18, 0x3c, 0x66, 0x66, 0x66, 0x3c, 0x18, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0xc6, 0xc6, 0xfe, 0xc6, 0xc6, 0x6c, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0xc6, 0xc6, 0xc6, 0x6c, 0x6c, 0x6c, 0x6c, 0xee, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1e, 0x30, 0x18, 0x0c, 0x3e, 0x66, 0x66, 0x66, 0x66, 0x3c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7e, 0xdb, 0xdb, 0xdb, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0x06, 0x7e, 0xdb, 0xdb, 0xf3, 0x7e, 0x60, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1c, 0x30, 0x60, 0x60, 0x7c, 0x60, 0x60, 0x60, 0x30, 0x1c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0xc6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfe, 0x00, 0x00, 0xfe, 0x00, 0x00, 0xfe, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x7e, 0x18, 0x18, 0x00, 0x00, 0xff, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x18, 0x0c, 0x06, 0x0c, 0x18, 0x30, 0x00, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0c, 0x18, 0x30, 0x60, 0x30, 0x18, 0x0c, 0x00, 0x7e, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0e, 0x1b, 0x1b, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0xd8, 0xd8, 0xd8, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x7e, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0xdc, 0x00, 0x76, 0xdc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x38, 0x6c, 0x6c, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0f, 0x0c, 0x0c, 0x0c, 0x0c, 0x0c, 0xec, 0x6c, 0x6c, 0x3c, 0x1c, 0x00, 0x00, 0x00, 0x00, 0x00, 0xd8, 0x6c, 0x6c, 0x6c, 0x6c, 0x6c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x70, 0xd8, 0x30, 0x60, 0xc8, 0xf8, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7c, 0x7c, 0x7c, 0x7c, 0x7c, 0x7c, 0x7c, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; u8 vgafont14alt[1] VAR16; u8 vgafont16alt[1] VAR16; tinyvisor/bios/vgasrc/clext.c0000644006644000001440000004216112172661303016575 0ustar yuichi_xyusers// QEMU Cirrus CLGD 54xx VGABIOS Extension. // // Copyright (C) 2009 Kevin O'Connor // Copyright (c) 2004 Makoto Suzuki (suzu) // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "clext.h" // clext_setup #include "vgabios.h" // VBE_VENDOR_STRING #include "biosvar.h" // GET_GLOBAL #include "util.h" // dprintf #include "bregs.h" // struct bregs #include "stdvga.h" // VGAREG_SEQU_ADDRESS #include "pci.h" // pci_config_readl #include "pci_regs.h" // PCI_BASE_ADDRESS_0 /**************************************************************** * Cirrus mode tables ****************************************************************/ /* VGA */ static u16 cseq_vga[] VAR16 = {0x0007,0xffff}; static u16 cgraph_vga[] VAR16 = {0x0009,0x000a,0x000b,0xffff}; static u16 ccrtc_vga[] VAR16 = {0x001a,0x001b,0x001d,0xffff}; /* extensions */ static u16 cgraph_svgacolor[] VAR16 = { 0x0000,0x0001,0x0002,0x0003,0x0004,0x4005,0x0506,0x0f07,0xff08, 0x0009,0x000a,0x000b, 0xffff }; /* 640x480x8 */ static u16 cseq_640x480x8[] VAR16 = { 0x0300,0x2101,0x0f02,0x0003,0x0e04,0x1107, 0x580b,0x580c,0x580d,0x580e, 0x0412,0x0013,0x2017, 0x331b,0x331c,0x331d,0x331e, 0xffff }; static u16 ccrtc_640x480x8[] VAR16 = { 0x2c11, 0x5f00,0x4f01,0x4f02,0x8003,0x5204,0x1e05,0x0b06,0x3e07, 0x4009,0x000c,0x000d, 0xea10,0xdf12,0x5013,0x4014,0xdf15,0x0b16,0xc317,0xff18, 0x001a,0x221b,0x001d, 0xffff }; /* 640x480x16 */ static u16 cseq_640x480x16[] VAR16 = { 0x0300,0x2101,0x0f02,0x0003,0x0e04,0x1707, 0x580b,0x580c,0x580d,0x580e, 0x0412,0x0013,0x2017, 0x331b,0x331c,0x331d,0x331e, 0xffff }; static u16 ccrtc_640x480x16[] VAR16 = { 0x2c11, 0x5f00,0x4f01,0x4f02,0x8003,0x5204,0x1e05,0x0b06,0x3e07, 0x4009,0x000c,0x000d, 0xea10,0xdf12,0xa013,0x4014,0xdf15,0x0b16,0xc317,0xff18, 0x001a,0x221b,0x001d, 0xffff }; /* 640x480x24 */ static u16 cseq_640x480x24[] VAR16 = { 0x0300,0x2101,0x0f02,0x0003,0x0e04,0x1507, 0x580b,0x580c,0x580d,0x580e, 0x0412,0x0013,0x2017, 0x331b,0x331c,0x331d,0x331e, 0xffff }; static u16 ccrtc_640x480x24[] VAR16 = { 0x2c11, 0x5f00,0x4f01,0x4f02,0x8003,0x5204,0x1e05,0x0b06,0x3e07, 0x4009,0x000c,0x000d, 0xea10,0xdf12,0xf013,0x4014,0xdf15,0x0b16,0xc317,0xff18, 0x001a,0x221b,0x001d, 0xffff }; /* 800x600x8 */ static u16 cseq_800x600x8[] VAR16 = { 0x0300,0x2101,0x0f02,0x0003,0x0e04,0x1107, 0x230b,0x230c,0x230d,0x230e, 0x0412,0x0013,0x2017, 0x141b,0x141c,0x141d,0x141e, 0xffff }; static u16 ccrtc_800x600x8[] VAR16 = { 0x2311,0x7d00,0x6301,0x6302,0x8003,0x6b04,0x1a05,0x9806,0xf007, 0x6009,0x000c,0x000d, 0x7d10,0x5712,0x6413,0x4014,0x5715,0x9816,0xc317,0xff18, 0x001a,0x221b,0x001d, 0xffff }; /* 800x600x16 */ static u16 cseq_800x600x16[] VAR16 = { 0x0300,0x2101,0x0f02,0x0003,0x0e04,0x1707, 0x230b,0x230c,0x230d,0x230e, 0x0412,0x0013,0x2017, 0x141b,0x141c,0x141d,0x141e, 0xffff }; static u16 ccrtc_800x600x16[] VAR16 = { 0x2311,0x7d00,0x6301,0x6302,0x8003,0x6b04,0x1a05,0x9806,0xf007, 0x6009,0x000c,0x000d, 0x7d10,0x5712,0xc813,0x4014,0x5715,0x9816,0xc317,0xff18, 0x001a,0x221b,0x001d, 0xffff }; /* 800x600x24 */ static u16 cseq_800x600x24[] VAR16 = { 0x0300,0x2101,0x0f02,0x0003,0x0e04,0x1507, 0x230b,0x230c,0x230d,0x230e, 0x0412,0x0013,0x2017, 0x141b,0x141c,0x141d,0x141e, 0xffff }; static u16 ccrtc_800x600x24[] VAR16 = { 0x2311,0x7d00,0x6301,0x6302,0x8003,0x6b04,0x1a05,0x9806,0xf007, 0x6009,0x000c,0x000d, 0x7d10,0x5712,0x2c13,0x4014,0x5715,0x9816,0xc317,0xff18, 0x001a,0x321b,0x001d, 0xffff }; /* 1024x768x8 */ static u16 cseq_1024x768x8[] VAR16 = { 0x0300,0x2101,0x0f02,0x0003,0x0e04,0x1107, 0x760b,0x760c,0x760d,0x760e, 0x0412,0x0013,0x2017, 0x341b,0x341c,0x341d,0x341e, 0xffff }; static u16 ccrtc_1024x768x8[] VAR16 = { 0x2911,0xa300,0x7f01,0x7f02,0x8603,0x8304,0x9405,0x2406,0xf507, 0x6009,0x000c,0x000d, 0x0310,0xff12,0x8013,0x4014,0xff15,0x2416,0xc317,0xff18, 0x001a,0x221b,0x001d, 0xffff }; /* 1024x768x16 */ static u16 cseq_1024x768x16[] VAR16 = { 0x0300,0x2101,0x0f02,0x0003,0x0e04,0x1707, 0x760b,0x760c,0x760d,0x760e, 0x0412,0x0013,0x2017, 0x341b,0x341c,0x341d,0x341e, 0xffff }; static u16 ccrtc_1024x768x16[] VAR16 = { 0x2911,0xa300,0x7f01,0x7f02,0x8603,0x8304,0x9405,0x2406,0xf507, 0x6009,0x000c,0x000d, 0x0310,0xff12,0x0013,0x4014,0xff15,0x2416,0xc317,0xff18, 0x001a,0x321b,0x001d, 0xffff }; /* 1024x768x24 */ static u16 cseq_1024x768x24[] VAR16 = { 0x0300,0x2101,0x0f02,0x0003,0x0e04,0x1507, 0x760b,0x760c,0x760d,0x760e, 0x0412,0x0013,0x2017, 0x341b,0x341c,0x341d,0x341e, 0xffff }; static u16 ccrtc_1024x768x24[] VAR16 = { 0x2911,0xa300,0x7f01,0x7f02,0x8603,0x8304,0x9405,0x2406,0xf507, 0x6009,0x000c,0x000d, 0x0310,0xff12,0x8013,0x4014,0xff15,0x2416,0xc317,0xff18, 0x001a,0x321b,0x001d, 0xffff }; /* 1280x1024x8 */ static u16 cseq_1280x1024x8[] VAR16 = { 0x0300,0x2101,0x0f02,0x0003,0x0e04,0x1107, 0x760b,0x760c,0x760d,0x760e, 0x0412,0x0013,0x2017, 0x341b,0x341c,0x341d,0x341e, 0xffff }; static u16 ccrtc_1280x1024x8[] VAR16 = { 0x2911,0xc300,0x9f01,0x9f02,0x8603,0x8304,0x9405,0x2406,0xf707, 0x6009,0x000c,0x000d, 0x0310,0xff12,0xa013,0x4014,0xff15,0x2416,0xc317,0xff18, 0x001a,0x221b,0x001d, 0xffff }; /* 1280x1024x16 */ static u16 cseq_1280x1024x16[] VAR16 = { 0x0300,0x2101,0x0f02,0x0003,0x0e04,0x1707, 0x760b,0x760c,0x760d,0x760e, 0x0412,0x0013,0x2017, 0x341b,0x341c,0x341d,0x341e, 0xffff }; static u16 ccrtc_1280x1024x16[] VAR16 = { 0x2911,0xc300,0x9f01,0x9f02,0x8603,0x8304,0x9405,0x2406,0xf707, 0x6009,0x000c,0x000d, 0x0310,0xff12,0x4013,0x4014,0xff15,0x2416,0xc317,0xff18, 0x001a,0x321b,0x001d, 0xffff }; /* 1600x1200x8 */ static u16 cseq_1600x1200x8[] VAR16 = { 0x0300,0x2101,0x0f02,0x0003,0x0e04,0x1107, 0x760b,0x760c,0x760d,0x760e, 0x0412,0x0013,0x2017, 0x341b,0x341c,0x341d,0x341e, 0xffff }; static u16 ccrtc_1600x1200x8[] VAR16 = { 0x2911,0xc300,0x9f01,0x9f02,0x8603,0x8304,0x9405,0x2406,0xf707, 0x6009,0x000c,0x000d, 0x0310,0xff12,0xc813,0x4014,0xff15,0x2416,0xc317,0xff18, 0x001a,0x221b,0x001d, 0xffff }; struct cirrus_mode_s { u16 mode, vesamode; struct vgamode_s info; u16 hidden_dac; /* 0x3c6 */ u16 *seq; /* 0x3c4 */ u16 *graph; /* 0x3ce */ u16 *crtc; /* 0x3d4 */ }; static struct cirrus_mode_s cirrus_modes[] VAR16 = { {0x5f,0x101,{MM_PACKED,640,480,8,8,16,SEG_GRAPH},0x00, cseq_640x480x8,cgraph_svgacolor,ccrtc_640x480x8}, {0x64,0x111,{MM_DIRECT,640,480,16,8,16,SEG_GRAPH},0xe1, cseq_640x480x16,cgraph_svgacolor,ccrtc_640x480x16}, {0x66,0x110,{MM_DIRECT,640,480,15,8,16,SEG_GRAPH},0xf0, cseq_640x480x16,cgraph_svgacolor,ccrtc_640x480x16}, {0x71,0x112,{MM_DIRECT,640,480,24,8,16,SEG_GRAPH},0xe5, cseq_640x480x24,cgraph_svgacolor,ccrtc_640x480x24}, {0x5c,0x103,{MM_PACKED,800,600,8,8,16,SEG_GRAPH},0x00, cseq_800x600x8,cgraph_svgacolor,ccrtc_800x600x8}, {0x65,0x114,{MM_DIRECT,800,600,16,8,16,SEG_GRAPH},0xe1, cseq_800x600x16,cgraph_svgacolor,ccrtc_800x600x16}, {0x67,0x113,{MM_DIRECT,800,600,15,8,16,SEG_GRAPH},0xf0, cseq_800x600x16,cgraph_svgacolor,ccrtc_800x600x16}, {0x60,0x105,{MM_PACKED,1024,768,8,8,16,SEG_GRAPH},0x00, cseq_1024x768x8,cgraph_svgacolor,ccrtc_1024x768x8}, {0x74,0x117,{MM_DIRECT,1024,768,16,8,16,SEG_GRAPH},0xe1, cseq_1024x768x16,cgraph_svgacolor,ccrtc_1024x768x16}, {0x68,0x116,{MM_DIRECT,1024,768,15,8,16,SEG_GRAPH},0xf0, cseq_1024x768x16,cgraph_svgacolor,ccrtc_1024x768x16}, {0x78,0x115,{MM_DIRECT,800,600,24,8,16,SEG_GRAPH},0xe5, cseq_800x600x24,cgraph_svgacolor,ccrtc_800x600x24}, {0x79,0x118,{MM_DIRECT,1024,768,24,8,16,SEG_GRAPH},0xe5, cseq_1024x768x24,cgraph_svgacolor,ccrtc_1024x768x24}, {0x6d,0x107,{MM_PACKED,1280,1024,8,8,16,SEG_GRAPH},0x00, cseq_1280x1024x8,cgraph_svgacolor,ccrtc_1280x1024x8}, {0x69,0x119,{MM_DIRECT,1280,1024,15,8,16,SEG_GRAPH},0xf0, cseq_1280x1024x16,cgraph_svgacolor,ccrtc_1280x1024x16}, {0x75,0x11a,{MM_DIRECT,1280,1024,16,8,16,SEG_GRAPH},0xe1, cseq_1280x1024x16,cgraph_svgacolor,ccrtc_1280x1024x16}, {0x7b,0xffff,{MM_PACKED,1600,1200,8,8,16,SEG_GRAPH},0x00, cseq_1600x1200x8,cgraph_svgacolor,ccrtc_1600x1200x8}, }; static struct cirrus_mode_s mode_switchback VAR16 = {0xfe,0xffff,{0xff},0,cseq_vga,cgraph_vga,ccrtc_vga}; int is_cirrus_mode(struct vgamode_s *vmode_g) { return (vmode_g >= &cirrus_modes[0].info && vmode_g <= &cirrus_modes[ARRAY_SIZE(cirrus_modes)-1].info); } struct vgamode_s * clext_find_mode(int mode) { struct cirrus_mode_s *table_g = cirrus_modes; while (table_g < &cirrus_modes[ARRAY_SIZE(cirrus_modes)]) { if (GET_GLOBAL(table_g->mode) == mode || GET_GLOBAL(table_g->vesamode) == mode) return &table_g->info; table_g++; } return stdvga_find_mode(mode); } void clext_list_modes(u16 seg, u16 *dest, u16 *last) { int i; for (i=0; i= 0x100) return -1; stdvga_grdc_write(window + 9, val); return 0; } int clext_get_linelength(struct vgamode_s *vmode_g) { u16 crtc_addr = stdvga_get_crtc(); u8 reg13 = stdvga_crtc_read(crtc_addr, 0x13); u8 reg1b = stdvga_crtc_read(crtc_addr, 0x1b); return (((reg1b & 0x10) << 4) + reg13) * stdvga_bpp_factor(vmode_g) * 2; } int clext_set_linelength(struct vgamode_s *vmode_g, int val) { u16 crtc_addr = stdvga_get_crtc(); int factor = stdvga_bpp_factor(vmode_g) * 2; int new_line_offset = DIV_ROUND_UP(val, factor); stdvga_crtc_write(crtc_addr, 0x13, new_line_offset); stdvga_crtc_mask(crtc_addr, 0x1b, 0x10, (new_line_offset & 0x100) >> 4); return 0; } int clext_get_displaystart(struct vgamode_s *vmode_g) { u16 crtc_addr = stdvga_get_crtc(); u8 b2 = stdvga_crtc_read(crtc_addr, 0x0c); u8 b1 = stdvga_crtc_read(crtc_addr, 0x0d); u8 b3 = stdvga_crtc_read(crtc_addr, 0x1b); u8 b4 = stdvga_crtc_read(crtc_addr, 0x1d); int val = (b1 | (b2<<8) | ((b3 & 0x01) << 16) | ((b3 & 0x0c) << 15) | ((b4 & 0x80) << 12)); return val * stdvga_bpp_factor(vmode_g); } int clext_set_displaystart(struct vgamode_s *vmode_g, int val) { u16 crtc_addr = stdvga_get_crtc(); val /= stdvga_bpp_factor(vmode_g); stdvga_crtc_write(crtc_addr, 0x0d, val); stdvga_crtc_write(crtc_addr, 0x0c, val >> 8); stdvga_crtc_mask(crtc_addr, 0x1d, 0x80, (val & 0x0800) >> 4); stdvga_crtc_mask(crtc_addr, 0x1b, 0x0d , ((val & 0x0100) >> 8) | ((val & 0x0600) >> 7)); return 0; } int clext_size_state(int states) { if (states & 8) return -1; return stdvga_size_state(states); } int clext_save_state(u16 seg, void *data, int states) { if (states & 8) return -1; return stdvga_save_state(seg, data, states); } int clext_restore_state(u16 seg, void *data, int states) { if (states & 8) return -1; return stdvga_restore_state(seg, data, states); } /**************************************************************** * Mode setting ****************************************************************/ static void cirrus_switch_mode_setregs(u16 *data, u16 port) { for (;;) { u16 val = GET_GLOBAL(*data); if (val == 0xffff) return; outw(val, port); data++; } } static void cirrus_switch_mode(struct cirrus_mode_s *table) { // Unlock cirrus special stdvga_sequ_write(0x06, 0x12); cirrus_switch_mode_setregs(GET_GLOBAL(table->seq), VGAREG_SEQU_ADDRESS); cirrus_switch_mode_setregs(GET_GLOBAL(table->graph), VGAREG_GRDC_ADDRESS); cirrus_switch_mode_setregs(GET_GLOBAL(table->crtc), stdvga_get_crtc()); stdvga_pelmask_write(0x00); stdvga_pelmask_read(); stdvga_pelmask_read(); stdvga_pelmask_read(); stdvga_pelmask_read(); stdvga_pelmask_write(GET_GLOBAL(table->hidden_dac)); stdvga_pelmask_write(0xff); u8 memmodel = GET_GLOBAL(table->info.memmodel); u8 on = 0; if (memmodel == MM_PLANAR) on = 0x41; else if (memmodel != MM_TEXT) on = 0x01; stdvga_attr_mask(0x10, 0x01, on); stdvga_attrindex_write(0x20); } static void cirrus_enable_16k_granularity(void) { stdvga_grdc_mask(0x0b, 0x00, 0x20); } static void cirrus_clear_vram(u16 fill) { cirrus_enable_16k_granularity(); int count = GET_GLOBAL(VBE_total_memory) / (16 * 1024); int i; for (i=0; iax = 0x0032; else if (v == 0xb8) // 5446 regs->ax = 0x0039; else regs->ax = 0x00ff; regs->bx = 0x00; return; } static void clext_101281(struct bregs *regs) { // XXX regs->ax = 0x0100; } static void clext_101282(struct bregs *regs) { regs->al = stdvga_crtc_read(stdvga_get_crtc(), 0x27) & 0x03; regs->ah = 0xAF; } static void clext_101285(struct bregs *regs) { regs->al = GET_GLOBAL(VBE_total_memory) / (64*1024); } static void clext_10129a(struct bregs *regs) { regs->ax = 0x4060; regs->cx = 0x1132; } extern void a0h_callback(void); ASM16( // fatal: not implemented yet "a0h_callback:" "cli\n" "hlt\n" "lretw"); static void clext_1012a0(struct bregs *regs) { struct vgamode_s *table_g = clext_find_mode(regs->al & 0x7f); regs->ah = (table_g ? 1 : 0); regs->bx = (u32)a0h_callback; regs->ds = regs->si = regs->es = regs->di = 0xffff; } static void clext_1012a1(struct bregs *regs) { regs->bx = 0x0e00; // IBM 8512/8513, color } static void clext_1012a2(struct bregs *regs) { regs->al = 0x07; // HSync 31.5 - 64.0 kHz } static void clext_1012ae(struct bregs *regs) { regs->al = 0x01; // High Refresh 75Hz } static void clext_1012XX(struct bregs *regs) { debug_stub(regs); } void clext_1012(struct bregs *regs) { switch (regs->bl) { case 0x80: clext_101280(regs); break; case 0x81: clext_101281(regs); break; case 0x82: clext_101282(regs); break; case 0x85: clext_101285(regs); break; case 0x9a: clext_10129a(regs); break; case 0xa0: clext_1012a0(regs); break; case 0xa1: clext_1012a1(regs); break; case 0xa2: clext_1012a2(regs); break; case 0xae: clext_1012ae(regs); break; default: clext_1012XX(regs); break; } } /**************************************************************** * init ****************************************************************/ static int cirrus_check(void) { stdvga_sequ_write(0x06, 0x92); return stdvga_sequ_read(0x06) == 0x12; } static u8 cirrus_get_memsize(void) { // get DRAM band width u8 v = stdvga_sequ_read(0x0f); u8 x = (v >> 3) & 0x03; if (x == 0x03 && v & 0x80) // 4MB return 0x40; return 0x04 << x; } int clext_setup(void) { int ret = stdvga_setup(); if (ret) return ret; dprintf(1, "cirrus init\n"); if (! cirrus_check()) return -1; dprintf(1, "cirrus init 2\n"); // memory setup stdvga_sequ_write(0x0a, stdvga_sequ_read(0x0f) & 0x18); // set vga mode stdvga_sequ_write(0x07, 0x00); // reset bitblt stdvga_grdc_write(0x31, 0x04); stdvga_grdc_write(0x31, 0x00); if (GET_GLOBAL(HaveRunInit)) return 0; u32 lfb_addr = 0; int bdf = GET_GLOBAL(VgaBDF); if (CONFIG_VGA_PCI && bdf >= 0) lfb_addr = (pci_config_readl(bdf, PCI_BASE_ADDRESS_0) & PCI_BASE_ADDRESS_MEM_MASK); SET_VGA(VBE_framebuffer, lfb_addr); u16 totalmem = cirrus_get_memsize(); SET_VGA(VBE_total_memory, totalmem * 64 * 1024); SET_VGA(VBE_win_granularity, 16); return 0; } tinyvisor/bios/vgasrc/clext.h0000644006644000001440000000147212172661303016602 0ustar yuichi_xyusers#ifndef __CLEXT_H #define __CLEXT_H #include "types.h" // u16 struct vgamode_s *clext_find_mode(int mode); void clext_list_modes(u16 seg, u16 *dest, u16 *last); int clext_get_window(struct vgamode_s *vmode_g, int window); int clext_set_window(struct vgamode_s *vmode_g, int window, int val); int clext_get_linelength(struct vgamode_s *vmode_g); int clext_set_linelength(struct vgamode_s *vmode_g, int val); int clext_get_displaystart(struct vgamode_s *vmode_g); int clext_set_displaystart(struct vgamode_s *vmode_g, int val); int clext_size_state(int states); int clext_save_state(u16 seg, void *data, int states); int clext_restore_state(u16 seg, void *data, int states); int clext_set_mode(struct vgamode_s *vmode_g, int flags); struct bregs; void clext_1012(struct bregs *regs); int clext_setup(void); #endif // clext.h tinyvisor/bios/vgasrc/stdvgaio.c0000644006644000001440000000677012172661303017304 0ustar yuichi_xyusers// Standard VGA IO port access // // Copyright (C) 2012 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "stdvga.h" // stdvga_pelmask_read #include "farptr.h" // GET_FARVAR #include "ioport.h" // inb u8 stdvga_pelmask_read(void) { return inb(VGAREG_PEL_MASK); } void stdvga_pelmask_write(u8 value) { outb(value, VGAREG_PEL_MASK); } u8 stdvga_misc_read(void) { return inb(VGAREG_READ_MISC_OUTPUT); } void stdvga_misc_write(u8 value) { outb(value, VGAREG_WRITE_MISC_OUTPUT); } void stdvga_misc_mask(u8 off, u8 on) { stdvga_misc_write((stdvga_misc_read() & ~off) | on); } u8 stdvga_sequ_read(u8 index) { outb(index, VGAREG_SEQU_ADDRESS); return inb(VGAREG_SEQU_DATA); } void stdvga_sequ_write(u8 index, u8 value) { outw((value<<8) | index, VGAREG_SEQU_ADDRESS); } void stdvga_sequ_mask(u8 index, u8 off, u8 on) { outb(index, VGAREG_SEQU_ADDRESS); u8 v = inb(VGAREG_SEQU_DATA); outb((v & ~off) | on, VGAREG_SEQU_DATA); } u8 stdvga_grdc_read(u8 index) { outb(index, VGAREG_GRDC_ADDRESS); return inb(VGAREG_GRDC_DATA); } void stdvga_grdc_write(u8 index, u8 value) { outw((value<<8) | index, VGAREG_GRDC_ADDRESS); } void stdvga_grdc_mask(u8 index, u8 off, u8 on) { outb(index, VGAREG_GRDC_ADDRESS); u8 v = inb(VGAREG_GRDC_DATA); outb((v & ~off) | on, VGAREG_GRDC_DATA); } u8 stdvga_crtc_read(u16 crtc_addr, u8 index) { outb(index, crtc_addr); return inb(crtc_addr + 1); } void stdvga_crtc_write(u16 crtc_addr, u8 index, u8 value) { outw((value<<8) | index, crtc_addr); } void stdvga_crtc_mask(u16 crtc_addr, u8 index, u8 off, u8 on) { outb(index, crtc_addr); u8 v = inb(crtc_addr + 1); outb((v & ~off) | on, crtc_addr + 1); } u8 stdvga_attr_read(u8 index) { inb(VGAREG_ACTL_RESET); u8 orig = inb(VGAREG_ACTL_ADDRESS); outb(index, VGAREG_ACTL_ADDRESS); u8 v = inb(VGAREG_ACTL_READ_DATA); inb(VGAREG_ACTL_RESET); outb(orig, VGAREG_ACTL_ADDRESS); return v; } void stdvga_attr_write(u8 index, u8 value) { inb(VGAREG_ACTL_RESET); u8 orig = inb(VGAREG_ACTL_ADDRESS); outb(index, VGAREG_ACTL_ADDRESS); outb(value, VGAREG_ACTL_WRITE_DATA); outb(orig, VGAREG_ACTL_ADDRESS); } void stdvga_attr_mask(u8 index, u8 off, u8 on) { inb(VGAREG_ACTL_RESET); u8 orig = inb(VGAREG_ACTL_ADDRESS); outb(index, VGAREG_ACTL_ADDRESS); u8 v = inb(VGAREG_ACTL_READ_DATA); outb((v & ~off) | on, VGAREG_ACTL_WRITE_DATA); outb(orig, VGAREG_ACTL_ADDRESS); } u8 stdvga_attrindex_read(void) { inb(VGAREG_ACTL_RESET); return inb(VGAREG_ACTL_ADDRESS); } void stdvga_attrindex_write(u8 value) { inb(VGAREG_ACTL_RESET); outb(value, VGAREG_ACTL_ADDRESS); } void stdvga_dac_read(u16 seg, u8 *data_far, u8 start, int count) { outb(start, VGAREG_DAC_READ_ADDRESS); while (count) { SET_FARVAR(seg, *data_far, inb(VGAREG_DAC_DATA)); data_far++; SET_FARVAR(seg, *data_far, inb(VGAREG_DAC_DATA)); data_far++; SET_FARVAR(seg, *data_far, inb(VGAREG_DAC_DATA)); data_far++; count--; } } void stdvga_dac_write(u16 seg, u8 *data_far, u8 start, int count) { outb(start, VGAREG_DAC_WRITE_ADDRESS); while (count) { outb(GET_FARVAR(seg, *data_far), VGAREG_DAC_DATA); data_far++; outb(GET_FARVAR(seg, *data_far), VGAREG_DAC_DATA); data_far++; outb(GET_FARVAR(seg, *data_far), VGAREG_DAC_DATA); data_far++; count--; } } tinyvisor/bios/vgasrc/vgaentry.S0000644006644000001440000000250612172661303017274 0ustar yuichi_xyusers// Rom layout and bios assembler to C interface. // // Copyright (C) 2009-2012 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "config.h" // CONFIG_* #include "entryfuncs.S" // ENTRY_* /**************************************************************** * Rom Header ****************************************************************/ .section .rom.header .code16gcc .global _rom_header, _rom_header_size, _rom_header_checksum _rom_header: .word 0xaa55 _rom_header_size: .byte 0 _rom_header_entry: jmp _optionrom_entry _rom_header_checksum: .byte 0 _rom_header_other: .space 17 _rom_header_pcidata: #if CONFIG_VGA_PCI == 1 .word rom_pci_data #else .word 0 #endif _rom_header_pnpdata: .word 0 _rom_header_other2: .word 0 _rom_header_signature: .asciz "IBM" /**************************************************************** * Entry points ****************************************************************/ DECLFUNC entry_104f05 entry_104f05: ENTRY_ARG vbe_104f05 lretw DECLFUNC _optionrom_entry _optionrom_entry: ENTRY_ARG vga_post lretw DECLFUNC entry_10 entry_10: ENTRY_ARG handle_10 iretw tinyvisor/bios/vgasrc/stdvga.h0000644006644000001440000001023612172661303016751 0ustar yuichi_xyusers#ifndef __STDVGA_H #define __STDVGA_H #include "types.h" // u8 // VGA registers #define VGAREG_ACTL_ADDRESS 0x3c0 #define VGAREG_ACTL_WRITE_DATA 0x3c0 #define VGAREG_ACTL_READ_DATA 0x3c1 #define VGAREG_INPUT_STATUS 0x3c2 #define VGAREG_WRITE_MISC_OUTPUT 0x3c2 #define VGAREG_VIDEO_ENABLE 0x3c3 #define VGAREG_SEQU_ADDRESS 0x3c4 #define VGAREG_SEQU_DATA 0x3c5 #define VGAREG_PEL_MASK 0x3c6 #define VGAREG_DAC_STATE 0x3c7 #define VGAREG_DAC_READ_ADDRESS 0x3c7 #define VGAREG_DAC_WRITE_ADDRESS 0x3c8 #define VGAREG_DAC_DATA 0x3c9 #define VGAREG_READ_FEATURE_CTL 0x3ca #define VGAREG_READ_MISC_OUTPUT 0x3cc #define VGAREG_GRDC_ADDRESS 0x3ce #define VGAREG_GRDC_DATA 0x3cf #define VGAREG_MDA_CRTC_ADDRESS 0x3b4 #define VGAREG_MDA_CRTC_DATA 0x3b5 #define VGAREG_VGA_CRTC_ADDRESS 0x3d4 #define VGAREG_VGA_CRTC_DATA 0x3d5 #define VGAREG_MDA_WRITE_FEATURE_CTL 0x3ba #define VGAREG_VGA_WRITE_FEATURE_CTL 0x3da #define VGAREG_ACTL_RESET 0x3da #define VGAREG_MDA_MODECTL 0x3b8 #define VGAREG_CGA_MODECTL 0x3d8 #define VGAREG_CGA_PALETTE 0x3d9 /* Video memory */ #define SEG_GRAPH 0xA000 #define SEG_CTEXT 0xB800 #define SEG_MTEXT 0xB000 // stdvgamodes.c struct vgamode_s *stdvga_find_mode(int mode); void stdvga_list_modes(u16 seg, u16 *dest, u16 *last); void stdvga_build_video_param(void); void stdvga_override_crtc(int mode, u8 *crtc); int stdvga_set_mode(struct vgamode_s *vmode_g, int flags); // stdvgaio.c u8 stdvga_pelmask_read(void); void stdvga_pelmask_write(u8 val); u8 stdvga_misc_read(void); void stdvga_misc_write(u8 value); void stdvga_misc_mask(u8 off, u8 on); u8 stdvga_sequ_read(u8 index); void stdvga_sequ_write(u8 index, u8 value); void stdvga_sequ_mask(u8 index, u8 off, u8 on); u8 stdvga_grdc_read(u8 index); void stdvga_grdc_write(u8 index, u8 value); void stdvga_grdc_mask(u8 index, u8 off, u8 on); u8 stdvga_crtc_read(u16 crtc_addr, u8 index); void stdvga_crtc_write(u16 crtc_addr, u8 index, u8 value); void stdvga_crtc_mask(u16 crtc_addr, u8 index, u8 off, u8 on); u8 stdvga_attr_read(u8 index); void stdvga_attr_write(u8 index, u8 value); void stdvga_attr_mask(u8 index, u8 off, u8 on); u8 stdvga_attrindex_read(void); void stdvga_attrindex_write(u8 value); void stdvga_dac_read(u16 seg, u8 *data_far, u8 start, int count); void stdvga_dac_write(u16 seg, u8 *data_far, u8 start, int count); // stdvga.c void stdvga_set_border_color(u8 color); void stdvga_set_overscan_border_color(u8 color); u8 stdvga_get_overscan_border_color(void); void stdvga_set_palette(u8 palid); void stdvga_set_all_palette_reg(u16 seg, u8 *data_far); void stdvga_get_all_palette_reg(u16 seg, u8 *data_far); void stdvga_toggle_intensity(u8 flag); void stdvga_select_video_dac_color_page(u8 flag, u8 data); void stdvga_read_video_dac_state(u8 *pmode, u8 *curpage); void stdvga_perform_gray_scale_summing(u16 start, u16 count); void stdvga_set_text_block_specifier(u8 spec); void stdvga_planar4_plane(int plane); void stdvga_load_font(u16 seg, void *src_far, u16 count , u16 start, u8 destflags, u8 fontsize); u16 stdvga_get_crtc(void); int stdvga_bpp_factor(struct vgamode_s *vmode_g); void stdvga_set_cursor_shape(u8 start, u8 end); void stdvga_set_cursor_pos(int address); void stdvga_set_scan_lines(u8 lines); u16 stdvga_get_vde(void); int stdvga_get_window(struct vgamode_s *vmode_g, int window); int stdvga_set_window(struct vgamode_s *vmode_g, int window, int val); int stdvga_get_linelength(struct vgamode_s *vmode_g); int stdvga_set_linelength(struct vgamode_s *vmode_g, int val); int stdvga_get_displaystart(struct vgamode_s *vmode_g); int stdvga_set_displaystart(struct vgamode_s *vmode_g, int val); int stdvga_get_dacformat(struct vgamode_s *vmode_g); int stdvga_set_dacformat(struct vgamode_s *vmode_g, int val); int stdvga_size_state(int states); int stdvga_save_state(u16 seg, void *data, int states); int stdvga_restore_state(u16 seg, void *data, int states); void stdvga_enable_video_addressing(u8 disable); int stdvga_setup(void); #endif // stdvga.h tinyvisor/bios/vgasrc/vgalayout.lds.S0000644006644000001440000000134211733243570020232 0ustar yuichi_xyusers// Linker definitions for an option rom // // Copyright (C) 2009 Kevin O'Connor // // This file may be distributed under the terms of the GNU LGPLv3 license. OUTPUT_FORMAT("elf32-i386", "elf32-i386", "elf32-i386") OUTPUT_ARCH("i386") ENTRY(_optionrom_entry) SECTIONS { .text 0 : { KEEP(*(.rom.header)) *(.text.*) _rodata = . ; *(.rodata.__func__.*) *(.rodata.str1.1) *(.data16.*) } // Discard regular data sections to force a link error if // 16bit code attempts to access data not marked with VAR16. /DISCARD/ : { *(.text*) *(.rodata*) *(.data*) *(.bss*) *(COMMON) } } tinyvisor/bios/vgasrc/vbe.c0000644006644000001440000003062512172661303016234 0ustar yuichi_xyusers// Video Bios Extensions handlers // // Copyright (C) 2012 Kevin O'Connor // Copyright (C) 2011 Julian Pidancet // Copyright (C) 2001-2008 the LGPL VGABios developers Team // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "vgabios.h" // handle_104f #include "config.h" // CONFIG_* #include "bregs.h" // struct bregs #include "vbe.h" // struct vbe_info #include "util.h" // dprintf #include "biosvar.h" // GET_GLOBAL #include "vgahw.h" // vgahw_set_mode u32 VBE_total_memory VAR16 = 256 * 1024; u32 VBE_capabilities VAR16; u32 VBE_framebuffer VAR16; u16 VBE_win_granularity VAR16; static void vbe_104f00(struct bregs *regs) { u16 seg = regs->es; struct vbe_info *info = (void*)(regs->di+0); if (GET_FARVAR(seg, info->signature) == VBE2_SIGNATURE) { dprintf(4, "Get VBE Controller: VBE2 Signature found\n"); } else if (GET_FARVAR(seg, info->signature) == VESA_SIGNATURE) { dprintf(4, "Get VBE Controller: VESA Signature found\n"); } else { dprintf(4, "Get VBE Controller: Invalid Signature\n"); } memset_far(seg, info, 0, sizeof(*info)); SET_FARVAR(seg, info->signature, VESA_SIGNATURE); SET_FARVAR(seg, info->version, 0x0300); SET_FARVAR(seg, info->oem_string, SEGOFF(get_global_seg(), (u32)VBE_OEM_STRING)); SET_FARVAR(seg, info->capabilities, GET_GLOBAL(VBE_capabilities)); /* We generate our mode list in the reserved field of the info block */ u16 *destmode = (void*)info->reserved; SET_FARVAR(seg, info->video_mode, SEGOFF(seg, (u32)destmode)); /* Total memory (in 64k blocks) */ SET_FARVAR(seg, info->total_memory , GET_GLOBAL(VBE_total_memory) / (64*1024)); SET_FARVAR(seg, info->oem_vendor_string, SEGOFF(get_global_seg(), (u32)VBE_VENDOR_STRING)); SET_FARVAR(seg, info->oem_product_string, SEGOFF(get_global_seg(), (u32)VBE_PRODUCT_STRING)); SET_FARVAR(seg, info->oem_revision_string, SEGOFF(get_global_seg(), (u32)VBE_REVISION_STRING)); /* Fill list of modes */ u16 *last = (void*)&info->reserved[sizeof(info->reserved)]; vgahw_list_modes(seg, destmode, last - 1); regs->ax = 0x004f; } static void vbe_104f01(struct bregs *regs) { u16 seg = regs->es; struct vbe_mode_info *info = (void*)(regs->di+0); u16 mode = regs->cx; dprintf(1, "VBE mode info request: %x\n", mode); struct vgamode_s *vmode_g = vgahw_find_mode(mode & ~MF_VBEFLAGS); if (! vmode_g) { dprintf(1, "VBE mode %x not found\n", mode); regs->ax = 0x014f; return; } memset_far(seg, info, 0, sizeof(*info)); // Basic information about video controller. u32 win_granularity = GET_GLOBAL(VBE_win_granularity); SET_FARVAR(seg, info->winA_attributes, (win_granularity ? VBE_WINDOW_ATTRIBUTE_RELOCATABLE : 0) | VBE_WINDOW_ATTRIBUTE_READABLE | VBE_WINDOW_ATTRIBUTE_WRITEABLE); SET_FARVAR(seg, info->winB_attributes, 0); SET_FARVAR(seg, info->win_granularity, win_granularity); SET_FARVAR(seg, info->win_size, 64); /* Bank size 64K */ SET_FARVAR(seg, info->winA_seg, GET_GLOBAL(vmode_g->sstart)); SET_FARVAR(seg, info->winB_seg, 0x0); extern void entry_104f05(void); SET_FARVAR(seg, info->win_func_ptr , SEGOFF(get_global_seg(), (u32)entry_104f05)); // Basic information about mode. int width = GET_GLOBAL(vmode_g->width); int height = GET_GLOBAL(vmode_g->height); int linesize = DIV_ROUND_UP(width * vga_bpp(vmode_g), 8); SET_FARVAR(seg, info->bytes_per_scanline, linesize); SET_FARVAR(seg, info->xres, width); SET_FARVAR(seg, info->yres, height); SET_FARVAR(seg, info->xcharsize, GET_GLOBAL(vmode_g->cwidth)); SET_FARVAR(seg, info->ycharsize, GET_GLOBAL(vmode_g->cheight)); int depth = GET_GLOBAL(vmode_g->depth); SET_FARVAR(seg, info->bits_per_pixel, depth); u8 memmodel = GET_GLOBAL(vmode_g->memmodel); SET_FARVAR(seg, info->mem_model, memmodel); SET_FARVAR(seg, info->reserved0, 1); // Mode specific info. u16 mode_attr = VBE_MODE_ATTRIBUTE_SUPPORTED | VBE_MODE_ATTRIBUTE_EXTENDED_INFORMATION_AVAILABLE | VBE_MODE_ATTRIBUTE_COLOR_MODE | VBE_MODE_ATTRIBUTE_GRAPHICS_MODE | VBE_MODE_ATTRIBUTE_NOT_VGA_COMPATIBLE; u32 framebuffer = 0; int planes = 1, banks = 1; u32 pages = GET_GLOBAL(VBE_total_memory) / ALIGN(height * linesize, 64*1024); switch (memmodel) { case MM_TEXT: mode_attr &= ~VBE_MODE_ATTRIBUTE_GRAPHICS_MODE; mode_attr |= VBE_MODE_ATTRIBUTE_TTY_BIOS_SUPPORT; if (GET_GLOBAL(vmode_g->sstart) == SEG_MTEXT) mode_attr &= ~VBE_MODE_ATTRIBUTE_COLOR_MODE; pages = 1; break; case MM_CGA: pages = 1; banks = 2; SET_FARVAR(seg, info->bank_size, 8); break; case MM_PLANAR: planes = 4; pages /= 4; break; default: framebuffer = GET_GLOBAL(VBE_framebuffer); if (framebuffer) mode_attr |= VBE_MODE_ATTRIBUTE_LINEAR_FRAME_BUFFER_MODE; break; } SET_FARVAR(seg, info->mode_attributes, mode_attr); SET_FARVAR(seg, info->planes, planes); SET_FARVAR(seg, info->pages, pages - 1); SET_FARVAR(seg, info->banks, banks); // Pixel color breakdown u8 r_size, r_pos, g_size, g_pos, b_size, b_pos, a_size, a_pos; switch (depth) { case 15: r_size = 5; r_pos = 10; g_size = 5; g_pos = 5; b_size = 5; b_pos = 0; a_size = 1; a_pos = 15; break; case 16: r_size = 5; r_pos = 11; g_size = 6; g_pos = 5; b_size = 5; b_pos = 0; a_size = 0; a_pos = 0; break; case 24: r_size = 8; r_pos = 16; g_size = 8; g_pos = 8; b_size = 8; b_pos = 0; a_size = 0; a_pos = 0; break; case 32: r_size = 8; r_pos = 16; g_size = 8; g_pos = 8; b_size = 8; b_pos = 0; a_size = 8; a_pos = 24; SET_FARVAR(seg, info->directcolor_info, VBE_DIRECTCOLOR_RESERVED_BITS_AVAILABLE); break; default: r_size = 0; r_pos = 0; g_size = 0; g_pos = 0; b_size = 0; b_pos = 0; a_size = 0; a_pos = 0; break; } SET_FARVAR(seg, info->red_size, r_size); SET_FARVAR(seg, info->red_pos, r_pos); SET_FARVAR(seg, info->green_size, g_size); SET_FARVAR(seg, info->green_pos, g_pos); SET_FARVAR(seg, info->blue_size, b_size); SET_FARVAR(seg, info->blue_pos, b_pos); SET_FARVAR(seg, info->alpha_size, a_size); SET_FARVAR(seg, info->alpha_pos, a_pos); // Linear framebuffer info. if (framebuffer) { SET_FARVAR(seg, info->phys_base, framebuffer); SET_FARVAR(seg, info->reserved1, 0); SET_FARVAR(seg, info->reserved2, 0); SET_FARVAR(seg, info->linear_bytes_per_scanline, linesize); SET_FARVAR(seg, info->linear_pages, 0); SET_FARVAR(seg, info->linear_red_size, r_size); SET_FARVAR(seg, info->linear_red_pos, r_pos); SET_FARVAR(seg, info->linear_green_size, g_size); SET_FARVAR(seg, info->linear_green_pos, g_pos); SET_FARVAR(seg, info->linear_blue_size, b_size); SET_FARVAR(seg, info->linear_blue_pos, b_pos); SET_FARVAR(seg, info->linear_alpha_size, a_size); SET_FARVAR(seg, info->linear_alpha_pos, a_pos); } regs->ax = 0x004f; } static void vbe_104f02(struct bregs *regs) { dprintf(1, "VBE mode set: %x\n", regs->bx); int mode = regs->bx & ~MF_VBEFLAGS; int flags = regs->bx & MF_VBEFLAGS; int ret = vga_set_mode(mode, flags); regs->ah = ret; regs->al = 0x4f; } static void vbe_104f03(struct bregs *regs) { regs->bx = GET_BDA(vbe_mode); dprintf(1, "VBE current mode=%x\n", regs->bx); regs->ax = 0x004f; } static void vbe_104f04(struct bregs *regs) { u16 seg = regs->es; void *data = (void*)(regs->bx+0); u16 states = regs->cx; if (states & ~0x0f) goto fail; int ret; switch (regs->dl) { case 0x00: ret = vgahw_size_state(states); if (ret < 0) goto fail; regs->bx = ret / 64; break; case 0x01: ret = vgahw_save_state(seg, data, states); if (ret) goto fail; break; case 0x02: ret = vgahw_restore_state(seg, data, states); if (ret) goto fail; break; default: goto fail; } regs->ax = 0x004f; return; fail: regs->ax = 0x014f; } void VISIBLE16 vbe_104f05(struct bregs *regs) { if (regs->bh > 1 || regs->bl > 1) goto fail; if (GET_BDA(vbe_mode) & MF_LINEARFB) { regs->ah = VBE_RETURN_STATUS_INVALID; return; } struct vgamode_s *vmode_g = get_current_mode(); if (! vmode_g) goto fail; if (regs->bh) { int ret = vgahw_get_window(vmode_g, regs->bl); if (ret < 0) goto fail; regs->dx = ret; regs->ax = 0x004f; return; } int ret = vgahw_set_window(vmode_g, regs->bl, regs->dx); if (ret) goto fail; regs->ax = 0x004f; return; fail: regs->ax = 0x014f; } static void vbe_104f06(struct bregs *regs) { if (regs->bl > 0x02) goto fail; struct vgamode_s *vmode_g = get_current_mode(); if (! vmode_g) goto fail; int bpp = vga_bpp(vmode_g); if (regs->bl == 0x00) { int ret = vgahw_set_linelength(vmode_g, DIV_ROUND_UP(regs->cx * bpp, 8)); if (ret) goto fail; } else if (regs->bl == 0x02) { int ret = vgahw_set_linelength(vmode_g, regs->cx); if (ret) goto fail; } int linelength = vgahw_get_linelength(vmode_g); if (linelength < 0) goto fail; regs->bx = linelength; regs->cx = (linelength * 8) / bpp; regs->dx = GET_GLOBAL(VBE_total_memory) / linelength; regs->ax = 0x004f; return; fail: regs->ax = 0x014f; } static void vbe_104f07(struct bregs *regs) { struct vgamode_s *vmode_g = get_current_mode(); if (! vmode_g) goto fail; int bpp = vga_bpp(vmode_g); int linelength = vgahw_get_linelength(vmode_g); if (linelength < 0) goto fail; int ret; switch (regs->bl) { case 0x80: case 0x00: ret = vgahw_set_displaystart( vmode_g, DIV_ROUND_UP(regs->cx * bpp, 8) + linelength * regs->dx); if (ret) goto fail; break; case 0x01: ret = vgahw_get_displaystart(vmode_g); if (ret < 0) goto fail; regs->dx = ret / linelength; regs->cx = (ret % linelength) * 8 / bpp; break; default: goto fail; } regs->ax = 0x004f; return; fail: regs->ax = 0x014f; } static void vbe_104f08(struct bregs *regs) { struct vgamode_s *vmode_g = get_current_mode(); if (! vmode_g) goto fail; u8 memmodel = GET_GLOBAL(vmode_g->memmodel); if (memmodel == MM_DIRECT || memmodel == MM_YUV) { regs->ax = 0x034f; return; } if (regs->bl > 1) goto fail; if (regs->bl == 0) { int ret = vgahw_set_dacformat(vmode_g, regs->bh); if (ret < 0) goto fail; } int ret = vgahw_get_dacformat(vmode_g); if (ret < 0) goto fail; regs->bh = ret; regs->ax = 0x004f; return; fail: regs->ax = 0x014f; } static void vbe_104f0a(struct bregs *regs) { debug_stub(regs); regs->ax = 0x0100; } static void vbe_104f10(struct bregs *regs) { switch (regs->bl) { case 0x00: regs->bx = 0x0f30; break; case 0x01: SET_BDA(vbe_flag, regs->bh); break; case 0x02: regs->bh = GET_BDA(vbe_flag); break; default: regs->ax = 0x014f; return; } regs->ax = 0x004f; } static void vbe_104fXX(struct bregs *regs) { debug_stub(regs); regs->ax = 0x0100; } void noinline handle_104f(struct bregs *regs) { if (!CONFIG_VGA_VBE) { vbe_104fXX(regs); return; } switch (regs->al) { case 0x00: vbe_104f00(regs); break; case 0x01: vbe_104f01(regs); break; case 0x02: vbe_104f02(regs); break; case 0x03: vbe_104f03(regs); break; case 0x04: vbe_104f04(regs); break; case 0x05: vbe_104f05(regs); break; case 0x06: vbe_104f06(regs); break; case 0x07: vbe_104f07(regs); break; case 0x08: vbe_104f08(regs); break; case 0x0a: vbe_104f0a(regs); break; case 0x10: vbe_104f10(regs); break; default: vbe_104fXX(regs); break; } } tinyvisor/bios/vgasrc/bochsvga.c0000644006644000001440000003237512172661303017260 0ustar yuichi_xyusers// Bochs VGA interface to extended "VBE" modes // // Copyright (C) 2012 Kevin O'Connor // Copyright (C) 2011 Julian Pidancet // Copyright (C) 2002 Jeroen Janssen // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "vgabios.h" // struct vbe_modeinfo #include "vbe.h" // VBE_CAPABILITY_8BIT_DAC #include "bochsvga.h" // bochsvga_set_mode #include "util.h" // dprintf #include "config.h" // CONFIG_* #include "biosvar.h" // GET_GLOBAL #include "stdvga.h" // VGAREG_SEQU_ADDRESS #include "pci.h" // pci_config_readl #include "pci_regs.h" // PCI_BASE_ADDRESS_0 /**************************************************************** * Mode tables ****************************************************************/ static struct bochsvga_mode { u16 mode; struct vgamode_s info; } bochsvga_modes[] VAR16 = { /* standard modes */ { 0x100, { MM_PACKED, 640, 400, 8, 8, 16, SEG_GRAPH } }, { 0x101, { MM_PACKED, 640, 480, 8, 8, 16, SEG_GRAPH } }, { 0x102, { MM_PLANAR, 800, 600, 4, 8, 16, SEG_GRAPH } }, { 0x103, { MM_PACKED, 800, 600, 8, 8, 16, SEG_GRAPH } }, { 0x104, { MM_PLANAR, 1024, 768, 4, 8, 16, SEG_GRAPH } }, { 0x105, { MM_PACKED, 1024, 768, 8, 8, 16, SEG_GRAPH } }, { 0x106, { MM_PLANAR, 1280, 1024, 4, 8, 16, SEG_GRAPH } }, { 0x107, { MM_PACKED, 1280, 1024, 8, 8, 16, SEG_GRAPH } }, { 0x10D, { MM_DIRECT, 320, 200, 15, 8, 16, SEG_GRAPH } }, { 0x10E, { MM_DIRECT, 320, 200, 16, 8, 16, SEG_GRAPH } }, { 0x10F, { MM_DIRECT, 320, 200, 24, 8, 16, SEG_GRAPH } }, { 0x110, { MM_DIRECT, 640, 480, 15, 8, 16, SEG_GRAPH } }, { 0x111, { MM_DIRECT, 640, 480, 16, 8, 16, SEG_GRAPH } }, { 0x112, { MM_DIRECT, 640, 480, 24, 8, 16, SEG_GRAPH } }, { 0x113, { MM_DIRECT, 800, 600, 15, 8, 16, SEG_GRAPH } }, { 0x114, { MM_DIRECT, 800, 600, 16, 8, 16, SEG_GRAPH } }, { 0x115, { MM_DIRECT, 800, 600, 24, 8, 16, SEG_GRAPH } }, { 0x116, { MM_DIRECT, 1024, 768, 15, 8, 16, SEG_GRAPH } }, { 0x117, { MM_DIRECT, 1024, 768, 16, 8, 16, SEG_GRAPH } }, { 0x118, { MM_DIRECT, 1024, 768, 24, 8, 16, SEG_GRAPH } }, { 0x119, { MM_DIRECT, 1280, 1024, 15, 8, 16, SEG_GRAPH } }, { 0x11A, { MM_DIRECT, 1280, 1024, 16, 8, 16, SEG_GRAPH } }, { 0x11B, { MM_DIRECT, 1280, 1024, 24, 8, 16, SEG_GRAPH } }, { 0x11C, { MM_PACKED, 1600, 1200, 8, 8, 16, SEG_GRAPH } }, { 0x11D, { MM_DIRECT, 1600, 1200, 15, 8, 16, SEG_GRAPH } }, { 0x11E, { MM_DIRECT, 1600, 1200, 16, 8, 16, SEG_GRAPH } }, { 0x11F, { MM_DIRECT, 1600, 1200, 24, 8, 16, SEG_GRAPH } }, /* BOCHS modes */ { 0x140, { MM_DIRECT, 320, 200, 32, 8, 16, SEG_GRAPH } }, { 0x141, { MM_DIRECT, 640, 400, 32, 8, 16, SEG_GRAPH } }, { 0x142, { MM_DIRECT, 640, 480, 32, 8, 16, SEG_GRAPH } }, { 0x143, { MM_DIRECT, 800, 600, 32, 8, 16, SEG_GRAPH } }, { 0x144, { MM_DIRECT, 1024, 768, 32, 8, 16, SEG_GRAPH } }, { 0x145, { MM_DIRECT, 1280, 1024, 32, 8, 16, SEG_GRAPH } }, { 0x146, { MM_PACKED, 320, 200, 8, 8, 16, SEG_GRAPH } }, { 0x147, { MM_DIRECT, 1600, 1200, 32, 8, 16, SEG_GRAPH } }, { 0x148, { MM_PACKED, 1152, 864, 8, 8, 16, SEG_GRAPH } }, { 0x149, { MM_DIRECT, 1152, 864, 15, 8, 16, SEG_GRAPH } }, { 0x14a, { MM_DIRECT, 1152, 864, 16, 8, 16, SEG_GRAPH } }, { 0x14b, { MM_DIRECT, 1152, 864, 24, 8, 16, SEG_GRAPH } }, { 0x14c, { MM_DIRECT, 1152, 864, 32, 8, 16, SEG_GRAPH } }, { 0x178, { MM_DIRECT, 1280, 800, 16, 8, 16, SEG_GRAPH } }, { 0x179, { MM_DIRECT, 1280, 800, 24, 8, 16, SEG_GRAPH } }, { 0x17a, { MM_DIRECT, 1280, 800, 32, 8, 16, SEG_GRAPH } }, { 0x17b, { MM_DIRECT, 1280, 960, 16, 8, 16, SEG_GRAPH } }, { 0x17c, { MM_DIRECT, 1280, 960, 24, 8, 16, SEG_GRAPH } }, { 0x17d, { MM_DIRECT, 1280, 960, 32, 8, 16, SEG_GRAPH } }, { 0x17e, { MM_DIRECT, 1440, 900, 16, 8, 16, SEG_GRAPH } }, { 0x17f, { MM_DIRECT, 1440, 900, 24, 8, 16, SEG_GRAPH } }, { 0x180, { MM_DIRECT, 1440, 900, 32, 8, 16, SEG_GRAPH } }, { 0x181, { MM_DIRECT, 1400, 1050, 16, 8, 16, SEG_GRAPH } }, { 0x182, { MM_DIRECT, 1400, 1050, 24, 8, 16, SEG_GRAPH } }, { 0x183, { MM_DIRECT, 1400, 1050, 32, 8, 16, SEG_GRAPH } }, { 0x184, { MM_DIRECT, 1680, 1050, 16, 8, 16, SEG_GRAPH } }, { 0x185, { MM_DIRECT, 1680, 1050, 24, 8, 16, SEG_GRAPH } }, { 0x186, { MM_DIRECT, 1680, 1050, 32, 8, 16, SEG_GRAPH } }, { 0x187, { MM_DIRECT, 1920, 1200, 16, 8, 16, SEG_GRAPH } }, { 0x188, { MM_DIRECT, 1920, 1200, 24, 8, 16, SEG_GRAPH } }, { 0x189, { MM_DIRECT, 1920, 1200, 32, 8, 16, SEG_GRAPH } }, { 0x18a, { MM_DIRECT, 2560, 1600, 16, 8, 16, SEG_GRAPH } }, { 0x18b, { MM_DIRECT, 2560, 1600, 24, 8, 16, SEG_GRAPH } }, { 0x18c, { MM_DIRECT, 2560, 1600, 32, 8, 16, SEG_GRAPH } }, }; static int is_bochsvga_mode(struct vgamode_s *vmode_g) { return (vmode_g >= &bochsvga_modes[0].info && vmode_g <= &bochsvga_modes[ARRAY_SIZE(bochsvga_modes)-1].info); } struct vgamode_s *bochsvga_find_mode(int mode) { struct bochsvga_mode *m = bochsvga_modes; for (; m < &bochsvga_modes[ARRAY_SIZE(bochsvga_modes)]; m++) if (GET_GLOBAL(m->mode) == mode) return &m->info; return stdvga_find_mode(mode); } void bochsvga_list_modes(u16 seg, u16 *dest, u16 *last) { struct bochsvga_mode *m = bochsvga_modes; for (; m < &bochsvga_modes[ARRAY_SIZE(bochsvga_modes)] && destmode); if (mode == 0xffff) continue; SET_FARVAR(seg, *dest, mode); dest++; } stdvga_list_modes(seg, dest, last); } /**************************************************************** * Helper functions ****************************************************************/ int bochsvga_get_window(struct vgamode_s *vmode_g, int window) { if (window != 0) return -1; return dispi_read(VBE_DISPI_INDEX_BANK); } int bochsvga_set_window(struct vgamode_s *vmode_g, int window, int val) { if (window != 0) return -1; dispi_write(VBE_DISPI_INDEX_BANK, val); if (dispi_read(VBE_DISPI_INDEX_BANK) != val) return -1; return 0; } int bochsvga_get_linelength(struct vgamode_s *vmode_g) { return dispi_read(VBE_DISPI_INDEX_VIRT_WIDTH) * vga_bpp(vmode_g) / 8; } int bochsvga_set_linelength(struct vgamode_s *vmode_g, int val) { stdvga_set_linelength(vmode_g, val); int pixels = (val * 8) / vga_bpp(vmode_g); dispi_write(VBE_DISPI_INDEX_VIRT_WIDTH, pixels); return 0; } int bochsvga_get_displaystart(struct vgamode_s *vmode_g) { int bpp = vga_bpp(vmode_g); int linelength = dispi_read(VBE_DISPI_INDEX_VIRT_WIDTH) * bpp / 8; int x = dispi_read(VBE_DISPI_INDEX_X_OFFSET); int y = dispi_read(VBE_DISPI_INDEX_Y_OFFSET); return x * bpp / 8 + linelength * y; } int bochsvga_set_displaystart(struct vgamode_s *vmode_g, int val) { stdvga_set_displaystart(vmode_g, val); int bpp = vga_bpp(vmode_g); int linelength = dispi_read(VBE_DISPI_INDEX_VIRT_WIDTH) * bpp / 8; dispi_write(VBE_DISPI_INDEX_X_OFFSET, (val % linelength) * 8 / bpp); dispi_write(VBE_DISPI_INDEX_Y_OFFSET, val / linelength); return 0; } int bochsvga_get_dacformat(struct vgamode_s *vmode_g) { u16 en = dispi_read(VBE_DISPI_INDEX_ENABLE); return (en & VBE_DISPI_8BIT_DAC) ? 8 : 6; } int bochsvga_set_dacformat(struct vgamode_s *vmode_g, int val) { u16 en = dispi_read(VBE_DISPI_INDEX_ENABLE); if (val == 6) en &= ~VBE_DISPI_8BIT_DAC; else if (val == 8) en |= VBE_DISPI_8BIT_DAC; else return -1; dispi_write(VBE_DISPI_INDEX_ENABLE, en); return 0; } int bochsvga_size_state(int states) { int size = stdvga_size_state(states); if (size < 0) return size; if (states & 8) size += (VBE_DISPI_INDEX_Y_OFFSET-VBE_DISPI_INDEX_XRES+1)*sizeof(u16); return size; } int bochsvga_save_state(u16 seg, void *data, int states) { int ret = stdvga_save_state(seg, data, states); if (ret < 0) return ret; if (!(states & 8)) return 0; u16 *info = (data + stdvga_size_state(states)); u16 en = dispi_read(VBE_DISPI_INDEX_ENABLE); SET_FARVAR(seg, *info, en); info++; if (!(en & VBE_DISPI_ENABLED)) return 0; int i; for (i = VBE_DISPI_INDEX_XRES; i <= VBE_DISPI_INDEX_Y_OFFSET; i++) if (i != VBE_DISPI_INDEX_ENABLE) { u16 v = dispi_read(i); SET_FARVAR(seg, *info, v); info++; } return 0; } int bochsvga_restore_state(u16 seg, void *data, int states) { int ret = stdvga_restore_state(seg, data, states); if (ret < 0) return ret; if (!(states & 8)) return 0; u16 *info = (data + stdvga_size_state(states)); u16 en = GET_FARVAR(seg, *info); info++; if (!(en & VBE_DISPI_ENABLED)) { dispi_write(VBE_DISPI_INDEX_ENABLE, en); return 0; } int i; for (i = VBE_DISPI_INDEX_XRES; i <= VBE_DISPI_INDEX_Y_OFFSET; i++) if (i == VBE_DISPI_INDEX_ENABLE) { dispi_write(i, en); } else { dispi_write(i, GET_FARVAR(seg, *info)); info++; } return 0; } /**************************************************************** * Mode setting ****************************************************************/ int bochsvga_set_mode(struct vgamode_s *vmode_g, int flags) { dispi_write(VBE_DISPI_INDEX_ENABLE, VBE_DISPI_DISABLED); if (! is_bochsvga_mode(vmode_g)) return stdvga_set_mode(vmode_g, flags); u8 depth = GET_GLOBAL(vmode_g->depth); if (depth == 4) stdvga_set_mode(stdvga_find_mode(0x6a), 0); if (depth == 8) // XXX load_dac_palette(3); ; dispi_write(VBE_DISPI_INDEX_BPP, depth); u16 width = GET_GLOBAL(vmode_g->width); u16 height = GET_GLOBAL(vmode_g->height); dispi_write(VBE_DISPI_INDEX_XRES, width); dispi_write(VBE_DISPI_INDEX_YRES, height); dispi_write(VBE_DISPI_INDEX_BANK, 0); u16 bf = ((flags & MF_NOCLEARMEM ? VBE_DISPI_NOCLEARMEM : 0) | (flags & MF_LINEARFB ? VBE_DISPI_LFB_ENABLED : 0)); dispi_write(VBE_DISPI_INDEX_ENABLE, VBE_DISPI_ENABLED | bf); /* VGA compat setup */ u16 crtc_addr = VGAREG_VGA_CRTC_ADDRESS; stdvga_crtc_write(crtc_addr, 0x11, 0x00); stdvga_crtc_write(crtc_addr, 0x01, width / 8 - 1); stdvga_set_linelength(vmode_g, width); stdvga_crtc_write(crtc_addr, 0x12, height - 1); u8 v = 0; if ((height - 1) & 0x0100) v |= 0x02; if ((height - 1) & 0x0200) v |= 0x40; stdvga_crtc_mask(crtc_addr, 0x07, 0x42, v); stdvga_crtc_write(crtc_addr, 0x09, 0x00); stdvga_crtc_mask(crtc_addr, 0x17, 0x00, 0x03); stdvga_attr_mask(0x10, 0x00, 0x01); stdvga_grdc_write(0x06, 0x05); stdvga_sequ_write(0x02, 0x0f); if (depth >= 8) { stdvga_crtc_mask(crtc_addr, 0x14, 0x00, 0x40); stdvga_attr_mask(0x10, 0x00, 0x40); stdvga_sequ_mask(0x04, 0x00, 0x08); stdvga_grdc_mask(0x05, 0x20, 0x40); } stdvga_attrindex_write(0x20); return 0; } /**************************************************************** * Init ****************************************************************/ int bochsvga_setup(void) { int ret = stdvga_setup(); if (ret) return ret; /* Sanity checks */ dispi_write(VBE_DISPI_INDEX_ID, VBE_DISPI_ID0); if (dispi_read(VBE_DISPI_INDEX_ID) != VBE_DISPI_ID0) { dprintf(1, "No VBE DISPI interface detected\n"); return -1; } dispi_write(VBE_DISPI_INDEX_ID, VBE_DISPI_ID5); if (GET_GLOBAL(HaveRunInit)) return 0; u32 lfb_addr = VBE_DISPI_LFB_PHYSICAL_ADDRESS; int bdf = GET_GLOBAL(VgaBDF); if (CONFIG_VGA_PCI && bdf >= 0) { int barid = 0; u32 bar = pci_config_readl(bdf, PCI_BASE_ADDRESS_0); if ((bar & PCI_BASE_ADDRESS_SPACE) != PCI_BASE_ADDRESS_SPACE_MEMORY) { barid = 1; bar = pci_config_readl(bdf, PCI_BASE_ADDRESS_1); } lfb_addr = bar & PCI_BASE_ADDRESS_MEM_MASK; dprintf(1, "VBE DISPI: bdf %02x:%02x.%x, bar %d\n", pci_bdf_to_bus(bdf) , pci_bdf_to_dev(bdf), pci_bdf_to_fn(bdf), barid); } SET_VGA(VBE_framebuffer, lfb_addr); u32 totalmem = dispi_read(VBE_DISPI_INDEX_VIDEO_MEMORY_64K) * 64 * 1024; SET_VGA(VBE_total_memory, totalmem); SET_VGA(VBE_win_granularity, 64); SET_VGA(VBE_capabilities, VBE_CAPABILITY_8BIT_DAC); dprintf(1, "VBE DISPI: lfb_addr=%x, size %d MB\n", lfb_addr, totalmem >> 20); // Validate modes u16 en = dispi_read(VBE_DISPI_INDEX_ENABLE); dispi_write(VBE_DISPI_INDEX_ENABLE, en | VBE_DISPI_GETCAPS); u16 max_xres = dispi_read(VBE_DISPI_INDEX_XRES); u16 max_bpp = dispi_read(VBE_DISPI_INDEX_BPP); dispi_write(VBE_DISPI_INDEX_ENABLE, en); struct bochsvga_mode *m = bochsvga_modes; for (; m < &bochsvga_modes[ARRAY_SIZE(bochsvga_modes)]; m++) { u16 width = GET_GLOBAL(m->info.width); u16 height = GET_GLOBAL(m->info.height); u8 depth = GET_GLOBAL(m->info.depth); u32 mem = (height * DIV_ROUND_UP(width * vga_bpp(&m->info), 8) * 4 / stdvga_bpp_factor(&m->info)); if (width > max_xres || depth > max_bpp || mem > totalmem) { dprintf(1, "Removing mode %x\n", GET_GLOBAL(m->mode)); SET_VGA(m->mode, 0xffff); } } return 0; } tinyvisor/bios/vgasrc/stdvgamodes.c0000644006644000001440000005155712172661303020007 0ustar yuichi_xyusers// Standard VGA mode information. // // Copyright (C) 2009 Kevin O'Connor // Copyright (C) 2001-2008 the LGPL VGABios developers Team // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "vgabios.h" // struct VideoParamTableEntry_s #include "biosvar.h" // GET_GLOBAL #include "util.h" // memcpy_far #include "stdvga.h" // stdvga_find_mode /**************************************************************** * Video mode register definitions ****************************************************************/ /* Mono */ static u8 palette0[] VAR16 = { 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x2a,0x2a,0x2a, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f, 0x3f,0x3f,0x3f }; static u8 palette1[] VAR16 = { 0x00,0x00,0x00, 0x00,0x00,0x2a, 0x00,0x2a,0x00, 0x00,0x2a,0x2a, 0x2a,0x00,0x00, 0x2a,0x00,0x2a, 0x2a,0x15,0x00, 0x2a,0x2a,0x2a, 0x00,0x00,0x00, 0x00,0x00,0x2a, 0x00,0x2a,0x00, 0x00,0x2a,0x2a, 0x2a,0x00,0x00, 0x2a,0x00,0x2a, 0x2a,0x15,0x00, 0x2a,0x2a,0x2a, 0x15,0x15,0x15, 0x15,0x15,0x3f, 0x15,0x3f,0x15, 0x15,0x3f,0x3f, 0x3f,0x15,0x15, 0x3f,0x15,0x3f, 0x3f,0x3f,0x15, 0x3f,0x3f,0x3f, 0x15,0x15,0x15, 0x15,0x15,0x3f, 0x15,0x3f,0x15, 0x15,0x3f,0x3f, 0x3f,0x15,0x15, 0x3f,0x15,0x3f, 0x3f,0x3f,0x15, 0x3f,0x3f,0x3f, 0x00,0x00,0x00, 0x00,0x00,0x2a, 0x00,0x2a,0x00, 0x00,0x2a,0x2a, 0x2a,0x00,0x00, 0x2a,0x00,0x2a, 0x2a,0x15,0x00, 0x2a,0x2a,0x2a, 0x00,0x00,0x00, 0x00,0x00,0x2a, 0x00,0x2a,0x00, 0x00,0x2a,0x2a, 0x2a,0x00,0x00, 0x2a,0x00,0x2a, 0x2a,0x15,0x00, 0x2a,0x2a,0x2a, 0x15,0x15,0x15, 0x15,0x15,0x3f, 0x15,0x3f,0x15, 0x15,0x3f,0x3f, 0x3f,0x15,0x15, 0x3f,0x15,0x3f, 0x3f,0x3f,0x15, 0x3f,0x3f,0x3f, 0x15,0x15,0x15, 0x15,0x15,0x3f, 0x15,0x3f,0x15, 0x15,0x3f,0x3f, 0x3f,0x15,0x15, 0x3f,0x15,0x3f, 0x3f,0x3f,0x15, 0x3f,0x3f,0x3f }; static u8 palette2[] VAR16 = { 0x00,0x00,0x00, 0x00,0x00,0x2a, 0x00,0x2a,0x00, 0x00,0x2a,0x2a, 0x2a,0x00,0x00, 0x2a,0x00,0x2a, 0x2a,0x2a,0x00, 0x2a,0x2a,0x2a, 0x00,0x00,0x15, 0x00,0x00,0x3f, 0x00,0x2a,0x15, 0x00,0x2a,0x3f, 0x2a,0x00,0x15, 0x2a,0x00,0x3f, 0x2a,0x2a,0x15, 0x2a,0x2a,0x3f, 0x00,0x15,0x00, 0x00,0x15,0x2a, 0x00,0x3f,0x00, 0x00,0x3f,0x2a, 0x2a,0x15,0x00, 0x2a,0x15,0x2a, 0x2a,0x3f,0x00, 0x2a,0x3f,0x2a, 0x00,0x15,0x15, 0x00,0x15,0x3f, 0x00,0x3f,0x15, 0x00,0x3f,0x3f, 0x2a,0x15,0x15, 0x2a,0x15,0x3f, 0x2a,0x3f,0x15, 0x2a,0x3f,0x3f, 0x15,0x00,0x00, 0x15,0x00,0x2a, 0x15,0x2a,0x00, 0x15,0x2a,0x2a, 0x3f,0x00,0x00, 0x3f,0x00,0x2a, 0x3f,0x2a,0x00, 0x3f,0x2a,0x2a, 0x15,0x00,0x15, 0x15,0x00,0x3f, 0x15,0x2a,0x15, 0x15,0x2a,0x3f, 0x3f,0x00,0x15, 0x3f,0x00,0x3f, 0x3f,0x2a,0x15, 0x3f,0x2a,0x3f, 0x15,0x15,0x00, 0x15,0x15,0x2a, 0x15,0x3f,0x00, 0x15,0x3f,0x2a, 0x3f,0x15,0x00, 0x3f,0x15,0x2a, 0x3f,0x3f,0x00, 0x3f,0x3f,0x2a, 0x15,0x15,0x15, 0x15,0x15,0x3f, 0x15,0x3f,0x15, 0x15,0x3f,0x3f, 0x3f,0x15,0x15, 0x3f,0x15,0x3f, 0x3f,0x3f,0x15, 0x3f,0x3f,0x3f }; static u8 palette3[] VAR16 = { 0x00,0x00,0x00, 0x00,0x00,0x2a, 0x00,0x2a,0x00, 0x00,0x2a,0x2a, 0x2a,0x00,0x00, 0x2a,0x00,0x2a, 0x2a,0x15,0x00, 0x2a,0x2a,0x2a, 0x15,0x15,0x15, 0x15,0x15,0x3f, 0x15,0x3f,0x15, 0x15,0x3f,0x3f, 0x3f,0x15,0x15, 0x3f,0x15,0x3f, 0x3f,0x3f,0x15, 0x3f,0x3f,0x3f, 0x00,0x00,0x00, 0x05,0x05,0x05, 0x08,0x08,0x08, 0x0b,0x0b,0x0b, 0x0e,0x0e,0x0e, 0x11,0x11,0x11, 0x14,0x14,0x14, 0x18,0x18,0x18, 0x1c,0x1c,0x1c, 0x20,0x20,0x20, 0x24,0x24,0x24, 0x28,0x28,0x28, 0x2d,0x2d,0x2d, 0x32,0x32,0x32, 0x38,0x38,0x38, 0x3f,0x3f,0x3f, 0x00,0x00,0x3f, 0x10,0x00,0x3f, 0x1f,0x00,0x3f, 0x2f,0x00,0x3f, 0x3f,0x00,0x3f, 0x3f,0x00,0x2f, 0x3f,0x00,0x1f, 0x3f,0x00,0x10, 0x3f,0x00,0x00, 0x3f,0x10,0x00, 0x3f,0x1f,0x00, 0x3f,0x2f,0x00, 0x3f,0x3f,0x00, 0x2f,0x3f,0x00, 0x1f,0x3f,0x00, 0x10,0x3f,0x00, 0x00,0x3f,0x00, 0x00,0x3f,0x10, 0x00,0x3f,0x1f, 0x00,0x3f,0x2f, 0x00,0x3f,0x3f, 0x00,0x2f,0x3f, 0x00,0x1f,0x3f, 0x00,0x10,0x3f, 0x1f,0x1f,0x3f, 0x27,0x1f,0x3f, 0x2f,0x1f,0x3f, 0x37,0x1f,0x3f, 0x3f,0x1f,0x3f, 0x3f,0x1f,0x37, 0x3f,0x1f,0x2f, 0x3f,0x1f,0x27, 0x3f,0x1f,0x1f, 0x3f,0x27,0x1f, 0x3f,0x2f,0x1f, 0x3f,0x37,0x1f, 0x3f,0x3f,0x1f, 0x37,0x3f,0x1f, 0x2f,0x3f,0x1f, 0x27,0x3f,0x1f, 0x1f,0x3f,0x1f, 0x1f,0x3f,0x27, 0x1f,0x3f,0x2f, 0x1f,0x3f,0x37, 0x1f,0x3f,0x3f, 0x1f,0x37,0x3f, 0x1f,0x2f,0x3f, 0x1f,0x27,0x3f, 0x2d,0x2d,0x3f, 0x31,0x2d,0x3f, 0x36,0x2d,0x3f, 0x3a,0x2d,0x3f, 0x3f,0x2d,0x3f, 0x3f,0x2d,0x3a, 0x3f,0x2d,0x36, 0x3f,0x2d,0x31, 0x3f,0x2d,0x2d, 0x3f,0x31,0x2d, 0x3f,0x36,0x2d, 0x3f,0x3a,0x2d, 0x3f,0x3f,0x2d, 0x3a,0x3f,0x2d, 0x36,0x3f,0x2d, 0x31,0x3f,0x2d, 0x2d,0x3f,0x2d, 0x2d,0x3f,0x31, 0x2d,0x3f,0x36, 0x2d,0x3f,0x3a, 0x2d,0x3f,0x3f, 0x2d,0x3a,0x3f, 0x2d,0x36,0x3f, 0x2d,0x31,0x3f, 0x00,0x00,0x1c, 0x07,0x00,0x1c, 0x0e,0x00,0x1c, 0x15,0x00,0x1c, 0x1c,0x00,0x1c, 0x1c,0x00,0x15, 0x1c,0x00,0x0e, 0x1c,0x00,0x07, 0x1c,0x00,0x00, 0x1c,0x07,0x00, 0x1c,0x0e,0x00, 0x1c,0x15,0x00, 0x1c,0x1c,0x00, 0x15,0x1c,0x00, 0x0e,0x1c,0x00, 0x07,0x1c,0x00, 0x00,0x1c,0x00, 0x00,0x1c,0x07, 0x00,0x1c,0x0e, 0x00,0x1c,0x15, 0x00,0x1c,0x1c, 0x00,0x15,0x1c, 0x00,0x0e,0x1c, 0x00,0x07,0x1c, 0x0e,0x0e,0x1c, 0x11,0x0e,0x1c, 0x15,0x0e,0x1c, 0x18,0x0e,0x1c, 0x1c,0x0e,0x1c, 0x1c,0x0e,0x18, 0x1c,0x0e,0x15, 0x1c,0x0e,0x11, 0x1c,0x0e,0x0e, 0x1c,0x11,0x0e, 0x1c,0x15,0x0e, 0x1c,0x18,0x0e, 0x1c,0x1c,0x0e, 0x18,0x1c,0x0e, 0x15,0x1c,0x0e, 0x11,0x1c,0x0e, 0x0e,0x1c,0x0e, 0x0e,0x1c,0x11, 0x0e,0x1c,0x15, 0x0e,0x1c,0x18, 0x0e,0x1c,0x1c, 0x0e,0x18,0x1c, 0x0e,0x15,0x1c, 0x0e,0x11,0x1c, 0x14,0x14,0x1c, 0x16,0x14,0x1c, 0x18,0x14,0x1c, 0x1a,0x14,0x1c, 0x1c,0x14,0x1c, 0x1c,0x14,0x1a, 0x1c,0x14,0x18, 0x1c,0x14,0x16, 0x1c,0x14,0x14, 0x1c,0x16,0x14, 0x1c,0x18,0x14, 0x1c,0x1a,0x14, 0x1c,0x1c,0x14, 0x1a,0x1c,0x14, 0x18,0x1c,0x14, 0x16,0x1c,0x14, 0x14,0x1c,0x14, 0x14,0x1c,0x16, 0x14,0x1c,0x18, 0x14,0x1c,0x1a, 0x14,0x1c,0x1c, 0x14,0x1a,0x1c, 0x14,0x18,0x1c, 0x14,0x16,0x1c, 0x00,0x00,0x10, 0x04,0x00,0x10, 0x08,0x00,0x10, 0x0c,0x00,0x10, 0x10,0x00,0x10, 0x10,0x00,0x0c, 0x10,0x00,0x08, 0x10,0x00,0x04, 0x10,0x00,0x00, 0x10,0x04,0x00, 0x10,0x08,0x00, 0x10,0x0c,0x00, 0x10,0x10,0x00, 0x0c,0x10,0x00, 0x08,0x10,0x00, 0x04,0x10,0x00, 0x00,0x10,0x00, 0x00,0x10,0x04, 0x00,0x10,0x08, 0x00,0x10,0x0c, 0x00,0x10,0x10, 0x00,0x0c,0x10, 0x00,0x08,0x10, 0x00,0x04,0x10, 0x08,0x08,0x10, 0x0a,0x08,0x10, 0x0c,0x08,0x10, 0x0e,0x08,0x10, 0x10,0x08,0x10, 0x10,0x08,0x0e, 0x10,0x08,0x0c, 0x10,0x08,0x0a, 0x10,0x08,0x08, 0x10,0x0a,0x08, 0x10,0x0c,0x08, 0x10,0x0e,0x08, 0x10,0x10,0x08, 0x0e,0x10,0x08, 0x0c,0x10,0x08, 0x0a,0x10,0x08, 0x08,0x10,0x08, 0x08,0x10,0x0a, 0x08,0x10,0x0c, 0x08,0x10,0x0e, 0x08,0x10,0x10, 0x08,0x0e,0x10, 0x08,0x0c,0x10, 0x08,0x0a,0x10, 0x0b,0x0b,0x10, 0x0c,0x0b,0x10, 0x0d,0x0b,0x10, 0x0f,0x0b,0x10, 0x10,0x0b,0x10, 0x10,0x0b,0x0f, 0x10,0x0b,0x0d, 0x10,0x0b,0x0c, 0x10,0x0b,0x0b, 0x10,0x0c,0x0b, 0x10,0x0d,0x0b, 0x10,0x0f,0x0b, 0x10,0x10,0x0b, 0x0f,0x10,0x0b, 0x0d,0x10,0x0b, 0x0c,0x10,0x0b, 0x0b,0x10,0x0b, 0x0b,0x10,0x0c, 0x0b,0x10,0x0d, 0x0b,0x10,0x0f, 0x0b,0x10,0x10, 0x0b,0x0f,0x10, 0x0b,0x0d,0x10, 0x0b,0x0c,0x10, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00, 0x00,0x00,0x00 }; static u8 sequ_01[] VAR16 = { 0x08, 0x03, 0x00, 0x02 }; static u8 crtc_01[] VAR16 = { 0x2d, 0x27, 0x28, 0x90, 0x2b, 0xa0, 0xbf, 0x1f, 0x00, 0x4f, 0x0d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x9c, 0x8e, 0x8f, 0x14, 0x1f, 0x96, 0xb9, 0xa3, 0xff }; static u8 actl_01[] VAR16 = { 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x14, 0x07, 0x38, 0x39, 0x3a, 0x3b, 0x3c, 0x3d, 0x3e, 0x3f, 0x0c, 0x00, 0x0f, 0x08 }; static u8 grdc_01[] VAR16 = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x0e, 0x0f, 0xff }; static u8 sequ_03[] VAR16 = { 0x00, 0x03, 0x00, 0x02 }; static u8 crtc_03[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x55, 0x81, 0xbf, 0x1f, 0x00, 0x4f, 0x0d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x9c, 0x8e, 0x8f, 0x28, 0x1f, 0x96, 0xb9, 0xa3, 0xff }; static u8 sequ_04[] VAR16 = { 0x09, 0x03, 0x00, 0x02 }; static u8 crtc_04[] VAR16 = { 0x2d, 0x27, 0x28, 0x90, 0x2b, 0x80, 0xbf, 0x1f, 0x00, 0xc1, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x9c, 0x8e, 0x8f, 0x14, 0x00, 0x96, 0xb9, 0xa2, 0xff }; static u8 actl_04[] VAR16 = { 0x00, 0x13, 0x15, 0x17, 0x02, 0x04, 0x06, 0x07, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x01, 0x00, 0x03, 0x00 }; static u8 grdc_04[] VAR16 = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x30, 0x0f, 0x0f, 0xff }; static u8 sequ_06[] VAR16 = { 0x01, 0x01, 0x00, 0x06 }; static u8 crtc_06[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x54, 0x80, 0xbf, 0x1f, 0x00, 0xc1, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x9c, 0x8e, 0x8f, 0x28, 0x00, 0x96, 0xb9, 0xc2, 0xff }; static u8 actl_06[] VAR16 = { 0x00, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x17, 0x01, 0x00, 0x01, 0x00 }; static u8 grdc_06[] VAR16 = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0d, 0x0f, 0xff }; static u8 crtc_07[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x55, 0x81, 0xbf, 0x1f, 0x00, 0x4f, 0x0d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x9c, 0x8e, 0x8f, 0x28, 0x0f, 0x96, 0xb9, 0xa3, 0xff }; static u8 actl_07[] VAR16 = { 0x00, 0x08, 0x08, 0x08, 0x08, 0x08, 0x08, 0x08, 0x10, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x18, 0x0e, 0x00, 0x0f, 0x08 }; static u8 grdc_07[] VAR16 = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x0a, 0x0f, 0xff }; static u8 sequ_0d[] VAR16 = { 0x09, 0x0f, 0x00, 0x06 }; static u8 crtc_0d[] VAR16 = { 0x2d, 0x27, 0x28, 0x90, 0x2b, 0x80, 0xbf, 0x1f, 0x00, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x9c, 0x8e, 0x8f, 0x14, 0x00, 0x96, 0xb9, 0xe3, 0xff }; static u8 actl_0d[] VAR16 = { 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x01, 0x00, 0x0f, 0x00 }; static u8 grdc_0d[] VAR16 = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x05, 0x0f, 0xff }; static u8 sequ_0e[] VAR16 = { 0x01, 0x0f, 0x00, 0x06 }; static u8 crtc_0e[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x54, 0x80, 0xbf, 0x1f, 0x00, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x9c, 0x8e, 0x8f, 0x28, 0x00, 0x96, 0xb9, 0xe3, 0xff }; static u8 crtc_0f[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x54, 0x80, 0xbf, 0x1f, 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x83, 0x85, 0x5d, 0x28, 0x0f, 0x63, 0xba, 0xe3, 0xff }; static u8 actl_0f[] VAR16 = { 0x00, 0x08, 0x00, 0x00, 0x18, 0x18, 0x00, 0x00, 0x00, 0x08, 0x00, 0x00, 0x00, 0x18, 0x00, 0x00, 0x01, 0x00, 0x01, 0x00 }; static u8 actl_10[] VAR16 = { 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x14, 0x07, 0x38, 0x39, 0x3a, 0x3b, 0x3c, 0x3d, 0x3e, 0x3f, 0x01, 0x00, 0x0f, 0x00 }; static u8 crtc_11[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x54, 0x80, 0x0b, 0x3e, 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xea, 0x8c, 0xdf, 0x28, 0x00, 0xe7, 0x04, 0xe3, 0xff }; static u8 actl_11[] VAR16 = { 0x00, 0x3f, 0x00, 0x3f, 0x00, 0x3f, 0x00, 0x3f, 0x00, 0x3f, 0x00, 0x3f, 0x00, 0x3f, 0x00, 0x3f, 0x01, 0x00, 0x0f, 0x00 }; static u8 sequ_13[] VAR16 = { 0x01, 0x0f, 0x00, 0x0e }; static u8 crtc_13[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x54, 0x80, 0xbf, 0x1f, 0x00, 0x41, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x9c, 0x8e, 0x8f, 0x28, 0x40, 0x96, 0xb9, 0xa3, 0xff }; static u8 actl_13[] VAR16 = { 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x41, 0x00, 0x0f, 0x00 }; static u8 grdc_13[] VAR16 = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x05, 0x0f, 0xff }; static u8 crtc_6A[] VAR16 = { 0x7f, 0x63, 0x63, 0x83, 0x6b, 0x1b, 0x72, 0xf0, 0x00, 0x60, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x59, 0x8d, 0x57, 0x32, 0x00, 0x57, 0x73, 0xe3, 0xff }; #define PAL(x) x, sizeof(x) struct stdvga_mode_s { u16 mode; struct vgamode_s info; u8 pelmask; u8 *dac; u16 dacsize; u8 *sequ_regs; u8 miscreg; u8 *crtc_regs; u8 *actl_regs; u8 *grdc_regs; }; static struct stdvga_mode_s vga_modes[] VAR16 = { //mode { model tx ty bpp cw ch sstart } // pelm dac sequ misc crtc actl grdc {0x00, { MM_TEXT, 40, 25, 4, 9, 16, SEG_CTEXT } , 0xFF, PAL(palette2), sequ_01, 0x67, crtc_01, actl_01, grdc_01}, {0x01, { MM_TEXT, 40, 25, 4, 9, 16, SEG_CTEXT } , 0xFF, PAL(palette2), sequ_01, 0x67, crtc_01, actl_01, grdc_01}, {0x02, { MM_TEXT, 80, 25, 4, 9, 16, SEG_CTEXT } , 0xFF, PAL(palette2), sequ_03, 0x67, crtc_03, actl_01, grdc_01}, {0x03, { MM_TEXT, 80, 25, 4, 9, 16, SEG_CTEXT } , 0xFF, PAL(palette2), sequ_03, 0x67, crtc_03, actl_01, grdc_01}, {0x04, { MM_CGA, 320, 200, 2, 8, 8, SEG_CTEXT } , 0xFF, PAL(palette1), sequ_04, 0x63, crtc_04, actl_04, grdc_04}, {0x05, { MM_CGA, 320, 200, 2, 8, 8, SEG_CTEXT } , 0xFF, PAL(palette1), sequ_04, 0x63, crtc_04, actl_04, grdc_04}, {0x06, { MM_CGA, 640, 200, 1, 8, 8, SEG_CTEXT } , 0xFF, PAL(palette1), sequ_06, 0x63, crtc_06, actl_06, grdc_06}, {0x07, { MM_TEXT, 80, 25, 4, 9, 16, SEG_MTEXT } , 0xFF, PAL(palette0), sequ_03, 0x66, crtc_07, actl_07, grdc_07}, {0x0D, { MM_PLANAR, 320, 200, 4, 8, 8, SEG_GRAPH } , 0xFF, PAL(palette1), sequ_0d, 0x63, crtc_0d, actl_0d, grdc_0d}, {0x0E, { MM_PLANAR, 640, 200, 4, 8, 8, SEG_GRAPH } , 0xFF, PAL(palette1), sequ_0e, 0x63, crtc_0e, actl_0d, grdc_0d}, {0x0F, { MM_PLANAR, 640, 350, 1, 8, 14, SEG_GRAPH } , 0xFF, PAL(palette0), sequ_0e, 0xa3, crtc_0f, actl_0f, grdc_0d}, {0x10, { MM_PLANAR, 640, 350, 4, 8, 14, SEG_GRAPH } , 0xFF, PAL(palette2), sequ_0e, 0xa3, crtc_0f, actl_10, grdc_0d}, {0x11, { MM_PLANAR, 640, 480, 1, 8, 16, SEG_GRAPH } , 0xFF, PAL(palette2), sequ_0e, 0xe3, crtc_11, actl_11, grdc_0d}, {0x12, { MM_PLANAR, 640, 480, 4, 8, 16, SEG_GRAPH } , 0xFF, PAL(palette2), sequ_0e, 0xe3, crtc_11, actl_10, grdc_0d}, {0x13, { MM_PACKED, 320, 200, 8, 8, 8, SEG_GRAPH } , 0xFF, PAL(palette3), sequ_13, 0x63, crtc_13, actl_13, grdc_13}, {0x6A, { MM_PLANAR, 800, 600, 4, 8, 16, SEG_GRAPH } , 0xFF, PAL(palette2), sequ_0e, 0xe3, crtc_6A, actl_10, grdc_0d}, }; /**************************************************************** * Mode functions ****************************************************************/ static int is_stdvga_mode(struct vgamode_s *vmode_g) { return (vmode_g >= &vga_modes[0].info && vmode_g <= &vga_modes[ARRAY_SIZE(vga_modes)-1].info); } struct vgamode_s * stdvga_find_mode(int mode) { int i; for (i = 0; i < ARRAY_SIZE(vga_modes); i++) { struct stdvga_mode_s *stdmode_g = &vga_modes[i]; if (GET_GLOBAL(stdmode_g->mode) == mode) return &stdmode_g->info; } return NULL; } void stdvga_list_modes(u16 seg, u16 *dest, u16 *last) { int i; for (i = 0; i < ARRAY_SIZE(vga_modes); i++) { struct stdvga_mode_s *stdmode_g = &vga_modes[i]; u16 mode = GET_GLOBAL(stdmode_g->mode); if (mode == 0xffff) continue; SET_FARVAR(seg, *dest, mode); dest++; } SET_FARVAR(seg, *dest, 0xffff); } void stdvga_build_video_param(void) { static u8 parammodes[] VAR16 = { 0, 0, 0, 0, 0x04, 0x05, 0x06, 0x07, 0, 0, 0, 0, 0, 0x0d, 0x0e, 0, 0, 0x0f, 0x10, 0, 0, 0, 0, 0x01, 0x03, 0x07, 0x11, 0x12, 0x13 }; int i; for (i=0; iwidth); int height = GET_GLOBAL(vmode_g->height); u8 memmodel = GET_GLOBAL(vmode_g->memmodel); int cheight = GET_GLOBAL(vmode_g->cheight); if (memmodel == MM_TEXT) { SET_VGA(vparam_g->twidth, width); SET_VGA(vparam_g->theightm1, height-1); } else { int cwidth = GET_GLOBAL(vmode_g->cwidth); SET_VGA(vparam_g->twidth, width / cwidth); SET_VGA(vparam_g->theightm1, (height / cheight) - 1); } SET_VGA(vparam_g->cheight, cheight); SET_VGA(vparam_g->slength, calc_page_size(memmodel, width, height)); struct stdvga_mode_s *stdmode_g = container_of( vmode_g, struct stdvga_mode_s, info); memcpy_far(get_global_seg(), vparam_g->sequ_regs , get_global_seg(), GET_GLOBAL(stdmode_g->sequ_regs) , ARRAY_SIZE(vparam_g->sequ_regs)); SET_VGA(vparam_g->miscreg, GET_GLOBAL(stdmode_g->miscreg)); memcpy_far(get_global_seg(), vparam_g->crtc_regs , get_global_seg(), GET_GLOBAL(stdmode_g->crtc_regs) , ARRAY_SIZE(vparam_g->crtc_regs)); memcpy_far(get_global_seg(), vparam_g->actl_regs , get_global_seg(), GET_GLOBAL(stdmode_g->actl_regs) , ARRAY_SIZE(vparam_g->actl_regs)); memcpy_far(get_global_seg(), vparam_g->grdc_regs , get_global_seg(), GET_GLOBAL(stdmode_g->grdc_regs) , ARRAY_SIZE(vparam_g->grdc_regs)); } } void stdvga_override_crtc(int mode, u8 *crtc) { struct vgamode_s *vmode_g = stdvga_find_mode(mode); if (!vmode_g) return; struct stdvga_mode_s *stdmode_g = container_of( vmode_g, struct stdvga_mode_s, info); SET_VGA(stdmode_g->crtc_regs, crtc); } static void clear_screen(struct vgamode_s *vmode_g) { switch (GET_GLOBAL(vmode_g->memmodel)) { case MM_TEXT: memset16_far(GET_GLOBAL(vmode_g->sstart), 0, 0x0720, 32*1024); break; case MM_CGA: memset16_far(GET_GLOBAL(vmode_g->sstart), 0, 0x0000, 32*1024); break; default: // XXX - old code gets/sets/restores sequ register 2 to 0xf - // but it should always be 0xf anyway. memset16_far(GET_GLOBAL(vmode_g->sstart), 0, 0x0000, 64*1024); } } int stdvga_set_mode(struct vgamode_s *vmode_g, int flags) { if (! is_stdvga_mode(vmode_g)) { warn_internalerror(); return -1; } struct stdvga_mode_s *stdmode_g = container_of( vmode_g, struct stdvga_mode_s, info); // if palette loading (bit 3 of modeset ctl = 0) if (!(flags & MF_NOPALETTE)) { // Set the PEL mask stdvga_pelmask_write(GET_GLOBAL(stdmode_g->pelmask)); // From which palette u8 *palette_g = GET_GLOBAL(stdmode_g->dac); u16 palsize = GET_GLOBAL(stdmode_g->dacsize) / 3; // Always 256*3 values stdvga_dac_write(get_global_seg(), palette_g, 0, palsize); int i; for (i = palsize; i < 0x0100; i++) { static u8 rgb[3] VAR16; stdvga_dac_write(get_global_seg(), rgb, i, 1); } if (flags & MF_GRAYSUM) stdvga_perform_gray_scale_summing(0x00, 0x100); } // Set Attribute Ctl u8 *regs = GET_GLOBAL(stdmode_g->actl_regs); int i; for (i = 0; i <= 0x13; i++) stdvga_attr_write(i, GET_GLOBAL(regs[i])); stdvga_attr_write(0x14, 0x00); // Set Sequencer Ctl stdvga_sequ_write(0x00, 0x03); regs = GET_GLOBAL(stdmode_g->sequ_regs); for (i = 1; i <= 4; i++) stdvga_sequ_write(i, GET_GLOBAL(regs[i - 1])); // Set Grafx Ctl regs = GET_GLOBAL(stdmode_g->grdc_regs); for (i = 0; i <= 8; i++) stdvga_grdc_write(i, GET_GLOBAL(regs[i])); // Set CRTC address VGA or MDA u8 miscreg = GET_GLOBAL(stdmode_g->miscreg); u16 crtc_addr = VGAREG_VGA_CRTC_ADDRESS; if (!(miscreg & 1)) crtc_addr = VGAREG_MDA_CRTC_ADDRESS; // Disable CRTC write protection stdvga_crtc_write(crtc_addr, 0x11, 0x00); // Set CRTC regs regs = GET_GLOBAL(stdmode_g->crtc_regs); for (i = 0; i <= 0x18; i++) stdvga_crtc_write(crtc_addr, i, GET_GLOBAL(regs[i])); // Set the misc register stdvga_misc_write(miscreg); // Enable video stdvga_attrindex_write(0x20); // Clear screen if (!(flags & MF_NOCLEARMEM)) clear_screen(vmode_g); // Write the fonts in memory u8 memmodel = GET_GLOBAL(vmode_g->memmodel); if (memmodel == MM_TEXT) stdvga_load_font(get_global_seg(), vgafont16, 0x100, 0, 0, 16); return 0; } tinyvisor/bios/vgasrc/stdvga.c0000644006644000001440000003023112172661303016741 0ustar yuichi_xyusers// Standard VGA driver code // // Copyright (C) 2009 Kevin O'Connor // Copyright (C) 2001-2008 the LGPL VGABios developers Team // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "vgabios.h" // struct vgamode_s #include "stdvga.h" // stdvga_setup #include "ioport.h" // outb #include "farptr.h" // SET_FARVAR #include "biosvar.h" // GET_GLOBAL #include "util.h" // memcpy_far /**************************************************************** * Attribute control ****************************************************************/ void stdvga_set_border_color(u8 color) { u8 v1 = color & 0x0f; if (v1 & 0x08) v1 += 0x08; stdvga_attr_write(0x00, v1); int i; for (i = 1; i < 4; i++) stdvga_attr_mask(i, 0x10, color & 0x10); } void stdvga_set_overscan_border_color(u8 color) { stdvga_attr_write(0x11, color); } u8 stdvga_get_overscan_border_color(void) { return stdvga_attr_read(0x11); } void stdvga_set_palette(u8 palid) { int i; for (i = 1; i < 4; i++) stdvga_attr_mask(i, 0x01, palid & 0x01); } void stdvga_set_all_palette_reg(u16 seg, u8 *data_far) { int i; for (i = 0; i < 0x10; i++) { stdvga_attr_write(i, GET_FARVAR(seg, *data_far)); data_far++; } stdvga_attr_write(0x11, GET_FARVAR(seg, *data_far)); } void stdvga_get_all_palette_reg(u16 seg, u8 *data_far) { int i; for (i = 0; i < 0x10; i++) { SET_FARVAR(seg, *data_far, stdvga_attr_read(i)); data_far++; } SET_FARVAR(seg, *data_far, stdvga_attr_read(0x11)); } void stdvga_toggle_intensity(u8 flag) { stdvga_attr_mask(0x10, 0x08, (flag & 0x01) << 3); } void stdvga_select_video_dac_color_page(u8 flag, u8 data) { if (!(flag & 0x01)) { // select paging mode stdvga_attr_mask(0x10, 0x80, data << 7); return; } // select page u8 val = stdvga_attr_read(0x10); if (!(val & 0x80)) data <<= 2; data &= 0x0f; stdvga_attr_write(0x14, data); } void stdvga_read_video_dac_state(u8 *pmode, u8 *curpage) { u8 val1 = stdvga_attr_read(0x10) >> 7; u8 val2 = stdvga_attr_read(0x14) & 0x0f; if (!(val1 & 0x01)) val2 >>= 2; *pmode = val1; *curpage = val2; } /**************************************************************** * DAC control ****************************************************************/ void stdvga_perform_gray_scale_summing(u16 start, u16 count) { stdvga_attrindex_write(0x00); int i; for (i = start; i < start+count; i++) { u8 rgb[3]; stdvga_dac_read(GET_SEG(SS), rgb, i, 1); // intensity = ( 0.3 * Red ) + ( 0.59 * Green ) + ( 0.11 * Blue ) u16 intensity = ((77 * rgb[0] + 151 * rgb[1] + 28 * rgb[2]) + 0x80) >> 8; if (intensity > 0x3f) intensity = 0x3f; rgb[0] = rgb[1] = rgb[2] = intensity; stdvga_dac_write(GET_SEG(SS), rgb, i, 1); } stdvga_attrindex_write(0x20); } /**************************************************************** * Memory control ****************************************************************/ void stdvga_set_text_block_specifier(u8 spec) { stdvga_sequ_write(0x03, spec); } // Enable reads and writes to the given "plane" when in planar4 mode. void stdvga_planar4_plane(int plane) { if (plane < 0) { // Return to default mode (read plane0, write all planes) stdvga_sequ_write(0x02, 0x0f); stdvga_grdc_write(0x04, 0); } else { stdvga_sequ_write(0x02, 1<memmodel)) { case MM_TEXT: return 2; case MM_CGA: return GET_GLOBAL(vmode_g->depth); case MM_PLANAR: return 1; default: return 4; } } void stdvga_set_cursor_shape(u8 start, u8 end) { u16 crtc_addr = stdvga_get_crtc(); stdvga_crtc_write(crtc_addr, 0x0a, start); stdvga_crtc_write(crtc_addr, 0x0b, end); } void stdvga_set_cursor_pos(int address) { u16 crtc_addr = stdvga_get_crtc(); address /= 2; // Assume we're in text mode. stdvga_crtc_write(crtc_addr, 0x0e, address >> 8); stdvga_crtc_write(crtc_addr, 0x0f, address); } void stdvga_set_scan_lines(u8 lines) { stdvga_crtc_mask(stdvga_get_crtc(), 0x09, 0x1f, lines - 1); } // Get vertical display end u16 stdvga_get_vde(void) { u16 crtc_addr = stdvga_get_crtc(); u16 vde = stdvga_crtc_read(crtc_addr, 0x12); u8 ovl = stdvga_crtc_read(crtc_addr, 0x07); vde += (((ovl & 0x02) << 7) + ((ovl & 0x40) << 3) + 1); return vde; } int stdvga_get_window(struct vgamode_s *vmode_g, int window) { return -1; } int stdvga_set_window(struct vgamode_s *vmode_g, int window, int val) { return -1; } int stdvga_get_linelength(struct vgamode_s *vmode_g) { u8 val = stdvga_crtc_read(stdvga_get_crtc(), 0x13); return val * stdvga_bpp_factor(vmode_g) * 2; } int stdvga_set_linelength(struct vgamode_s *vmode_g, int val) { int factor = stdvga_bpp_factor(vmode_g) * 2; stdvga_crtc_write(stdvga_get_crtc(), 0x13, DIV_ROUND_UP(val, factor)); return 0; } int stdvga_get_displaystart(struct vgamode_s *vmode_g) { u16 crtc_addr = stdvga_get_crtc(); int addr = (stdvga_crtc_read(crtc_addr, 0x0c) << 8 | stdvga_crtc_read(crtc_addr, 0x0d)); return addr * stdvga_bpp_factor(vmode_g); } int stdvga_set_displaystart(struct vgamode_s *vmode_g, int val) { u16 crtc_addr = stdvga_get_crtc(); val /= stdvga_bpp_factor(vmode_g); stdvga_crtc_write(crtc_addr, 0x0c, val >> 8); stdvga_crtc_write(crtc_addr, 0x0d, val); return 0; } int stdvga_get_dacformat(struct vgamode_s *vmode_g) { return -1; } int stdvga_set_dacformat(struct vgamode_s *vmode_g, int val) { return -1; } /**************************************************************** * Save/Restore state ****************************************************************/ struct saveVideoHardware { u8 sequ_index; u8 crtc_index; u8 grdc_index; u8 actl_index; u8 feature; u8 sequ_regs[4]; u8 sequ0; u8 crtc_regs[25]; u8 actl_regs[20]; u8 grdc_regs[9]; u16 crtc_addr; u8 plane_latch[4]; }; static void stdvga_save_hw_state(u16 seg, struct saveVideoHardware *info) { u16 crtc_addr = stdvga_get_crtc(); SET_FARVAR(seg, info->sequ_index, inb(VGAREG_SEQU_ADDRESS)); SET_FARVAR(seg, info->crtc_index, inb(crtc_addr)); SET_FARVAR(seg, info->grdc_index, inb(VGAREG_GRDC_ADDRESS)); SET_FARVAR(seg, info->actl_index, stdvga_attrindex_read()); SET_FARVAR(seg, info->feature, inb(VGAREG_READ_FEATURE_CTL)); int i; for (i=0; i<4; i++) SET_FARVAR(seg, info->sequ_regs[i], stdvga_sequ_read(i+1)); SET_FARVAR(seg, info->sequ0, stdvga_sequ_read(0)); for (i=0; i<25; i++) SET_FARVAR(seg, info->crtc_regs[i], stdvga_crtc_read(crtc_addr, i)); for (i=0; i<20; i++) SET_FARVAR(seg, info->actl_regs[i], stdvga_attr_read(i)); for (i=0; i<9; i++) SET_FARVAR(seg, info->grdc_regs[i], stdvga_grdc_read(i)); SET_FARVAR(seg, info->crtc_addr, crtc_addr); /* XXX: read plane latches */ for (i=0; i<4; i++) SET_FARVAR(seg, info->plane_latch[i], 0); } static void stdvga_restore_hw_state(u16 seg, struct saveVideoHardware *info) { int i; for (i=0; i<4; i++) stdvga_sequ_write(i+1, GET_FARVAR(seg, info->sequ_regs[i])); stdvga_sequ_write(0x00, GET_FARVAR(seg, info->sequ0)); // Disable CRTC write protection u16 crtc_addr = GET_FARVAR(seg, info->crtc_addr); stdvga_crtc_write(crtc_addr, 0x11, 0x00); // Set CRTC regs for (i=0; i<25; i++) if (i != 0x11) stdvga_crtc_write(crtc_addr, i, GET_FARVAR(seg, info->crtc_regs[i])); // select crtc base address stdvga_misc_mask(0x01, crtc_addr == VGAREG_VGA_CRTC_ADDRESS ? 0x01 : 0x00); // enable write protection if needed stdvga_crtc_write(crtc_addr, 0x11, GET_FARVAR(seg, info->crtc_regs[0x11])); // Set Attribute Ctl for (i=0; i<20; i++) stdvga_attr_write(i, GET_FARVAR(seg, info->actl_regs[i])); stdvga_attrindex_write(GET_FARVAR(seg, info->actl_index)); for (i=0; i<9; i++) stdvga_grdc_write(i, GET_FARVAR(seg, info->grdc_regs[i])); outb(GET_FARVAR(seg, info->sequ_index), VGAREG_SEQU_ADDRESS); outb(GET_FARVAR(seg, info->crtc_index), crtc_addr); outb(GET_FARVAR(seg, info->grdc_index), VGAREG_GRDC_ADDRESS); outb(GET_FARVAR(seg, info->feature), crtc_addr - 0x4 + 0xa); } struct saveDACcolors { u8 rwmode; u8 peladdr; u8 pelmask; u8 dac[768]; u8 color_select; }; static void stdvga_save_dac_state(u16 seg, struct saveDACcolors *info) { /* XXX: check this */ SET_FARVAR(seg, info->rwmode, inb(VGAREG_DAC_STATE)); SET_FARVAR(seg, info->peladdr, inb(VGAREG_DAC_WRITE_ADDRESS)); SET_FARVAR(seg, info->pelmask, stdvga_pelmask_read()); stdvga_dac_read(seg, info->dac, 0, 256); SET_FARVAR(seg, info->color_select, 0); } static void stdvga_restore_dac_state(u16 seg, struct saveDACcolors *info) { stdvga_pelmask_write(GET_FARVAR(seg, info->pelmask)); stdvga_dac_write(seg, info->dac, 0, 256); outb(GET_FARVAR(seg, info->peladdr), VGAREG_DAC_WRITE_ADDRESS); } int stdvga_size_state(int states) { int size = 0; if (states & 1) size += sizeof(struct saveVideoHardware); if (states & 2) size += sizeof(struct saveBDAstate); if (states & 4) size += sizeof(struct saveDACcolors); return size; } int stdvga_save_state(u16 seg, void *data, int states) { if (states & 1) { stdvga_save_hw_state(seg, data); data += sizeof(struct saveVideoHardware); } if (states & 2) { save_bda_state(seg, data); data += sizeof(struct saveBDAstate); } if (states & 4) stdvga_save_dac_state(seg, data); return 0; } int stdvga_restore_state(u16 seg, void *data, int states) { if (states & 1) { stdvga_restore_hw_state(seg, data); data += sizeof(struct saveVideoHardware); } if (states & 2) { restore_bda_state(seg, data); data += sizeof(struct saveBDAstate); } if (states & 4) stdvga_restore_dac_state(seg, data); return 0; } /**************************************************************** * Misc ****************************************************************/ void stdvga_enable_video_addressing(u8 disable) { u8 v = (disable & 1) ? 0x00 : 0x02; stdvga_misc_mask(0x02, v); } int stdvga_setup(void) { // switch to color mode and enable CPU access 480 lines stdvga_misc_write(0xc3); // more than 64k 3C4/04 stdvga_sequ_write(0x04, 0x02); return 0; } tinyvisor/bios/vgasrc/vgafb.c0000644006644000001440000003454512172661303016552 0ustar yuichi_xyusers// Code for manipulating VGA framebuffers. // // Copyright (C) 2009 Kevin O'Connor // Copyright (C) 2001-2008 the LGPL VGABios developers Team // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "vgabios.h" // vgafb_scroll #include "biosvar.h" // GET_BDA #include "util.h" // memset_far #include "byteorder.h" // cpu_to_be16 #include "stdvga.h" // stdvga_planar4_plane /**************************************************************** * Screen scrolling ****************************************************************/ static inline void * memcpy_stride(u16 seg, void *dst, void *src, int copylen, int stride, int lines) { for (; lines; lines--, dst+=stride, src+=stride) memcpy_far(seg, dst, seg, src, copylen); return dst; } static inline void memset_stride(u16 seg, void *dst, u8 val, int setlen, int stride, int lines) { for (; lines; lines--, dst+=stride) memset_far(seg, dst, val, setlen); } static inline void memset16_stride(u16 seg, void *dst, u16 val, int setlen, int stride, int lines) { for (; lines; lines--, dst+=stride) memset16_far(seg, dst, val, setlen); } static void scroll_pl4(struct vgamode_s *vmode_g, int nblines, int attr , struct cursorpos ul, struct cursorpos lr) { int cheight = GET_GLOBAL(vmode_g->cheight); int cwidth = 1; int stride = GET_BDA(video_cols) * cwidth; void *src_far, *dest_far; if (nblines >= 0) { dest_far = (void*)(ul.y * cheight * stride + ul.x * cwidth); src_far = dest_far + nblines * cheight * stride; } else { // Scroll down nblines = -nblines; dest_far = (void*)(lr.y * cheight * stride + ul.x * cwidth); src_far = dest_far - nblines * cheight * stride; stride = -stride; } if (attr < 0) attr = 0; int cols = lr.x - ul.x + 1; int rows = lr.y - ul.y + 1; int i; for (i=0; i<4; i++) { stdvga_planar4_plane(i); void *dest = dest_far; if (nblines < rows) dest = memcpy_stride(SEG_GRAPH, dest, src_far, cols * cwidth , stride, (rows - nblines) * cheight); u8 pixels = (attr & (1<cheight) / 2; int cwidth = GET_GLOBAL(vmode_g->depth); int stride = GET_BDA(video_cols) * cwidth; void *src_far, *dest_far; if (nblines >= 0) { dest_far = (void*)(ul.y * cheight * stride + ul.x * cwidth); src_far = dest_far + nblines * cheight * stride; } else { // Scroll down nblines = -nblines; dest_far = (void*)(lr.y * cheight * stride + ul.x * cwidth); src_far = dest_far - nblines * cheight * stride; stride = -stride; } if (attr < 0) attr = 0; if (cwidth == 1) attr = (attr&1) | ((attr&1)<<1); attr &= 3; attr |= (attr<<2) | (attr<<4) | (attr<<6); int cols = lr.x - ul.x + 1; int rows = lr.y - ul.y + 1; if (nblines < rows) { memcpy_stride(SEG_CTEXT, dest_far+0x2000, src_far+0x2000, cols * cwidth , stride, (rows - nblines) * cheight); dest_far = memcpy_stride(SEG_CTEXT, dest_far, src_far, cols * cwidth , stride, (rows - nblines) * cheight); } memset_stride(SEG_CTEXT, dest_far + 0x2000, attr, cols * cwidth , stride, nblines * cheight); memset_stride(SEG_CTEXT, dest_far, attr, cols * cwidth , stride, nblines * cheight); } static void scroll_lin(struct vgamode_s *vmode_g, int nblines, int attr , struct cursorpos ul, struct cursorpos lr) { int cheight = 8; int cwidth = 8; int stride = GET_BDA(video_cols) * cwidth; void *src_far, *dest_far; if (nblines >= 0) { dest_far = (void*)(ul.y * cheight * stride + ul.x * cwidth); src_far = dest_far + nblines * cheight * stride; } else { // Scroll down nblines = -nblines; dest_far = (void*)(lr.y * cheight * stride + ul.x * cwidth); src_far = dest_far - nblines * cheight * stride; stride = -stride; } if (attr < 0) attr = 0; int cols = lr.x - ul.x + 1; int rows = lr.y - ul.y + 1; if (nblines < rows) dest_far = memcpy_stride(SEG_GRAPH, dest_far, src_far, cols * cwidth , stride, (rows - nblines) * cheight); memset_stride(SEG_GRAPH, dest_far, attr, cols * cwidth , stride, nblines * cheight); } static void scroll_text(struct vgamode_s *vmode_g, int nblines, int attr , struct cursorpos ul, struct cursorpos lr) { int cheight = 1; int cwidth = 2; int stride = GET_BDA(video_cols) * cwidth; void *src_far, *dest_far = (void*)(GET_BDA(video_pagesize) * ul.page); if (nblines >= 0) { dest_far += ul.y * cheight * stride + ul.x * cwidth; src_far = dest_far + nblines * cheight * stride; } else { // Scroll down nblines = -nblines; dest_far += lr.y * cheight * stride + ul.x * cwidth; src_far = dest_far - nblines * cheight * stride; stride = -stride; } if (attr < 0) attr = 0x07; attr = (attr << 8) | ' '; int cols = lr.x - ul.x + 1; int rows = lr.y - ul.y + 1; u16 seg = GET_GLOBAL(vmode_g->sstart); if (nblines < rows) dest_far = memcpy_stride(seg, dest_far, src_far, cols * cwidth , stride, (rows - nblines) * cheight); memset16_stride(seg, dest_far, attr, cols * cwidth , stride, nblines * cheight); } void vgafb_scroll(int nblines, int attr, struct cursorpos ul, struct cursorpos lr) { // Get the mode struct vgamode_s *vmode_g = get_current_mode(); if (!vmode_g) return; // FIXME gfx mode not complete switch (GET_GLOBAL(vmode_g->memmodel)) { case MM_TEXT: scroll_text(vmode_g, nblines, attr, ul, lr); break; case MM_PLANAR: scroll_pl4(vmode_g, nblines, attr, ul, lr); break; case MM_CGA: scroll_cga(vmode_g, nblines, attr, ul, lr); break; case MM_DIRECT: case MM_PACKED: scroll_lin(vmode_g, nblines, attr, ul, lr); break; default: break; } } /**************************************************************** * Read/write characters to screen ****************************************************************/ static void write_gfx_char_pl4(struct vgamode_s *vmode_g , struct cursorpos cp, struct carattr ca) { u16 nbcols = GET_BDA(video_cols); if (cp.x >= nbcols) return; u8 cheight = GET_GLOBAL(vmode_g->cheight); u8 *fdata_g; switch (cheight) { case 14: fdata_g = vgafont14; break; case 16: fdata_g = vgafont16; break; default: fdata_g = vgafont8; } u16 addr = cp.x + cp.y * cheight * nbcols; u16 src = ca.car * cheight; int i; for (i=0; i<4; i++) { stdvga_planar4_plane(i); u8 colors = ((ca.attr & (1<= nbcols) return; u8 *fdata_g = vgafont8; u8 bpp = GET_GLOBAL(vmode_g->depth); u16 addr = (cp.x * bpp) + cp.y * 320; u16 src = ca.car * 8; u8 i; for (i = 0; i < 8; i++) { u8 *dest_far = (void*)(addr + (i >> 1) * 80); if (i & 1) dest_far += 0x2000; if (bpp == 1) { u8 colors = (ca.attr & 0x01) ? 0xff : 0x00; u8 pixels = colors & GET_GLOBAL(fdata_g[src + i]); if (ca.attr & 0x80) pixels ^= GET_FARVAR(SEG_GRAPH, *dest_far); SET_FARVAR(SEG_CTEXT, *dest_far, pixels); } else { u16 pixels = 0; u8 fontline = GET_GLOBAL(fdata_g[src + i]); int j; for (j = 0; j < 8; j++) if (fontline & (1<= nbcols) return; u8 *fdata_g = vgafont8; u16 addr = cp.x * 8 + cp.y * nbcols * 64; u16 src = ca.car * 8; u8 i; for (i = 0; i < 8; i++) { u8 *dest_far = (void*)(addr + i * nbcols * 8); u8 fontline = GET_GLOBAL(fdata_g[src + i]); u8 j; for (j = 0; j < 8; j++) { u8 pixel = (fontline & (0x80>>j)) ? ca.attr : 0x00; SET_FARVAR(SEG_GRAPH, dest_far[j], pixel); } } } static void write_text_char(struct vgamode_s *vmode_g , struct cursorpos cp, struct carattr ca) { // Compute the address u16 nbcols = GET_BDA(video_cols); void *address_far = (void*)(GET_BDA(video_pagesize) * cp.page + (cp.x + cp.y * nbcols) * 2); if (ca.use_attr) { u16 dummy = (ca.attr << 8) | ca.car; SET_FARVAR(GET_GLOBAL(vmode_g->sstart), *(u16*)address_far, dummy); } else { SET_FARVAR(GET_GLOBAL(vmode_g->sstart), *(u8*)address_far, ca.car); } } void vgafb_write_char(struct cursorpos cp, struct carattr ca) { // Get the mode struct vgamode_s *vmode_g = get_current_mode(); if (!vmode_g) return; // FIXME gfx mode not complete switch (GET_GLOBAL(vmode_g->memmodel)) { case MM_TEXT: write_text_char(vmode_g, cp, ca); break; case MM_PLANAR: write_gfx_char_pl4(vmode_g, cp, ca); break; case MM_CGA: write_gfx_char_cga(vmode_g, cp, ca); break; case MM_DIRECT: case MM_PACKED: write_gfx_char_lin(vmode_g, cp, ca); break; default: break; } } struct carattr vgafb_read_char(struct cursorpos cp) { // Get the mode struct vgamode_s *vmode_g = get_current_mode(); if (!vmode_g) goto fail; if (GET_GLOBAL(vmode_g->memmodel) != MM_TEXT) { // FIXME gfx mode dprintf(1, "Read char in graphics mode\n"); goto fail; } // Compute the address u16 nbcols = GET_BDA(video_cols); u16 *address_far = (void*)(GET_BDA(video_pagesize) * cp.page + (cp.x + cp.y * nbcols) * 2); u16 v = GET_FARVAR(GET_GLOBAL(vmode_g->sstart), *address_far); struct carattr ca = {v, v>>8, 0}; return ca; fail: ; struct carattr ca2 = {0, 0, 0}; return ca2; } /**************************************************************** * Read/write pixels ****************************************************************/ void vgafb_write_pixel(u8 color, u16 x, u16 y) { // Get the mode struct vgamode_s *vmode_g = get_current_mode(); if (!vmode_g) return; u8 *addr_far, mask, attr, data, i; switch (GET_GLOBAL(vmode_g->memmodel)) { case MM_PLANAR: addr_far = (void*)(x / 8 + y * GET_BDA(video_cols)); mask = 0x80 >> (x & 0x07); for (i=0; i<4; i++) { stdvga_planar4_plane(i); u8 colors = (color & (1<depth) == 2) addr_far = (void*)((x >> 2) + (y >> 1) * 80); else addr_far = (void*)((x >> 3) + (y >> 1) * 80); if (y & 1) addr_far += 0x2000; data = GET_FARVAR(SEG_CTEXT, *addr_far); if (GET_GLOBAL(vmode_g->depth) == 2) { attr = (color & 0x03) << ((3 - (x & 0x03)) * 2); mask = 0x03 << ((3 - (x & 0x03)) * 2); } else { attr = (color & 0x01) << (7 - (x & 0x07)); mask = 0x01 << (7 - (x & 0x07)); } if (color & 0x80) { data ^= attr; } else { data &= ~mask; data |= attr; } SET_FARVAR(SEG_CTEXT, *addr_far, data); break; case MM_DIRECT: case MM_PACKED: addr_far = (void*)(x + y * (GET_BDA(video_cols) * 8)); SET_FARVAR(SEG_GRAPH, *addr_far, color); break; default: case MM_TEXT: return; } } u8 vgafb_read_pixel(u16 x, u16 y) { // Get the mode struct vgamode_s *vmode_g = get_current_mode(); if (!vmode_g) return 0; u8 *addr_far, mask, attr=0, data, i; switch (GET_GLOBAL(vmode_g->memmodel)) { case MM_PLANAR: addr_far = (void*)(x / 8 + y * GET_BDA(video_cols)); mask = 0x80 >> (x & 0x07); attr = 0x00; for (i = 0; i < 4; i++) { stdvga_planar4_plane(i); data = GET_FARVAR(SEG_GRAPH, *addr_far) & mask; if (data > 0) attr |= (0x01 << i); } stdvga_planar4_plane(-1); break; case MM_CGA: addr_far = (void*)((x >> 2) + (y >> 1) * 80); if (y & 1) addr_far += 0x2000; data = GET_FARVAR(SEG_CTEXT, *addr_far); if (GET_GLOBAL(vmode_g->depth) == 2) attr = (data >> ((3 - (x & 0x03)) * 2)) & 0x03; else attr = (data >> (7 - (x & 0x07))) & 0x01; break; case MM_DIRECT: case MM_PACKED: addr_far = (void*)(x + y * (GET_BDA(video_cols) * 8)); attr = GET_FARVAR(SEG_GRAPH, *addr_far); break; default: case MM_TEXT: return 0; } return attr; } tinyvisor/bios/vgasrc/geodevga.h0000644006644000001440000000606112172661303017243 0ustar yuichi_xyusers// Geode GX2/LX VGA functions // // Copyright (C) 2009 Chris Kindt // // Writen for Google Summer of Code 2009 for the coreboot project // // This file may be distributed under the terms of the GNU LGPLv3 license. #ifndef GEODEVGA_H #define GEODEVGA_H #define VRC_INDEX 0xAC1C // Index register #define VRC_DATA 0xAC1E // Data register #define VR_UNLOCK 0xFC53 // Virtual register unlock code // Graphics-specific registers: #define OEM_BAR0 0x50 #define OEM_BAR1 0x54 #define OEM_BAR2 0x58 #define OEM_BAR3 0x5C #define DC_LOCK_LOCK 0x00000000 #define DC_LOCK_UNLOCK 0x00004758 /* LX MSRs */ #define MSR_GLIU0 (1 << 28) #define MSR_GLIU0_BASE4 (MSR_GLIU0 + 0x23) /* LX */ #define GLIU0_P2D_BM_4 (MSR_GLIU0 + 0x24) /* GX2 */ #define GLIU0_P2D_RO (MSR_GLIU0 + 0x29) #define GLIU0_IOD_BM_0 (MSR_GLIU0 + 0xE0) #define GLIU0_IOD_BM_1 (MSR_GLIU0 + 0xE1) #define DC_SPARE 0x80000011 #define VP_MSR_CONFIG_GX2 0xc0002001 /* GX2 */ #define VP_MSR_CONFIG_LX 0x48002001 /* LX */ #define VP_MSR_PADSEL 0x48002011 #define VP_MSR_PADSEL_TFT_SEL_LOW 0xDFFFFFFF #define VP_MSR_PADSEL_TFT_SEL_HIGH 0x0000003F /* VP_MSR_CONFIG bits */ #define VP_MSR_CONFIG_FMT_CRT (0) #define VP_MSR_CONFIG_FMT_FP (1 << 3) #define VP_MSR_CONFIG_FPC (1 << 15) #define VP_MSR_CONFIG_FMT ((1 << 3) | (1 << 4) | (1 << 5)) /* DC REG OFFSET */ #define DC_UNLOCK 0x0 #define DC_GENERAL_CFG 0x4 #define DC_DISPLAY_CFG 0x8 #define DC_FB_ST_OFFSET 0x10 #define DC_CB_ST_OFFSET 0x14 #define DC_CURS_ST_OFFSET 0x18 #define DC_GLIU0_MEM_OFFSET 0x84 /* VP REG OFFSET */ #define VP_VCFG 0x0 #define VP_DCFG 0x8 #define VP_MISC 0x50 /* FP REG OFFSET */ #define FP_PT1 0x00 #define FP_PT2 0x08 #define FP_PM 0x10 /* DC bits */ #define DC_GENERAL_CFG_VGAE (1 << 7) #define DC_DISPLAY_CFG_GDEN (1 << 3) #define DC_DISPLAY_CFG_TRUP (1 << 6) /* VP bits */ #define VP_DCFG_CRT_EN (1 << 0) #define VP_DCFG_HSYNC_EN (1 << 1) #define VP_DCFG_VSYNC_EN (1 << 2) #define VP_DCFG_DAC_BL_EN (1 << 3) #define VP_DCFG_CRT_SKEW (1 << 16) #define VP_DCFG_BYP_BOTH (1 << 0) /* FP bits */ #define FP_PM_P (1 << 24) /* panel power ctl */ #define FP_PT2_SCRC (1 << 27) /* panel shift clock retrace activity ctl */ /* Mask */ #define DC_CFG_MSK 0xf000a6 int geodevga_setup(); #endif tinyvisor/bios/vgasrc/geodevga.c0000644006644000001440000003172012172661303017236 0ustar yuichi_xyusers// Geode GX2/LX VGA functions // // Copyright (C) 2009 Chris Kindt // // Written for Google Summer of Code 2009 for the coreboot project // // This file may be distributed under the terms of the GNU LGPLv3 license. #include "geodevga.h" // geodevga_setup #include "farptr.h" // SET_FARVAR #include "biosvar.h" // GET_BDA #include "vgabios.h" // VGAREG_* #include "util.h" // memset #include "stdvga.h" // stdvga_crtc_write #include "pci.h" // pci_config_readl #include "pci_regs.h" // PCI_BASE_ADDRESS_0 /**************************************************************** * MSR and High Mem access through VSA Virtual Register ****************************************************************/ static u64 geode_msr_read(u32 msrAddr) { union u64_u32_u val; asm __volatile__ ( "movw $0x0AC1C, %%dx \n" "movl $0xFC530007, %%eax \n" "outl %%eax, %%dx \n" "addb $2, %%dl \n" "inw %%dx, %%ax \n" : "=a" (val.lo), "=d"(val.hi) : "c"(msrAddr) : "cc" ); dprintf(4, "%s(0x%08x) = 0x%08x-0x%08x\n" , __func__, msrAddr, val.hi, val.lo); return val.val; } static void geode_msr_mask(u32 msrAddr, u64 off, u64 on) { union u64_u32_u uand, uor; uand.val = ~off; uor.val = on; dprintf(4, "%s(0x%08x, 0x%016llx, 0x%016llx)\n" , __func__, msrAddr, off, on); asm __volatile__ ( "push %%eax \n" "movw $0x0AC1C, %%dx \n" "movl $0xFC530007, %%eax \n" "outl %%eax, %%dx \n" "addb $2, %%dl \n" "pop %%eax \n" "outw %%ax, %%dx \n" : : "c"(msrAddr), "S" (uand.hi), "D" (uand.lo), "b" (uor.hi), "a" (uor.lo) : "%edx","cc" ); } static u32 geode_mem_read(u32 addr) { u32 val; asm __volatile__ ( "movw $0x0AC1C, %%dx \n" "movl $0xFC530001, %%eax \n" "outl %%eax, %%dx \n" "addb $2, %%dl \n" "inw %%dx, %%ax \n" : "=a" (val) : "b"(addr) : "cc" ); return val; } static void geode_mem_mask(u32 addr, u32 off, u32 or) { asm __volatile__ ( "movw $0x0AC1C, %%dx \n" "movl $0xFC530001, %%eax \n" "outl %%eax, %%dx \n" "addb $2, %%dl \n" "outw %%ax, %%dx \n" : : "b"(addr), "S" (~off), "D" (or) : "%eax","cc" ); } #define VP_FP_START 0x400 static u32 GeodeFB VAR16; static u32 GeodeDC VAR16; static u32 GeodeVP VAR16; static u32 geode_dc_read(int reg) { u32 val = geode_mem_read(GET_GLOBAL(GeodeDC) + reg); dprintf(4, "%s(0x%08x) = 0x%08x\n" , __func__, GET_GLOBAL(GeodeDC) + reg, val); return val; } static void geode_dc_write(int reg, u32 val) { dprintf(4, "%s(0x%08x, 0x%08x)\n" , __func__, GET_GLOBAL(GeodeDC) + reg, val); geode_mem_mask(GET_GLOBAL(GeodeDC) + reg, ~0, val); } static void geode_dc_mask(int reg, u32 off, u32 on) { dprintf(4, "%s(0x%08x, 0x%08x, 0x%08x)\n" , __func__, GET_GLOBAL(GeodeDC) + reg, off, on); geode_mem_mask(GET_GLOBAL(GeodeDC) + reg, off, on); } static u32 geode_vp_read(int reg) { u32 val = geode_mem_read(GET_GLOBAL(GeodeVP) + reg); dprintf(4, "%s(0x%08x) = 0x%08x\n" , __func__, GET_GLOBAL(GeodeVP) + reg, val); return val; } static void geode_vp_write(int reg, u32 val) { dprintf(4, "%s(0x%08x, 0x%08x)\n" , __func__, GET_GLOBAL(GeodeVP) + reg, val); geode_mem_mask(GET_GLOBAL(GeodeVP) + reg, ~0, val); } static void geode_vp_mask(int reg, u32 off, u32 on) { dprintf(4, "%s(0x%08x, 0x%08x, 0x%08x)\n" , __func__, GET_GLOBAL(GeodeVP) + reg, off, on); geode_mem_mask(GET_GLOBAL(GeodeVP) + reg, off, on); } static u32 geode_fp_read(int reg) { u32 val = geode_mem_read(GET_GLOBAL(GeodeVP) + VP_FP_START + reg); dprintf(4, "%s(0x%08x) = 0x%08x\n" , __func__, GET_GLOBAL(GeodeVP) + VP_FP_START + reg, val); return val; } static void geode_fp_write(int reg, u32 val) { dprintf(4, "%s(0x%08x, 0x%08x)\n" , __func__, GET_GLOBAL(GeodeVP) + VP_FP_START + reg, val); geode_mem_mask(GET_GLOBAL(GeodeVP) + VP_FP_START + reg, ~0, val); } /**************************************************************** * Helper functions ****************************************************************/ static int legacyio_check(void) { int ret=0; u64 val; if (CONFIG_VGA_GEODEGX2) val = geode_msr_read(GLIU0_P2D_BM_4); else val = geode_msr_read(MSR_GLIU0_BASE4); if ((val & 0xffffffff) != 0x0A0fffe0) ret|=1; val = geode_msr_read(GLIU0_IOD_BM_0); if ((val & 0xffffffff) != 0x3c0ffff0) ret|=2; val = geode_msr_read(GLIU0_IOD_BM_1); if ((val & 0xffffffff) != 0x3d0ffff0) ret|=4; return ret; } static u32 framebuffer_size(void) { /* We use the P2D_R0 msr to read out the number of pages. * One page has a size of 4k * * Bit Name Description * 39:20 PMAX Physical Memory Address Max * 19:0 PMIX Physical Memory Address Min * */ u64 msr = geode_msr_read(GLIU0_P2D_RO); u32 pmax = (msr >> 20) & 0x000fffff; u32 pmin = msr & 0x000fffff; u32 val = pmax - pmin; val += 1; /* The page size is 4k */ return (val << 12); } /**************************************************************** * Init Functions ****************************************************************/ static void geodevga_set_output_mode(void) { u64 msr_addr; u64 msr; /* set output to crt and RGB/YUV */ if (CONFIG_VGA_GEODEGX2) msr_addr = VP_MSR_CONFIG_GX2; else msr_addr = VP_MSR_CONFIG_LX; /* set output mode (RGB/YUV) */ msr = geode_msr_read(msr_addr); msr &= ~VP_MSR_CONFIG_FMT; // mask out FMT (bits 5:3) if (CONFIG_VGA_OUTPUT_PANEL || CONFIG_VGA_OUTPUT_CRT_PANEL) { msr |= VP_MSR_CONFIG_FMT_FP; // flat panel if (CONFIG_VGA_OUTPUT_CRT_PANEL) { msr |= VP_MSR_CONFIG_FPC; // simultaneous Flat Panel and CRT dprintf(1, "output: simultaneous Flat Panel and CRT\n"); } else { msr &= ~VP_MSR_CONFIG_FPC; // no simultaneous Flat Panel and CRT dprintf(1, "ouput: flat panel\n"); } } else { msr |= VP_MSR_CONFIG_FMT_CRT; // CRT only dprintf(1, "output: CRT\n"); } geode_msr_mask(msr_addr, ~msr, msr); } /* Set up the dc (display controller) portion of the geodelx * The dc provides hardware support for VGA graphics. */ static void dc_setup(void) { dprintf(2, "DC_SETUP\n"); geode_dc_write(DC_UNLOCK, DC_LOCK_UNLOCK); /* zero memory config */ geode_dc_write(DC_FB_ST_OFFSET, 0x0); geode_dc_write(DC_CB_ST_OFFSET, 0x0); geode_dc_write(DC_CURS_ST_OFFSET, 0x0); geode_dc_mask(DC_DISPLAY_CFG, ~DC_CFG_MSK, DC_DISPLAY_CFG_GDEN|DC_DISPLAY_CFG_TRUP); geode_dc_write(DC_GENERAL_CFG, DC_GENERAL_CFG_VGAE); geode_dc_write(DC_UNLOCK, DC_LOCK_LOCK); } /* Setup the vp (video processor) portion of the geodelx * Under VGA modes the vp was handled by softvg from inside VSA2. * Without a softvg module, access is only available through a pci bar. * The High Mem Access virtual register is used to configure the * pci mmio bar from 16bit friendly io space. */ static void vp_setup(void) { dprintf(2,"VP_SETUP\n"); geodevga_set_output_mode(); /* Set mmio registers * there may be some timing issues here, the reads seem * to slow things down enough work reliably */ u32 reg = geode_vp_read(VP_MISC); dprintf(1,"VP_SETUP VP_MISC=0x%08x\n",reg); geode_vp_write(VP_MISC, VP_DCFG_BYP_BOTH); reg = geode_vp_read(VP_MISC); dprintf(1,"VP_SETUP VP_MISC=0x%08x\n",reg); reg = geode_vp_read(VP_DCFG); dprintf(1,"VP_SETUP VP_DCFG=0x%08x\n",reg); geode_vp_mask(VP_DCFG, 0, VP_DCFG_CRT_EN|VP_DCFG_HSYNC_EN|VP_DCFG_VSYNC_EN|VP_DCFG_DAC_BL_EN|VP_DCFG_CRT_SKEW); reg = geode_vp_read(VP_DCFG); dprintf(1,"VP_SETUP VP_DCFG=0x%08x\n",reg); /* setup flat panel */ if (CONFIG_VGA_OUTPUT_PANEL || CONFIG_VGA_OUTPUT_CRT_PANEL) { u64 msr; dprintf(1, "Setting up flat panel\n"); /* write timing register */ geode_fp_write(FP_PT1, 0x0); geode_fp_write(FP_PT2, FP_PT2_SCRC); /* set pad select for TFT/LVDS */ msr = VP_MSR_PADSEL_TFT_SEL_HIGH; msr = msr << 32; msr |= VP_MSR_PADSEL_TFT_SEL_LOW; geode_msr_mask(VP_MSR_PADSEL, ~msr, msr); /* turn the panel on (if it isn't already) */ reg = geode_fp_read(FP_PM); reg |= FP_PM_P; geode_fp_write(FP_PM, reg); } } static u8 geode_crtc_01[] VAR16 = { 0x2d, 0x27, 0x28, 0x90, 0x29, 0x8e, 0xbf, 0x1f, 0x00, 0x4f, 0x0d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x9b, 0x8d, 0x8f, 0x14, 0x1f, 0x97, 0xb9, 0xa3, 0xff }; static u8 geode_crtc_03[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x51, 0x9e, 0xbf, 0x1f, 0x00, 0x4f, 0x0d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x9b, 0x8d, 0x8f, 0x28, 0x1f, 0x97, 0xb9, 0xa3, 0xff }; static u8 geode_crtc_04[] VAR16 = { 0x2d, 0x27, 0x28, 0x90, 0x29, 0x8e, 0xbf, 0x1f, 0x00, 0xc1, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x9b, 0x8d, 0x8f, 0x14, 0x00, 0x97, 0xb9, 0xa2, 0xff }; static u8 geode_crtc_05[] VAR16 = { 0x2d, 0x27, 0x28, 0x90, 0x29, 0x8e, 0xbf, 0x1f, 0x00, 0xc1, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x9b, 0x8e, 0x8f, 0x14, 0x00, 0x97, 0xb9, 0xa2, 0xff }; static u8 geode_crtc_06[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x51, 0x9e, 0xbf, 0x1f, 0x00, 0xc1, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x9b, 0x8d, 0x8f, 0x28, 0x00, 0x97, 0xb9, 0xc2, 0xff }; static u8 geode_crtc_07[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x51, 0x9e, 0xbf, 0x1f, 0x00, 0x4f, 0x0d, 0x0e, 0x00, 0x00, 0x00, 0x00, 0x9b, 0x8d, 0x8f, 0x28, 0x0f, 0x97, 0xb9, 0xa3, 0xff }; static u8 geode_crtc_0d[] VAR16 = { 0x2d, 0x27, 0x28, 0x90, 0x29, 0x8e, 0xbf, 0x1f, 0x00, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x9b, 0x8d, 0x8f, 0x14, 0x00, 0x97, 0xb9, 0xe3, 0xff }; static u8 geode_crtc_0e[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x51, 0x9e, 0xbf, 0x1f, 0x00, 0xc0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x9b, 0x8d, 0x8f, 0x28, 0x00, 0x97, 0xb9, 0xe3, 0xff }; static u8 geode_crtc_0f[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x51, 0x9e, 0xbf, 0x1f, 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x83, 0x85, 0x5d, 0x28, 0x0f, 0x65, 0xb9, 0xe3, 0xff }; static u8 geode_crtc_11[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x51, 0x9e, 0x0b, 0x3e, 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xe9, 0x8b, 0xdf, 0x28, 0x00, 0xe7, 0x04, 0xe3, 0xff }; static u8 geode_crtc_13[] VAR16 = { 0x5f, 0x4f, 0x50, 0x82, 0x51, 0x9e, 0xbf, 0x1f, 0x00, 0x41, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x9b, 0x8d, 0x8f, 0x28, 0x40, 0x98, 0xb9, 0xa3, 0xff }; int geodevga_setup(void) { int ret = stdvga_setup(); if (ret) return ret; dprintf(1,"GEODEVGA_SETUP\n"); if ((ret=legacyio_check())) { dprintf(1,"GEODEVGA_SETUP legacyio_check=0x%x\n",ret); } // Updated timings from geode datasheets, table 6-53 in particular static u8 *new_crtc[] VAR16 = { geode_crtc_01, geode_crtc_01, geode_crtc_03, geode_crtc_03, geode_crtc_04, geode_crtc_05, geode_crtc_06, geode_crtc_07, 0, 0, 0, 0, 0, geode_crtc_0d, geode_crtc_0e, geode_crtc_0f, geode_crtc_0f, geode_crtc_11, geode_crtc_11, geode_crtc_13 }; int i; for (i=0; ihflags2 & HF2_NMI_MASK)) { + svm_check_intercept(SVM_EXIT_NMI); env->interrupt_request &= ~CPU_INTERRUPT_NMI; env->hflags2 |= HF2_NMI_MASK; do_interrupt(EXCP02_NMI, 0, 0, 0, 1); tinyvisor/bootloader/0000755006644000001440000000000012206363326015221 5ustar yuichi_xyuserstinyvisor/bootloader/Makefile0000644006644000001440000000023111733245403016654 0ustar yuichi_xyusers.PHONY : all clean all : bootloader bootloader: bootloader.s gcc -nostdlib -Wl,--oformat,binary -o bootloader bootloader.s clean : rm -f bootloader tinyvisor/bootloader/bootloader.s0000644006644000001440000001255311764646340017555 0ustar yuichi_xyusers/* * Copyright (c) 2007, 2008 University of Tsukuba * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, * this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright notice, * this list of conditions and the following disclaimer in the documentation * and/or other materials provided with the distribution. * 3. Neither the name of the University of Tsukuba nor the names of its * contributors may be used to endorse or promote products derived from * this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Copyright (c) 2010-2012 Yuichi Watanabe */ /* simple boot loader for 386 and above PC */ CR0_PE_BIT = 0x1 .code16 entry: # 0x7C00 jmp start .org entry+4 .space 4 # 0x7C04 length .space 8 # 0x7C08 LBA .space 4 # 0x7C10 cmdline start offset/512 .space 4 # 0x7C14 module start offset/512 #.short 0x27 # 0x7C10 GDTR #.long 0x7C10 # 0x7C12 #.short 0 # 0x7C16 .quad 0x00CF9B000000FFFF # 0x7C18 0x08 CODE32 .quad 0x008F93000000FFFF # 0x7C20 0x10 DATA32 not big .quad 0x00009B000000FFFF # 0x7C28 0x18 CODE16 .quad 0x000093000000FFFF # 0x7C30 0x20 DATA16 start: # 0x7C38 cli push %cs pop %ds push %cs pop %ss mov $0x7FFC,%sp # B flag of the stack segment is off mov %sp,%bp # Enable A20 in $0x92,%al or $0x2,%al out %al,$0x92 # Read sectors lea 0x7C00,%esi mov 4(%si),%ecx # length pushl %ecx lea 16(%si),%ebx pushl 4(%bx) pushl (%bx) mov %bx,(%bx) mov %ebx,2(%bx) mov $511,%bx add %ebx,%ecx mov $0x100000,%edi # destination address push %edi mov $'L'|('o'<<8)|('a'<<16)|('d'<<24),%eax call print shr $9,%ecx je error mov %ecx,%eax shr $6,%eax mov %ax,(%bp) mov %ax,2(%bp) mov $'i'|('n'<<8)|('g'<<16)|(' '<<24),%eax call print readloop: sti pushl %ecx movw $0x10,(%si) mov $0x40,%al cmpl %eax,%ecx jb readsmall mov %eax,%ecx readsmall: mov %cx,2(%si) mov $0x8000,%ax movl %eax,4(%si) mov $0x42,%ah int $0x13 jnc copy error: mov $'E'|('r'<<8)|('r'<<16)|('o'<<24),%eax call print mov $'r'|('!'<<8)|('\r'<<16)|('\n'<<24),%eax call print int $0x16 int $0x19 toreal: mov %cx,%ds mov %cx,%es mov %cx,%ss jc error pop %ecx progressloop: decw 2(%si) js readloop lea '.'|('\b'<<8),%eax decw (%bp) jne progressprint pushw 2(%bp) popw (%bp) cbtw progressprint: call print dec %ecx jne progressloop mov $'\r'|('\n'<<8),%ax call print copy: mov $0x10,%bx lgdt (%bx,%si) # GDTR cli mov %cr0,%eax inc %ax mov %eax,%cr0 ljmp $0x8,$to32-entry+0x7C00 to16: mov $0x20,%bl mov %bx,%ds mov %bx,%es mov %bx,%ss dec %ax # CF is not affected mov %eax,%cr0 ljmp $0x0,$toreal-entry+0x7C00 print: pushal mov $7,%bx mov $0xE,%ah int $0x10 popal shr $8,%eax jne print ret .code32 to32: mov %ebx,%ds mov %ebx,%es mov %ebx,%ss cld jecxz start32 addl %ecx,8(%esi) adcl $0,12(%esi) push %esi mov 4(%esi),%esi shl $7,%ecx # CF should be zero after this rep movsl pop %esi error2: ljmpw $0x18,$to16-entry+0x7C00 # Start start32: pop %esi # 0x100000 # ELF header check cmpl $0x464C457F,(%esi) # ELF header correct? stc # Set CF jne error2 # No- # Make a multiboot info xor %eax,%eax lea 4(%bp),%edi push %edi # Clear multiboot info lea 88/4(%eax),%ecx rep stosl pop %ebx mov %dl,15(%ebx) # Write a drive number orb $2,(%ebx) # Set a boot device flag cmdline: pop %eax test %eax,%eax je module orb $4,(%ebx) # Set a cmdline flag add %esi,%eax # Calculate the address of the cmdline mov %eax,16(%ebx) # Store the address of the cmdline module: # Modules pop %eax # 1st module offset test %eax,%eax je dojmp mov %edi,24(%ebx) # Write a modules structure address orb $8,(%ebx) # Set a mods flag add %esi,%eax # Calculate the address of the module stosl # Store the 1st module start address ;; pop %eax # 2nd module offset ;; test %eax,%eax ;; je modend ;; add %esi,%eax # Calculate the address of the module ;; stosl # Store the 1st module end address ;; stosl # unused ;; stosl # unused ;; incl 20(%ebx) # Increment modules count ;; stosl # Store the 2nd module start address ;; modend: pop %eax # end of the data add %esi,%eax # Calculate the address stosl # Store the module end address stosl # unused stosl # unused incl 20(%ebx) # Increment modules count dojmp: mov 0x18(%esi),%si # Get an entry point address < 64KiB jmp *%esi .org entry+0x1FE .byte 0x55 .byte 0xAA tinyvisor/copy.sh0000755006644000001440000000020411733261041014367 0ustar yuichi_xyusers#!/bin/sh if [ -z $1 ]; then echo "Please specify a destination." exit 1 fi date scp vmm/vmm.elf cmd/dbgsh bios/out/bios.bin $1