一区二区三区成人-一区二区三区www-一区二区三区 日韩-一区二区日韩欧美-一区二区日韩精品中文字幕-一区二区日韩

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

復(fù)制代碼
  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
級(jí)別: 正式會(huì)員
精華主題: 0
發(fā)帖數(shù)量: 3 個(gè)
工控威望: 96 點(diǎn)
下載積分: 648 分
在線時(shí)間: 24(小時(shí))
注冊(cè)時(shí)間: 2017-02-12
最后登錄: 2017-05-19
查看moecmks的 主題 / 回貼
1樓  發(fā)表于: 2017-04-24 19:48
FX1S 報(bào)文編解碼
復(fù)制代碼
  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
級(jí)別: 正式會(huì)員
精華主題: 0
發(fā)帖數(shù)量: 3 個(gè)
工控威望: 96 點(diǎn)
下載積分: 648 分
在線時(shí)間: 24(小時(shí))
注冊(cè)時(shí)間: 2017-02-12
最后登錄: 2017-05-19
查看moecmks的 主題 / 回貼
2樓  發(fā)表于: 2017-04-24 19:52
復(fù)制代碼
  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. }

主站蜘蛛池模板: 欧美日本道 | 免费爱爱网站 | 精品久久久久久无码中文字幕一区 | 黑人操bb | 国产真实野战在线视频 | 99热精品在线观看 | 调教重口xx区一精品网站 | tube欧美巨大44 | 在线一区二区三区在线一区 | 丝袜视频在线观看 | 成人美女在线 | 久久久久久久久久久久久女过产乱 | 国产成人自拍视频在线 | 午夜| 午夜欧美视频 | 国产丰满农村老妇女乱 | 奇米影视奇奇米色狠狠色777 | 国产性自拍 | 91在线不卡 | 国产成人免费9x9x | 91嫩草国产线观看亚洲一区二区 | 动漫美女靠逼 | 一道本在线伊人蕉无码 | 国产色多传媒网站 | 国产专区一区二区 | 亚洲免费网站在线观看 | 国产95在线 | 欧美 | 日韩欧美一区二区三 | 精品久久综合1区2区3区激情 | 曰韩精品一区二区 | 九九热视频免费观看 | 91爱国产| 成人黄色片免费 | 国产乱子伦精品免费女 | 国产精品毛片一区二区 | 91久久精品国产91性色69 | 欧美在线性 | 懂色av蜜臀av粉嫩av喷吹 | 精品无码人妻一区二区三区不卡 | jizzjizzjizz日本人 | 欧美在线视频免费观看 | 日产精品一区二区 | 性久久久久久久久久久久 | 日本在线国产 | bnb998成人免费| 性开放少妇xxxxⅹ视频蜜桃 | 中文字幕一区二区三区四区欧美 | 欧美三区四区 | 国产偷人爽久久久久久老妇app | 四虎4hu永久免费深夜福利 | 羞羞视频导航 | 国产在线观看不卡 | 太深太粗太爽太猛了视频免费观看 | 久久国产区 | 337p亚洲精品色噜噜狠狠 | 久久日本香蕉一区二区三区 | 另类激情在线 | 国产又色又爽无遮挡免费 | 亚洲一区二区三区精品动漫 | 国产女高清在线看免费观看 | 岳奶大又白下面又肥又黑水多 | 美国黄色毛片 | 国产一二三区免费视频 | 性国产精品 | 国产精品久久久久久久久久久免费看 | 欧美性猛交乱大交xxxx | 国产精品麻豆免费观看 | 亚洲日韩av一区二区三区中文 | 亚洲欧美人色综合婷婷久久 | 亚洲线精品一区二区三区 | 国产素人av | 网站一区二区 | 天海翼激烈高潮到腰振不止 | 国产精品久久久久久婷婷不卡 | 国产一区二区三区四区三区 | 都市激情 在线 亚洲 国产 | 九九国产在线观看 | 欧美区一区 | 亚洲国产成人欧美激情 | baoyu131成人免费视频 | 亚洲一二三四五 | 免费观看成人毛片 | 怡红院怡春院a∨免费十部 怡红院最新网址 | 999zyz玖玖资源站永久 | 久久免费视频精品 | 动漫精品专区一区二区三区 | 窝窝人体色www | 久久盗摄 | 国产在线资源站 | 香蕉国产片一级一级一级一级 | 国产精品久久久一区二区三区 | a 'v片欧美日韩在线 | 午夜视频免费观看 | 黄色片网站在线看 | 天堂视频免费看 | 亚洲日本aⅴ片在线观看香蕉 | 日本肉体xxxx裸交 | 欧美乱妇无乱码大黄a片 | 天干夜夜爽爽日日日日 | 亚洲 欧美 制服 综合 另类 | 日本久久精品少妇高潮日出水 | 天堂网在线中文 | 明星毛片 | 国产露脸久久高潮 | 日本少妇b | 亚洲精品aaaa乱码 | 欧美aa大片欧美大片观看 | 国产xx视频| 亚洲视频黄色 | 色悠久久久| 日韩免费一区二区 | 狠色狠狠色狠狠狠色综合久久 | 成人激情在线观看 | 91黄色视屏 | 国产主播自拍av | 国产精品美女久久久久久久网站 | 公妇乱淫视频 | 国内揄拍国内精品少妇 | 欧美熟妇另类久久久久久多毛 | 日韩在线观看a | 里番acg☆里番本子全彩 | 女人18毛片毛片毛片毛片区二 | 日本高清有码视频 | 精品久久久久久一区二区 | 亚洲欧美日韩一区在线观看 | 欧美激情国产精品 | 日韩高清无线码2023 | 日本熟妇人妻中出 | 婷婷俺也去 | 18中国性生交xxxxxhd | 一级片的网站 | 久久一视频 | 国产精品视频免费看 | 丁香天五香天堂综合 | 欧美嘿咻视频 | jzz在线观看 | 巨大巨粗巨长 黑人长吊 | 四虎永久在线精品免费一区二区 | 做爰吃奶全过程免费的网站 | 国产裸体永久免费无遮挡 | 国产毛片久久久久久 | 少妇高潮zzzzzzzyⅹ一 | 国产农村妇女精品 | 国产伦精品一区二区三区免费迷 | 国产成人精品日本亚洲直播 | 色撸撸在线观看 | 日韩中文字幕视频在线观看 | 欧美在线一二三 | 91在线短视频 | 国产电影一区二区三区 | 亚洲国产成人av在线观看 | 女人浣肠av大片 | 国产精品第一国产精品 | 丝袜理论片在线观看 | 日本午夜免费福利视频 | 无码人妻一区二区三区精品视频 | 奇米综合网 | av中文字幕网址 | 亚洲色图清纯唯美 | 久久视频免费观看 | 国产精品午夜一区二区三区视频 | 天天摸天天看 | 一级黄色的毛片 | 美女性感毛片 | 一区二区三区四区亚洲 | 国产精品15p | 国产精品 视频一区 二区三区 | 高清性色生活片97 | а天堂中文最新一区二区三区 | 亚洲成人观看 | 伊人久久精品视频 | 国产欧美精品 | 亚洲综合图色40p | 成人免费ā片在线观看 | 成熟了的熟妇毛茸茸 | 久久久久久久女女女又又 | 亚洲成人一区在线 | 国模欢欢炮交啪啪150 | 久久国产视频精品 | 97在线免费视频 | 成 人 网 站国产免费观看 | 国内视频自拍 | 久久96国产精品久久 | 把女邻居弄到潮喷的性经历 | 97久久精品人人澡人人爽古装 | 无码专区一ⅴa亚洲v天堂 | 日韩精品免费 | 亚洲国产精品成人综合色在线婷婷 | 国产永久在线观看 | 国产小视频免费在线观看 | 欧美亚洲精品在线观看 | 免费人成网站 | 色综合久久精品亚洲国产 | 九一亚色视频 | 色婷婷六月天 | 人妻无码中文字幕免费视频蜜桃 | 免费av黄色 | 欧美成人a∨高清免费观看 欧美成人aa | 免费观看全黄做爰的视在线观看 | 国产视频每日更新 | 日本少妇喂奶视频 | 狠狠色综合激情丁香五月 | 生活片一级片 | 欧美大片xxxx | 福利片一区二区三区 | 人人草人人插 | 天海翼一区二区三区免费 | 日产亚洲一区二区三区 | 亚洲欧美日韩综合一区 | 日韩视频一区在线 | 狼人狠狠干| 国产裸体美女视频全黄 | 亚洲欧美另类在线观看 | 国产精品视频一区二区三区无码 | 夜夜高潮夜夜爽高清完整版1 | 亚洲区一 | xx性欧美肥妇精品久久久久久 | 人人妻人人澡人人爽不卡视频 | 热99re6久精品国产首页青柠 | 亚洲国产精品第一页 | 久草在线在线精品观看 | 午夜影院一区二区 | 亚洲欧美国产高清va在线播放 | 久久精品国产中国久久 | 阿v天堂网| 高清乱码毛片 | 中文字幕日韩精品有码视频 | 久久精品国产99国产 | 国产精品毛片a∨一区二区三区 | 黄色网址国产 | 一级片免费 | 国产成人精品免费视频大全 | 伊人久久爱 | 东京无码熟妇人妻av在线网址 | 婷婷色怡春院 | 亚洲成a人v欧美综合天堂麻豆 | 夜夜夜网 | 成人精品一区二区三区电影 | av免费黄色| 大狠狠大臿蕉香蕉大视频 | 国产精品1234 | 午夜美女裸体福利视频 | 精品一区二区三区毛片 | 在线一区国产 | 色综合天天综合网天天狠天天 | 久久久男女| 亚洲欧美精品aaaaaa片 | 国产精品国产三级国产播12软件 | 亚洲精品乱码久久久久久国产主播 | 黄色片欧美 | 国产极品jizzhd欧美 | 亚洲精品视频久久 | 久久性色欲av免费精品观看 | 特级无码毛片免费视频 | 久久久久区 | 亚洲国产成人精品女人 | 好吊妞视频在线 | 天天精品在线 | а√天堂www在线天堂小说 | 麻豆国产丝袜白领秘书在线观看 | 原神污文全文肉高h | 国产伦精品一区二区三区在线观看 | 久久影视传媒 | 欧美日韩中文字幕在线视频 | av毛片在线免费看 | 一本大道东京热无码 | 中国大陆毛片 | 国产毛片毛片 | 国产露脸精品国产探 | 日韩中文字幕网站 | 亚洲欧洲精品一区二区三区不卡 | 中文字幕二区三区 | 成人涩涩日本国产一区 | 国产又色又爽又黄的视频在线观看 | 免费超爽大片黄 | 在线中文字幕播放 | 特大巨黑吊av在线播放 | 日本高清aⅴ毛片免费 | 欧美疯狂做受xxxxx高潮 | 日本a级片在线播放 | 国产精品无码av在线播放 | 精品人妻码一区二区三区 | 国产3p露脸普通话对白 | 粉嫩在线 | 国产精品www老牛影视 | 久久婷婷影视 | 伊人久操 | 毛片基地黄久久久久久天堂 | 999久久久久久久久6666 | 一国产一级淫片a免费播放口 | av在线中文字幕不卡电影网 | 天天av天天av天天透 | 久久国产精品综合 | 国产精品女主播一区二区三区 | 精品无码一区二区三区爱欲九九 | 亚婷婷洲av久久蜜臀小说 | 一性一交一口添一摸视频 | 亚洲中文字幕无码爆乳 | 情侣黄网站免费看 | 毛片链接 | 国产交换配乱淫视频免费 | 成年人在线免费观看视频网站 | 国产成人在线看 | 涩久久| 欧美久久免费观看 | 日本精品巨爆乳无码大乳巨 | 国产一区二区日本欧美精品久久久 | 亚洲人精品亚洲人成在线 | 寂寞少妇按摩spa高潮91 | 欧美另类videosbestsex日本 | 成人国内精品久久久久影院成人国产9 | 亚洲国产网 | 狂野3p欧美激情性xxxx | 国产精品亚洲欧美 | 狠狠色噜噜狠狠狠狠色综合久 | 国产熟妇另类久久久久 | 少妇太紧太爽又黄又硬又爽 | 欧美三日本三级少妇99印度 | 午夜爽爽爽爽技女8888 | av福利网站 | 欧美激情15p | 欧美黄色免费大片 | 久久久久久久一区二区 | 欧美成人精品a∨在线观看 香蕉av福利精品导航 | 美女初尝巨物嗷嗷叫自拍视频 | 中文字幕精品一区二区精品 | 中文字幕一区二区三区日韩精品 | 国产激情毛片 | 91性高潮久久久久久久 | 国产乱码一二三区精品 | 91av在线视频播放 | 777精品伊人久久久久大香线蕉 | 欧美国产片 | 久久久久免费精品国产 | 亚洲第一黄色片 | 少妇无码av无码一区 | 男女互操视频网站 | 国产精品1000夫妇激情啪 | 在线视频久 | 成人做爰高潮片免费看 | 亚洲不卡在线播放 | 特级西西444www大精品视频 | 风流少妇bbwbbw69视频 | 久久国产成人精品国产成人亚洲 | 精品国产乱码久久久人妻 | 国产精品免费视频一区二区三区 | 一级特黄aa大片免费播放 | 成人av社区 | 麻豆国产97在线 | 欧洲 | 在线激情小视频 | 2018av天堂在线视频精品观看 | va在线播放| 久久久久一 | 亚洲欧美在线综合 | 亚洲码中文 | 深夜激情视频 | 91风间由美一区二区三区四区 | xxxxwww69| 色偷偷av一区二区三区 | 国产东北农村女人av | 久久久久中文 | 国产在线精品一区二区在线看 | 在线播放无码高潮的视频 | 久久精品无码一区二区三区 | 妺妺窝人体色www聚色窝仙踪 | 台湾av毛片| 国产精品丝袜一区二区 | 麻豆91茄子在线观看 | 青娱乐av在线 | 国产原创剧情av | 三级福利片 | 国内精品国产三级国产aⅴ久 | 男人激烈吮乳吃奶视频 | 黄色一大片| 中文字字幕在线中文乱 | 日韩一区二区在线观看视频 | 亚州av在线 | 香蕉视频免费在线播放 | 国产综合在线播放 | 国产男女猛烈无遮挡免费网站 | 欧美三级大片 | 最新av在线网址 | 成人性视频网站 | www.激情五月 | 欧美69式互添视频在线 | 亚色一区 | 日韩在线观看a | 国产免费看黄 | 在线观看中文字幕码 | 中文字幕日韩高清 | 国产成人无码免费视频在线 | 91精品国产综合久久久久久 | 久久九九精品 | 日本美女极度性诱惑卡不卡 | 亚洲日韩中文字幕天堂不卡 | 粗大猛烈进出高潮视频 | 一级片免费观看视频 | 国产丰满农村老妇女乱 | 国产99久久久欧美黑人 | 中文字幕av观看 | 久色成人 | 国产成+人欧美+综合在线观看 | 欧美乱强伦 | 狠狠色丁香婷婷 | 黄色小视频链接 | 二区在线播放 | 精品国产乱码一区二区三区99 | 波多野结衣黄色网址 | 国产黄色小视频在线观看 | 亚洲色大网站www永久网站 | 久久香蕉国产线看观看猫咪av | 日韩动漫av | 国产精品久久久久无码av | 蜜桃狠狠色伊人亚洲综合网站 | 无码播放一区二区三区 | 天天色天 | 国内精品久久久久久中文字幕 | 国产真实乱对白精彩久久老熟妇女 | 99在线视频免费观看 | 超碰人体| 天天插天天摸 | 中文字幕女教师julia视频 | 黄色国产免费 | 国产精品久久久久久麻豆一区 | 日本少妇做爰免费视频软件 | 92电影网午夜福利 | 欧美成人免费一区二区 | 精品国产免费第一区二区三区 | 日本鲜嫩鲜嫩bbw | 国产特级毛片aaaaaa高清 | 亚洲午夜爱爱香蕉片 | 欧美日韩精品中文字幕 | 国产jizz | 日韩黄色一区 | 蜜桃视频在线观看免费视频网站www | 精品无码专区久久久水蜜桃 | 成人在线免费观看视频 | 国产在线啪 | 欧美乱淫| 亚洲字幕av| 国产精品国产成人国产三级 | 免费一级全黄裸片 | 熟妇的味道hd中文字幕 | 色性av| 久久精品成人热国产成 | 亚洲国产精品无码久久久久高潮 | 国产精品视频区 | 无码一区二区三区av免费 | 免费人成在线视频无码 | 青草伊人久久综在合线亚洲观看 | 国产成人精品无码片区在线观看 | 国产精品igao视频网网址 | 免费纯肉3d动漫无码网站 | 一区二区三区午夜 | 国产午夜免费 | 日本特黄色片 | 欧美少妇一区 | 99视频在线观看免费 | 国产黄网在线观看 | 欧美一区亚洲 | 国产主播福利 | 久久免费视频一区二区 | 中文字幕无线码一区 | 国产特黄特色大片免费视频 | 99热这里只有精品最新地址获取 | 日日爱669| 国产成人免费看一级大黄 | 国产绳艺sm入口 | 成人综合伊人五月婷久久 | 亚洲va韩国va欧美va | 欧美日韩在线观看一区 | 激情小说一区 | 精品视频免费在线观看 | 性福宝av | 久久天天躁狠狠躁夜夜2020一 | 国产黄色免费观看 | 夫妻性生活自拍 | 中国三级视频 | 狠狠色噜噜狠狠狠狠999米奇 | 国产一级做a爰片久久毛片99 | 久久亚洲精华国产精华液 | 中国丰满猛少妇xxxx | 色噜噜久久综合伊人一本 | 性欧美成人播放77777 | 色欲网天天无码av | 久久久无码精品午夜 | 国产成人无码精品一区在线观看 | 国产黄在线观看免费观看不卡 | 777中文字幕 | √天堂资源网最新版在线 | 筱田优全部av免费观看 | 色先锋av| 中国大陆毛片 | 噜噜啪啪| 99视频精品全部免费 在线 | 中文天堂在线播放 | 天天干天天骑 | 女人14毛片毛片毛片毛片区二 | 欧美黄视频 | 偷拍盗摄高潮叫床对白清晰 | 亚洲成av人片在线播放无码 | 亚洲乱码国产乱码 | 色视频网址 | 一区二区三区高清视频一 | 久久精品国产曰本波多野结衣 | a一级黄色片 | 秋霞影院午夜伦a片欧美 | 成年人免费看黄色 | 日韩综合无码一区二区 | 美女视频黄a视频全免费观看 | 免费播放黄色片 | 综合 欧美 亚洲日本 | 国产精品久久久久永久免费 | 国产av人人夜夜澡人人爽麻豆 | 含羞草www国产在线视频 | 校园春色av| 激情小说在线观看 | 欧美精品成人久久 | 波多野结衣av在线观看 | 国产视频精选 | 美国伦理3野性 | 小丽的性荡生活 | 国产精品99久久久久久小说 | 精品av天堂毛片久久久借种 | a亚洲精品 | 日韩免费视频一区二区 | 亚洲成人在线网站 | 亚洲激情欧美激情 | 日本不卡影院 | 亚洲一区二区三区四区在线 | 国产肉体xxxx裸体784大胆 | 天堂在线观看www | 韩国成年人网站 | 免费人成又黄又爽又色 | 午夜精品久久久久久 | a点w片| 亚洲免费看片 | 亚洲天堂资源在线 | 午夜影院久久 | 香蕉av福利精品导航 | 偷偷操网站 | 亚洲xxx视频| 377p欧洲日本亚洲大胆 | 91在线免费看片 | 欧美专区日韩专区 | 深夜免费福利 | 不卡的日韩av| 九九视频免费看 | 人妻无码第一区二区三区 | 黄色尤物视频 | 99热免费观看 | 黄色毛片在线播放 | 国产区精品在线 | 女人解开奶罩喂男人吃奶 | 无码国产精品久久一区免费 | 99精品久久久久久久婷婷 | 久久久久久久久久网 | 尤物一区二区 | 国产精品调教视频 | 国产精品久久久久久久竹霞 | 手机在线观看av | 国内少妇偷人精品免费 | 婷婷久久精品 | 亚洲欧美久久 | 日韩天堂av | 葵司av三级在线看 | 啦啦啦中文在线观看日本 | 青青青草网站免费视频在线观看 | 精品人妻少妇嫩草av无码专区 | 韩国毛片在线 | 久久久久久网站 | 神秘马戏团在线观看免费高清中文 | 久久精品国产片 | 黄色网战入口 | 肉色丝袜足j视频国产 | 亚洲精品一区国语对白 | 欧美亚洲精品suv一区 | 久久久久久亚洲精品不卡4k岛国 | 亚洲精品毛片一级91精品 | 日产精品久久久一区二区 | 色综合久久久久综合一本到桃花网 | 国外处破女一区二区 | 小萝莉末成年一区二区 | 椎名由奈一区二区在线 | 久久国产精品99精品国产 | 毛片内射-百度 | 播放黄色 | 日本精品久久久久久草草 | 国产精品13p | 国产精品免费麻豆入口 | 熟妇丰满多毛的大隂户 | 天啪| 激情内射日本一区二区三区 | 玖玖爱资源站 | 日本一卡2卡3卡四卡精品网站 | 37p粉嫩大胆色噜噜噜 | 97国产精品理伦影院 | 成人男女啪啪免费观软件 | 亚色在线 | 夜夜高潮夜夜爽夜夜爱 | 国产精品无码素人福利不卡 | 黑人玩弄出轨人妻松雪 | 午夜在线免费视频 | 亚洲综合久 | 内射白嫩少妇超碰 | 欧美色一区二区三区在线观看 | 青青草免费在线视频 | 五月激情小说网 | 亚洲天堂成人av | 狠狠躁日日躁夜夜躁2022麻豆 | av中文字幕第一页 | 久久久久久亚洲精品a片成人 | 国产无遮挡猛进猛出免费软件 | 日本国产一区二区三区在线观看 | 久久久久伊人 |