u-boot/drivers/demo/demo-shape.c

128 lines
2.6 KiB
C
Raw Normal View History

/*
* Copyright (c) 2013 Google, Inc
*
* SPDX-License-Identifier: GPL-2.0+
*/
#include <common.h>
#include <dm.h>
#include <errno.h>
#include <fdtdec.h>
#include <malloc.h>
#include <dm-demo.h>
#include <asm/io.h>
DECLARE_GLOBAL_DATA_PTR;
/* Shape size */
#define WIDTH 8
#define HEIGHT 6
struct shape_data {
int num_chars; /* Number of non-space characters output so far */
};
/* Crazy little function to draw shapes on the console */
static int shape_hello(struct udevice *dev, int ch)
{
const struct dm_demo_pdata *pdata = dev_get_platdata(dev);
struct shape_data *data = dev_get_priv(dev);
static const struct shape {
int start;
int end;
int dstart;
int dend;
} shapes[3] = {
{ 0, 1, 0, 1 },
{ 0, WIDTH, 0, 0 },
{ HEIGHT / 2 - 1, WIDTH - HEIGHT / 2 + 1, -1, 1},
};
struct shape shape;
unsigned int index;
int line, pos, inside;
const char *colour = pdata->colour;
int first = 0;
if (!ch)
ch = pdata->default_char;
if (!ch)
ch = '@';
index = (pdata->sides / 2) - 1;
if (index >= ARRAY_SIZE(shapes))
return -EIO;
shape = shapes[index];
for (line = 0; line < HEIGHT; line++) {
first = 1;
for (pos = 0; pos < WIDTH; pos++) {
inside = pos >= shape.start && pos < shape.end;
if (inside) {
putc(first ? *colour++ : ch);
data->num_chars++;
first = 0;
if (!*colour)
colour = pdata->colour;
} else {
putc(' ');
}
}
putc('\n');
shape.start += shape.dstart;
shape.end += shape.dend;
if (shape.start < 0) {
shape.dstart = -shape.dstart;
shape.dend = -shape.dend;
shape.start += shape.dstart;
shape.end += shape.dend;
}
}
return 0;
}
static int shape_status(struct udevice *dev, int *status)
{
struct shape_data *data = dev_get_priv(dev);
*status = data->num_chars;
return 0;
}
static const struct demo_ops shape_ops = {
.hello = shape_hello,
.status = shape_status,
};
static int shape_ofdata_to_platdata(struct udevice *dev)
{
struct dm_demo_pdata *pdata = dev_get_platdata(dev);
int ret;
/* Parse the data that is common with all demo devices */
ret = demo_parse_dt(dev);
if (ret)
return ret;
/* Parse the data that only we need */
pdata->default_char = fdtdec_get_int(gd->fdt_blob, dev->of_offset,
"character", '@');
return 0;
}
static const struct udevice_id demo_shape_id[] = {
{ "demo-shape", 0 },
{ },
};
U_BOOT_DRIVER(demo_shape_drv) = {
.name = "demo_shape_drv",
.of_match = demo_shape_id,
.id = UCLASS_DEMO,
.ofdata_to_platdata = shape_ofdata_to_platdata,
.ops = &shape_ops,
.priv_auto_alloc_size = sizeof(struct shape_data),
.platdata_auto_alloc_size = sizeof(struct dm_demo_pdata),
};