/***************************************************************************
* Copyright (c) 2016, Wolf Vollprecht, Johan Mabille, Sylvain Corlay and   *
* Martin Renou                                                             *
*                                                                          *
* Distributed under the terms of the BSD 3-Clause License.                 *
*                                                                          *
* The full license is in the file LICENSE, distributed with this software. *
****************************************************************************/

#ifndef XSIMD_NEON_UINT16_HPP
#define XSIMD_NEON_UINT16_HPP

#include <utility>

#include "xsimd_base.hpp"
#include "xsimd_neon_bool.hpp"
#include "xsimd_neon_utils.hpp"

namespace xsimd
{
    /*********************
     * batch<uint16_t, 8>*
     *********************/

    template <>
    struct simd_batch_traits<batch<uint16_t, 8>>
    {
        using value_type = uint16_t;
        static constexpr std::size_t size = 8;
        using batch_bool_type = batch_bool<uint16_t, 8>;
        static constexpr std::size_t align = XSIMD_DEFAULT_ALIGNMENT;
        using storage_type = uint16x8_t;
    };

    template <>
    class batch<uint16_t, 8> : public simd_batch<batch<uint16_t, 8>>
    {
    public:

        using base_type = simd_batch<batch<uint16_t, 8>>;
        using storage_type = typename base_type::storage_type;

        batch();
        explicit batch(uint16_t d);

        template <class... Args, class Enable = detail::is_array_initializer_t<uint16_t, 8, Args...>>
        batch(Args... args);
        explicit batch(const uint16_t* src);

        batch(const uint16_t* src, aligned_mode);
        batch(const uint16_t* src, unaligned_mode);

        batch(const storage_type& rhs);
        batch& operator=(const storage_type& rhs);

        operator storage_type() const;

        batch& load_aligned(const int16_t* src);
        batch& load_unaligned(const int16_t* src);

        batch& load_aligned(const uint16_t* src);
        batch& load_unaligned(const uint16_t* src);

        void store_aligned(int16_t* dst) const;
        void store_unaligned(int16_t* dst) const;

        void store_aligned(uint16_t* dst) const;
        void store_unaligned(uint16_t* dst) const;

        using base_type::load_aligned;
        using base_type::load_unaligned;
        using base_type::store_aligned;
        using base_type::store_unaligned;

        XSIMD_DECLARE_LOAD_STORE_INT16(uint16_t, 8)
        XSIMD_DECLARE_LOAD_STORE_LONG(uint16_t, 8)
    };

    batch<uint16_t, 8> operator<<(const batch<uint16_t, 8>& lhs, int16_t rhs);
    batch<uint16_t, 8> operator>>(const batch<uint16_t, 8>& lhs, int16_t rhs);
    batch<uint16_t, 8> operator<<(const batch<uint16_t, 8>& lhs, const batch<int16_t, 8>& rhs);

    /************************************
     * batch<int16_t, 8> implementation *
     ************************************/

    inline batch<uint16_t, 8>::batch()
    {
    }

    inline batch<uint16_t, 8>::batch(uint16_t d)
        : base_type(vdupq_n_u16(d))
    {
    }

    template <class... Args, class>
    inline batch<uint16_t, 8>::batch(Args... args)
        : base_type(storage_type{static_cast<uint16_t>(args)...})
    {
    }

    inline batch<uint16_t, 8>::batch(const uint16_t* d)
        : base_type(vld1q_u16(d))
    {
    }

    inline batch<uint16_t, 8>::batch(const uint16_t* d, aligned_mode)
        : batch(d)
    {
    }

    inline batch<uint16_t, 8>::batch(const uint16_t* d, unaligned_mode)
        : batch(d)
    {
    }

    inline batch<uint16_t, 8>::batch(const storage_type& rhs)
        : base_type(rhs)
    {
    }

    inline batch<uint16_t, 8>& batch<uint16_t, 8>::operator=(const storage_type& rhs)
    {
        this->m_value = rhs;
        return *this;
    }

    inline batch<uint16_t, 8>& batch<uint16_t, 8>::load_aligned(const int16_t* src)
    {
        this->m_value = vreinterpretq_u16_s16(vld1q_s16(src));
        return *this;
    }

    inline batch<uint16_t, 8>& batch<uint16_t, 8>::load_unaligned(const int16_t* src)
    {
        return load_aligned(src);
    }


    inline batch<uint16_t, 8>& batch<uint16_t, 8>::load_aligned(const uint16_t* src)
    {
        this->m_value = vld1q_u16(src);
        return *this;
    }

    inline batch<uint16_t, 8>& batch<uint16_t, 8>::load_unaligned(const uint16_t* src)
    {
        return load_aligned(src);
    }

    inline void batch<uint16_t, 8>::store_aligned(int16_t* dst) const
    {
        vst1q_s16(dst, vreinterpretq_s16_u16(this->m_value));
    }

    inline void batch<uint16_t, 8>::store_unaligned(int16_t* dst) const
    {
        store_aligned(dst);
    }

    inline void batch<uint16_t, 8>::store_aligned(uint16_t* dst) const
    {
        vst1q_u16(dst, this->m_value);
    }

    inline void batch<uint16_t, 8>::store_unaligned(uint16_t* dst) const
    {
        store_aligned(dst);
    }

    XSIMD_DEFINE_LOAD_STORE_INT16(uint16_t, 8, 8)
    XSIMD_DEFINE_LOAD_STORE_LONG(uint16_t, 8, 8)

