在厨房拨开内裤进入毛片-欧美一区亚洲二区-www九九热com-亚洲午夜久久久精品一区二区三剧-国产91精品看黄网站在线观看动漫-heyzo朝桐光一区二区

moecmks
級別: 正式會員
精華主題: 0
發帖數量: 3 個
工控威望: 96 點
下載積分: 648 分
在線時間: 24(小時)
注冊時間: 2017-02-12
最后登錄: 2017-05-19
查看moecmks的 主題 / 回貼
樓主  發表于: 2017-04-24 19:39
先發 FX1S數據讀報文,PLC接受到信號準備數據放到緩沖區。然后在用ReadFile從緩沖區接受一次報文。。。 30 MS左右
這時間正常嗎?還是說我設置有問題?總感覺這樣時間有點長啊。【工控菜鳥一個,放下代碼求老鳥指點一二,有無能提升效率的地方。 ^_^】

復制代碼
  1. #include <Windows.h>
  2. #include "codecb.h"
  3. #include "invariant.h"
  4. #include <assert.h>
  5. #include <tchar.h>
  6. #include "timing.h"
  7. extern HANDLE commport;
  8. _CRT_ALIGN (32)
  9. char ASCII_tonums_RVlut[0xFFFF+1];
  10. void build_ASC_RVlut (void)
  11. {
  12.   uint32_t ii;
  13.   static BOOL __init = FALSE;
  14.   if ( __init == TRUE) return;
  15.        __init  = TRUE;
  16.   ZeroMemory (ASCII_tonums_RVlut, sizeof (ASCII_tonums_RVlut));
  17.   for (ii = 0; ii != 0x10000; ii++) {
  18.    uint16_t lo = ii & 0x00FF;
  19.    uint16_t hi = ii >> 8;
  20.    if ( (( lo >= '0' && lo <= '9') || ( lo >= 'A' && lo <= 'F'))
  21.     && (( hi >= '0' && hi <= '9') || ( hi >= 'A' && hi <= 'F')))
  22.    {
  23.     if ( ( hi >= '0' && hi <= '9'))
  24.       ASCII_tonums_RVlut[ii] = hi - '0';
  25.     else if ( ( hi >= 'A' && hi <= 'F'))
  26.       ASCII_tonums_RVlut[ii] = hi - 'A' + 10;
  27.     if ( ( lo >= '0' && lo <= '9'))
  28.       ASCII_tonums_RVlut[ii] |= ( ( (unsigned) (lo - '0')) << 4);
  29.     else if ( ( lo >= 'A' && lo <= 'F'))
  30.       ASCII_tonums_RVlut[ii] |= ( ( (unsigned) (lo - 'A' + 10)) << 4);
  31.    }
  32.   }
  33. }
  34. BOOL comm_init (int comm_index)
  35. {
  36.   DCB dcbs;
  37.   COMMTIMEOUTS ct;  
  38.   BOOL success_io_;
  39.   TCHAR comm_buf0[256];
  40.   _stprintf (& comm_buf0[0], _T ("//./COM%i"), comm_index);
  41.   comm_close ();
  42.   commport = CreateFile ( & comm_buf0[0], GENERIC_READ | GENERIC_WRITE, 0,
  43.               NULL, OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL, NULL );
  44.   success_io_ = GetCommState (commport, & dcbs);
  45.   assert (success_io_ != FALSE);
  46.   dcbs.BaudRate = CBR_9600;
  47.   dcbs.fParity  = TRUE;
  48.   dcbs.Parity   = EVENPARITY;
  49.   dcbs.StopBits = ONESTOPBIT;
  50.   dcbs.ByteSize = 7;
  51.   dcbs.fDtrControl = DTR_CONTROL_DISABLE;
  52.   dcbs.fRtsControl = RTS_CONTROL_DISABLE;
  53.     
  54.   success_io_ = SetupComm (commport, 2048, 2048);
  55.   assert (success_io_ != FALSE);
  56.   success_io_ = SetCommState (commport, & dcbs);
  57.   assert (success_io_ != FALSE);
  58.   // SetTimeOut.
  59.   ct.ReadIntervalTimeout = 0x0000FFFF;
  60.   ct.ReadTotalTimeoutMultiplier = 0x0000FFFF;
  61.   ct.ReadTotalTimeoutConstant = 0xFFFFFFFE;
  62.   ct.WriteTotalTimeoutMultiplier = 0x0000FFFF;
  63.   ct.WriteTotalTimeoutConstant =   0xFFFFFFFE;  
  64.   
  65.   success_io_ = SetCommTimeouts (commport, &ct);  
  66.   assert (success_io_ != FALSE);
  67.   success_io_ = SetupComm (commport, 2400, 2400);  
  68.   assert (success_io_ != FALSE);
  69.   success_io_ = PurgeComm (commport, PURGE_RXABORT | PURGE_TXCLEAR | PURGE_RXCLEAR | PURGE_TXABORT);
  70.   assert (success_io_ != FALSE);
  71.   build_ASC_RVlut ();
  72.   
  73.   timing_init48 ();
  74.   INIT_WSCCRSEC__;
  75. }
  76. void comm_close (void)
  77. {
  78.   if (commport != INVALID_HANDLE_VALUE)
  79.   {
  80.     PurgeComm (commport, PURGE_RXABORT | PURGE_TXCLEAR | PURGE_RXCLEAR | PURGE_TXABORT);
  81.     CloseHandle (commport);
  82.   }
  83.   commport = INVALID_HANDLE_VALUE;
  84. }
  85. int8_t readOYB (int16_t e_addr) {
  86.   struct read_section2 rdsec;
  87.   char varsbuf[128];
  88.   int isr = 0;
  89.   int tm_numbs = 0;
  90.   uint16_t rv_numbs = 0;
  91.   BOOL io_success_;
  92.   DWORD rv_numbs2 = 0;
  93.   /* prepare Output-register read_section. */
  94.   isr = fx1s_makersecb ( & rdsec, FX1S_REGISTER_FIELD_Y_OUT,
  95.         & rv_numbs, FX1S_VERSION_30MR, e_addr);
  96.   assert (isr == FX1S_OK);
  97.   /* write Output-register read-code. */
  98.   io_success_ = WriteFile (commport, & rdsec,
  99.      sizeof(struct read_section), & tm_numbs, NULL);
  100.   assert (io_success_ != FALSE);
  101.   assert (tm_numbs == sizeof(struct read_section));
  102.   io_success_ = ReadFile  (commport, & varsbuf[0], rv_numbs, & rv_numbs2, NULL);
  103.   assert (io_success_ != FALSE);
  104.   assert (rv_numbs2 == rv_numbs);
  105.   assert (varsbuf[0] == SECTION_LINK_STX);
  106.   return ASCII_tonums_RVlut[ *(uint16_t *)& varsbuf[1]];
  107. }
  108. void setOYB (int16_t e_addr, int8_t val) {
  109.   char varsbuf[128];
  110.   int isr = 0;
  111.   int tm_numbs = 0;
  112.   uint16_t rv_numbs = 0;
  113.   BOOL io_success_;
  114.   DWORD rv_numbs2 = 0;
  115.   /* prepare Output-register write_section. */
  116.   isr = fx1s_makewsecb (& varsbuf[0], & val, FX1S_REGISTER_FIELD_Y_OUT,
  117.               & rv_numbs, FX1S_VERSION_30MR, e_addr);
  118.   assert (isr == FX1S_OK);
  119.   /* write Output-register write-code. */
  120.   io_success_ = WriteFile (commport, & varsbuf[0],
  121.      rv_numbs, & tm_numbs, NULL);
  122.   assert (io_success_ != FALSE);
  123.   assert (rv_numbs == tm_numbs);
  124.   io_success_ = ReadFile  (commport, & varsbuf[0], 1, & rv_numbs2, NULL);
  125.   assert (io_success_ != FALSE);
  126.   assert (rv_numbs2 == 1);
  127.   assert (varsbuf[0] == SECTION_LINK_ACK);
  128. }
  129. static __forceinline
  130. int8_t readRELAY_M (int16_t addr) {
  131.   struct read_section2 rdsec;
  132.   char varsbuf[128];
  133.   int isr = 0;
  134.   int tm_numbs = 0;
  135.   uint16_t rv_numbs = 0;
  136.   BOOL io_success_;
  137.   DWORD rv_numbs2;
  138.   isr = fx1s_makersecb ( & rdsec, FX1S_REGISTER_FIELD_M,
  139.         & rv_numbs, FX1S_VERSION_14MR, addr);
  140.   assert (isr == FX1S_OK);
  141.   io_success_ = WriteFile (commport, & rdsec,
  142.      sizeof(struct read_section), & tm_numbs, NULL);
  143.   assert (io_success_ != FALSE);
  144.   assert (tm_numbs == sizeof(struct read_section));
  145.   io_success_ = ReadFile  (commport, & varsbuf[0], rv_numbs, & rv_numbs2, NULL);
  146.   assert (io_success_ != FALSE);
  147.   assert (rv_numbs2 == rv_numbs);
  148.   assert (varsbuf[0] == SECTION_LINK_STX);
  149.   return ASCII_tonums_RVlut[ *(uint16_t *)& varsbuf[1]];
  150. }
  151. static  __forceinline
  152. void writeRELAY_M (uint16_t addr, int8_t val) {
  153.   char varsbuf[128];
  154.   int isr = 0;
  155.   int tm_numbs = 0;
  156.   uint16_t rv_numbs = 0;
  157.   BOOL io_success_;
  158.   DWORD rv_numbs2;
  159.   /* prepare Output-register write_section. */
  160.   isr = fx1s_makewsecb (& varsbuf[0], & val, FX1S_REGISTER_FIELD_M,
  161.               & rv_numbs, FX1S_VERSION_14MR, addr);
  162.   assert (isr == FX1S_OK);
  163.   /* write Output-register write-code. */
  164.   io_success_ = WriteFile (commport, & varsbuf[0],
  165.      rv_numbs, & tm_numbs, NULL);
  166.   assert (io_success_ != FALSE);
  167.   assert (rv_numbs == tm_numbs);
  168.   io_success_ = ReadFile  (commport, & varsbuf[0], 1, & rv_numbs2, NULL);
  169.   assert (io_success_ != FALSE);
  170.   assert (rv_numbs2 == 1);
  171.   assert (varsbuf[0] == SECTION_LINK_ACK);
  172. }
  173. void plc_force_close_ (void) {
  174.   BYTE obt;
  175.     /* force close PLC [by M8037]  **/
  176.     obt = readRELAY_M (8037);
  177.     writeRELAY_M (8037, obt | 0x20);
  178. }
  179. void plc_force_open_ (void) {
  180.   BYTE obt;
  181.   /* force open PLC [by M8035/M8036/M8037]  **/
  182.   obt = readRELAY_M (8037);
  183.   obt &= ~(1 << (8037 & 7));
  184.   writeRELAY_M (8037, obt);
  185.   obt = readRELAY_M (8035);
  186.   obt |= (11 << (8035 & 7));
  187.   writeRELAY_M (8035, obt);
  188. }
  189. void plc_set_pulse235_ (uint32_t val) {
  190.   int isr = 0;
  191.   char varsbuf[128];
  192.   uint16_t rv_numbs = 0;
  193.   DWORD rv_numbs2 = 0;
  194.   DWORD rv_numbs3 = 0;
  195.   BOOL io_success_;
  196.   isr = fx1s_makewsecb (& varsbuf[0], & val, FX1S_REGISTER_FIELD_C32,
  197.               & rv_numbs, FX1S_VERSION_14MR, PULSE_ENCODER_ADDR);
  198.   assert (isr == FX1S_OK);
  199.   rv_numbs2 = rv_numbs;
  200.   io_success_ = WriteFile (commport, & varsbuf[0], rv_numbs, & rv_numbs3, NULL);
  201.   assert (io_success_ != FALSE);
  202.   assert (rv_numbs2 == rv_numbs3);
  203.   io_success_ = ReadFile  (commport, & varsbuf[0], 1, & rv_numbs2, NULL);
  204.   assert (io_success_ != FALSE);
  205.   assert (rv_numbs2 == 1);
  206.   assert (varsbuf[0] == SECTION_LINK_ACK);
  207. }
  208. uint32_t plc_get_pulse235_ (void) {
  209.   union {
  210.     char bgroup[4];
  211.     int32_t inter;
  212.   } cc_timing;
  213.   BOOL io_success_;
  214.   DWORD rv_numbs = 0;
  215.   BYTE varsbuf[128];
  216.   io_success_ = WriteFile (commport, & g_crs2_pulse235.rsc, sizeof (struct read_section), & rv_numbs, NULL);
  217.   assert (io_success_ != FALSE);
  218.   assert (rv_numbs == sizeof (struct read_section));
  219.   io_success_ = ReadFile  (commport, & varsbuf [0], g_crs2_pulse235.rsc_cnt, & rv_numbs, NULL);
  220.   assert (io_success_ != FALSE);
  221.   assert (rv_numbs == g_crs2_pulse235.rsc_cnt);
  222.   assert (varsbuf[0] == SECTION_LINK_STX);
  223.   assert (varsbuf[9] == SECTION_LINK_ETX);
  224.   cc_timing.bgroup[0] = ASCII_tonums_RVlut[ *(uint16_t *)& varsbuf[1]];
  225.   cc_timing.bgroup[1] = ASCII_tonums_RVlut[ *(uint16_t *)& varsbuf[3]];
  226.   cc_timing.bgroup[2] = ASCII_tonums_RVlut[ *(uint16_t *)& varsbuf[5]];
  227.   cc_timing.bgroup[3] = ASCII_tonums_RVlut[ *(uint16_t *)& varsbuf[7]];
  228.   return cc_timing.inter;
  229. }


