linux/fs/ncpfs/ncpsign_kernel.c
<<
>>
Prefs
   1/*
   2 *  ncpsign_kernel.c
   3 *
   4 *  Arne de Bruijn (arne@knoware.nl), 1997
   5 *
   6 */
   7
   8
   9#ifdef CONFIG_NCPFS_PACKET_SIGNING
  10
  11#include <linux/string.h>
  12#include <linux/ncp.h>
  13#include <linux/bitops.h>
  14#include "ncp_fs.h"
  15#include "ncpsign_kernel.h"
  16
  17/* i386: 32-bit, little endian, handles mis-alignment */
  18#ifdef __i386__
  19#define GET_LE32(p) (*(const int *)(p))
  20#define PUT_LE32(p,v) { *(int *)(p)=v; }
  21#else
  22/* from include/ncplib.h */
  23#define BVAL(buf,pos) (((const __u8 *)(buf))[pos])
  24#define PVAL(buf,pos) ((unsigned)BVAL(buf,pos))
  25#define BSET(buf,pos,val) (((__u8 *)(buf))[pos] = (val))
  26
  27static inline __u16
  28WVAL_LH(const __u8 * buf, int pos)
  29{
  30        return PVAL(buf, pos) | PVAL(buf, pos + 1) << 8;
  31}
  32static inline __u32
  33DVAL_LH(const __u8 * buf, int pos)
  34{
  35        return WVAL_LH(buf, pos) | WVAL_LH(buf, pos + 2) << 16;
  36}
  37static inline void
  38WSET_LH(__u8 * buf, int pos, __u16 val)
  39{
  40        BSET(buf, pos, val & 0xff);
  41        BSET(buf, pos + 1, val >> 8);
  42}
  43static inline void
  44DSET_LH(__u8 * buf, int pos, __u32 val)
  45{
  46        WSET_LH(buf, pos, val & 0xffff);
  47        WSET_LH(buf, pos + 2, val >> 16);
  48}
  49
  50#define GET_LE32(p) DVAL_LH(p,0)
  51#define PUT_LE32(p,v) DSET_LH(p,0,v)
  52#endif
  53
  54static void nwsign(char *r_data1, char *r_data2, char *outdata) {
  55 int i;
  56 unsigned int w0,w1,w2,w3;
  57 static int rbit[4]={0, 2, 1, 3};
  58#ifdef __i386__
  59 unsigned int *data2=(unsigned int *)r_data2;
  60#else
  61 unsigned int data2[16];
  62 for (i=0;i<16;i++)
  63  data2[i]=GET_LE32(r_data2+(i<<2));
  64#endif 
  65 w0=GET_LE32(r_data1);
  66 w1=GET_LE32(r_data1+4);
  67 w2=GET_LE32(r_data1+8);
  68 w3=GET_LE32(r_data1+12);
  69 for (i=0;i<16;i+=4) {
  70  w0=rol32(w0 + ((w1 & w2) | ((~w1) & w3)) + data2[i+0],3);
  71  w3=rol32(w3 + ((w0 & w1) | ((~w0) & w2)) + data2[i+1],7);
  72  w2=rol32(w2 + ((w3 & w0) | ((~w3) & w1)) + data2[i+2],11);
  73  w1=rol32(w1 + ((w2 & w3) | ((~w2) & w0)) + data2[i+3],19);
  74 }
  75 for (i=0;i<4;i++) {
  76  w0=rol32(w0 + (((w2 | w3) & w1) | (w2 & w3)) + 0x5a827999 + data2[i+0],3);
  77  w3=rol32(w3 + (((w1 | w2) & w0) | (w1 & w2)) + 0x5a827999 + data2[i+4],5);
  78  w2=rol32(w2 + (((w0 | w1) & w3) | (w0 & w1)) + 0x5a827999 + data2[i+8],9);
  79  w1=rol32(w1 + (((w3 | w0) & w2) | (w3 & w0)) + 0x5a827999 + data2[i+12],13);
  80 }
  81 for (i=0;i<4;i++) {
  82  w0=rol32(w0 + ((w1 ^ w2) ^ w3) + 0x6ed9eba1 + data2[rbit[i]+0],3);
  83  w3=rol32(w3 + ((w0 ^ w1) ^ w2) + 0x6ed9eba1 + data2[rbit[i]+8],9);
  84  w2=rol32(w2 + ((w3 ^ w0) ^ w1) + 0x6ed9eba1 + data2[rbit[i]+4],11);
  85  w1=rol32(w1 + ((w2 ^ w3) ^ w0) + 0x6ed9eba1 + data2[rbit[i]+12],15);
  86 }
  87 PUT_LE32(outdata,(w0+GET_LE32(r_data1)) & 0xffffffff);
  88 PUT_LE32(outdata+4,(w1+GET_LE32(r_data1+4)) & 0xffffffff);
  89 PUT_LE32(outdata+8,(w2+GET_LE32(r_data1+8)) & 0xffffffff);
  90 PUT_LE32(outdata+12,(w3+GET_LE32(r_data1+12)) & 0xffffffff);
  91}
  92
  93/* Make a signature for the current packet and add it at the end of the */
  94/* packet. */
  95void __sign_packet(struct ncp_server *server, const char *packet, size_t size, __u32 totalsize, void *sign_buff) {
  96        unsigned char data[64];
  97
  98        memcpy(data, server->sign_root, 8);
  99        *(__u32*)(data + 8) = totalsize;
 100        if (size < 52) {
 101                memcpy(data + 12, packet, size);
 102                memset(data + 12 + size, 0, 52 - size);
 103        } else {
 104                memcpy(data + 12, packet, 52);
 105        }
 106        nwsign(server->sign_last, data, server->sign_last);
 107        memcpy(sign_buff, server->sign_last, 8);
 108}
 109
 110int sign_verify_reply(struct ncp_server *server, const char *packet, size_t size, __u32 totalsize, const void *sign_buff) {
 111        unsigned char data[64];
 112        unsigned char hash[16];
 113
 114        memcpy(data, server->sign_root, 8);
 115        *(__u32*)(data + 8) = totalsize;
 116        if (size < 52) {
 117                memcpy(data + 12, packet, size);
 118                memset(data + 12 + size, 0, 52 - size);
 119        } else {
 120                memcpy(data + 12, packet, 52);
 121        }
 122        nwsign(server->sign_last, data, hash);
 123        return memcmp(sign_buff, hash, 8);
 124}
 125
 126#endif  /* CONFIG_NCPFS_PACKET_SIGNING */
 127
 128
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.