void z_plot(const char *fname, const Grid &a) {
FILE *out = fopen(fname, "w");
if (!out) {
fprintf(stderr, "Unable to create file %s!\n", fname);
// don't just abort?
return;
}
const GridDescription gd = a.description();
const int x = 0;
const int y = 0;
for (int z=0; z<gd.Nz/2; z++) {
Cartesian here = gd.fineLat.toCartesian(Relative(x,y,z));
double ahere = a(x,y,z);
fprintf(out, "%g\t%g\n", here[2], ahere);
}
fclose(out);
}
void TJerFile::CreateCompletePath(const char *BeginDir, const char *RelativePath)
{
BPath path(BeginDir);
BDirectory dir(BeginDir);
string Relative(RelativePath);
string PathToCreate(path.Path());
int indstart = 0;
if (Relative.length()!=0)
{
if (Relative[0]=='/')
{
indstart = 1;
}
PathToCreate = PathToCreate + "/";
for (uint32 ind=indstart;ind<Relative.length();ind++)
{
if (Relative[ind]=='/')
{
dir.CreateDirectory(PathToCreate.c_str(),&dir);
PathToCreate = PathToCreate + "/";
}
else
{
PathToCreate = PathToCreate + Relative[ind];
}
}
if (PathToCreate.length()>0)
{
dir.CreateDirectory(PathToCreate.c_str(),&dir);
}
} //If Length == 0
// int errcode = dir.CreateDirectory(DirComplete.c_str(),&dir);
/*
if (errcode!=B_OK)
{
string truc2(strerror(errcode));
printf("Code : %d Err : %s \n",errcode,truc2.c_str());
// GeneralException excep(truc2.c_str(),"BJerFile::CreateCompletePath");
// throw(excep);
}
*/
}
void plot_grids_y_direction(const char *fname, const Grid &a, const Grid &b, const Grid &c, const Grid &d) {
FILE *out = fopen(fname, "w");
if (!out) {
fprintf(stderr, "Unable to create file %s!\n", fname);
// don't just abort?
return;
}
const GridDescription gd = a.description();
const int x = gd.Nx/2;
const int z = 0;
for (int y=0; y<gd.Ny; y++) {
Cartesian here = gd.fineLat.toCartesian(Relative(x,y,z));
double ahere = a(x,y,z);
double bhere = b(x,y,z);
double chere = c(x,y,z);
double dhere = d(x,y,z);
fprintf(out, "%g\t%g\t%g\t%g\t%g\t%g\t%g\n", here[0], here[1], here[2], ahere, bhere, chere, dhere);
}
fclose(out);
}
void plot_grids_110(const char *fname, const Grid &a, const Grid &b, const Grid &c) {
FILE *out = fopen(fname, "w");
if (!out) {
fprintf(stderr, "Unable to create file %s!\n", fname);
// don't just abort?
return;
}
const GridDescription gd = a.description();
for (int y=-gd.Ny/2; y<=gd.Ny/2; y++) {
for (int z=-gd.Nz/2; z<=gd.Nz/2; z++) {
const int x = y;
Cartesian here = gd.fineLat.toCartesian(Relative(x,y,z));
double ahere = a(here);
double bhere = b(here);
double chere = c(here);
fprintf(out, "%g\t%g\t%g\t%g\t%g\t%g\n", here[0], here[1], here[2],
ahere, bhere, chere);
}
fprintf(out,"\n");
}
fclose(out);
}
void Apu2F()
{
// BRA
Relative();
IAPU.PC = IAPU.RAM + (uint16_t) Int16;
}
int
main(int argc, char **argv)
{
struct dataset *ds[7];
int nds;
double a;
const char *delim = " \t";
char *p;
int c, i, ci;
int column = 1;
int flag_s = 0;
int flag_n = 0;
int termwidth = 74;
int suppress_plot = 0;
if (isatty(STDOUT_FILENO)) {
struct winsize wsz;
if ((p = getenv("COLUMNS")) != NULL && *p != '\0')
termwidth = atoi(p);
else if (ioctl(STDOUT_FILENO, TIOCGWINSZ, &wsz) != -1 &&
wsz.ws_col > 0)
termwidth = wsz.ws_col - 2;
}
ci = -1;
while ((c = getopt(argc, argv, "AC:c:d:snw:")) != -1)
switch (c) {
case 'A':
suppress_plot = 1;
break;
case 'C':
column = strtol(optarg, &p, 10);
if (p != NULL && *p != '\0')
usage("Invalid column number.");
if (column <= 0)
usage("Column number should be positive.");
break;
case 'c':
a = strtod(optarg, &p);
if (p != NULL && *p != '\0')
usage("Not a floating point number");
for (i = 0; i < NCONF; i++)
if (a == studentpct[i])
ci = i;
if (ci == -1)
usage("No support for confidence level");
break;
case 'd':
if (*optarg == '\0')
usage("Can't use empty delimiter string");
delim = optarg;
break;
case 'n':
flag_n = 1;
break;
case 's':
flag_s = 1;
break;
case 'w':
termwidth = strtol(optarg, &p, 10);
if (p != NULL && *p != '\0')
usage("Invalid width, not a number.");
if (termwidth < 0)
usage("Unable to move beyond left margin.");
break;
default:
usage("Unknown option");
break;
}
if (ci == -1)
ci = 2;
argc -= optind;
argv += optind;
if (argc == 0) {
ds[0] = ReadSet("-", column, delim);
nds = 1;
} else {
if (argc > (MAX_DS - 1))
usage("Too many datasets.");
nds = argc;
for (i = 0; i < nds; i++)
ds[i] = ReadSet(argv[i], column, delim);
}
for (i = 0; i < nds; i++)
printf("%c %s\n", symbol[i+1], ds[i]->name);
if (!flag_n && !suppress_plot) {
SetupPlot(termwidth, flag_s, nds);
for (i = 0; i < nds; i++)
DimPlot(ds[i]);
for (i = 0; i < nds; i++)
PlotSet(ds[i], i + 1);
DumpPlot();
}
VitalsHead();
Vitals(ds[0], 1);
for (i = 1; i < nds; i++) {
Vitals(ds[i], i + 1);
if (!flag_n)
Relative(ds[i], ds[0], ci);
}
exit(0);
}
EvdevDevice::EvdevDevice(const std::string& filename)
: device(filename)
{
fd = open(device.c_str(), O_RDONLY | O_NONBLOCK);
if (fd == -1)
{
throw std::runtime_error(filename + ": " + std::string(strerror(errno)));
}
if (ioctl(fd, EVIOCGVERSION, &version))
{
throw std::runtime_error("Error: EvdevDevice: Couldn't get version for " + filename);
}
if (1)
{ // FIXME: Some versions of linux don't have these structs, use arrays there
struct input_id id;
ioctl(fd, EVIOCGID, &id);
printf("Input device ID: bus 0x%x vendor 0x%x product 0x%x version 0x%x\n",
id.bustype, id.vendor, id.product, id.vendor);
}
{ // Get the human readable name
char c_name[256] = "unknown";
ioctl(fd, EVIOCGNAME(sizeof(c_name)), c_name);
name = c_name;
std::cout << "Name: " << name << std::endl;
}
{ // Read in how many buttons the device has
unsigned long bit[EV_MAX][NBITS(KEY_MAX)];
memset(bit, 0, sizeof(bit));
ioctl(fd, EVIOCGBIT(0, EV_MAX), bit[0]);
for (int i = 0; i < EV_MAX; i++)
{
if (test_bit(i, bit[0]))
{
//printf(" Event type %d (%s)\n", i, events[i] ? events[i] : "?");
if (!i) continue;
ioctl(fd, EVIOCGBIT(i, KEY_MAX), bit[i]);
for (int j = 0; j < KEY_MAX; j++)
{
if (test_bit(j, bit[i]))
{
if (i == EV_KEY)
{
keys.push_back(Key(j));
}
else if (i == EV_ABS)
{
// FIXME: Some Linuxes don't have these struct
struct input_absinfo absinfo;
ioctl(fd, EVIOCGABS(j), &absinfo);
// FIXME: we are ignoring absinfo.fuzz and
// absinfo.flat = deadzone
// absinfo.fuzz = values in which range can be considered the same (jitter)
absolutes.push_back(Absolute(j, absinfo.minimum, absinfo.maximum, absinfo.value));
}
else if (i == EV_REL)
{
relatives.push_back(Relative(j));
}
}
}
}
}
}
}
void OrientConstRotation::Update(TimeValue t){
Interval iv = FOREVER;
ivalid = FOREVER;
int ct = pblock->Count(orientation_target_list);
int ctf = pblock->Count(orientation_target_weight);
float total_orient_target_weight_prev = 0.0f, total_orient_target_weight_current = 0.0f;
float orient_targ_Wt_current = 0.0f;
Quat quat_prev, quat_current, lCurRot;
INode *orient_target_prev= NULL, *orient_target_current= NULL;
Matrix3 targetTM(1);
Point3 trans, scaleP;
quat_prev.Identity();
quat_current.Identity();
lCurRot.Identity();
if (ct == 1){
pblock->GetValue(orientation_target_list, t, orient_target_prev, iv, 0);
pblock->GetValue(orientation_target_weight, t, orient_targ_Wt_current, iv, 0);
ivalid &= iv;
if (orient_target_prev == NULL){
targetTM.IdentityMatrix();
}
else {
targetTM = orient_target_prev->GetNodeTM(t, &ivalid);
}
if (IsLocal() && orient_target_prev != NULL) {
targetTM = targetTM * Inverse(orient_target_prev->GetParentTM(t));
}
AffineParts comps; // Requires header decomp.h
decomp_affine(targetTM, &comps);
quat_current = comps.q;
quat_current.Normalize();
quat_current.MakeClosest(quat_prev);
lCurRot = quat_current;
quat_prev = lCurRot;
total_orient_target_weight_prev += orient_targ_Wt_current;
// }
}
else if (ct > 1){
pblock->GetValue(orientation_target_list, t, orient_target_prev, iv, 0);
pblock->GetValue(orientation_target_weight, t, orient_targ_Wt_current, iv, 0);
// if (orient_target_prev != NULL)
// {
ivalid &= iv;
if (orient_target_prev == NULL){
targetTM.IdentityMatrix();
}
else {
targetTM = orient_target_prev->GetNodeTM(t, &ivalid);
}
if (IsLocal() && orient_target_prev != NULL) {
targetTM = targetTM * Inverse(orient_target_prev->GetParentTM(t));
}
AffineParts comps; // Requires header decomp.h
decomp_affine(targetTM, &comps);
quat_current = comps.q;
quat_current.Normalize();
quat_current.MakeClosest(quat_prev);
lCurRot = quat_current;
quat_prev = lCurRot;
total_orient_target_weight_prev += orient_targ_Wt_current;
// }
for (int i = 0; i < ct -1; i++) {
// ct = pblock->Count(orientation_target_list);
pblock->GetValue(orientation_target_list, t, orient_target_current, iv, i+1);
pblock->GetValue(orientation_target_weight, t, orient_targ_Wt_current, iv, i+1);
// if (orient_target_current != NULL){
ivalid &= iv;
if (orient_target_current == NULL){
targetTM.IdentityMatrix();
}
else {
targetTM = orient_target_current->GetNodeTM(t, &ivalid);
}
// Matrix3 targetTM = orient_target_current->GetNodeTM(t, &ivalid);
if (IsLocal() && orient_target_current != NULL) {
targetTM = targetTM * Inverse(orient_target_current->GetParentTM(t));
}
AffineParts comps; // Requires header decomp.h
decomp_affine(targetTM, &comps);
quat_current = comps.q;
quat_current.Normalize();
quat_current.MakeClosest(quat_prev);
float slerp_wt = 0.0f;
if ((total_orient_target_weight_prev + orient_targ_Wt_current) != 0.0){
slerp_wt = orient_targ_Wt_current / (total_orient_target_weight_prev + orient_targ_Wt_current);
}
lCurRot = Slerp(quat_prev, quat_current, slerp_wt);
lCurRot.Normalize();
quat_prev = lCurRot;
total_orient_target_weight_prev += orient_targ_Wt_current;
// }
} //for (int i = 0; i < ct -1; i++)
} //else if (ct > 1)
if (oldTargetNumber != ct) {
InitialOrientQuat = lCurRot;
}
curRot = lCurRot;
if (total_orient_target_weight_prev > 0.0){
if (Relative()){
if(IsLocal()){
curRot = baseRotQuatLocal * (lCurRot /InitialOrientQuat);
}
else{
curRot = baseRotQuatWorld * (lCurRot /InitialOrientQuat);
}
}
}
else {
curRot = baseRotQuatLocal;
}
curRot.MakeClosest(IdentQuat());
curRot.Normalize();
oldTargetNumber = ct;
// if (ivalid.Empty()) ivalid.SetInstant(t);
}
BOOL GetRelative() {return Relative();}