moecmks
級別: 正式會員
精華主題: 0
發帖數量: 3 個
工控威望: 96 點
下載積分: 648 分
在線時間: 24(小時)
注冊時間: 2017-02-12
最后登錄: 2017-05-19
查看moecmks的 主題 / 回貼
1樓  發表于: 2017-04-24 19:48
FX1S 報文編解碼
復制代碼
  1. /*-
  2. * Copyright (c) 2017 moecmks
  3. * All rights reserved.
  4. *
  5. * Redistribution and use in source and binary forms, with or without
  6. * modification, are permitted provided that the following conditions
  7. * are met:
  8. * 1. Redistributions of source code must retain the above copyright
  9. *    notice, this list of conditions and the following disclaimer.
  10. * 2. Redistributions in binary form must reproduce the above copyright
  11. *    notice, this list of conditions and the following disclaimer in the
  12. *    documentation and/or other materials provided with the distribution.
  13. *
  14. * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15. * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16. * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17. * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  18. * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19. * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20. * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRCMD, STRICT
  22. * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23. * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24. * SUCH DAMAGE.
  25. *
  26. */
  27. #if !defined (codec_included_MOECMKS)
  28. #define codec_included_MOECMKS
  29. /*
  30. * fx1s read/write codec.
  31. * simple, each read a current register size unit memory
  32. * more information, please refer to the PLC manual and Internet resources.
  33. */
  34. #if defined (__cplusplus)  /** __cplusplus */
  35. extern "C" {
  36. #endif  /** __cplusplus */
  37. /* Portable fixed length ***/
  38. #include "stdint.h"
  39. /*
  40. * errror code
  41. */
  42. #define FX1S_RANGE 1
  43. #define FX1S_FAIL 2
  44. #define FX1S_KFAIL 3
  45. #define FX1S_UNKN 4
  46. #define FX1S_LIMIT 5
  47. #define FX1S_NAK 6
  48. #define FX1S_ACK 7
  49. #define FX1S_PARA 8
  50. #define FX1S_INCOP 9
  51. #define FX1S_OK 0
  52. /*
  53. * version control
  54. */
  55. enum FX1S_VERSION {
  56.   FX1S_VERSION_10MR = 0,
  57.   FX1S_VERSION_14MR,
  58.   FX1S_VERSION_20MR,
  59.   FX1S_VERSION_30MR,
  60.   FX1S_VERSION_OVERFLAGS
  61. };
  62. /*
  63. * register field.
  64. * Ignore T bit register and set register.
  65. * Ignore C bit register
  66. */
  67. enum FX1S_REGISTER_FIELD {
  68.   FX1S_REGISTER_FIELD_S = 0,
  69.   FX1S_REGISTER_FIELD_X,
  70.   FX1S_REGISTER_FIELD_Y_OUT,
  71.   FX1S_REGISTER_FIELD_Y_PLS,
  72.   FX1S_REGISTER_FIELD_D,
  73.   FX1S_REGISTER_FIELD_T,
  74.   FX1S_REGISTER_FIELD_M,
  75.   FX1S_REGISTER_FIELD_C16,
  76.   FX1S_REGISTER_FIELD_C32,
  77.   FX1S_REGISTER_FIELD_CRESET
  78. };
  79. /*
  80. * section .link code
  81. */
  82. #define SECTION_LINK_STX 0x02 /* PLC info-section begin flags. */
  83. #define SECTION_LINK_ETX 0x03 /* PLC info-section end flags .***/
  84. #define SECTION_LINK_EOT 0x03 /* .***/
  85. #define SECTION_LINK_ENQ 0x05 /* PLC only test enable */
  86. #define SECTION_LINK_ACK 0x06 /* PLC reply "can do" */
  87. #define SECTION_LINK_LF 0x0A /* .***/
  88. #define SECTION_LINK_CL 0x0C /* .***/
  89. #define SECTION_LINK_CR 0x0D /* .***/
  90. #define SECTION_LINK_NAK 0x15 /* PLC reply "bad things" */
  91. /*
  92. * section cmdion.
  93. */
  94. #define SECTION_CMD_READ      '0' /* .***/
  95. #define SECTION_CMD_WRITE     '1' /* .***/
  96. #define SECTION_CMD_FORCE_ON  '7' /* .***/
  97. #define SECTION_CMD_FORCE_OFF '8' /* .***/
  98. /*
  99. * read section
  100. */
  101. struct read_section {
  102.   uint8_t stx; /* read_section's stdhead. always SECTIOM_LINK_STX */
  103.   uint8_t cmd; /* read_section's cmd  always SECTIOM_CMD_READ  */
  104.   uint8_t unit_address[4];  /* read_section's address*/
  105.   uint8_t numb[2];          /* read's byte count. simple always one */
  106.   uint8_t etx;    /* read_section's stdend.   always SECTION_LINK_ETX  */
  107.   uint8_t crc[2]; /* correcting code*/
  108. };
  109. /*
  110. * read section2
  111. */
  112. struct read_section2 {
  113.   uint8_t stx; /* read_section's stdhead. always SECTIOM_LINK_STX */
  114.   uint8_t cmd; /* read_section's cmd  always SECTIOM_CMD_READ  */
  115.   uint8_t unit_address[4];  /* read_section's address*/
  116.   uint8_t numb[2];          /* read's byte count. simple always one */
  117.   uint8_t etx;    /* read_section's stdend.   always SECTION_LINK_ETX  */
  118.   uint8_t crc[2]; /* correcting code*/
  119.   uint8_t crce; /* easy to read..**/
  120.   uint16_t opbsize; /******/
  121.   uint8_t opboff; /* for bit register(X, Y, M.) **/
  122.   uint16_t opbaddr; /* easy to read. **/
  123. };
  124. /*
  125. * write section
  126. */
  127. struct write_section {
  128.   uint8_t stx; /* write_section's stdhead.  always SECTIOM_LINK_STX */
  129.   uint8_t cmd; /* write_section's cmd  always SECTIOM_CMD_WRITE   */
  130.   uint8_t unit_address[4]; /* write_section's address*/
  131.   uint8_t numb[2]; /* write's byte count.. must <= 64  */
  132.   uint8_t etx; /* write_section's stdend. */
  133.   uint8_t crc[2]; /* correcting code*/
  134.   uint8_t crce; /* easy to read..**/
  135.   uint8_t obpoff; /* for bit register(X, Y, M.) **/
  136.   uint16_t opbaddr; /* easy to read. **/
  137. };
  138. /*
  139. * force section
  140. */
  141. struct force_section {
  142.   uint8_t stx; /* force_section's stdhead.  always SECTIOM_LINK_STX */
  143.   uint8_t cmd; /* force_section's cmd  always SECTIOM_CMD_FORCE_OFF or SECTIOM_CMD_FORCE_ON   */
  144.   uint8_t unit_address[4]; /* force_section's address*/
  145.   uint8_t etx; /* force_section's stdend. */
  146.   uint8_t crc[2]; /* correcting code*/
  147. };
  148. /*
  149. * Accept the write section is very simple,
  150. * if successful send SECTION_LINK_ACK otherwise SECTION_LINK_NAK
  151. */
  152. int fx1s_makersecb (struct read_section2 *rsec, /* write to the serial port, use the size of the read_section */
  153.                          enum FX1S_REGISTER_FIELD rf, uint16_t  *rvap_size,
  154.                          enum FX1S_VERSION ver, uint16_t address);
  155. int fx1s_makewsecb (void *wsec, /* Variable size structure, so use void *, please understand **/
  156.                    void *spval,
  157.                          enum FX1S_REGISTER_FIELD rf, uint16_t  *wsec_size,
  158.                          enum FX1S_VERSION ver, uint16_t address);
  159. int fx1s_makefsecb (struct force_section *fsec,
  160.                          enum FX1S_REGISTER_FIELD rf,
  161.                          enum FX1S_VERSION ver, uint16_t address);            
  162. #if defined (__cplusplus)  /** __cplusplus */
  163. }
  164. #endif  /** __cplusplus */
  165. #endif /* codec_included_MOECMKS */
