ref: a9376bfb28fbd354131420aafa67fedd1e9a3ca0
dir: /app/path/drw.c/
#include <u.h>
#include <libc.h>
#include <draw.h>
#include "asif.h"
#include "graph.h"
#include "path.h"
#include "dat.h"
#include "fns.h"
Node *selected;
int showgrid;
int nodesz = 1;
Point pan;
typedef Vertex Point;
typedef Vectangle Rectangle;
enum{
Cbg,
Cgrid,
Cfree,
Cblocked,
Copen,
Cclosed,
Cpath,
Cstart,
Cgoal,
Cref,
Cend,
};
static Image *col[Cend];
static Point viewΔ, panmax;
static Rectangle viewr, hudr;
static Image *view, *board;
static Image *
eallocimage(Rectangle r, int repl, ulong col)
{
Image *i;
if((i = allocimage(display, r, screen->chan, repl, col)) == nil)
sysfatal("allocimage: %r");
return i;
}
int
dopan(Point p)
{
p.x = pan.x - p.x;
p.y = pan.y - p.y;
if(p.x < -panmax.x/2)
p.x = -panmax.x/2;
else if(p.x > panmax.x/2)
p.x = panmax.x/2;
if(p.y < 0)
p.y = 0;
else if(p.y > panmax.y)
p.y = panmax.y;
if(!eqpt(p, pan)){
pan = p;
return 0;
}
return -1;
}
void
errmsg(char *fmt, ...)
{
char s[256];
va_list arg;
Point p;
va_start(arg, fmt);
vseprint(s, s+sizeof s, fmt, arg);
va_end(arg);
p = addpt(screen->r.min, subpt(Pt(2, viewr.max.y+2), viewΔ));
p.y += font->height * 2;
string(screen, p, col[Cgoal], ZP, font, s);
}
Node *
scrselect(Point p)
{
p = addpt(subpt(addpt(subpt(p, screen->r.min), viewΔ), Pt(1,1)), pan);
if(!ptinrect(p, viewr)){
selected = nil;
return nil;
}
p = divpt(p, nodesz);
p.x = MIN(p.x, gridwidth-1);
p.y = MIN(p.y, gridheight-1);
selected = grid + p.y * gridwidth + p.x;
return selected;
}
static void
flushdrw(void)
{
draw(screen, screen->r, view, nil, addpt(viewΔ, pan));
flushimage(display, 1);
}
static void
drawhud(void)
{
char s[128], *sp;
Node *n;
Point p;
Sim *sim;
draw(screen, hudr, col[Cbg], nil, ZP);
sp = seprint(s, s+sizeof s, "grid size: %dx%d (x%d)", gridwidth, gridheight, nodesz);
if((n = selected) != nil){
assert(n >= grid && n < grid + gridwidth * gridheight);
sp = seprint(sp, s+sizeof s, " selected: %P ",
Pt((n-grid) % gridwidth, (n-grid) / gridwidth));
if(isblocked(n))
sp = strecpy(sp, s+sizeof s, "B");
else if(n == start)
sp = strecpy(sp, s+sizeof s, "s");
else if(n == goal)
sp = strecpy(sp, s+sizeof s, "g");
else if(n->to != nil)
sp = strecpy(sp, s+sizeof s, "p");
else if(n->closed)
sp = strecpy(sp, s+sizeof s, "C");
else if(n->open)
sp = strecpy(sp, s+sizeof s, "O");
}
sp = seprint(sp, s+sizeof s, "; RMB sets %s",
mousemode == Mmodegoal ? "goal" :
mousemode == Mmodestart ? "start" :
"block");
USED(sp);
p = addpt(screen->r.min, subpt(Pt(2, viewr.max.y+2), viewΔ));
string(screen, p, col[Cfree], ZP, font, s);
if(start != nil && goal != nil){
seprint(s, s+sizeof s,
"path len=%d Δ=%.2f $=%.2f opened=%d expanded=%d updated=%d closed=%d",
stats.steps, stats.dist, stats.cost, stats.opened, stats.expanded,
stats.updated, stats.closed);
p.y += font->height;
string(screen, p, col[Cfree], ZP, font, s);
}
if(sims != nil && curscen < sims->n){
sim = (Sim *)sims->p + curscen;
seprint(s, s+sizeof s,
"ref len=%d Δ=%.2f $=%.2f opened=%d expanded=%d updated=%d closed=%d",
sim->steps, sim->dist, sim->cost, sim->opened, sim->expanded,
sim->updated, sim->closed);
p.y += font->height;
string(screen, p, col[Cfree], ZP, font, s);
}
}
/* FIXME: multiple, spurious calls when repathing */
static void
drawscenpath(void)
{
int sz;
Sim *sp;
Vertex *vp, *ve;
Node *n;
Rectangle r;
if(sims == nil || curscen >= sims->n || goal == nil || start == nil)
return;
sp = (Sim *)sims->p + curscen;
if(sp->path == nil || sp->path->n == 0)
return;
sz = MAX(nodesz - showgrid, 1);
for(vp=sp->path->p, ve=vp+sp->path->n; vp<ve; vp++){
n = grid + vp->y * gridwidth + vp->x;
if(n == goal)
return;
r.min = n2s(n);
r.max = addpt(r.min, Pt(sz, sz));
draw(board, r, col[Cref], nil, ZP);
}
dprint(Lognone, "path::drawscenpath: malformed or wrong path\n");
}
static void
drawnodes(void)
{
int sz;
Node *n;
Rectangle r;
Image *c;
draw(board, board->r, col[Cfree], nil, ZP);
sz = MAX(nodesz - showgrid, 1);
for(n=grid; n<grid+gridwidth*gridheight; n++){
if(isblocked(n))
c = col[Cblocked];
else if(n == start)
c = col[Cstart];
else if(n == goal)
c = col[Cgoal];
else if(n->to != nil)
c = col[Cpath];
else if(n->closed)
c = col[Cclosed];
else if(n->open)
c = col[Copen];
else
continue;
r.min = n2s(n);
r.max = addpt(r.min, Pt(sz, sz));
draw(board, r, c, nil, ZP);
}
}
static void
drawfrom(void)
{
Node *n;
Point p0, p1;
for(n=grid; n<grid+gridwidth*gridheight; n++){
if(!n->open)
continue;
p1 = addpt(n2s(n), Pt(nodesz / 2, nodesz / 2));
p0 = addpt(n2s(n->from), Pt(nodesz / 2, nodesz / 2));
line(view, p0, p1, 0, 0, 0, col[Cgrid], ZP);
}
}
static void
drawgrid(void)
{
Rectangle r;
r = viewr;
while(r.min.x < viewr.max.x){
r.max.x = r.min.x;
line(view, r.min, r.max, 0, 0, 0, col[Cgrid], ZP);
r.min.x += nodesz;
}
r = viewr;
while(r.min.y < viewr.max.y){
r.max.y = r.min.y;
line(view, r.min, r.max, 0, 0, 0, col[Cgrid], ZP);
r.min.y += nodesz;
}
}
static void
redraw(int clear, int turboclear)
{
if(clear)
draw(screen, screen->r, col[Cbg], nil, ZP);
if(turboclear){
drawnodes();
drawscenpath();
}
draw(view, view->r, board, nil, ZP);
if(showgrid && nodesz > 1)
drawgrid();
if(nodesz > 8)
drawfrom();
}
void
updatedrw(int clear, int turboclear)
{
lockdisplay(display);
redraw(clear, turboclear);
unlockdisplay(display);
drawhud();
flushdrw();
}
void
resetdrw(void)
{
viewr = Rpt(ZP, Pt(gridwidth*nodesz+1, gridheight*nodesz+1));
viewΔ = divpt(addpt(subpt(ZP, subpt(screen->r.max, screen->r.min)), viewr.max), 2);
if(-viewΔ.y < font->height * 2)
viewΔ.y = 0;
panmax.x = MAX(nodesz * gridwidth - Dx(screen->r), 0);
panmax.y = MAX(nodesz * gridheight - Dy(screen->r), 0);
dopan(ZP);
hudr.min = addpt(screen->r.min, subpt(Pt(2, viewr.max.y+2), viewΔ));
hudr.max = addpt(hudr.min, Pt(screen->r.max.x, font->height*3));
freeimage(view);
view = eallocimage(viewr, 0, DNofill);
freeimage(board);
board = eallocimage(viewr, 0, DNofill);
updatedrw(1, 1);
}
void
initdrw(void)
{
int z, zx, zy;
if(initdraw(nil, nil, "path") < 0)
sysfatal("initdraw: %r");
display->locking = 1;
unlockdisplay(display);
col[Cbg] = display->black;
col[Cgrid] = eallocimage(Rect(0,0,1,1), 1, 0x222222ff);
col[Cblocked] = display->black;
col[Cfree] = eallocimage(Rect(0,0,1,1), 1, 0x777777ff);
col[Copen] = eallocimage(Rect(0,0,1,1), 1, 0x00ccccff);
col[Cclosed] = eallocimage(Rect(0,0,1,1), 1, 0x0000ccff);
col[Cpath] = eallocimage(Rect(0,0,1,1), 1, 0xcccc00ff);
col[Cstart] = eallocimage(Rect(0,0,1,1), 1, 0x00cc00ff);
col[Cgoal] = eallocimage(Rect(0,0,1,1), 1, 0xcc0000ff);
col[Cref] = eallocimage(Rect(0,0,1,1), 1, 0xcc00cc77);
zx = Dx(screen->r) / gridwidth;
zy = (Dy(screen->r) - font->height*2) / gridheight;
z = MIN(zx, zy);
//nodesz = z <= 1 ? 1 : z > 2 ? z & ~1 : z;
nodesz = z <= 1 ? 1 : z;
resetdrw();
}