---
freebsd/sys/dev/fb/fb.c | 762 ++++++++++++++++++++++
freebsd/sys/dev/fb/fbd.c | 372 +++++++++++
freebsd/sys/dev/vt/colors/vt_termcolors.h | 63 ++
freebsd/sys/dev/vt/hw/fb/vt_fb.h | 54 ++
4 files changed, 1251 insertions(+)
create mode 100644 freebsd/sys/dev/fb/fb.c
create mode 100644 freebsd/sys/dev/fb/fbd.c
create mode 100644 freebsd/sys/dev/vt/colors/vt_termcolors.h
create mode 100644 freebsd/sys/dev/vt/hw/fb/vt_fb.h
diff --git a/freebsd/sys/dev/fb/fb.c b/freebsd/sys/dev/fb/fb.c
new file mode 100644
index 00000000..a3263c91
--- /dev/null
+++ b/freebsd/sys/dev/fb/fb.c
@@ -0,0 +1,762 @@
+#include <machine/rtems-bsd-kernel-space.h>
+
+/*-
+ * SPDX-License-Identifier: BSD-3-Clause
+ *
+ * Copyright (c) 1999 Kazutaka YOKOTA <yok...@zodiac.mech.utsunomiya-u.ac.jp>
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer as
+ * the first lines of this file unmodified.
+ * 2. Redistributions in binary form must reproduce 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.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
+ * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
+ * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
+ * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
+ * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
+ * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (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 <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <rtems/bsd/local/opt_fb.h>
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/conf.h>
+#include <sys/bus.h>
+#include <sys/kernel.h>
+#include <sys/malloc.h>
+#include <sys/module.h>
+#include <sys/uio.h>
+#include <sys/fbio.h>
+#include <sys/linker_set.h>
+
+#include <vm/vm.h>
+#include <vm/pmap.h>
+
+#include <dev/fb/fbreg.h>
+
+SET_DECLARE(videodriver_set, const video_driver_t);
+
+/* local arrays */
+
+/*
+ * We need at least one entry each in order to initialize a video card
+ * for the kernel console. The arrays will be increased dynamically
+ * when necessary.
+ */
+
+static int vid_malloc;
+static int adapters = 1;
+static video_adapter_t *adp_ini;
+static video_adapter_t **adapter = &adp_ini;
+static video_switch_t *vidsw_ini;
+ video_switch_t **vidsw = &vidsw_ini;
+
+#ifdef FB_INSTALL_CDEV
+static struct cdevsw *vidcdevsw_ini;
+static struct cdevsw **vidcdevsw = &vidcdevsw_ini;
+#endif
+
+#define ARRAY_DELTA 4
+
+static int
+vid_realloc_array(void)
+{
+ video_adapter_t **new_adp;
+ video_switch_t **new_vidsw;
+#ifdef FB_INSTALL_CDEV
+ struct cdevsw **new_cdevsw;
+#endif
+ int newsize;
+ int s;
+
+ if (!vid_malloc)
+ return ENOMEM;
+
+ s = spltty();
+ newsize = rounddown(adapters + ARRAY_DELTA, ARRAY_DELTA);
+ new_adp = malloc(sizeof(*new_adp)*newsize, M_DEVBUF, M_WAITOK | M_ZERO);
+ new_vidsw = malloc(sizeof(*new_vidsw)*newsize, M_DEVBUF,
+ M_WAITOK | M_ZERO);
+#ifdef FB_INSTALL_CDEV
+ new_cdevsw = malloc(sizeof(*new_cdevsw)*newsize, M_DEVBUF,
+ M_WAITOK | M_ZERO);
+#endif
+ bcopy(adapter, new_adp, sizeof(*adapter)*adapters);
+ bcopy(vidsw, new_vidsw, sizeof(*vidsw)*adapters);
+#ifdef FB_INSTALL_CDEV
+ bcopy(vidcdevsw, new_cdevsw, sizeof(*vidcdevsw)*adapters);
+#endif
+ if (adapters > 1) {
+ free(adapter, M_DEVBUF);
+ free(vidsw, M_DEVBUF);
+#ifdef FB_INSTALL_CDEV
+ free(vidcdevsw, M_DEVBUF);
+#endif
+ }
+ adapter = new_adp;
+ vidsw = new_vidsw;
+#ifdef FB_INSTALL_CDEV
+ vidcdevsw = new_cdevsw;
+#endif
+ adapters = newsize;
+ splx(s);
+
+ if (bootverbose)
+ printf("fb: new array size %d\n", adapters);
+
+ return 0;
+}
+
+static void
+vid_malloc_init(void *arg)
+{
+ vid_malloc = TRUE;
+}
+
+SYSINIT(vid_mem, SI_SUB_KMEM, SI_ORDER_ANY, vid_malloc_init, NULL);
+
+/*
+ * Low-level frame buffer driver functions
+ * frame buffer subdrivers, such as the VGA driver, call these functions
+ * to initialize the video_adapter structure and register it to the virtual
+ * frame buffer driver `fb'.
+ */
+
+/* initialize the video_adapter_t structure */
+void
+vid_init_struct(video_adapter_t *adp, char *name, int type, int unit)
+{
+ adp->va_flags = 0;
+ adp->va_name = name;
+ adp->va_type = type;
+ adp->va_unit = unit;
+}
+
+/* Register a video adapter */
+int
+vid_register(video_adapter_t *adp)
+{
+ const video_driver_t **list;
+ const video_driver_t *p;
+ int index;
+
+ for (index = 0; index < adapters; ++index) {
+ if (adapter[index] == NULL)
+ break;
+ }
+ if (index >= adapters) {
+ if (vid_realloc_array())
+ return -1;
+ }
+
+ adp->va_index = index;
+ adp->va_token = NULL;
+ SET_FOREACH(list, videodriver_set) {
+ p = *list;
+ if (strcmp(p->name, adp->va_name) == 0) {
+ adapter[index] = adp;
+ vidsw[index] = p->vidsw;
+ return index;
+ }
+ }
+
+ return -1;
+}
+
+int
+vid_unregister(video_adapter_t *adp)
+{
+ if ((adp->va_index < 0) || (adp->va_index >= adapters))
+ return ENOENT;
+ if (adapter[adp->va_index] != adp)
+ return ENOENT;
+
+ adapter[adp->va_index] = NULL;
+ vidsw[adp->va_index] = NULL;
+ return 0;
+}
+
+/* Get video I/O function table */
+video_switch_t
+*vid_get_switch(char *name)
+{
+ const video_driver_t **list;
+ const video_driver_t *p;
+
+ SET_FOREACH(list, videodriver_set) {
+ p = *list;
+ if (strcmp(p->name, name) == 0)
+ return p->vidsw;
+ }
+
+ return NULL;
+}
+
+/*
+ * Video card client functions
+ * Video card clients, such as the console driver `syscons' and the frame
+ * buffer cdev driver, use these functions to claim and release a card for
+ * exclusive use.
+ */
+
+/* find the video card specified by a driver name and a unit number */
+int
+vid_find_adapter(char *driver, int unit)
+{
+ int i;
+
+ for (i = 0; i < adapters; ++i) {
+ if (adapter[i] == NULL)
+ continue;
+ if (strcmp("*", driver) && strcmp(adapter[i]->va_name, driver))
+ continue;
+ if ((unit != -1) && (adapter[i]->va_unit != unit))
+ continue;
+ return i;
+ }
+ return -1;
+}
+
+/* allocate a video card */
+int
+vid_allocate(char *driver, int unit, void *id)
+{
+ int index;
+ int s;
+
+ s = spltty();
+ index = vid_find_adapter(driver, unit);
+ if (index >= 0) {
+ if (adapter[index]->va_token) {
+ splx(s);
+ return -1;
+ }
+ adapter[index]->va_token = id;
+ }
+ splx(s);
+ return index;
+}
+
+int
+vid_release(video_adapter_t *adp, void *id)
+{
+ int error;
+ int s;
+
+ s = spltty();
+ if (adp->va_token == NULL) {
+ error = EINVAL;
+ } else if (adp->va_token != id) {
+ error = EPERM;
+ } else {
+ adp->va_token = NULL;
+ error = 0;
+ }
+ splx(s);
+ return error;
+}
+
+/* Get a video adapter structure */
+video_adapter_t
+*vid_get_adapter(int index)
+{
+ if ((index < 0) || (index >= adapters))
+ return NULL;
+ return adapter[index];
+}
+
+/* Configure drivers: this is a backdoor for the console driver XXX */
+int
+vid_configure(int flags)
+{
+ const video_driver_t **list;
+ const video_driver_t *p;
+
+ SET_FOREACH(list, videodriver_set) {
+ p = *list;
+ if (p->configure != NULL)
+ (*p->configure)(flags);
+ }
+
+ return 0;
+}
+
+/*
+ * Virtual frame buffer cdev driver functions
+ * The virtual frame buffer driver dispatches driver functions to
+ * appropriate subdrivers.
+ */
+
+#define FB_DRIVER_NAME "fb"
+
+#ifdef FB_INSTALL_CDEV
+
+#if 0 /* experimental */
+
+static devclass_t fb_devclass;
+
+static int fbprobe(device_t dev);
+static int fbattach(device_t dev);
+
+static device_method_t fb_methods[] = {
+ DEVMETHOD(device_probe, fbprobe),
+ DEVMETHOD(device_attach, fbattach),
+
+ DEVMETHOD_END
+};
+
+static driver_t fb_driver = {
+ FB_DRIVER_NAME,
+ fb_methods,
+ 0,
+};
+
+static int
+fbprobe(device_t dev)
+{
+ int unit;
+
+ unit = device_get_unit(dev);
+ if (unit >= adapters)
+ return ENXIO;
+ if (adapter[unit] == NULL)
+ return ENXIO;
+
+ device_set_desc(dev, "generic frame buffer");
+ return 0;
+}
+
+static int
+fbattach(device_t dev)
+{
+ printf("fbattach: about to attach children\n");
+ bus_generic_attach(dev);
+ return 0;
+}
+
+#endif
+
+#define FB_UNIT(dev) dev2unit(dev)
+#define FB_MKMINOR(unit) (u)
+
+#if 0 /* experimental */
+static d_open_t fbopen;
+static d_close_t fbclose;
+static d_read_t fbread;
+static d_write_t fbwrite;
+static d_ioctl_t fbioctl;
+static d_mmap_t fbmmap;
+
+
+static struct cdevsw fb_cdevsw = {
+ .d_version = D_VERSION,
+ .d_flags = D_NEEDGIANT,
+ .d_open = fbopen,
+ .d_close = fbclose,
+ .d_read = fbread,
+ .d_write = fbwrite,
+ .d_ioctl = fbioctl,
+ .d_mmap = fbmmap,
+ .d_name = FB_DRIVER_NAME,
+};
+#endif
+
+
+static int
+fb_modevent(module_t mod, int type, void *data)
+{
+
+ switch (type) {
+ case MOD_LOAD:
+ break;
+ case MOD_UNLOAD:
+ printf("fb module unload - not possible for this module
type\n");
+ return EINVAL;
+ default:
+ return EOPNOTSUPP;
+ }
+ return 0;
+}
+
+static moduledata_t fb_mod = {
+ "fb",
+ fb_modevent,
+ NULL
+};
+
+DECLARE_MODULE(fb, fb_mod, SI_SUB_PSEUDO, SI_ORDER_ANY);
+
+int
+fb_attach(int unit, video_adapter_t *adp, struct cdevsw *cdevsw)
+{
+ int s;
+
+ if (adp->va_index >= adapters)
+ return EINVAL;
+ if (adapter[adp->va_index] != adp)
+ return EINVAL;
+
+ s = spltty();
+ adp->va_minor = unit;
+ vidcdevsw[adp->va_index] = cdevsw;
+ splx(s);
+
+ printf("fb%d at %s%d\n", adp->va_index, adp->va_name, adp->va_unit);
+ return 0;
+}
+
+int
+fb_detach(int unit, video_adapter_t *adp, struct cdevsw *cdevsw)
+{
+ int s;
+
+ if (adp->va_index >= adapters)
+ return EINVAL;
+ if (adapter[adp->va_index] != adp)
+ return EINVAL;
+ if (vidcdevsw[adp->va_index] != cdevsw)
+ return EINVAL;
+
+ s = spltty();
+ vidcdevsw[adp->va_index] = NULL;
+ splx(s);
+ return 0;
+}
+
+/*
+ * Generic frame buffer cdev driver functions
+ * Frame buffer subdrivers may call these functions to implement common
+ * driver functions.
+ */
+
+int genfbopen(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
+ struct thread *td)
+{
+ int s;
+
+ s = spltty();
+ if (!(sc->gfb_flags & FB_OPEN))
+ sc->gfb_flags |= FB_OPEN;
+ splx(s);
+ return 0;
+}
+
+int genfbclose(genfb_softc_t *sc, video_adapter_t *adp, int flag, int mode,
+ struct thread *td)
+{
+ int s;
+
+ s = spltty();
+ sc->gfb_flags &= ~FB_OPEN;
+ splx(s);
+ return 0;
+}
+
+int genfbread(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
+ int flag)
+{
+ int size;
+ int offset;
+ int error;
+ int len;
+
+ error = 0;
+ size = adp->va_buffer_size/adp->va_info.vi_planes;
+ while (uio->uio_resid > 0) {
+ if (uio->uio_offset >= size)
+ break;
+ offset = uio->uio_offset%adp->va_window_size;
+ len = imin(uio->uio_resid, size - uio->uio_offset);
+ len = imin(len, adp->va_window_size - offset);
+ if (len <= 0)
+ break;
+ vidd_set_win_org(adp, uio->uio_offset);
+ error = uiomove((caddr_t)(adp->va_window + offset), len, uio);
+ if (error)
+ break;
+ }
+ return error;
+}
+
+int genfbwrite(genfb_softc_t *sc, video_adapter_t *adp, struct uio *uio,
+ int flag)
+{
+ return ENODEV;
+}
+
+int genfbioctl(genfb_softc_t *sc, video_adapter_t *adp, u_long cmd,
+ caddr_t arg, int flag, struct thread *td)
+{
+ int error;
+
+ if (adp == NULL) /* XXX */
+ return ENXIO;
+ error = vidd_ioctl(adp, cmd, arg);
+ if (error == ENOIOCTL)
+ error = ENODEV;
+ return error;
+}
+
+int genfbmmap(genfb_softc_t *sc, video_adapter_t *adp, vm_ooffset_t offset,
+ vm_offset_t *paddr, int prot, vm_memattr_t *memattr)
+{
+ return vidd_mmap(adp, offset, paddr, prot, memattr);
+}
+
+#endif /* FB_INSTALL_CDEV */
+
+static char
+*adapter_name(int type)
+{
+ static struct {
+ int type;
+ char *name;
+ } names[] = {
+ { KD_MONO, "MDA" },
+ { KD_HERCULES, "Hercules" },
+ { KD_CGA, "CGA" },
+ { KD_EGA, "EGA" },
+ { KD_VGA, "VGA" },
+ { KD_TGA, "TGA" },
+ { -1, "Unknown" },
+ };
+ int i;
+
+ for (i = 0; names[i].type != -1; ++i)
+ if (names[i].type == type)
+ break;
+ return names[i].name;
+}
+
+/*
+ * Generic low-level frame buffer functions
+ * The low-level functions in the frame buffer subdriver may use these
+ * functions.
+ */
+
+void
+fb_dump_adp_info(char *driver, video_adapter_t *adp, int level)
+{
+ if (level <= 0)
+ return;
+
+ printf("%s%d: %s%d, %s, type:%s (%d), flags:0x%x\n",
+ FB_DRIVER_NAME, adp->va_index, driver, adp->va_unit, adp->va_name,
+ adapter_name(adp->va_type), adp->va_type, adp->va_flags);
+ printf("%s%d: port:0x%lx-0x%lx, crtc:0x%lx, mem:0x%lx 0x%x\n",
+ FB_DRIVER_NAME, adp->va_index, (u_long)adp->va_io_base,
+ (u_long)adp->va_io_base + adp->va_io_size - 1,
+ (u_long)adp->va_crtc_addr, (u_long)adp->va_mem_base,
+ adp->va_mem_size);
+ printf("%s%d: init mode:%d, bios mode:%d, current mode:%d\n",
+ FB_DRIVER_NAME, adp->va_index,
+ adp->va_initial_mode, adp->va_initial_bios_mode, adp->va_mode);
+ printf("%s%d: window:%p size:%dk gran:%dk, buf:%p size:%dk\n",
+ FB_DRIVER_NAME, adp->va_index,
+ (void *)adp->va_window, (int)adp->va_window_size/1024,
+ (int)adp->va_window_gran/1024, (void *)adp->va_buffer,
+ (int)adp->va_buffer_size/1024);
+}
+
+void
+fb_dump_mode_info(char *driver, video_adapter_t *adp, video_info_t *info,
+ int level)
+{
+ if (level <= 0)
+ return;
+
+ printf("%s%d: %s, mode:%d, flags:0x%x ",
+ driver, adp->va_unit, adp->va_name, info->vi_mode, info->vi_flags);
+ if (info->vi_flags & V_INFO_GRAPHICS)
+ printf("G %dx%dx%d, %d plane(s), font:%dx%d, ",
+ info->vi_width, info->vi_height,
+ info->vi_depth, info->vi_planes,
+ info->vi_cwidth, info->vi_cheight);
+ else
+ printf("T %dx%d, font:%dx%d, ",
+ info->vi_width, info->vi_height,
+ info->vi_cwidth, info->vi_cheight);
+ printf("win:0x%lx\n", (u_long)info->vi_window);
+}
+
+int
+fb_type(int adp_type)
+{
+ static struct {
+ int fb_type;
+ int va_type;
+ } types[] = {
+ { FBTYPE_MDA, KD_MONO },
+ { FBTYPE_HERCULES, KD_HERCULES },
+ { FBTYPE_CGA, KD_CGA },
+ { FBTYPE_EGA, KD_EGA },
+ { FBTYPE_VGA, KD_VGA },
+ { FBTYPE_TGA, KD_TGA },
+ };
+ int i;
+
+ for (i = 0; i < nitems(types); ++i) {
+ if (types[i].va_type == adp_type)
+ return types[i].fb_type;
+ }
+ return -1;
+}
+
+int
+fb_commonioctl(video_adapter_t *adp, u_long cmd, caddr_t arg)
+{
+ int error;
+ int s;
+
+ /* assert(adp != NULL) */
+
+ error = 0;
+ s = spltty();
+
+ switch (cmd) {
+
+ case FBIO_ADAPTER: /* get video adapter index */
+ *(int *)arg = adp->va_index;
+ break;
+
+ case FBIO_ADPTYPE: /* get video adapter type */
+ *(int *)arg = adp->va_type;
+ break;
+
+ case FBIO_ADPINFO: /* get video adapter info */
+ ((video_adapter_info_t *)arg)->va_index = adp->va_index;
+ ((video_adapter_info_t *)arg)->va_type = adp->va_type;
+ bcopy(adp->va_name, ((video_adapter_info_t *)arg)->va_name,
+ imin(strlen(adp->va_name) + 1,
+ sizeof(((video_adapter_info_t *)arg)->va_name)));
+ ((video_adapter_info_t *)arg)->va_unit = adp->va_unit;
+ ((video_adapter_info_t *)arg)->va_flags = adp->va_flags;
+ ((video_adapter_info_t *)arg)->va_io_base = adp->va_io_base;
+ ((video_adapter_info_t *)arg)->va_io_size = adp->va_io_size;
+ ((video_adapter_info_t *)arg)->va_crtc_addr = adp->va_crtc_addr;
+ ((video_adapter_info_t *)arg)->va_mem_base = adp->va_mem_base;
+ ((video_adapter_info_t *)arg)->va_mem_size = adp->va_mem_size;
+ ((video_adapter_info_t *)arg)->va_window
+#if defined(__amd64__) || defined(__i386__)
+ = vtophys(adp->va_window);
+#else
+ = adp->va_window;
+#endif
+ ((video_adapter_info_t *)arg)->va_window_size
+ = adp->va_window_size;
+ ((video_adapter_info_t *)arg)->va_window_gran
+ = adp->va_window_gran;
+ ((video_adapter_info_t *)arg)->va_window_orig
+ = adp->va_window_orig;
+ ((video_adapter_info_t *)arg)->va_unused0
+#if defined(__amd64__) || defined(__i386__)
+ = adp->va_buffer != 0 ? vtophys(adp->va_buffer) : 0;
+#else
+ = adp->va_buffer;
+#endif
+ ((video_adapter_info_t *)arg)->va_buffer_size
+ = adp->va_buffer_size;
+ ((video_adapter_info_t *)arg)->va_mode = adp->va_mode;
+ ((video_adapter_info_t *)arg)->va_initial_mode
+ = adp->va_initial_mode;
+ ((video_adapter_info_t *)arg)->va_initial_bios_mode
+ = adp->va_initial_bios_mode;
+ ((video_adapter_info_t *)arg)->va_line_width
+ = adp->va_line_width;
+ ((video_adapter_info_t *)arg)->va_disp_start.x
+ = adp->va_disp_start.x;
+ ((video_adapter_info_t *)arg)->va_disp_start.y
+ = adp->va_disp_start.y;
+ break;
+
+ case FBIO_MODEINFO: /* get mode information */
+ error = vidd_get_info(adp,
+ ((video_info_t *)arg)->vi_mode,
+ (video_info_t *)arg);
+ if (error)
+ error = ENODEV;
+ break;
+
+ case FBIO_FINDMODE: /* find a matching video mode */
+ error = vidd_query_mode(adp, (video_info_t *)arg);
+ break;
+
+ case FBIO_GETMODE: /* get video mode */
+ *(int *)arg = adp->va_mode;
+ break;
+
+ case FBIO_SETMODE: /* set video mode */
+ error = vidd_set_mode(adp, *(int *)arg);
+ if (error)
+ error = ENODEV; /* EINVAL? */
+ break;
+
+ case FBIO_GETWINORG: /* get frame buffer window origin */
+ *(u_int *)arg = adp->va_window_orig;
+ break;
+
+ case FBIO_GETDISPSTART: /* get display start address */
+ ((video_display_start_t *)arg)->x = adp->va_disp_start.x;
+ ((video_display_start_t *)arg)->y = adp->va_disp_start.y;
+ break;
+
+ case FBIO_GETLINEWIDTH: /* get scan line width in bytes */
+ *(u_int *)arg = adp->va_line_width;
+ break;
+
+ case FBIO_BLANK: /* blank display */
+ error = vidd_blank_display(adp, *(int *)arg);
+ break;
+
+ case FBIO_GETPALETTE: /* get color palette */
+ case FBIO_SETPALETTE: /* set color palette */
+ /* XXX */
+
+ case FBIOPUTCMAP:
+ case FBIOGETCMAP:
+ case FBIOPUTCMAPI:
+ case FBIOGETCMAPI:
+ /* XXX */
+
+ case FBIO_SETWINORG: /* set frame buffer window origin */
+ case FBIO_SETDISPSTART: /* set display start address */
+ case FBIO_SETLINEWIDTH: /* set scan line width in pixel */
+
+ case FBIOGTYPE:
+ case FBIOGATTR:
+ case FBIOSVIDEO:
+ case FBIOGVIDEO:
+ case FBIOVERTICAL:
+ case FBIOSCURSOR:
+ case FBIOGCURSOR:
+ case FBIOSCURPOS:
+ case FBIOGCURPOS:
+ case FBIOGCURMAX:
+ case FBIOMONINFO:
+ case FBIOGXINFO:
+
+ default:
+ error = ENODEV;
+ break;
+ }
+
+ splx(s);
+ return error;
+}
diff --git a/freebsd/sys/dev/fb/fbd.c b/freebsd/sys/dev/fb/fbd.c
new file mode 100644
index 00000000..60ce4bc3
--- /dev/null
+++ b/freebsd/sys/dev/fb/fbd.c
@@ -0,0 +1,372 @@
+#include <machine/rtems-bsd-kernel-space.h>
+
+/*-
+ * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
+ *
+ * Copyright (c) 2013 The FreeBSD Foundation
+ * All rights reserved.
+ *
+ * This software was developed by Aleksandr Rybalko under sponsorship from the
+ * FreeBSD Foundation.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must 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$
+ */
+
+/* Generic framebuffer */
+/* TODO unlink from VT(9) */
+/* TODO done normal /dev/fb methods */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/bus.h>
+#include <sys/conf.h>
+#include <sys/kernel.h>
+#include <sys/malloc.h>
+#include <sys/module.h>
+#include <sys/queue.h>
+#include <sys/fbio.h>
+
+#include <machine/bus.h>
+
+#include <dev/vt/vt.h>
+#include <dev/vt/hw/fb/vt_fb.h>
+
+#include <vm/vm.h>
+#include <vm/pmap.h>
+
+#include <rtems/bsd/local/fb_if.h>
+
+LIST_HEAD(fb_list_head_t, fb_list_entry) fb_list_head =
+ LIST_HEAD_INITIALIZER(fb_list_head);
+struct fb_list_entry {
+ struct fb_info *fb_info;
+ struct cdev *fb_si;
+ LIST_ENTRY(fb_list_entry) fb_list;
+};
+
+struct fbd_softc {
+ device_t sc_dev;
+ struct fb_info *sc_info;
+};
+
+static void fbd_evh_init(void *);
+/* SI_ORDER_SECOND, just after EVENTHANDLERs initialized. */
+SYSINIT(fbd_evh_init, SI_SUB_CONFIGURE, SI_ORDER_SECOND, fbd_evh_init, NULL);
+
+static d_open_t fb_open;
+static d_close_t fb_close;
+static d_read_t fb_read;
+static d_write_t fb_write;
+static d_ioctl_t fb_ioctl;
+static d_mmap_t fb_mmap;
+
+static struct cdevsw fb_cdevsw = {
+ .d_version = D_VERSION,
+ .d_flags = D_NEEDGIANT,
+ .d_open = fb_open,
+ .d_close = fb_close,
+ .d_read = fb_read,
+ .d_write = fb_write,
+ .d_ioctl = fb_ioctl,
+ .d_mmap = fb_mmap,
+ .d_name = "fb",
+};
+
+static int framebuffer_dev_unit = 0;
+
+static int
+fb_open(struct cdev *dev, int oflags, int devtype, struct thread *td)
+{
+
+ return (0);
+}
+
+static int
+fb_close(struct cdev *dev, int fflag, int devtype, struct thread *td)
+{
+
+ return (0);
+}
+
+static int
+fb_ioctl(struct cdev *dev, u_long cmd, caddr_t data, int fflag,
+ struct thread *td)
+{
+ struct fb_info *info;
+ int error;
+
+ error = 0;
+ info = dev->si_drv1;
+
+ switch (cmd) {
+ case FBIOGTYPE:
+ bcopy(info, (struct fbtype *)data, sizeof(struct fbtype));
+ break;
+
+ case FBIO_GETWINORG: /* get frame buffer window origin */
+ *(u_int *)data = 0;
+ break;
+
+ case FBIO_GETDISPSTART: /* get display start address */
+ ((video_display_start_t *)data)->x = 0;
+ ((video_display_start_t *)data)->y = 0;
+ break;
+
+ case FBIO_GETLINEWIDTH: /* get scan line width in bytes */
+ *(u_int *)data = info->fb_stride;
+ break;
+
+ case FBIO_BLANK: /* blank display */
+ if (info->setblankmode != NULL)
+ error = info->setblankmode(info->fb_priv, *(int *)data);
+ break;
+
+ default:
+ error = ENOIOCTL;
+ break;
+ }
+ return (error);
+}
+
+static int
+fb_read(struct cdev *dev, struct uio *uio, int ioflag)
+{
+
+ return (0); /* XXX nothing to read, yet */
+}
+
+static int
+fb_write(struct cdev *dev, struct uio *uio, int ioflag)
+{
+
+ return (0); /* XXX nothing written */
+}
+
+static int
+fb_mmap(struct cdev *dev, vm_ooffset_t offset, vm_paddr_t *paddr, int nprot,
+ vm_memattr_t *memattr)
+{
+ struct fb_info *info;
+
+ info = dev->si_drv1;
+
+ if (info->fb_flags & FB_FLAG_NOMMAP)
+ return (ENODEV);
+
+ if (offset >= 0 && offset < info->fb_size) {
+ if (info->fb_pbase == 0)
+ *paddr = vtophys((uint8_t *)info->fb_vbase + offset);
+ else
+ *paddr = info->fb_pbase + offset;
+ if (info->fb_flags & FB_FLAG_MEMATTR)
+ *memattr = info->fb_memattr;
+ return (0);
+ }
+ return (EINVAL);
+}
+
+static int
+fb_init(struct fb_list_entry *entry, int unit)
+{
+ struct fb_info *info;
+
+ info = entry->fb_info;
+ entry->fb_si = make_dev(&fb_cdevsw, unit, UID_ROOT, GID_WHEEL,
+ 0600, "fb%d", unit);
+ entry->fb_si->si_drv1 = info;
+ info->fb_cdev = entry->fb_si;
+
+ return (0);
+}
+
+int
+fbd_list()
+{
+ struct fb_list_entry *entry;
+
+ if (LIST_EMPTY(&fb_list_head))
+ return (ENOENT);
+
+ LIST_FOREACH(entry, &fb_list_head, fb_list) {
+ printf("FB %s @%p\n", entry->fb_info->fb_name,
+ (void *)entry->fb_info->fb_pbase);
+ }
+
+ return (0);
+}
+
+static struct fb_list_entry *
+fbd_find(struct fb_info* info)
+{
+ struct fb_list_entry *entry, *tmp;
+
+ LIST_FOREACH_SAFE(entry, &fb_list_head, fb_list, tmp) {
+ if (entry->fb_info == info) {
+ return (entry);
+ }
+ }
+
+ return (NULL);
+}
+
+int
+fbd_register(struct fb_info* info)
+{
+ struct fb_list_entry *entry;
+ int err, first;
+
+ first = 0;
+ if (LIST_EMPTY(&fb_list_head))
+ first++;
+
+ entry = fbd_find(info);
+ if (entry != NULL) {
+ /* XXX Update framebuffer params */
+ return (0);
+ }
+
+ entry = malloc(sizeof(struct fb_list_entry), M_DEVBUF, M_WAITOK|M_ZERO);
+ entry->fb_info = info;
+
+ LIST_INSERT_HEAD(&fb_list_head, entry, fb_list);
+
+ err = fb_init(entry, framebuffer_dev_unit++);
+ if (err)
+ return (err);
+ if (first) {
+ err = vt_fb_attach(info);
+ if (err)
+ return (err);
+ }
+
+ return (0);
+}
+
+int
+fbd_unregister(struct fb_info* info)
+{
+ struct fb_list_entry *entry, *tmp;
+
+ LIST_FOREACH_SAFE(entry, &fb_list_head, fb_list, tmp) {
+ if (entry->fb_info == info) {
+ LIST_REMOVE(entry, fb_list);
+ if (LIST_EMPTY(&fb_list_head))
+ vt_fb_detach(info);
+ free(entry, M_DEVBUF);
+ return (0);
+ }
+ }
+
+ return (ENOENT);
+}
+
+static void
+register_fb_wrap(void *arg, void *ptr)
+{
+
+ fbd_register((struct fb_info *)ptr);
+}
+
+static void
+unregister_fb_wrap(void *arg, void *ptr)
+{
+
+ fbd_unregister((struct fb_info *)ptr);
+}
+
+static void
+fbd_evh_init(void *ctx)
+{
+
+ EVENTHANDLER_REGISTER(register_framebuffer, register_fb_wrap, NULL,
+ EVENTHANDLER_PRI_ANY);
+ EVENTHANDLER_REGISTER(unregister_framebuffer, unregister_fb_wrap, NULL,
+ EVENTHANDLER_PRI_ANY);
+}
+
+/* Newbus methods. */
+static int
+fbd_probe(device_t dev)
+{
+
+ return (BUS_PROBE_NOWILDCARD);
+}
+
+static int
+fbd_attach(device_t dev)
+{
+ struct fbd_softc *sc;
+ int err;
+
+ sc = device_get_softc(dev);
+
+ sc->sc_dev = dev;
+ sc->sc_info = FB_GETINFO(device_get_parent(dev));
+ if (sc->sc_info == NULL)
+ return (ENXIO);
+ err = fbd_register(sc->sc_info);
+
+ return (err);
+}
+
+static int
+fbd_detach(device_t dev)
+{
+ struct fbd_softc *sc;
+ int err;
+
+ sc = device_get_softc(dev);
+
+ err = fbd_unregister(sc->sc_info);
+
+ return (err);
+}
+
+static device_method_t fbd_methods[] = {
+ /* Device interface */
+ DEVMETHOD(device_probe, fbd_probe),
+ DEVMETHOD(device_attach, fbd_attach),
+ DEVMETHOD(device_detach, fbd_detach),
+
+ DEVMETHOD(device_shutdown, bus_generic_shutdown),
+
+ { 0, 0 }
+};
+
+driver_t fbd_driver = {
+ "fbd",
+ fbd_methods,
+ sizeof(struct fbd_softc)
+};
+
+devclass_t fbd_devclass;
+
+DRIVER_MODULE(fbd, fb, fbd_driver, fbd_devclass, 0, 0);
+DRIVER_MODULE(fbd, drmn, fbd_driver, fbd_devclass, 0, 0);
+DRIVER_MODULE(fbd, udl, fbd_driver, fbd_devclass, 0, 0);
+MODULE_VERSION(fbd, 1);
+
diff --git a/freebsd/sys/dev/vt/colors/vt_termcolors.h
b/freebsd/sys/dev/vt/colors/vt_termcolors.h
new file mode 100644
index 00000000..8a8c7b65
--- /dev/null
+++ b/freebsd/sys/dev/vt/colors/vt_termcolors.h
@@ -0,0 +1,63 @@
+/*-
+ * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
+ *
+ * Copyright (c) 2013 The FreeBSD Foundation
+ * All rights reserved.
+ *
+ * This software was developed by Aleksandr Rybalko under sponsorship from the
+ * FreeBSD Foundation.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must 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$
+ */
+
+enum vt_color_format {
+ COLOR_FORMAT_BW = 0,
+ COLOR_FORMAT_GRAY,
+ COLOR_FORMAT_VGA, /* Color Index. */
+ COLOR_FORMAT_RGB,
+ COLOR_FORMAT_ARGB,
+ COLOR_FORMAT_CMYK,
+ COLOR_FORMAT_HSL,
+ COLOR_FORMAT_YUV,
+ COLOR_FORMAT_YCbCr,
+ COLOR_FORMAT_YPbPr,
+
+ COLOR_FORMAT_MAX = 15,
+};
+
+#define NCOLORS 16
+
+/*
+ * Between console's palette and VGA's one:
+ * - blue and red are swapped (1 <-> 4)
+ * - yellow and cyan are swapped (3 <-> 6)
+ */
+static const int cons_to_vga_colors[NCOLORS] = {
+ 0, 4, 2, 6, 1, 5, 3, 7,
+ 8, 12, 10, 14, 9, 13, 11, 15
+};
+
+/* Helper to fill color map used by driver */
+int vt_generate_cons_palette(uint32_t *palette, int format, uint32_t rmax,
+ int roffset, uint32_t gmax, int goffset, uint32_t bmax, int boffset);
diff --git a/freebsd/sys/dev/vt/hw/fb/vt_fb.h b/freebsd/sys/dev/vt/hw/fb/vt_fb.h
new file mode 100644
index 00000000..42b395e8
--- /dev/null
+++ b/freebsd/sys/dev/vt/hw/fb/vt_fb.h
@@ -0,0 +1,54 @@
+/*-
+ * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
+ *
+ * Copyright (c) 2013 The FreeBSD Foundation
+ * All rights reserved.
+ *
+ * This software was developed by Aleksandr Rybalko under sponsorship from the
+ * FreeBSD Foundation.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ * notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must 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$
+ */
+
+#ifndef _DEV_VT_HW_FB_VT_FB_H_
+#define _DEV_VT_HW_FB_VT_FB_H_
+/* Generic framebuffer interface call vt_fb_attach to init VT(9) */
+int vt_fb_attach(struct fb_info *info);
+void vt_fb_resume(struct vt_device *vd);
+void vt_fb_suspend(struct vt_device *vd);
+int vt_fb_detach(struct fb_info *info);
+
+vd_init_t vt_fb_init;
+vd_fini_t vt_fb_fini;
+vd_blank_t vt_fb_blank;
+vd_bitblt_text_t vt_fb_bitblt_text;
+vd_invalidate_text_t vt_fb_invalidate_text;
+vd_bitblt_bmp_t vt_fb_bitblt_bitmap;
+vd_drawrect_t vt_fb_drawrect;
+vd_setpixel_t vt_fb_setpixel;
+vd_postswitch_t vt_fb_postswitch;
+vd_fb_ioctl_t vt_fb_ioctl;
+vd_fb_mmap_t vt_fb_mmap;
+
+#endif /* _DEV_VT_HW_FB_VT_FB_H_ */
--
2.20.1
_______________________________________________
devel mailing list
devel@rtems.org
http://lists.rtems.org/mailman/listinfo/devel