moecmks
級別: 正式會員
精華主題: 0
發帖數量: 3 個
工控威望: 96 點
下載積分: 648 分
在線時間: 24(小時)
注冊時間: 2017-02-12
最后登錄: 2017-05-19
查看moecmks的 主題 / 回貼
2樓  發表于: 2017-04-24 19:52
復制代碼
  1. /*-
  2. * Copyright (c) 2017 moecmks
  3. * All rights reserved.
  4. *
  5. * Redistribution and use in source and binary forms, with or without
  6. * modification, are permitted provided that the following conditions
  7. * are met:
  8. * 1. Redistributions of source code must retain the above copyright
  9. *    notice, this list of conditions and the following disclaimer.
  10. * 2. Redistributions in binary form must reproduce the above copyright
  11. *    notice, this list of conditions and the following disclaimer in the
  12. *    documentation and/or other materials provided with the distribution.
  13. *
  14. * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  15. * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  16. * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  17. * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  18. * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  19. * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  20. * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  21. * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  22. * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  23. * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  24. * SUCH DAMAGE.
  25. *
  26. */
  27. #include <assert.h>
  28. #include <string.h>
  29. #include "codecb.h"
  30. /* Convert characters to specific number - noexport */
  31. static
  32. char ascii_to_num (char ch) {
  33.   /* e.g.
  34.    *  source '9' -> target 9
  35.    *  source 'A' -> target 10
  36.    *  source '1' -> target 1
  37.    *  source 'a' -> (nondone, Don't use lowercase letters in fx1s-14mr-001).
  38.    */
  39.   if (ch >= '0' && ch <= '9')
  40.     return (ch - '0');
  41.   if (ch >= 'A' && ch <= 'F')
  42.     return (ch - ('A' - 10));
  43.   else
  44.     assert (0);
  45.   return ch;
  46. }
  47. /* Convert number to specific characters - noexport */
  48. static
  49. char num_to_ascii (char ch) {
  50.   /* e.g.
  51.    *  source 9 -> target '9'
  52.    *  source A -> target '0'
  53.    *  source 1 -> target '1'
  54.    *  source a -> (nondone, Don't use lowercase letters in fx1s-14mr-001).
  55.    */
  56.   if (ch >= 0x00 && ch <= 0x09)
  57.     return (ch + '0');
  58.   if (ch >= 0x0A && ch <= 0x0F)
  59.     return (ch + ('A' - 10));
  60.   else
  61.     assert (0);
  62.   return ch;
  63. }
  64. /* XXX:L-endian.
  65. */
  66. static
  67. uint16_t vailed8 (uint16_t nums) {
  68.   
  69.   /* e.g.
  70.    * 1234 vailed.
  71.    * 9000 invailed.
  72.    * 1007 vailed.
  73.    * 1811 invailed.
  74.    * 0 ~ 65535
  75.    */
  76.    uint16_t d0 = nums % 10 >> 0;
  77.    uint16_t d1 = nums % 100 / 10;
  78.    uint16_t d2 = nums % 1000 / 100;
  79.    uint16_t d3 = nums % 10000 / 1000;
  80.   
  81.    if ( d0 > 7 || d1 > 7)
  82.      return -1;
  83.    if ( d2 > 7)
  84.      return -1;
  85.    return d0 + d1 * 8 + d2 * 8 * 8 + d3 * 8 * 8 * 8;
  86. }
  87. static
  88. uint8_t fxcrc_adjust (unsigned char *crcbuf, uint32_t num) {
  89.   
  90.   uint32_t s= 0;
  91.   uint32_t st = 0;
  92.   
  93.   for (; s != num; s++)
  94.     st += crcbuf[s];
  95.   /* we only save lowest bit's byte **/
  96.   return st & 0xFF;
  97. }
  98. static /* we not check numb cross register **.**/
  99. uint32_t fxcalc_addru (enum FXREGS_FIELD reg, uint16_t addr,
  100.                            enum FX1S_VERSION ver,
  101.                            uint16_t  *opbsize,
  102.                                 uint16_t *raddr, unsigned char *dboff) {
  103.   
  104.   static const /* XXX:enum constant dependence **/
  105.                    uint16_t xmax_tab[4] = { 6, 8, 12, 16 };
  106.   static const /* XXX:enum constant dependence **/
  107.                    uint16_t ymax_tab[4] = { 4, 6, 8, 14 };
  108.   uint16_t addr0 = 0x00A0;
  109.   uint16_t eig = vailed8 (addr);
  110.   uint8_t off = -1;
  111.   uint32_t opbsize0 = 2;
  112.   switch (reg) {
  113.     
  114.   case FX1S_REGISTER_FIELD_D:
  115.   
  116.     if (addr <= 127 && addr == addr) /* numbers: 128, normal use */
  117.       addr0 = 0x1000 + addr * 2;
  118.     else if (addr <= 255) /* numbers: 128, save use */
  119.       addr0 = 0x1000 + addr * 2;
  120.     else if (addr >= 1000 && addr <= 2499)  /* numbers: 1500, file register */
  121.       addr0 = 0x1000 + addr * 2;
  122.     else if (addr >= 8000 && addr <= 8255) /* numbers: 256, special IO port */
  123.       addr0 = 0x0E00 + (addr - 8000) * 2;
  124.     else  /* Illegal access */
  125.       return FX1S_RANGE;
  126.     break;
  127.   case FX1S_REGISTER_FIELD_X:
  128.     /*
  129.      * Check the number of available X-coils according to the PLC version
  130.      */
  131.     if ((eig = vailed8 (addr)) == -1
  132.      || (eig >= xmax_tab[ver]) )
  133.       return FX1S_PARA;
  134.       
  135.     addr0 = 0x0080 + eig / 8;
  136.     off = eig & 7;
  137.     
  138.     opbsize0 = 1;
  139.     break;
  140.     
  141.   case FX1S_REGISTER_FIELD_Y_PLS:
  142.     addr0 += 0x0200;
  143.   case FX1S_REGISTER_FIELD_Y_OUT:
  144.   
  145.     /*
  146.      * Check the number of available Y-coils according to the PLC version
  147.      */
  148.     if ((eig = vailed8 (addr)) == -1)
  149.       return FX1S_PARA;
  150.     
  151.     addr0 += eig / 8;
  152.     off = eig & 7;
  153.     
  154.     opbsize0 = 1;
  155.     break;
  156.   case FX1S_REGISTER_FIELD_S:
  157.   
  158.     if ((addr >=  128)) /* numbers:128, status register **/
  159.       return FX1S_RANGE;
  160.     addr0 = addr / 8;
  161.     off = addr & 7;
  162.     
  163.     opbsize0 = 1;
  164.     break;
  165.   
  166.   case FX1S_REGISTER_FIELD_T:
  167.   
  168.     if ( (addr <=  63)) /* numbers:64, 100ms or 10ms M8028/D8030/D8031 **/
  169.       addr0 = 0x0800 + addr * 2;
  170.     else    
  171.       return FX1S_RANGE;
  172.     break;
  173.     
  174.   case FX1S_REGISTER_FIELD_M:
  175.   
  176.     if (addr < 384) /* numbers: 384, normal use */
  177.       addr0 = 0x0100 + addr / 8;
  178.     else if (addr < 512) /* numbers: 512, save use */
  179.       addr0 = 0x0100 + addr / 8;
  180.     else if (addr >= 8000 && addr < 8256) /* numbers: 256, special IO port */
  181.       addr0 = 0x01E0 + (addr - 8000) / 8;
  182.     else /* Illegal access */
  183.       return FX1S_RANGE;
  184.     
  185.     off = addr & 7;
  186.     opbsize0 = 1;
  187.     break;
  188.   
  189.   case FX1S_REGISTER_FIELD_C16:
  190.   
  191.     if (addr < 16) /* numbers: 16, normal use */
  192.       addr0 = 0x0A00 + addr * 2;
  193.     else if (addr < 32) /* numbers: 16, save use */
  194.       addr0 = 0x0A00 + addr * 2;
  195.     else /* Illegal access */
  196.       return FX1S_RANGE;
  197.     break;
  198.     
  199.   case FX1S_REGISTER_FIELD_C32:
  200.   
  201.    /* for C32 high speed registers,
  202.     * we only perform some basic checks, please note
  203.     **/
  204.     if (addr > 200 && addr <= 255)
  205.       addr0 = 0x0C00 + (addr - 200) * 4;
  206.     else /* Illegal access */
  207.       return FX1S_RANGE;
  208.       
  209.     opbsize0 = 4;
  210.     break;
  211.   
  212.   case FX1S_REGISTER_FIELD_CRESET:
  213.   
  214.     if (addr <= 255)
  215.       addr0 = 0x03C0 + addr / 8;
  216.     else /* Illegal access */
  217.       return FX1S_RANGE;
  218.       
  219.     opbsize0 = 1;
  220.     break;
  221.     
  222.   default:
  223.       return FX1S_PARA;
  224.   }
  225.   
  226.   *raddr = addr0;
  227.   *dboff = off;
  228.   *opbsize = opbsize0;
  229.   return FX1S_OK;
  230. }
  231. int fx1s_makersecb (struct read_section2 *rsec, /* write to the serial port, use the size of the read_section */
  232.                          enum FX1S_REGISTER_FIELD rf, uint16_t  *rvap_size,
  233.                          enum FX1S_VERSION ver, uint16_t address)
  234. {
  235.   struct read_section2 sec;
  236.   uint32_t e;
  237.   
  238.   /** phase 1:fill stdhead/stdend flags and cmd, rread count,s */
  239.   sec.stx = SECTION_LINK_STX;
  240.   sec.etx = SECTION_LINK_ETX;
  241.   sec.cmd = SECTION_CMD_READ;
  242.   /** phase 2:calc address for register and current PLC version */
  243.   e = fxcalc_addru (rf, address, ver, & sec.opbsize, & sec.opbaddr, & sec.opboff);
  244.   if (e != FX1S_OK)
  245.     return e;
  246.   else
  247.    *rvap_size = sizeof (sec.stx) +
  248.                 sizeof (sec.crc)+ sizeof (sec.etx) + sec.opbsize * 2;
  249.   /** phase 3:fill numb ascii, * */
  250.   sec.numb[0] = num_to_ascii ( (sec.opbsize  & 0xF0) >>4);
  251.   sec.numb[1] = num_to_ascii ( (sec.opbsize  & 0x0F) >>0);
  252.   
  253.   /** phase 4:fill address ascii, * */
  254.   sec.unit_address[0] = num_to_ascii ( (sec.opbaddr  & 0xF000) >>12);
  255.   sec.unit_address[1] = num_to_ascii ( (sec.opbaddr  & 0x0F00) >> 8);
  256.   sec.unit_address[2] = num_to_ascii ( (sec.opbaddr  & 0x00F0) >> 4);
  257.   sec.unit_address[3] = num_to_ascii ( (sec.opbaddr  & 0x000F) >> 0);
  258.   
  259.   /** phase 5:crc adjust, fill ascii buf * */
  260.   sec.crce = fxcrc_adjust (& sec.cmd, sizeof (sec.cmd) + sizeof (sec.unit_address)
  261.                                         + sizeof (sec.numb)
  262.                                         + sizeof (sec.etx));
  263.   sec.crc[0] = num_to_ascii ( (sec.crce  & 0xF0) >> 4);
  264.   sec.crc[1] = num_to_ascii ( (sec.crce  & 0x0F) >> 0);
  265.   
  266.   memcpy (rsec, & sec, sizeof (sec));
  267.   return FX1S_OK;  
  268. }
  269. int fx1s_makewsecb (void *wsec, /* Variable size structure, so use void *, please understand **/
  270.                    void *buf, /* wsec size == sizeof(wc) * 2  **/
  271.                          enum FX1S_REGISTER_FIELD rf, uint16_t *wsec_size,
  272.                          enum FX1S_VERSION ver, uint16_t address)
  273. {
  274.   uint16_t opbsize, opbaddr;
  275.   char obpoff;
  276.   char varsbuf[256];
  277.   char *as = buf, cs;
  278.   uint32_t e;
  279.   uint32_t s = 0;
  280.   struct write_section *secp = wsec;
  281.   struct write_section *secdp = (void *)varsbuf;
  282.   /** phase 1:fill stdhead flags and cmd */
  283.   secdp->stx = SECTION_LINK_STX;
  284.   secdp->cmd = SECTION_CMD_WRITE;
  285.   /** phase 2:calc address for register and current PLC version */
  286.   e = fxcalc_addru (rf, address, ver, & opbsize, & opbaddr, & obpoff);
  287.   if (e != FX1S_OK)
  288.     return e;
  289.   else
  290.     *wsec_size = sizeof (struct write_section) + opbsize * 2;
  291.   /** phase 3:fill numb ascii, * */
  292.   secdp->numb[0] = num_to_ascii ( (opbsize  & 0xF0) >>4);
  293.   secdp->numb[1] = num_to_ascii ( (opbsize  & 0x0F) >>0);
  294.   
  295.   /** phase 4:fill address ascii, * */
  296.   secdp->unit_address[0] = num_to_ascii ( (opbaddr  & 0xF000) >>12);
  297.   secdp->unit_address[1] = num_to_ascii ( (opbaddr  & 0x0F00) >> 8);
  298.   secdp->unit_address[2] = num_to_ascii ( (opbaddr  & 0x00F0) >> 4);
  299.   secdp->unit_address[3] = num_to_ascii ( (opbaddr  & 0x000F) >> 0);
  300.   
  301.   /** phase 5:fill variable buffer, * */
  302.   for ( ; s != opbsize; s++) {
  303.     unsigned char  temp = as[s];
  304.     char  tmphi = num_to_ascii (temp >> 4);
  305.     char  tmplo = num_to_ascii (temp & 15);
  306.     
  307.     secdp->numb[2+s*2+0] = tmphi;
  308.     secdp->numb[2+s*2+1] = tmplo;
  309.   }
  310.   /** phase 6:crc adjust, fill ascii buf * */
  311.   secdp->numb[2+opbsize*2] = SECTION_LINK_ETX;
  312.   
  313.   cs = fxcrc_adjust (& secdp->cmd, opbsize * 2 + sizeof (secp->cmd) + sizeof (secp->unit_address)
  314.                                         + sizeof (secp->numb)
  315.                                         + sizeof (secp->etx));
  316.   secdp->numb[2+opbsize*2+1] = num_to_ascii ( (cs  & 0xF0) >> 4);
  317.   secdp->numb[2+opbsize*2+2] = num_to_ascii ( (cs  & 0x0F) >> 0);
  318.   
  319.   memcpy (wsec, & varsbuf, *wsec_size);
  320.   return FX1S_OK;
  321. }
  322. uint32_t fx1s_cmprvpack (void *raccbuf, /* Variable size structure, so use void *, please understand **/
  323.                          uint16_t rc, void **ascii_buf, uint16_t *opbsize
  324.                          , uint16_t *stdpos)
  325. {
  326.   char *varsbuf = raccbuf;
  327.   uint16_t c = 0;
  328.   char stx_find = 0;
  329.   uint16_t stdpos0 = -1;
  330.   
  331.   /* we find SECTION_LINK_NAK or SECTION_LINK_STX at first **/
  332.   for (; c != rc; c++)
  333.    {
  334.      if (varsbuf[c] == SECTION_LINK_NAK)
  335.        return FX1S_NAK;
  336.      if (varsbuf[c] == SECTION_LINK_STX)
  337.       {
  338.         /* second, we check SECTION_LINK_ETX in buffer **/
  339.         stx_find = 1;
  340.         stdpos0 = c + 1;
  341.       }  
  342.      if (varsbuf[c] == SECTION_LINK_ETX && stx_find == 1)
  343.       {
  344.         /* exist CRC byte ??**/
  345.         if ((c + 2) >= rc)
  346.           return FX1S_INCOP;
  347.         /* calculate, compare the CRC code **/
  348.         {
  349.       # if 0
  350.       # else
  351.           *ascii_buf = & varsbuf[stdpos0];
  352.           *opbsize = c - stdpos0;
  353.           *stdpos = stdpos0;
  354.           return FX1S_OK;
  355.       # endif    
  356.         }
  357.       }
  358.    }
  359.   
  360.    return FX1S_INCOP;
  361. }                    
  362. uint32_t fx1s_decrvsec (void *raccbuf, void *sbuf, uint16_t opbasize) {
  363.   
  364.   char *varsbuf = raccbuf;
  365.   char *ssbuf = sbuf;
  366.   uint16_t c = 0;
  367.   
  368.   if (opbasize % 2 == 1)
  369.     return FX1S_INCOP;
  370.   if (opbasize == 0)
  371.     return FX1S_PARA;
  372.   
  373.   for ( ; c != opbasize; c += 2)
  374.     {
  375.       char tmphi = ascii_to_num (varsbuf[c]) << 4;
  376.       char tmplo = ascii_to_num (varsbuf[c+1]);  
  377.       char temp  =   (tmphi & 0xF0) |    (tmplo & 0x0F);
  378.       
  379.       ssbuf[c>>1] = temp;
  380.     }
  381.     
  382.     return FX1S_OK;
  383. }

