static inline void lpc17_fpuconfig(void)
{
uint32_t regval;
/* Clear CONTROL.FPCA so that we do not get the extended context frame
* with the volatile FP registers stacked in the saved context.
*/
regval = getcontrol();
regval &= ~(1 << 2);
setcontrol(regval);
/* Ensure that FPCCR.LSPEN is disabled, so that we don't have to contend
* with the lazy FP context save behaviour. Clear FPCCR.ASPEN since we
* are going to keep CONTROL.FPCA off for all contexts.
*/
regval = getreg32(NVIC_FPCCR);
regval &= ~((1 << 31) | (1 << 30));
putreg32(regval, NVIC_FPCCR);
/* Enable full access to CP10 and CP11 */
regval = getreg32(NVIC_CPACR);
regval |= ((3 << (2*10)) | (3 << (2*11)));
putreg32(regval, NVIC_CPACR);
}
void up_systemswitch(uint32_t sys_addr)
{
typedef void (FAR *__start_t)(void);
__start_t __start;
__start = (__start_t) *(CODE uint32_t*) (sys_addr + 4);
setcontrol(getcontrol() & 0xfffffffc);
setmsp(*(CODE uint32_t*) sys_addr);
__start();
}
void Command_Setcontrol2_f(void)
{
INT32 na;
na = (INT32)COM_Argc();
if (na != 3 && na != 4)
{
CONS_Printf(M_GetText("setcontrol2 <controlname> <keyname> [<2nd keyname>]: set controls for player 2\n"));
return;
}
setcontrol(gamecontrolbis);
}
Mob::Mob(int32_t oi, int32_t mid, int8_t mode, int8_t st, uint16_t fh,
bool newspawn, int8_t tm, Point<int16_t> position) : MapObject(oi) {
std::string strid = string_format::extend_id(mid, 7);
nl::node src = nl::nx::mob[strid + ".img"];
nl::node info = src["info"];
level = info["level"];
watk = info["PADamage"];
matk = info["MADamage"];
wdef = info["PDDamage"];
mdef = info["MDDamage"];
accuracy = info["acc"];
avoid = info["eva"];
knockback = info["pushed"];
speed = info["speed"];
flyspeed = info["flySpeed"];
touchdamage = info["bodyAttack"].get_bool();
undead = info["undead"].get_bool();
noflip = info["noFlip"].get_bool();
notattack = info["notAttack"].get_bool();
canjump = src["jump"].size() > 0;
canfly = src["fly"].size() > 0;
canmove = src["move"].size() > 0 || canfly;
if (canfly)
{
animations[STAND] = src["fly"];
animations[MOVE] = src["fly"];
}
else
{
animations[STAND] = src["stand"];
animations[MOVE] = src["move"];
}
animations[JUMP] = src["jump"];
animations[HIT] = src["hit1"];
animations[DIE] = src["die1"];
name = nl::nx::string["Mob.img"][std::to_string(mid)]["name"];
nl::node sndsrc = nl::nx::sound["Mob.img"][strid];
hitsound = sndsrc["Damage"];
diesound = sndsrc["Die"];
speed += 100;
speed *= 0.001f;
flyspeed += 100;
flyspeed *= 0.0005f;
if (canfly)
phobj.type = PhysicsObject::FLYING;
id = mid;
team = tm;
setposition(position);
setcontrol(mode);
phobj.fhid = fh;
phobj.setflag(PhysicsObject::TURNATEDGES);
hppercent = 0;
dying = false;
dead = false;
fading = false;
awaitdeath = false;
setstance(st);
flydirection = STRAIGHT;
counter = 0;
namelabel = Text(Text::A13M, Text::CENTER, Text::WHITE);
namelabel.setback(Text::NAMETAG);
namelabel.settext(name);
if (newspawn)
{
fadein = true;
opacity.set(0.0f);
}
else
{
fadein = false;
opacity.set(1.0f);
}
if (control && stance == Stance::STAND)
{
nextmove();
}
}
void
controlproc(void *)
{
/* Proc that looks after /dev/usb/%d/ctl */
int i, nf;
char *req, *args[8];
Audiocontrol *c;
long value[8];
Channel *replchan;
while(req = recvp(controlchan)){
int rec;
nf = tokenize(req, args, nelem(args));
if(nf < 3)
sysfatal("controlproc: not enough arguments");
replchan = (Channel*)strtol(args[0], nil, 0);
if(strcmp(args[2], "playback") == 0)
rec = Play;
else if(strcmp(args[2], "record") == 0)
rec = Record;
else{
/* illegal request */
dprint(2, "%s must be record or playback", args[2]);
if(replchan) chanprint(replchan, "%s must be record or playback", args[2]);
free(req);
continue;
}
c = nil;
for(i = 0; i < Ncontrol; i++){
c = &controls[rec][i];
if(strcmp(args[1], c->name) == 0)
break;
}
if(i == Ncontrol){
dprint(2, "Illegal control name: %s", args[1]);
if(replchan) chanprint(replchan, "Illegal control name: %s", args[1]);
}else if(!c->settable){
dprint(2, "%s %s is not settable", args[1], args[2]);
if(replchan)
chanprint(replchan, "%s %s is not settable", args[1], args[2]);
}else if(nf < 4){
dprint(2, "insufficient arguments for %s %s", args[1], args[2]);
if(replchan)
chanprint(replchan, "insufficient arguments for %s %s",
args[1], args[2]);
}else if(ctlparse(args[3], c, value) < 0){
if(replchan)
chanprint(replchan, "parse error in %s %s", args[1], args[2]);
}else{
dprint(2, "controlproc: setcontrol %s %s %s\n",
rec?"in":"out", args[1], args[3]);
if(setcontrol(rec, args[1], value) < 0){
if(replchan)
chanprint(replchan, "setting %s %s failed", args[1], args[2]);
}else{
if(replchan) chanprint(replchan, "ok");
}
ctlevent();
}
free(req);
}
}
void
threadmain(int argc, char **argv)
{
char *devdir;
int i;
long value[8], volume[8];
Audiocontrol *c;
char *p;
extern int attachok;
Ep *ep;
int csps[] = { Audiocsp, 0};
devdir = nil;
volume[0] = Undef;
for(i = 0; i<8; i++)
value[i] = 0;
fmtinstall('A', Aconv);
fmtinstall('U', Ufmt);
quotefmtinstall();
ARGBEGIN{
case 'N':
p = EARGF(usage()); /* ignore dev nb */
break;
case 'd':
usbdebug++;
verbose++;
break;
case 'm':
mntpt = EARGF(usage());
break;
case 'p':
attachok++;
break;
case 's':
srvpost = EARGF(usage());
break;
case 'v':
volume[0] = strtol(EARGF(usage()), &p, 0);
for(i = 1; i < 8; i++)
volume[i] = volume[0];
break;
case 'V':
verbose++;
break;
default:
usage();
}ARGEND
switch(argc){
case 0:
break;
case 1:
devdir = argv[0];
break;
default:
usage();
}
if(devdir == nil)
if(finddevs(matchdevcsp, csps, &devdir, 1) < 1){
fprint(2, "No usb audio\n");
threadexitsall("usbaudio not found");
}
ad = opendev(devdir);
if(ad == nil)
sysfatal("opendev: %r");
if(configdev(ad) < 0)
sysfatal("configdev: %r");
for(i = 0; i < nelem(ad->usb->ddesc); i++)
if(ad->usb->ddesc[i] != nil)
switch(ad->usb->ddesc[i]->data.bDescriptorType){
case AUDIO_INTERFACE:
audio_interface(ad, ad->usb->ddesc[i]);
break;
case AUDIO_ENDPOINT:
audio_endpoint(ad, ad->usb->ddesc[i]);
break;
}
controlchan = chancreate(sizeof(char*), 8);
for(i = 0; i < nelem(ad->usb->ep); i++)
if((ep = ad->usb->ep[i]) != nil){
if(ep->iface->csp == CSP(Claudio, 2, 0) && ep->dir == Eout)
endpt[0] = ep->id;
if(ep->iface->csp == CSP(Claudio, 2, 0) && ep->dir == Ein)
endpt[1] = ep->id;
if(buttonendpt<0 && Class(ep->iface->csp) == Clhid)
buttonendpt = ep->id;
}
if(endpt[0] != -1){
if(verbose)
fprint(2, "usb/audio: playback on ep %d\n", endpt[0]);
interface[0] = ad->usb->ep[endpt[0]]->iface->id;
}
if(endpt[1] != -1){
if(verbose)
fprint(2, "usb/audio: record on ep %d\n", endpt[0]);
interface[1] = ad->usb->ep[endpt[1]]->iface->id;
}
if(verbose && buttonendpt >= 0)
fprint(2, "usb/audio: buttons on ep %d\n", buttonendpt);
if(endpt[Play] >= 0){
if(verbose)
fprint(2, "Setting default play parameters: %d Hz, %d channels at %d bits\n",
defaultspeed[Play], 2, 16);
if(findalt(Play, 2, 16, defaultspeed[Play]) < 0){
if(findalt(Play, 2, 16, 48000) < 0)
sysfatal("Can't configure playout for %d or %d Hz", defaultspeed[Play], 48000);
fprint(2, "Warning, can't configure playout for %d Hz, configuring for %d Hz instead\n",
defaultspeed[Play], 48000);
defaultspeed[Play] = 48000;
}
value[0] = 2;
if(setcontrol(Play, "channels", value) == Undef)
sysfatal("Can't set play channels");
value[0] = 16;
if(setcontrol(Play, "resolution", value) == Undef)
sysfatal("Can't set play resolution");
}
if(endpt[Record] >= 0){
setrec = 1;
if(verbose)
fprint(2, "Setting default record parameters: "
"%d Hz, %d channels at %d bits\n",
defaultspeed[Record], 2, 16);
i = 2;
while(findalt(Record, i, 16, defaultspeed[Record]) < 0)
if(i == 2 && controls[Record][Channel_control].max == 1){
fprint(2, "Warning, can't configure stereo "
"recording, configuring mono instead\n");
i = 1;
}else
break;
if(findalt(Record, i, 16, 48000) < 0){
endpt[Record] = -1; /* disable recording */
setrec = 0;
fprint(2, "Warning, can't configure record for %d Hz or %d Hz\n",
defaultspeed[Record], 48000);
}else
fprint(2, "Warning, can't configure record for %d Hz, "
"configuring for %d Hz instead\n",
defaultspeed[Record], 48000);
defaultspeed[Record] = 48000;
if(setrec){
value[0] = i;
if(setcontrol(Record, "channels", value) == Undef)
sysfatal("Can't set record channels");
value[0] = 16;
if(setcontrol(Record, "resolution", value) == Undef)
sysfatal("Can't set record resolution");
}
}
getcontrols(); /* Get the initial value of all controls */
value[0] = defaultspeed[Play];
if(endpt[Play] >= 0 && setcontrol(Play, "speed", value) < 0)
sysfatal("can't set play speed");
value[0] = defaultspeed[Record];
if(endpt[Record] >= 0 && setcontrol(Record, "speed", value) < 0)
fprint(2, "%s: can't set record speed\n", argv0);
value[0] = 0;
setcontrol(Play, "mute", value);
if(volume[0] != Undef){
c = &controls[Play][Volume_control];
if(*p == '%' && c->min != Undef)
for(i = 0; i < 8; i++)
volume[i] = (volume[i]*c->max + (100-volume[i])*c->min)/100;
if(c->settable)
setcontrol(Play, "volume", volume);
c = &controls[Record][Volume_control];
if(c->settable && setrec)
setcontrol(Record, "volume", volume);
}
if(buttonendpt > 0){
buttondev = openep(ad, buttonendpt);
if(buttondev == nil)
sysfatal("openep: buttons: %r");
if(opendevdata(buttondev, OREAD) < 0)
sysfatal("open buttons fd: %r");
proccreate(buttonproc, nil, STACKSIZE);
}
proccreate(controlproc, nil, STACKSIZE);
proccreate(serve, nil, STACKSIZE);
threadexits(nil);
}
