123456789101112131415161718192021222324252627282930313233 |
- /*************************************************************************
- * Copyright (c) 2011 AT&T Intellectual Property
- * All rights reserved. This program and the accompanying materials
- * are made available under the terms of the Eclipse Public License v1.0
- * which accompanies this distribution, and is available at
- * https://www.eclipse.org/legal/epl-v10.html
- *
- * Contributors: Details at https://graphviz.org
- *************************************************************************/
- /*
- * in_poly
- *
- * Test if a point is inside a polygon.
- * The polygon must be convex with vertices in CW order.
- */
- #include <pathplan/pathutil.h>
- #include <pathplan/vispath.h>
- #include <stdbool.h>
- #include <stddef.h>
- #include <stdlib.h>
- bool in_poly(const Ppoly_t poly, Ppoint_t q) {
- const Ppoint_t *P = poly.ps;
- const size_t n = poly.pn;
- for (size_t i = 0; i < n; i++) {
- const size_t i1 = (i + n - 1) % n; // point index; i1 = i-1 mod n
- if (wind(P[i1], P[i], q) == 1)
- return false;
- }
- return true;
- }
|