主站蜘蛛池模板: 日本精品专区 | 好色先生视频污 | 亚洲最大成人网站 | 2020av视频| 爱爱小视频免费看 | 韩国三级欧美三级国产三级 | 午夜啪啪福利视频 | 成人妇女淫片aaaa视频 | 精品国产乱码久久久久久丨区2区 | 国产人妻大战黑人20p | 久久99精品久久久久久狂牛 | 亚洲 综合 欧美 动漫 丝袜图 | 综合无码一区二区三区 | 又大又粗欧美黑人aaaaa片 | 国产成人8x视频网站入口 | 欧美日韩综合视频 | 欧美顶级少妇做爰hd | 国内精品久久久久影院日本资源 | 国产亚洲精品久久久久丝瓜 | 亚洲自拍偷拍图 | 亚洲精品v天堂中文字幕 | 国产成人a v | 日韩人妻熟女中文字幕a美景之屋 | 很黄的网站在线观看 | 欧美三级久久 | 欧美经典一区二区三区 | 欧美精品自拍偷拍 | 日韩一二三四五区 | 99久久精品一区二区 | 亚洲国色天香卡2卡3卡4 | 黄色高清网站 | 成人福利视频在线观看 | www.超碰| 91精品国产爱久久丝袜脚 | 亚洲七七久久桃花影院 | 久久国产精品二区 | 天堂网中文在线 | 国产精品特级毛片一区二区三区 | 亚洲最大看欧美片网站 | 看毛片网站 | 丰满的人妻hd高清日本 | 亚洲精品一区二区久 | 国产成人无码www免费视频播放 | 亚洲精品久久久口爆吞精 | 国精产品乱码视频一区二区 | 久久精品国产亚洲77777 | 新婚之夜玷污岳丰满少妇在线观看 | 国产成人三级在线观看视频 | 深夜福利免费视频 | 国产成人在线播放 | 亚洲精品久久久久久 | 中文字幕丝袜第1页 | 破了亲妺妺的处免费视频国产 | 国产一区二区三区在线观看免费 | 国产精品黄在线观看免费软件 | 久久精品女人天堂av | 老女人任你躁久久久久久老妇 | 日本亚洲最大的色成网站www | 国产精品99视频 | 懂色av一区二区在线播放 | 国产无遮挡成人免费视频 | 麻豆久久久9性大片 | 国产av久久久久精东av | 国内精品国产三级国产在线专 | 蜜臀av免费一区二区三区久久乐 | 国产精品老热丝在线观看 | 天干夜天干夜天天免费视频 | 色窝窝无码一区二区三区色欲 | 免费a级大片 | 超碰免费97| 制服丝袜一区二区三区 | 国产伦精品一区二区三区四区视频 | 理论片87福利理论电影 | 午夜小视频免费在线观看 | 免费看一级黄色片 | 九一精品视频 | 女同av国产亚洲片bbb及 | 国产精品久久久久久福利一牛影视 | 中文字幕五区 | 国产在线 | 中文 | 九色在线观看视频 | 精品国产乱码一区二 | 日本精品久久久久久草草 | 精品超清无码视频在线观看 | 免费看黄网站在线 | 色一情一区二区三区四区 | 欧美多人片高潮野外做片黑人 | 在线精品视频一区二区三四 | 综合伊人久久 | 亚洲视频综合网 | 麻豆亚洲 | 四虎精品成人免费网站 | 国内揄拍国内精品少妇国语 | 少妇放荡的呻吟干柴烈火动漫 | 特级av毛片免费观看 | 成人永久免费视频 | 天堂av免费在线 | 9999国产精品欧美久久久久久 | 欧美性猛交xxx乱大交3蜜桃 | 日韩无砖专区2021嘟嘟网 | 五月天堂婷婷 | 欧美一区二区三区免费在线观看 | 日本十八少妇毛片视频 | 在线欧美日韩 | 亚欧美在线观看 | 欧美精品网站 | 中国美女毛片 | 日吊视频 | 国产又黄又爽又色的免费 | 日躁夜躁狠狠躁2020 | 免费九九视频 | 操久久久| 国产激情一区二区三区成人免费 | 四川话毛片少妇免费看 | 美女脱了内裤张开腿让男人桶网站 | 伊人免费在线观看 | 91免费在线看 | 中文字幕亚洲中文字幕无码码 | 操操操日日日 | 国产性生交xxxxx无码 | 五月色丁香婷婷网蜜臀av | 天天干天天搞天天射 | 国产亚洲欧美一区二区三区 | 久久久久夜| 一级黄色av| 成人美女黄网站色大色费全看在线观看 | 中文字幕第7页 | 特黄色一级片 | 男人的又粗又长又硬 | 成年入口无限观看免费完整大片 | 国产又粗又硬又大爽黄老大爷视 | 五月天一区二区三区 | 懂色av一区二区 | 51免费动漫网永久入口 | 亚洲日韩视频免费观看 | 国产中文区二暮区2022 | 国产精品十八禁在线观看 | 欧美成年人在线观看 | 欧美又粗又大xxxxbbbb疯狂 | 国产欧美一区二区三区网站 | 久久久久久夜精品精品免费啦 | 成人在线精品 | 日韩欧美一区二区三区四区五区 | 性色欲情网站iwww | 少妇被黑人到高潮喷出白浆 | 欧美日韩一区二区在线观看 | 99午夜| 欧美福利在线观看 | 苍井空张开腿实干12次 | 一级aaa级毛片午夜在线播放 | 青草成人免费视频 | 亚洲第一在线 | 欧美亚洲国产一区二区三区 | 国产精品久久久久久人妻精品动漫 | 色久影院| 亚洲深夜视频 | 亚洲国产精久久久久久久 | 国产精欧美一区二区三区 | 国产成人精品自拍 | a级毛片国产| 538任你躁精品视频网免费 | 成人毛片一级 | 亚洲精品国精品久久99热 | 亚洲成人在线视频播放 | 精品一区二区久久久久久久网站 | 一级二级在线观看 | av在线短片 | 成人av手机在线观看 | 久久久影视文化传媒有限公司 | 99国产午夜精品一区二区天美 | 国产又色又爽又黄的 | 免费a级毛片| 一级空姐毛片 | 秋霞福利网 | 少妇超碰 | 欧美18videosex性欧美黑吊 | а√天堂资源8在线官网在线 | 久久久久琪琪去精品色无码 | 久热网站| 国产第七页 | 手机看片日本 | 九色中文字幕 | 成人午夜黄色 | 欧美日韩在线观看成人 | 99免费在线观看 | 国产精品女同 | 99视频在线精品免费观看6 | 亚洲国产精品久久久久婷婷老年 | 亚洲精品国精品久久99热一 | 欧美国产在线看 | 天天干夜夜看 | 91丝袜呻吟高潮美腿白嫩在线观看 | 国产免费a∨片在线观看不卡 | 91pony九色 | 亚洲第一页在线 | av在线一区二区三区四区 | 成人免费观看视频 | 久久久久国色av免费观看性色 | 国产露脸无套对白在线播放 | 午夜精品亚洲 | 超碰日韩 | 久久av色 | 日韩精品一卡2卡3卡4卡乱码的功能 | 亚洲色成人一区二区三区小说 | 国产全肉乱妇杂乱视频男男 | 永井玛利亚 精品 国产 一区 | 精品国精品国产自在久国产应用 | 久久精品欧美一区二区 | 国产黄色在线播放 | 人人妻人人澡人人爽欧美精品 | 中国一级免费毛片 | 噜噜噜久久亚洲精品国产品小说 | 中老年熟妇激情啪啪大屁股 | 香蕉视频二区 | 国产精品一区二区毛片 | xx性欧美肥妇精品久久久久久 | 亚洲国产另类久久久精品性 | 欧美性猛交内射兽交老熟妇 | 欧美做受高潮1 | 国产午夜精品一区二区理论影院 | 国产美女无遮挡裸色视频 | 午夜羞羞影院男女爽爽爽 | 国产精品视频在线观看 | 日韩有码av| 久久精品国产亚洲精品2020 | 99久久99久久 | 午夜三级影院 | 免费国产裸体美女视频全黄 | 一级黄色毛片 | 亚洲国产一区二区视频 | 99久久婷婷国产综合精品青草免费 | 国产午夜福利在线观看视频 | 国产成人免费ā片在线观看老同学 | 十二月综合缴缴情小说 | 国精品人妻无码一区二区三区喝尿 | 国产最爽乱淫视频国语对白 | 91成熟丰满女人少妇 | 国产特级全黄寡妇毛片 | 999国产在线 | 在线视频se| a级国产黄色片 | 少妇公车张开腿迎合巨大视频 | 韩国av毛片| 欧美成人一二区 | 国产免费a∨片在线观看不卡 | 欧美二区乱c黑人 | 欧美日韩在线一区二区三区 | 久久天天躁狠狠躁夜夜躁2014 | 好吊日精品视频 | 日本丰满大乳乳奶 | 天堂资源中文 | 午夜在线观看影院 | 68日本xxxxxxxxx59人 | 午夜小视频在线 | www日韩视频 | 婷婷久久亚洲 | 亚洲区欧美 | 成人综合影院 | 国产美女久久久 | 亚洲无吗视频 | 欧美精品偷自拍另类在线观看 | 久在线播放 | 亚洲色图一区二区三区 | 欧美国产亚洲精品suv | 日韩精品成人 | 欧美色欧美亚洲另类二区 | 国产色婷婷精品综合在线手机播放 | 欧美成年人视频 | 久久精品国产99国产精品亚洲 | av丁香| 夜夜精品无码一区二区三区 | 青青青在线免费观看 | 国产精品久久久久久久久久久久久久久久久久 | 国产精品自在线拍国产手机版 | 国产一区二区三区 | 国产免费又色又爽粗视频 | 国产女人40精品一区毛片视频 | 国产黄大片 | 九色丨porny丨自拍视频 | 精品精品欲天堂导航 | 精品国产亚洲一区 | 日本少妇裸体做爰高潮片 | 91玉足脚交白嫩脚丫在线播放 | 国产精品色综合一区二区三区 | 一本中文字幕 | 日韩不卡毛片 | 国产伦理丿天美传媒av | 亚洲色域网 | 国产一级淫片a级aaa | 亚洲成人高清 | 81精品久久久久久久婷婷 | 不卡三区 | 免费一级做a爰片久久毛片潮 | 色婷五月天 | 欧美亚洲国产一区二区三区 | 人人爱夜夜爽日日做蜜桃 | 国产精品国产片 | 荡女精品导航 | 少妇一级淫片免费视频 | 午夜精品一区二区三区三上悠亚 | 国产盗摄一区二区三区 | 日韩精品一区二 | 亚洲丁香五月天缴情综合 | 国产伦精品一区二区三区在线观看 | 哭悲在线观看免费高清恐怖片段 | 国产成人高清 | 91成人久久| 久久免费看毛片 | 与子敌伦刺激对白播放的优点 | 欧美人妻精品一区二区三区 | 一本色道久久综合狠狠躁篇的优点 | 久久久久国产精品一区 | 欧美顶级毛片在线播放 | 国产精品自在在线午夜免费 | 久久精品国产亚洲一区二区 | 91成人在线看 | 日日噜噜夜夜狠狠久久丁香五月 | 户外少妇对白啪啪野战 | 日本精品久久久久久草草 | 亚洲欧美中文日韩v在线观看 | 国产精品久久久久久久蜜臀 | 麻花传媒mv在线观看 | 亚洲区免费视频 | 九一成人网 | 亚洲一区二区视频在线观看 | 最色成人网 | 亚洲精品码 | 又污又黄又无遮挡的网站 | 午夜精品一区二区三区免费 | 中文字幕亚洲乱码熟女在线萌芽 | 欧美人与禽zozzo性之恋的特点 | 国产成人精品牛牛影视 | 久久久国产精品免费 | 亚洲码欧美码一区二区三区 | 色网在线 | 大肉大捧一进一出好爽视频mba | 人人狠狠综合久久亚洲婷婷 | 夜夜嗨国产精品 | 亚洲国产精品尤物yw在线观看 | 成人一级片网站 | 日韩免费成人 | 亚洲国产成人一区二区三区 | 亚洲国产一区二区三区日本久久久 | 在线播放色 | 少妇人妻av毛片在线看 | 国内自拍视频在线观看 | 总裁高h震动喷水双性 | 国产在线观看www | 消息称老熟妇乱视频一区二区 | 在线播放小视频 | 天天搞夜夜 | 97色伦图片97综合影院 | 中文字幕我不卡在线看 | 亚洲综合情 | 亚洲欧美日韩精品久久奇米一区 | 五月情网 | 亚洲精品国产一区二区的区别 | 国产思思99re99在线观看 | 最新日本黄色网址 | 99视频在线 | 嫩草在线播放 | 香蕉视频色版 | 午夜爱 | www成人精品| 日韩一区二区在线视频 | 欧美日韩激情一区二区 | 亚洲娇小与黑人巨大交 | 国产精品国语 | 鲁大师影院在线观看 | 91在线勾搭足浴店女技师 | 精品亚洲一区二区三区在线播放 | 伊人久久中文 | 日韩av中文| 一本一道av无码中文字幕麻豆 | 国产精品三级久久久久三级 | 天天射天天干天天舔 | www亚洲高清| 欧美a久久 | 免费黄色三级网站 | 国产又黄又猛又粗又爽的a片动漫 | 欧美性猛交xxxx乱大交 | 亚洲12p| 日韩视频免费在线播放 | 99国产精品白浆在线观看免费 | 久久国产精品成人影院 | 天天鲁在视频在线观看 | 亚洲免费精品网站 | www.com久久| 女人被狂躁c到高潮 | 中文精品一区二区三区四区 | 国产人妖在线视频 | 美女一级黄 | 国产福利一区二区三区在线视频 | 日韩干 | 国产欧美一区二区精品仙草咪 | 亚洲国产精华液网站w | 国产成人精品亚洲777人妖 | 色一情一伦一子一伦一区 | 噜啪啪| 亚洲精品字幕 | 免费日韩中文字幕 | 麻豆视频在线免费观看 | blacked精品一区国产在线观看 | 搞av.com | 久久不见久久见免费影院国语 | 影音先锋国产在线 | 香蕉视频在线观看网站 | 国产私密视频 | 岛国裸体写真hd在线 | 性色影院 | 成人免费a视频 | 91精品欧美 | a级黄色毛片 | 亚洲 欧美 制服 综合 另类 | 欧美性猛交xxxxx水多 | 91日本在线 | 中文字幕av无码人妻 | 免费一区二区在线观看 | 日韩精品视频在线一区 | 性视频一区二区三区 | 在线成人精品国产区免费 | 99精品一级欧美片免费播放 | 亚洲精品成人av在线 | 中国女人内谢69xxxx天美 | 直接观看黄网站免费视频 | 国产精选第一页 | 同性恋一级片 | 91免费观看网站 | 野草社区在线观看 | 亚洲五月婷婷 | 佐山爱成人av在线播放 | 九九热国产在线 | 国产亚洲精品精华液 | 国产高清精品一区 | 波多野结衣小视频 | 精产国品一二三产区m553麻豆 | 超碰2023| 久久久无码中文字幕久... | 成人动漫视频 | av福利在线免费观看 | 日韩中文字幕亚洲欧美 | 久久一区av | 欧美毛片视频 | a三级黄色片 | 天天操天天干天天舔 | 性,国产三级在线观看 | 精品国产一区二区三区免费 | 91污在线观看| 黄色在线免费观看视频 | 91视频日本| 全国最大色 | 九九热在线观看 | 色臀av| 国产nv在线观看 | 7m视频国产精品 | 国自产拍偷拍精品啪啪一区二区 | 色综合久久久无码中文字幕 | 99视频久久 | 天堂国产一区二区三区四区不卡 | 极品白嫩少妇无套内谢 | 五月天激情电影 | 成人av免费播放 | 国产精品久久久免费 | 久久伊人精品中文字幕有软件 | 国产有码在线观看 | 一级片网址 | 国内精品久久久 | 精品国产人妻一区二区三区 | 男女作爱免费网站 | 丰满少妇在线观看网站 | 性开放网站 | 四虎一级片| 国精品无码一区二区三区在线 | 久久久精品人妻一区二区三区 | 无遮挡边摸边吃奶边做视频 | 日批视频免费 | 少妇一级淫免费播放 | 国产精品一区二区欧美黑人喷潮水 | 天天色婷婷 | 久久午夜场 | 黄色大全在线观看 | 97无码免费人妻超级碰碰碰碰 | 中国少妇xxxⅹ性xxxx | 国产精品v一区二区三区 | 日韩视频在线一区 | 国产精品成人免费精品自在线观看 | 在线精品一区 | 国产成人免费9x9x人网站视频 | 日韩精品视频在线观看免费 | 老女人任你躁久久久久久老妇 | 欧美精品久 | 久久久久久一区 | 182tv国产免费观看软件 | 日韩少妇乱码一区二区三区免费 | 欧美香蕉爽爽人人爽 | 香港三级韩国三级日本三级 | 97人人模人人爽人人喊0 | 天天躁狠狠躁狠狠躁夜夜躁 | 尤物精品视频在线观看 | 久久精品国产av一区二区三区 | 污污内射久久一区二区欧美日韩 | 草草在线观看视频 | 麻豆国产97在线 | 欧洲 | 国产无遮挡吃胸膜奶免费看 | 亚洲男人的天堂网站 | 亚洲天堂五月天 | 麻豆毛片在线看 | 91免费污视频 | 一区二区三区视频在线播放 | 婷婷狠狠干 | 欧美性生活视频 | 国产成人av一区二区三区不卡 | 亚洲精品色 | 色先锋资源久久综合5566 | 久久99操 | 91少妇精拍在线播放 | 欧美一级二级片 | 国产欧美一区二区三区视频 | 午夜大片网| 一本色道无码不卡在线观看 | 一本色道无码道dvd在线观看 | 亚洲h在线播放在线观看h | 亚洲精品一区二区冲田杏梨 | 精品国产乱码久久久久久久 | 尤物网站在线观看 | 天堂av在线官网 | 久热中文字幕在线精品观 | 久久精品毛片 | 久久精品无码一区二区日韩av | 久久成人av | 亚洲精品久久久蜜夜影视 | 中国女人内谢69xxxx天美 | 免费jizz | 免费a v视频 | 自拍三级视频 | 亚洲综合激情另类小说区 | 闺蜜互慰吃奶互揉69式磨豆腐 | 美女破处视频 | 蜜桃tv一区二区三区 | 国产亚洲欧美一区二区 | 无码av最新无码av专区 | 中文字幕在线免费97 | 91av蝌蚪| 国产视频一区二区不卡 | 女同互舔互慰dv毛片 | 日韩欧美激情 | 欧美视频一区二区 | 久久精品国产清高在天天线 | 91精品91久久久中77777老牛 | 欲求不满在线小早川怜子 | 亚洲乱强伦 | 成在线人免费视频 | 日韩女优一区 | 人妻熟女av一区二区三区 | 久久不见久久见免费视频4 国产真人做爰毛片视频直播 | 全部免费a级毛片 | 青久草视频 | 婷婷精品国产一区二区三区日韩 | 国产女高清在线看免费观看 | 中文字幕综合在线分类 | 日本曰又深又爽免费视频 | 波多野结衣在线观看一区 | 中文字幕一区二区三区又粗 | 91成人破解版 | 在线观看黄色的网站 | 国产精品99久久99久久久动漫 | 成人午夜在线观看视频 | 国产精品无套 | 中文区中文字幕免费看 | 2018天天躁,夜夜躁 | 强开小嫩苞一区二区三区图片 | 天天爽天天爽夜夜爽毛片 | 麻豆视频免费网站 | 91麻豆蜜桃一区二区三区 | 台湾佬美性中文网 | 国产精品亚洲а∨天堂123bt | 日本熟妇成熟毛茸茸 | 日韩视频在线观看一区二区 | 亚洲成av人片在线观看无码 | 中文字幕在线观 | 免费在线观看污网站 | 韩国日本三级在线观看 | 国产中文字幕一区二区三区 | 都市激情久久 | 国产一区二区在线视频 | 亚洲一区二区三区久久久 | 国产精品免费视频一区二区三区 | 中文字幕黄色片 | www国产精品内射老熟女 | 国内精品伊人久久久久网站 | 欧美精品小视频 | 日本色中色 | 欧美大肚乱孕交hd孕妇 | 免费的很黄很污的视频 | 亚洲在线免费 | 亚洲精品沙发午睡系列 | 一色道久久88加勒比一 | 国产精品久久久国产盗摄 | 国产午夜精品av一区二区麻豆 | 天天夜天天干 | 免费精品一区二区三区视频日产 | 国产成人精品在线观看 | 国产调教av | 国产中文区二暮区2022 | 国产亚洲精品久久久久久久久久 | 狠狠躁天天躁无码中文字幕 | 九九九热视频 | 国产精品久久无码一区 | 成人国内精品久久久久影院成人国产9 | 国产精品无码专区在线观看 | 亚洲 自拍 另类小说综合图区 | 国产成人久久精品亚洲 | 欧美xxxx黑人又粗又长 | 老司机在线精品视频网站的优点 | 日韩精品专区 |