bool Cylinder3D::intersects(const Line3D& line,Real* tmin,Real* tmax) const { Real axistmin,axistmax; //quick reject - infinite cylinder Vector3 src=line.source-center; const Vector3& dir=line.direction; assert(FuzzyEquals(axis.normSquared(),One)); //quadratic equation Real a,b,c; Real dv,sv; dv = dir.dot(axis); sv = src.dot(axis); a=dir.normSquared()-Sqr(dv); b=Two*(dir.dot(src)-sv*dv); c=src.normSquared()-Sqr(sv)-Sqr(radius); int nroots=quadratic(a,b,c,axistmin,axistmax); //TODO: if the line is contained within the cylinder, ignore this if(nroots == 0) return false; else if(nroots == 1) axistmax=axistmin; else if(nroots == 2) { if(axistmin > axistmax) std::swap(axistmin,axistmax); } else if(nroots == -1) return false; else return false; //what case is this? //projection of intersection pts on the cyl axis Real axisumin,axisumax; Vector3 temp; line.eval(axistmin,temp); axisumin = axis.dot(temp-center); line.eval(axistmax,temp); axisumax = axis.dot(temp-center); //now check the caps Real tc; Circle3D cir; if(axisumin < 0) { //hits a cap first if(dv > 0) //line points along axis getBase(cir); else //line points against axis getCap(cir); if(!cir.intersects(line,&tc)) return false; axistmin = tc; } if(axisumin > height) { //hits a cap last if(dv > 0) //line points along axis getCap(cir); else //line points against axis getBase(cir); if(!cir.intersects(line,&tc)) return false; axistmax = tc; } //if(axistmin > axistmax) return false; if(tmin) *tmin=axistmin; if(tmax) *tmax=axistmax; return true; }
bool Circle3D::intersects(const Line3D& l,Real* _t) const { Plane3D p; getPlane(p); Real t; if(p.intersectsLine(l,&t)) { if(t == Inf) { //line lies in plane t = l.closestPointParameter(center); } if(_t) (*_t)=t; Point3D pt; l.eval(t,pt); return DistanceLEQ(pt,center,radius); } return false; }
bool TransformWidget::Hover(int x,int y,Camera::Viewport& viewport,double& distance) { Real globalScale = 1.0; if(scaleToScreen) { float sx,sy,sz; viewport.project(T.t,sx,sy,sz); globalScale = sz/viewport.scale; } distance = Inf; int oldHoverItem = hoverItem; hoverItem = -1; Ray3D r; viewport.getClickSource(x,y,r.source); viewport.getClickVector(x,y,r.direction); //check origin if(enableTranslation && enableOriginTranslation) { Sphere3D s; s.center = T.t; s.radius = originRadius*globalScale; Real tmin,tmax; if(s.intersects(r,&tmin,&tmax)) { distance = tmin; hoverItem = 0; } } //check translation axes for(int i=0;i<3;i++) { if(!enableTranslation) break; if(!enableTranslationAxes[i]) continue; Line3D axisLine; axisLine.source = T.t; axisLine.direction = Vector3(T.R.col(i)); Real t,u; axisLine.closestPoint(r,t,u); t = Clamp(t,0.0,axisLength*globalScale); u = Clamp(u,0.0,Inf); Vector3 paxis,pray; axisLine.eval(t,paxis); r.eval(u,pray); if(paxis.distanceSquared(pray) <= Sqr(axisRadius*globalScale)) { if(u < distance) { distance = u; hoverItem = 1+i; } } } if(enableRotation) { //check rotation rings Circle3D c; c.center = T.t; for(int i=0;i<3;i++) { if(!enableRotationAxes[i]) continue; c.axis = Vector3(T.R.col(i)); c.radius = ringOuterRadius*globalScale; Real t; if(c.intersects(r,&t) && t >= 0) { c.radius = ringInnerRadius*globalScale; if(!c.intersects(r,NULL)) { if(t < distance) { distance = t; hoverItem = i+4; } } } } } if(enableRotation && enableOuterRingRotation) { //check outer ring Circle3D c; c.center = T.t; viewport.getViewVector(c.axis); c.radius = (ringOuterRadius+arrowHeight)*globalScale; Real t; if(c.intersects(r,&t) && t >= 0) { c.radius = (ringInnerRadius+arrowHeight)*globalScale; if(!c.intersects(r,NULL)) { if(t < distance) { distance = t; hoverItem = 7; } } } clickAxis = c.axis; } if(hoverItem != oldHoverItem) Refresh(); r.eval(distance,hoverPos); return hoverItem != -1; }