netlink: Fix getting route scope of interface's IPv4 addresses

[zlei]

Summary

netlink: Fix getting route scope of interface's IPv4 addresses

sin_addr of a `struct sockaddr_in` is stored in network byte order, but
IN_LOOPBACK() and IN_LINKLOCAL() want the host order.

Fixes:  7e5bf68495cc netlink: add netlink support
MFC after:      3 days

tests/netlink: Assert the route scope of interfaces's addresses

While here, add IPv4 link-local address to cover RT_SCOPE_LINK case.

MFC after:      3 days

[jlduran]

Nice! Thank you!

[melifaro]

LGTM, thank you!

[glebius]

Zhenlei, please go forward with Alexander's review, don't wait on me. Thanks!

[zlei]

In D49226#1123621, @glebius wrote:

Zhenlei, please go forward with Alexander's review, don't wait on me. Thanks!

Yeah, I'm going to commit today (UTC+8). I'm not familiar with Python. The fix is simple but I spent a lot time on the tests :-)

tests/sys/netlink/test_rtnl_ifaddr.py

 #include "snd_fxdiv_gen.h"
 #endif
 
 #define FEEDMATRIX_RESERVOIR    (SND_CHN_MAX * PCM_32_BPS)
 
 #define SND_CHN_T_EOF           0x00e0fe0f
 #define SND_CHN_T_NULL          0x0e0e0e0e
 