    inline batch<uint16_t, 8>::operator uint16x8_t() const
    {
        return this->m_value;
    }

    namespace detail
    {
        template <>
        struct batch_kernel<uint16_t, 8>
        {
            using batch_type = batch<uint16_t, 8>;
            using value_type = uint16_t;
            using batch_bool_type = batch_bool<uint16_t, 8>;

            static batch_type neg(const batch_type& rhs)
            {
                return vreinterpretq_u16_s16(vnegq_s16(vreinterpretq_s16_u16(rhs)));
            }

            static batch_type add(const batch_type& lhs, const batch_type& rhs)
            {
                return vaddq_u16(lhs, rhs);
            }

            static batch_type sub(const batch_type& lhs, const batch_type& rhs)
            {
                return vsubq_u16(lhs, rhs);
            }

            static batch_type mul(const batch_type& lhs, const batch_type& rhs)
            {
                return vmulq_u16(lhs, rhs);
            }

            static batch_type div(const batch_type& lhs, const batch_type& rhs)
            {
                return neon_detail::unroll_op<8, uint16x8_t, uint16_t>([&lhs, &rhs] (std::size_t idx) {
                    return lhs[idx] / rhs[idx];
                });
            }

            static batch_type mod(const batch_type& lhs, const batch_type& rhs)
            {
                return neon_detail::unroll_op<8, uint16x8_t, uint16_t>([&lhs, &rhs] (std::size_t idx) {
                    return lhs[idx] % rhs[idx];
                });
            }

            static batch_bool_type eq(const batch_type& lhs, const batch_type& rhs)
            {
                return vceqq_u16(lhs, rhs);
            }

            static batch_bool_type neq(const batch_type& lhs, const batch_type& rhs)
            {
                return !(lhs == rhs);
            }

            static batch_bool_type lt(const batch_type& lhs, const batch_type& rhs)
            {
                return vcltq_u16(lhs, rhs);
            }

            static batch_bool_type lte(const batch_type& lhs, const batch_type& rhs)
            {
                return vcleq_u16(lhs, rhs);
            }

            static batch_type bitwise_and(const batch_type& lhs, const batch_type& rhs)
            {
                return vandq_u16(lhs, rhs);
            }

            static batch_type bitwise_or(const batch_type& lhs, const batch_type& rhs)
            {
                return vorrq_u16(lhs, rhs);
            }

            static batch_type bitwise_xor(const batch_type& lhs, const batch_type& rhs)
            {
                return veorq_u16(lhs, rhs);
            }

            static batch_type bitwise_not(const batch_type& rhs)
            {
                return vmvnq_u16(rhs);
            }

            static batch_type bitwise_andnot(const batch_type& lhs, const batch_type& rhs)
            {
                return vbicq_u16(lhs, rhs);
            }

            static batch_type min(const batch_type& lhs, const batch_type& rhs)
            {
                return vminq_u16(lhs, rhs);
            }

            static batch_type max(const batch_type& lhs, const batch_type& rhs)
            {
                return vmaxq_u16(lhs, rhs);
            }

            static batch_type abs(const batch_type& rhs)
            {
                return rhs;
            }

            static batch_type fma(const batch_type& x, const batch_type& y, const batch_type& z)
            {
                return x * y + z;
            }

            static batch_type fms(const batch_type& x, const batch_type& y, const batch_type& z)
            {
                return x * y - z;
            }

            static batch_type fnma(const batch_type& x, const batch_type& y, const batch_type& z)
            {
                return -x * y + z;
            }

            static batch_type fnms(const batch_type& x, const batch_type& y, const batch_type& z)
            {
                return -x * y - z;
            }

            // Not implemented yet
            static value_type hadd(const batch_type& rhs)
            {
#if XSIMD_ARM_INSTR_SET >= XSIMD_ARM8_64_NEON_VERSION
                return vaddvq_u16(rhs);
#else
                uint16x4_t tmp = vpadd_u16(vget_low_u16(rhs), vget_high_u16(rhs));
                value_type res = 0;
                for (std::size_t i = 0; i < 4; ++i)
                {
                    res += tmp[i];
                }
                return res;
#endif
            }

            static batch_type select(const batch_bool_type& cond, const batch_type& a, const batch_type& b)
            {
                return vbslq_u16(cond, a, b);
            }
        };
    }

    namespace detail
    {
        inline batch<uint16_t, 8> shift_left(const batch<uint16_t, 8>& lhs, const int n)
        {
            switch(n)
            {
                case 0: return lhs;
                XSIMD_REPEAT_16(vshlq_n_u16);
                default: break;
            }
            return batch<uint16_t, 8>(uint16_t(0));
        }

        inline batch<uint16_t, 8> shift_right(const batch<uint16_t, 8>& lhs, const int n)
        {
            switch(n)
            {
                case 0: return lhs;
                XSIMD_REPEAT_16(vshrq_n_u16);
                default: break;
            }
            return batch<uint16_t, 8>(uint16_t(0));
        }
    }

    inline batch<uint16_t, 8> operator<<(const batch<uint16_t, 8>& lhs, int16_t rhs)
    {
        return detail::shift_left(lhs, rhs);
    }

    inline batch<uint16_t, 8> operator>>(const batch<uint16_t, 8>& lhs, int16_t rhs)
    {
        return detail::shift_right(lhs, rhs);
    }

    inline batch<uint16_t, 8> operator<<(const batch<uint16_t, 8>& lhs, const batch<int16_t, 8>& rhs)
    {
        return vshlq_u16(lhs, rhs);
    }
}

#endif
