1 #include <errno.h> 2 #include <string.h> 3 #include <sys/types.h> 4 #include <netinet/in.h> 5 6 #include "utils.h" 7 8 static __inline__ u_int16_t dn_ntohs(u_int16_t addr) 9 { 10 union { 11 u_int8_t byte[2]; 12 u_int16_t word; 13 } u; 14 15 u.word = addr; 16 return ((u_int16_t)u.byte[0]) | (((u_int16_t)u.byte[1]) << 8); 17 } 18 19 static __inline__ int do_digit(char *str, u_int16_t *addr, u_int16_t scale, size_t *pos, size_t len, int *started) 20 { 21 u_int16_t tmp = *addr / scale; 22 23 if (*pos == len) 24 return 1; 25 26 if (((tmp) > 0) || *started || (scale == 1)) { 27 *str = tmp + '0'; 28 *started = 1; 29 (*pos)++; 30 *addr -= (tmp * scale); 31 } 32 33 return 0; 34 } 35 36 37 static const char *dnet_ntop1(const struct dn_naddr *dna, char *str, size_t len) 38 { 39 u_int16_t addr, area; 40 size_t pos = 0; 41 int started = 0; 42 43 memcpy(&addr, dna->a_addr, sizeof(addr)); 44 addr = dn_ntohs(addr); 45 area = addr >> 10; 46 47 if (dna->a_len != 2) 48 return NULL; 49 50 addr &= 0x03ff; 51 52 if (len == 0) 53 return str; 54 55 if (do_digit(str + pos, &area, 10, &pos, len, &started)) 56 return str; 57 58 if (do_digit(str + pos, &area, 1, &pos, len, &started)) 59 return str; 60 61 if (pos == len) 62 return str; 63 64 *(str + pos) = '.'; 65 pos++; 66 started = 0; 67 68 if (do_digit(str + pos, &addr, 1000, &pos, len, &started)) 69 return str; 70 71 if (do_digit(str + pos, &addr, 100, &pos, len, &started)) 72 return str; 73 74 if (do_digit(str + pos, &addr, 10, &pos, len, &started)) 75 return str; 76 77 if (do_digit(str + pos, &addr, 1, &pos, len, &started)) 78 return str; 79 80 if (pos == len) 81 return str; 82 83 *(str + pos) = 0; 84 85 return str; 86 } 87 88 89 const char *dnet_ntop(int af, const void *addr, char *str, size_t len) 90 { 91 switch(af) { 92 case AF_DECnet: 93 errno = 0; 94 return dnet_ntop1((struct dn_naddr *)addr, str, len); 95 default: 96 errno = EAFNOSUPPORT; 97 } 98 99 return NULL; 100 } 101 102 103
