ncpsign_kernel.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:3k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  *  ncpsign_kernel.c
  3.  *
  4.  *  Arne de Bruijn (arne@knoware.nl), 1997
  5.  *
  6.  */
  7. #include <linux/config.h>
  8. #ifdef CONFIG_NCPFS_PACKET_SIGNING
  9. #include <linux/string.h>
  10. #include <linux/ncp.h>
  11. #include "ncpsign_kernel.h"
  12. #define rol32(i,c) (((((i)&0xffffffff)<<c)&0xffffffff)| 
  13.                     (((i)&0xffffffff)>>(32-c)))
  14. /* i386: 32-bit, little endian, handles mis-alignment */
  15. #ifdef __i386__
  16. #define GET_LE32(p) (*(int *)(p))
  17. #define PUT_LE32(p,v) { *(int *)(p)=v; }
  18. #else
  19. /* from include/ncplib.h */
  20. #define BVAL(buf,pos) (((__u8 *)(buf))[pos])
  21. #define PVAL(buf,pos) ((unsigned)BVAL(buf,pos))
  22. #define BSET(buf,pos,val) (BVAL(buf,pos) = (val))
  23. static inline __u16
  24. WVAL_LH(__u8 * buf, int pos)
  25. {
  26. return PVAL(buf, pos) | PVAL(buf, pos + 1) << 8;
  27. }
  28. static inline __u32
  29. DVAL_LH(__u8 * buf, int pos)
  30. {
  31. return WVAL_LH(buf, pos) | WVAL_LH(buf, pos + 2) << 16;
  32. }
  33. static inline void
  34. WSET_LH(__u8 * buf, int pos, __u16 val)
  35. {
  36. BSET(buf, pos, val & 0xff);
  37. BSET(buf, pos + 1, val >> 8);
  38. }
  39. static inline void
  40. DSET_LH(__u8 * buf, int pos, __u32 val)
  41. {
  42. WSET_LH(buf, pos, val & 0xffff);
  43. WSET_LH(buf, pos + 2, val >> 16);
  44. }
  45. #define GET_LE32(p) DVAL_LH(p,0)
  46. #define PUT_LE32(p,v) DSET_LH(p,0,v)
  47. #endif
  48. static void nwsign(char *r_data1, char *r_data2, char *outdata) {
  49.  int i;
  50.  unsigned int w0,w1,w2,w3;
  51.  static int rbit[4]={0, 2, 1, 3};
  52. #ifdef __i386__
  53.  unsigned int *data2=(int *)r_data2;
  54. #else
  55.  unsigned int data2[16];
  56.  for (i=0;i<16;i++)
  57.   data2[i]=GET_LE32(r_data2+(i<<2));
  58. #endif 
  59.  w0=GET_LE32(r_data1);
  60.  w1=GET_LE32(r_data1+4);
  61.  w2=GET_LE32(r_data1+8);
  62.  w3=GET_LE32(r_data1+12);
  63.  for (i=0;i<16;i+=4) {
  64.   w0=rol32(w0 + ((w1 & w2) | ((~w1) & w3)) + data2[i+0],3);
  65.   w3=rol32(w3 + ((w0 & w1) | ((~w0) & w2)) + data2[i+1],7);
  66.   w2=rol32(w2 + ((w3 & w0) | ((~w3) & w1)) + data2[i+2],11);
  67.   w1=rol32(w1 + ((w2 & w3) | ((~w2) & w0)) + data2[i+3],19);
  68.  }
  69.  for (i=0;i<4;i++) {
  70.   w0=rol32(w0 + (((w2 | w3) & w1) | (w2 & w3)) + 0x5a827999 + data2[i+0],3);
  71.   w3=rol32(w3 + (((w1 | w2) & w0) | (w1 & w2)) + 0x5a827999 + data2[i+4],5);
  72.   w2=rol32(w2 + (((w0 | w1) & w3) | (w0 & w1)) + 0x5a827999 + data2[i+8],9);
  73.   w1=rol32(w1 + (((w3 | w0) & w2) | (w3 & w0)) + 0x5a827999 + data2[i+12],13);
  74.  }
  75.  for (i=0;i<4;i++) {
  76.   w0=rol32(w0 + ((w1 ^ w2) ^ w3) + 0x6ed9eba1 + data2[rbit[i]+0],3);
  77.   w3=rol32(w3 + ((w0 ^ w1) ^ w2) + 0x6ed9eba1 + data2[rbit[i]+8],9);
  78.   w2=rol32(w2 + ((w3 ^ w0) ^ w1) + 0x6ed9eba1 + data2[rbit[i]+4],11);
  79.   w1=rol32(w1 + ((w2 ^ w3) ^ w0) + 0x6ed9eba1 + data2[rbit[i]+12],15);
  80.  }
  81.  PUT_LE32(outdata,(w0+GET_LE32(r_data1)) & 0xffffffff);
  82.  PUT_LE32(outdata+4,(w1+GET_LE32(r_data1+4)) & 0xffffffff);
  83.  PUT_LE32(outdata+8,(w2+GET_LE32(r_data1+8)) & 0xffffffff);
  84.  PUT_LE32(outdata+12,(w3+GET_LE32(r_data1+12)) & 0xffffffff);
  85. }
  86. /* Make a signature for the current packet and add it at the end of the */
  87. /* packet. */
  88. void sign_packet(struct ncp_server *server, int *size) {
  89.  char data[64];
  90.  memset(data,0,64);
  91.  memcpy(data,server->sign_root,8);
  92.  PUT_LE32(data+8,(*size));
  93.  memcpy(data+12,server->packet+sizeof(struct ncp_request_header)-1,
  94.   min_t(unsigned int,(*size)-sizeof(struct ncp_request_header)+1,52));
  95.  nwsign(server->sign_last,data,server->sign_last);
  96.  memcpy(server->packet+(*size),server->sign_last,8);
  97.  (*size)+=8;
  98. }
  99. #endif /* CONFIG_NCPFS_PACKET_SIGNING */