1*c9945492SAndroid Build Coastguard Worker #include <wchar.h>
2*c9945492SAndroid Build Coastguard Worker
3*c9945492SAndroid Build Coastguard Worker #define MAX(a,b) ((a)>(b)?(a):(b))
4*c9945492SAndroid Build Coastguard Worker #define MIN(a,b) ((a)<(b)?(a):(b))
5*c9945492SAndroid Build Coastguard Worker
twoway_wcsstr(const wchar_t * h,const wchar_t * n)6*c9945492SAndroid Build Coastguard Worker static wchar_t *twoway_wcsstr(const wchar_t *h, const wchar_t *n)
7*c9945492SAndroid Build Coastguard Worker {
8*c9945492SAndroid Build Coastguard Worker const wchar_t *z;
9*c9945492SAndroid Build Coastguard Worker size_t l, ip, jp, k, p, ms, p0, mem, mem0;
10*c9945492SAndroid Build Coastguard Worker
11*c9945492SAndroid Build Coastguard Worker /* Computing length of needle */
12*c9945492SAndroid Build Coastguard Worker for (l=0; n[l] && h[l]; l++);
13*c9945492SAndroid Build Coastguard Worker if (n[l]) return 0; /* hit the end of h */
14*c9945492SAndroid Build Coastguard Worker
15*c9945492SAndroid Build Coastguard Worker /* Compute maximal suffix */
16*c9945492SAndroid Build Coastguard Worker ip = -1; jp = 0; k = p = 1;
17*c9945492SAndroid Build Coastguard Worker while (jp+k<l) {
18*c9945492SAndroid Build Coastguard Worker if (n[ip+k] == n[jp+k]) {
19*c9945492SAndroid Build Coastguard Worker if (k == p) {
20*c9945492SAndroid Build Coastguard Worker jp += p;
21*c9945492SAndroid Build Coastguard Worker k = 1;
22*c9945492SAndroid Build Coastguard Worker } else k++;
23*c9945492SAndroid Build Coastguard Worker } else if (n[ip+k] > n[jp+k]) {
24*c9945492SAndroid Build Coastguard Worker jp += k;
25*c9945492SAndroid Build Coastguard Worker k = 1;
26*c9945492SAndroid Build Coastguard Worker p = jp - ip;
27*c9945492SAndroid Build Coastguard Worker } else {
28*c9945492SAndroid Build Coastguard Worker ip = jp++;
29*c9945492SAndroid Build Coastguard Worker k = p = 1;
30*c9945492SAndroid Build Coastguard Worker }
31*c9945492SAndroid Build Coastguard Worker }
32*c9945492SAndroid Build Coastguard Worker ms = ip;
33*c9945492SAndroid Build Coastguard Worker p0 = p;
34*c9945492SAndroid Build Coastguard Worker
35*c9945492SAndroid Build Coastguard Worker /* And with the opposite comparison */
36*c9945492SAndroid Build Coastguard Worker ip = -1; jp = 0; k = p = 1;
37*c9945492SAndroid Build Coastguard Worker while (jp+k<l) {
38*c9945492SAndroid Build Coastguard Worker if (n[ip+k] == n[jp+k]) {
39*c9945492SAndroid Build Coastguard Worker if (k == p) {
40*c9945492SAndroid Build Coastguard Worker jp += p;
41*c9945492SAndroid Build Coastguard Worker k = 1;
42*c9945492SAndroid Build Coastguard Worker } else k++;
43*c9945492SAndroid Build Coastguard Worker } else if (n[ip+k] < n[jp+k]) {
44*c9945492SAndroid Build Coastguard Worker jp += k;
45*c9945492SAndroid Build Coastguard Worker k = 1;
46*c9945492SAndroid Build Coastguard Worker p = jp - ip;
47*c9945492SAndroid Build Coastguard Worker } else {
48*c9945492SAndroid Build Coastguard Worker ip = jp++;
49*c9945492SAndroid Build Coastguard Worker k = p = 1;
50*c9945492SAndroid Build Coastguard Worker }
51*c9945492SAndroid Build Coastguard Worker }
52*c9945492SAndroid Build Coastguard Worker if (ip+1 > ms+1) ms = ip;
53*c9945492SAndroid Build Coastguard Worker else p = p0;
54*c9945492SAndroid Build Coastguard Worker
55*c9945492SAndroid Build Coastguard Worker /* Periodic needle? */
56*c9945492SAndroid Build Coastguard Worker if (wmemcmp(n, n+p, ms+1)) {
57*c9945492SAndroid Build Coastguard Worker mem0 = 0;
58*c9945492SAndroid Build Coastguard Worker p = MAX(ms, l-ms-1) + 1;
59*c9945492SAndroid Build Coastguard Worker } else mem0 = l-p;
60*c9945492SAndroid Build Coastguard Worker mem = 0;
61*c9945492SAndroid Build Coastguard Worker
62*c9945492SAndroid Build Coastguard Worker /* Initialize incremental end-of-haystack pointer */
63*c9945492SAndroid Build Coastguard Worker z = h;
64*c9945492SAndroid Build Coastguard Worker
65*c9945492SAndroid Build Coastguard Worker /* Search loop */
66*c9945492SAndroid Build Coastguard Worker for (;;) {
67*c9945492SAndroid Build Coastguard Worker /* Update incremental end-of-haystack pointer */
68*c9945492SAndroid Build Coastguard Worker if (z-h < l) {
69*c9945492SAndroid Build Coastguard Worker /* Fast estimate for MIN(l,63) */
70*c9945492SAndroid Build Coastguard Worker size_t grow = l | 63;
71*c9945492SAndroid Build Coastguard Worker const wchar_t *z2 = wmemchr(z, 0, grow);
72*c9945492SAndroid Build Coastguard Worker if (z2) {
73*c9945492SAndroid Build Coastguard Worker z = z2;
74*c9945492SAndroid Build Coastguard Worker if (z-h < l) return 0;
75*c9945492SAndroid Build Coastguard Worker } else z += grow;
76*c9945492SAndroid Build Coastguard Worker }
77*c9945492SAndroid Build Coastguard Worker
78*c9945492SAndroid Build Coastguard Worker /* Compare right half */
79*c9945492SAndroid Build Coastguard Worker for (k=MAX(ms+1,mem); n[k] && n[k] == h[k]; k++);
80*c9945492SAndroid Build Coastguard Worker if (n[k]) {
81*c9945492SAndroid Build Coastguard Worker h += k-ms;
82*c9945492SAndroid Build Coastguard Worker mem = 0;
83*c9945492SAndroid Build Coastguard Worker continue;
84*c9945492SAndroid Build Coastguard Worker }
85*c9945492SAndroid Build Coastguard Worker /* Compare left half */
86*c9945492SAndroid Build Coastguard Worker for (k=ms+1; k>mem && n[k-1] == h[k-1]; k--);
87*c9945492SAndroid Build Coastguard Worker if (k <= mem) return (wchar_t *)h;
88*c9945492SAndroid Build Coastguard Worker h += p;
89*c9945492SAndroid Build Coastguard Worker mem = mem0;
90*c9945492SAndroid Build Coastguard Worker }
91*c9945492SAndroid Build Coastguard Worker }
92*c9945492SAndroid Build Coastguard Worker
wcsstr(const wchar_t * restrict h,const wchar_t * restrict n)93*c9945492SAndroid Build Coastguard Worker wchar_t *wcsstr(const wchar_t *restrict h, const wchar_t *restrict n)
94*c9945492SAndroid Build Coastguard Worker {
95*c9945492SAndroid Build Coastguard Worker /* Return immediately on empty needle or haystack */
96*c9945492SAndroid Build Coastguard Worker if (!n[0]) return (wchar_t *)h;
97*c9945492SAndroid Build Coastguard Worker if (!h[0]) return 0;
98*c9945492SAndroid Build Coastguard Worker
99*c9945492SAndroid Build Coastguard Worker /* Use faster algorithms for short needles */
100*c9945492SAndroid Build Coastguard Worker h = wcschr(h, *n);
101*c9945492SAndroid Build Coastguard Worker if (!h || !n[1]) return (wchar_t *)h;
102*c9945492SAndroid Build Coastguard Worker if (!h[1]) return 0;
103*c9945492SAndroid Build Coastguard Worker
104*c9945492SAndroid Build Coastguard Worker return twoway_wcsstr(h, n);
105*c9945492SAndroid Build Coastguard Worker }
106