utils.cpp

#include "utils.h"

#include <iostream>

/**
 * 16ビットでバイトオーダーを入れ替える
 */
uint16_t swap_byte_order_16(uint16_t v) {
    return (v & 0x00ff) << 8 | (v & 0xff00) >> 8;
}

/**
 * 32ビットでバイトオーダーを入れ替える
 */
uint32_t swap_byte_order_32(uint32_t v) {
    return (v & 0x000000ff) << 24 | (v & 0x0000ff00) << 8 |
           (v & 0x00ff0000) >> 8 | (v & 0xff000000) >> 24;
}

uint16_t ntohs(uint16_t v) { return swap_byte_order_16(v); }

uint16_t htons(uint16_t v) { return swap_byte_order_16(v); }

uint32_t ntohl(uint32_t v) { return swap_byte_order_32(v); }

uint32_t htonl(uint32_t v) { return swap_byte_order_32(v); }

uint8_t ip_string_pool_index = 0;
char ip_string_pool[4]
                   [16]; // 16バイト(xxx.xxx.xxx.xxxの文字数+1)の領域を4つ確保

/**
 * IPアドレスから文字列に変換
 * @param in
 * @return
 */
const char *ip_ntoa(uint32_t in) {
    uint8_t a = in & 0x000000ff;
    uint8_t b = in >> 8 & 0x000000ff;
    uint8_t c = in >> 16 & 0x000000ff;
    uint8_t d = in >> 24 & 0x000000ff;
    ip_string_pool_index++;
    ip_string_pool_index %= 4;
    sprintf(ip_string_pool[ip_string_pool_index], "%d.%d.%d.%d", a, b, c, d);
    return ip_string_pool[ip_string_pool_index];
}

// ホストバイトオーダーのIPアドレスから文字列に変換
const char *ip_htoa(uint32_t in) { return ip_ntoa(htonl(in)); }

uint8_t mac_addr_string_pool_index = 0;
char mac_addr_string_pool
    [4][18]; // 18バイト(xxx.xxx.xxx.xxxの文字数+1)の領域を4つ確保

/**
 * MACアドレスから文字列に変換
 * @param addr
 */
const char *mac_addr_toa(const uint8_t *addr) {
    mac_addr_string_pool_index++;
    mac_addr_string_pool_index %= 4;
    sprintf(mac_addr_string_pool[mac_addr_string_pool_index],
            "%02x:%02x:%02x:%02x:%02x:%02x", addr[0], addr[1], addr[2], addr[3],
            addr[4], addr[5]);
    return mac_addr_string_pool[mac_addr_string_pool_index];
}

/**
 * Checksumの計算
 * @param buffer 計算する対象のデータ
 * @param count 計算するデータの長さ
 * @param start 計算する初期値
 * @return 計算されたチェックサム
 */
uint16_t checksum_16(uint16_t *buffer, size_t count, uint16_t start) {
    uint32_t sum = start;
    // まず16ビット毎に足す
    while (count > 1) {
        sum += *buffer++;
        count -= 2;
    }
    // もし1バイト余ってたら足す
    if (count > 0) sum += *(uint8_t *)buffer;
    // あふれた桁を折り返して足す
    while (sum >> 16)
        sum = (sum & 0xffff) + (sum >> 16);

    return ~sum; // 論理否定(NOT)をとる
}