-struct feed_matrix_info;
-
-typedef void (*feed_matrix_t)(struct feed_matrix_info *, uint8_t *,
-    uint8_t *, uint32_t);
-
 struct feed_matrix_info {
+        uint32_t fmt;
         uint32_t bps;
         uint32_t ialign, oalign;
         uint32_t in, out;
-        feed_matrix_t apply;
         struct {
                 int chn[SND_CHN_T_MAX + 1];
                 int mul, shift;
         } matrix[SND_CHN_T_MAX + 1];
         uint8_t reservoir[FEEDMATRIX_RESERVOIR];
 };
 
 static struct pcmchan_matrix feeder_matrix_maps[SND_CHN_MATRIX_MAX] = {

 #else
 #define FEEDMATRIX_CLIP_CHECK(v, BIT)   do {                            \
         if ((v) < PCM_S##BIT##_MIN || (v) > PCM_S##BIT##_MAX)             \
             errx(1, "\n\n%s(): Sample clipping: %jd\n",                       \
                 __func__, (intmax_t)(v));                               \
 } while (0)
 #endif
 
-#define FEEDMATRIX_DECLARE(SIGN, BIT, ENDIAN)                           \
-static void                                                             \
-feed_matrix_##SIGN##BIT##ENDIAN(struct feed_matrix_info *info,          \
-    uint8_t *src, uint8_t *dst, uint32_t count)                         \
-{                                                                       \
-        intpcm64_t accum;                                               \
-        intpcm_t v;                                                     \
-        int i, j;                                                       \
-                                                                        \
-        do {                                                            \
-                for (i = 0; info->matrix[i].chn[0] != SND_CHN_T_EOF; \
-                    i++) {                                              \
-                        if (info->matrix[i].chn[0] == SND_CHN_T_NULL) {      \
-                                pcm_sample_write(dst, 0,                \
-                                    AFMT_##SIGN##BIT##_##ENDIAN);       \
-                                dst += PCM_##BIT##_BPS;                 \
-                                continue;                               \
-                        } else if (info->matrix[i].chn[1] ==         \
-                            SND_CHN_T_EOF) {                            \
-                                v = pcm_sample_read(                    \
-                                    src + info->matrix[i].chn[0],    \
-                                    AFMT_##SIGN##BIT##_##ENDIAN);       \
-                                pcm_sample_write(dst, v,                \
-                                    AFMT_##SIGN##BIT##_##ENDIAN);       \
-                                dst += PCM_##BIT##_BPS;                 \
-                                continue;                               \
-                        }                                               \
-                                                                        \
-                        accum = 0;                                      \
-                        for (j = 0;                                     \
-                            info->matrix[i].chn[j] != SND_CHN_T_EOF; \
-                            j++) {                                      \
-                                v = pcm_sample_read(                    \
-                                    src + info->matrix[i].chn[j],    \
-                                    AFMT_##SIGN##BIT##_##ENDIAN);       \
-                                accum += v;                             \
-                        }                                               \
-                                                                        \
-                        accum = (accum * info->matrix[i].mul) >>       \
-                            info->matrix[i].shift;                   \
-                                                                        \
-                        FEEDMATRIX_CLIP_CHECK(accum, BIT);              \
-                                                                        \
-                        v = (accum > PCM_S##BIT##_MAX) ?             \
-                            PCM_S##BIT##_MAX :                          \
-                            ((accum < PCM_S##BIT##_MIN) ?            \
-                            PCM_S##BIT##_MIN :                          \
-                            accum);                                     \
-                        pcm_sample_write(dst, v,                        \
-                            AFMT_##SIGN##BIT##_##ENDIAN);               \
-                        dst += PCM_##BIT##_BPS;                         \
-                }                                                       \
-                src += info->ialign;                                 \
-        } while (--count != 0);                                         \
+__always_inline static void
+feed_matrix_apply(struct feed_matrix_info *info, uint8_t *src, uint8_t *dst,
+    uint32_t count, const uint32_t fmt)
+{
+        intpcm64_t accum;
+        intpcm_t v;
+        int i, j;
+
+        do {
+                for (i = 0; info->matrix[i].chn[0] != SND_CHN_T_EOF; i++) {
+                        if (info->matrix[i].chn[0] == SND_CHN_T_NULL) {
+                                pcm_sample_write(dst, 0, fmt);
+                                dst += info->bps;
+                                continue;
+                        } else if (info->matrix[i].chn[1] == SND_CHN_T_EOF) {
+                                v = pcm_sample_read(src +
+                                    info->matrix[i].chn[0], fmt);
+                                pcm_sample_write(dst, v, fmt);
+                                dst += info->bps;
+                                continue;
                         }
 
-#if BYTE_ORDER == LITTLE_ENDIAN || defined(SND_FEEDER_MULTIFORMAT)
-FEEDMATRIX_DECLARE(S, 16, LE)
-FEEDMATRIX_DECLARE(S, 32, LE)
-#endif
-#if BYTE_ORDER == BIG_ENDIAN || defined(SND_FEEDER_MULTIFORMAT)
-FEEDMATRIX_DECLARE(S, 16, BE)
-FEEDMATRIX_DECLARE(S, 32, BE)
-#endif
-#ifdef SND_FEEDER_MULTIFORMAT
-FEEDMATRIX_DECLARE(S,  8, NE)
-FEEDMATRIX_DECLARE(S, 24, LE)
-FEEDMATRIX_DECLARE(S, 24, BE)
-FEEDMATRIX_DECLARE(U,  8, NE)
-FEEDMATRIX_DECLARE(U, 16, LE)
-FEEDMATRIX_DECLARE(U, 24, LE)
-FEEDMATRIX_DECLARE(U, 32, LE)
-FEEDMATRIX_DECLARE(U, 16, BE)
-FEEDMATRIX_DECLARE(U, 24, BE)
-FEEDMATRIX_DECLARE(U, 32, BE)
-#endif
-
-#define FEEDMATRIX_ENTRY(SIGN, BIT, ENDIAN)                             \
-        {                                                               \
-                AFMT_##SIGN##BIT##_##ENDIAN,                            \
-                feed_matrix_##SIGN##BIT##ENDIAN                         \
+                        accum = 0;
+                        for (j = 0; info->matrix[i].chn[j] != SND_CHN_T_EOF;
+                            j++) {
+                                v = pcm_sample_read(src +
+                                    info->matrix[i].chn[j], fmt);
+                                accum += v;
                         }
 
-static const struct {
-        uint32_t format;
-        feed_matrix_t apply;
-} feed_matrix_tab[] = {
-#if BYTE_ORDER == LITTLE_ENDIAN || defined(SND_FEEDER_MULTIFORMAT)
-        FEEDMATRIX_ENTRY(S, 16, LE),
-        FEEDMATRIX_ENTRY(S, 32, LE),
-#endif
-#if BYTE_ORDER == BIG_ENDIAN || defined(SND_FEEDER_MULTIFORMAT)
-        FEEDMATRIX_ENTRY(S, 16, BE),
-        FEEDMATRIX_ENTRY(S, 32, BE),
-#endif
-#ifdef SND_FEEDER_MULTIFORMAT
-        FEEDMATRIX_ENTRY(S,  8, NE),
-        FEEDMATRIX_ENTRY(S, 24, LE),
-        FEEDMATRIX_ENTRY(S, 24, BE),
-        FEEDMATRIX_ENTRY(U,  8, NE),
-        FEEDMATRIX_ENTRY(U, 16, LE),
-        FEEDMATRIX_ENTRY(U, 24, LE),
-        FEEDMATRIX_ENTRY(U, 32, LE),
-        FEEDMATRIX_ENTRY(U, 16, BE),
-        FEEDMATRIX_ENTRY(U, 24, BE),
-        FEEDMATRIX_ENTRY(U, 32, BE)
-#endif
-};
+                        accum = (accum * info->matrix[i].mul) >>
+                            info->matrix[i].shift;
 
+                        FEEDMATRIX_CLIP_CHECK(accum, AFMT_BIT(fmt));
+
+                        v = pcm_clamp(accum, fmt);
+                        pcm_sample_write(dst, v, fmt);
+                        dst += info->bps;
+                }
+                src += info->ialign;
+        } while (--count != 0);
+}
+
 static void
 feed_matrix_reset(struct feed_matrix_info *info)
 {
         uint32_t i, j;
 
         for (i = 0; i < nitems(info->matrix); i++) {
                 for (j = 0;
                     j < (sizeof(info->matrix[i].chn) /
#endif
         return (0);
 }
 
 static int
 feed_matrix_init(struct pcm_feeder *f)
 {
         struct feed_matrix_info *info;
         struct pcmchan_matrix *m_in, *m_out;
-        uint32_t i;
         int ret;
 
         if (AFMT_ENCODING(f->desc->in) != AFMT_ENCODING(f->desc->out))
                 return (EINVAL);
 
         info = malloc(sizeof(*info), M_DEVBUF, M_NOWAIT | M_ZERO);
         if (info == NULL)
                 return (ENOMEM);
 
         info->in = f->desc->in;
         info->out = f->desc->out;
+        info->fmt = AFMT_ENCODING(info->in);
         info->bps = AFMT_BPS(info->in);
         info->ialign = AFMT_ALIGN(info->in);
         info->oalign = AFMT_ALIGN(info->out);
-        info->apply = NULL;
 
-        for (i = 0; info->apply == NULL &&
-            i < (sizeof(feed_matrix_tab) / sizeof(feed_matrix_tab[0])); i++) {
-                if (AFMT_ENCODING(info->in) == feed_matrix_tab[i].format)
-                        info->apply = feed_matrix_tab[i].apply;
-        }
-
-        if (info->apply == NULL) {
-#ifdef FEEDMATRIX_GENERIC
-                info->apply = feed_matrix_apply_generic;
-#else
-                free(info, M_DEVBUF);
-                return (EINVAL);
-#endif
-        }
-
         m_in  = feeder_matrix_format_map(info->in);
         m_out = feeder_matrix_format_map(info->out);
 
         ret = feed_matrix_setup(info, m_in, m_out);
         if (ret != 0) {
                 free(info, M_DEVBUF);
                 return (ret);
         }
if (count < inmax) {
                         src = dst + count - j;
                 }
 
                 j = SND_FXDIV(FEEDER_FEED(f->source, c, src, j, source),
                     info->ialign);
                 if (j == 0)
                         break;
 
-                info->apply(info, src, dst, j);
+                /* Optimize some common formats. */
+                switch (info->fmt) {
+                case AFMT_S16_NE:
+                        feed_matrix_apply(info, src, dst, j, AFMT_S16_NE);
+                        break;
+                case AFMT_S24_NE:
+                        feed_matrix_apply(info, src, dst, j, AFMT_S24_NE);
+                        break;
+                case AFMT_S32_NE:
+                        feed_matrix_apply(info, src, dst, j, AFMT_S32_NE);
+                        break;
+                default:
+                        feed_matrix_apply(info, src, dst, j, info->fmt);
+                        break;
+                }
 
                 j *= info->oalign;
                 dst += j;
                 count -= j;
 
         } while (count != 0);
 
         return (dst - b);