123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312 |
- #include "stdinc.h"
- #include "dat.h"
- #include "fns.h"
- int
- nameEq(char *s, char *t)
- {
- return strncmp(s, t, ANameSize) == 0;
- }
- void
- nameCp(char *dst, char *src)
- {
- strncpy(dst, src, ANameSize - 1);
- dst[ANameSize - 1] = '\0';
- }
- int
- nameOk(char *name)
- {
- char *t;
- int c;
- if(name == nil)
- return 0;
- for(t = name; c = *t; t++)
- if(t - name >= ANameSize
- || c < ' ' || c >= 0x7f)
- return 0;
- return 1;
- }
- int
- strU32Int(char *s, u32int *r)
- {
- char *t;
- u32int n, nn, m;
- int c;
- m = TWID32 / 10;
- n = 0;
- for(t = s; ; t++){
- c = *t;
- if(c < '0' || c > '9')
- break;
- if(n > m)
- return 0;
- nn = n * 10 + c - '0';
- if(nn < n)
- return 0;
- n = nn;
- }
- *r = n;
- return s != t && *t == '\0';
- }
- int
- strU64Int(char *s, u64int *r)
- {
- char *t;
- u64int n, nn, m;
- int c;
- m = TWID64 / 10;
- n = 0;
- for(t = s; ; t++){
- c = *t;
- if(c < '0' || c > '9')
- break;
- if(n > m)
- return 0;
- nn = n * 10 + c - '0';
- if(nn < n)
- return 0;
- n = nn;
- }
- *r = n;
- return s != t && *t == '\0';
- }
- int
- vtTypeValid(int type)
- {
- return type > VtErrType && type < VtMaxType;
- }
- void
- fmtZBInit(Fmt *f, ZBlock *b)
- {
- f->runes = 0;
- f->start = b->data;
- f->to = f->start;
- f->stop = (char*)f->start + b->len;
- f->flush = nil;
- f->farg = nil;
- f->nfmt = 0;
- f->args = nil;
- }
- static char*
- logit(int severity, char *fmt, va_list args)
- {
- char *s;
- s = vsmprint(fmt, args);
- if(s == nil)
- return nil;
- if(severity != EOk){
- if(argv0 == nil)
- fprint(2, "%s: err %d: %s\n", argv0, severity, s);
- else
- fprint(2, "err %d: %s\n", severity, s);
- }
- return s;
- }
- void
- setErr(int severity, char *fmt, ...)
- {
- char *s;
- va_list args;
- va_start(args, fmt);
- s = logit(severity, fmt, args);
- va_end(args);
- if(s == nil)
- vtSetError("error setting error");
- else{
- vtSetError(s);
- free(s);
- }
- }
- void
- logErr(int severity, char *fmt, ...)
- {
- char *s;
- va_list args;
- va_start(args, fmt);
- s = logit(severity, fmt, args);
- va_end(args);
- free(s);
- }
- u32int
- now(void)
- {
- return time(nil);
- }
- void
- fatal(char *fmt, ...)
- {
- Fmt f;
- va_list arg;
- char buf[256];
- fmtfdinit(&f, 2, buf, sizeof buf);
- fmtprint(&f, "fatal %s error: ", argv0);
- va_start(arg, fmt);
- fmtvprint(&f, fmt, arg);
- va_end(arg);
- fmtprint(&f, "\n");
- fmtfdflush(&f);
- if(0)
- abort();
- exits(buf);
- }
- ZBlock *
- allocZBlock(u32int size, int zeroed)
- {
- ZBlock *b;
- static ZBlock z;
- b = malloc(sizeof(ZBlock) + size);
- if(b == nil){
- setErr(EOk, "out of memory");
- return nil;
- }
- *b = z;
- b->data = (u8int*)&b[1];
- b->len = size;
- if(zeroed)
- memset(b->data, 0, size);
- return b;
- }
- void
- freeZBlock(ZBlock *b)
- {
- free(b);
- }
- ZBlock*
- packet2ZBlock(Packet *p, u32int size)
- {
- ZBlock *b;
- if(p == nil)
- return nil;
- b = allocZBlock(size, 0);
- if(b == nil)
- return nil;
- b->len = size;
- if(!packetCopy(p, b->data, 0, size)){
- freeZBlock(b);
- return nil;
- }
- return b;
- }
- Packet*
- zblock2Packet(ZBlock *zb, u32int size)
- {
- Packet *p;
- if(zb == nil)
- return nil;
- p = packetAlloc();
- packetAppend(p, zb->data, size);
- return p;
- }
- void *
- emalloc(ulong n)
- {
- void *p;
- p = malloc(n);
- if(p == nil)
- fatal("out of memory");
- memset(p, 0xa5, n);
- return p;
- }
- void *
- ezmalloc(ulong n)
- {
- void *p;
- p = malloc(n);
- if(p == nil)
- fatal("out of memory");
- memset(p, 0, n);
- return p;
- }
- void *
- erealloc(void *p, ulong n)
- {
- p = realloc(p, n);
- if(p == nil)
- fatal("out of memory");
- return p;
- }
- char *
- estrdup(char *s)
- {
- char *t;
- int n;
- n = strlen(s) + 1;
- t = emalloc(n);
- memmove(t, s, n);
- return t;
- }
- /*
- ZBlock*
- readFile(char *name)
- {
- Part *p;
- ZBlock *b;
- p = initPart(name, 1);
- if(p == nil)
- return nil;
- b = allocZBlock(p->size, 0);
- if(b == nil){
- setErr(EOk, "can't alloc %s: %R", name);
- freePart(p);
- return nil;
- }
- if(!readPart(p, 0, b->data, p->size)){
- setErr(EOk, "can't read %s: %R", name);
- freePart(p);
- freeZBlock(b);
- return nil;
- }
- freePart(p);
- return b;
- }
- */
- /*
- * return floor(log2(v))
- */
- int
- u64log2(u64int v)
- {
- int i;
- for(i = 0; i < 64; i++)
- if((v >> i) <= 1)
- break;
- return i;
- }
|