#include #include #include void printm(Matrix m) { int i, j; for(i = 0; i < 3; i++){ for(j = 0; j < 3; j++) print("\t%g", m[i][j]); print("\n"); } } Point2 rfxform(Point2 p, RFrame rf) { Matrix m = { rf.bx.x, rf.by.x, 0, rf.bx.y, rf.by.y, 0, 0, 0, 1 }; invm(m); // printm(m); return xform(subpt2(p, rf.p), m); } Point2 invrfxform(Point2 p, RFrame rf) { Matrix m = { rf.bx.x, rf.by.x, 0, rf.bx.y, rf.by.y, 0, 0, 0, 1 }; // printm(m); return addpt2(xform(p, m), rf.p); } void usage(void) { fprint(2, "usage: %s srcp srcbx srcby dstp dstbx dstby p\n", argv0); exits("usage"); } void main(int argc, char *argv[]) { char *s; RFrame src, dst; Point2 p; GEOMfmtinstall(); ARGBEGIN{ default: usage(); }ARGEND; if(argc != 7) usage(); s = argv[0]; src.p.x = strtod(s, &s); src.p.y = strtod(s, &s); src.p.w = strtod(s, &s); s = argv[1]; src.bx.x = strtod(s, &s); src.bx.y = strtod(s, &s); src.bx.w = 0; s = argv[2]; src.by.x = strtod(s, &s); src.by.y = strtod(s, &s); src.by.w = 0; s = argv[3]; dst.p.x = strtod(s, &s); dst.p.y = strtod(s, &s); dst.p.w = strtod(s, &s); s = argv[4]; dst.bx.x = strtod(s, &s); dst.bx.y = strtod(s, &s); dst.bx.w = 0; s = argv[5]; dst.by.x = strtod(s, &s); dst.by.y = strtod(s, &s); dst.by.w = 0; s = argv[6]; p.x = strtod(s, &s); p.y = strtod(s, &s); p.w = strtod(s, &s); print("src\n\tp %v\n\tbx %v\n\tby %v\n", src.p, src.bx, src.by); print("dst\n\tp %v\n\tbx %v\n\tby %v\n", dst.p, dst.bx, dst.by); print("p %v\n", p); print("p' %v\n", rframexform(invrframexform(p, src), dst)); // print("S→D %v\n", rfxform(invrfxform(p, src), dst)); // print("D→S %v\n", rfxform(invrfxform(p, dst), src)); // print("S→ %v\n", invrfxform(p, src)); // print("→S %v\n", rfxform(p, src)); // print("D→ %v\n", invrfxform(p, dst)); // print("→D %v\n", rfxform(p, dst)); exits(nil); }