Finished SteerAvoidObstacle. This also will use the calculated intersect time with another subject to know whether avoidance is needed or not, otherwise it will be treated as a static object.