libc/src/string/memory_utils/inline_memmem.h

//===-- memmem implementation -----------------------------------*- C++ -*-===//
//
// Part of the LLVM Project, under the Apache License v2.0 with LLVM Exceptions.
// See https://llvm.org/LICENSE.txt for license information.
// SPDX-License-Identifier: Apache-2.0 WITH LLVM-exception
//
//===----------------------------------------------------------------------===//

#ifndef LLVM_LIBC_SRC_STRING_MEMORY_UTILS_INLINE_MEMMEM_H
#define LLVM_LIBC_SRC_STRING_MEMORY_UTILS_INLINE_MEMMEM_H

#include "src/__support/macros/attributes.h"
#include "src/__support/macros/config.h"

#include <stddef.h>

namespace LIBC_NAMESPACE_DECL {

template <typename Comp>
LIBC_INLINE constexpr static void *
inline_memmem(const void *haystack, size_t haystack_len, const void *needle,
              size_t needle_len, Comp &&comp) {
  // TODO: simple brute force implementation. This can be
  // improved upon using well known string matching algorithms.
  if (!needle_len)
    return const_cast<void *>(haystack);

  if (needle_len > haystack_len)
    return nullptr;

  const unsigned char *h = static_cast<const unsigned char *>(haystack);
  const unsigned char *n = static_cast<const unsigned char *>(needle);
  for (size_t i = 0; i <= (haystack_len - needle_len); ++i) {
    size_t j = 0;
    for (; j < needle_len && !comp(h[i + j], n[j]); ++j)
      ;
    if (j == needle_len)
      return const_cast<unsigned char *>(h + i);
  }
  return nullptr;
}

} // namespace LIBC_NAMESPACE_DECL

#endif // LLVM_LIBC_SRC_STRING_MEMORY_UTILS_INLINE_MEMMEM_H