If Modbus_have_data > 0 Then                             'Have we got a modbus packet
      Call Modbus_task()                                    'Handle Modbus packet
      Modbus_have_data = 0                                  'Clear flag
   End if
 

Sub Modbus_task()
'Function    : Check modbus packets calling the correct decoder (read/write) .
'Author      : Ian Dobson
'Inputs      : None
'Outputs     : None
'Limitations :       :
'Date        : 13.2.2016
   If Modbus_buffer(1) = _modbus_slave_address Then         'Slave address correct
      Modbus_temp1 = Modbus_have_data - 2                   'Low Byte
      Modbus_temp2 = Modbus_have_data - 1                   'High Byte
      Modbus_checksum_serial = Makeint(modbus_buffer(modbus_temp1) , Modbus_buffer(modbus_temp2))
      Modbus_temp1 = Modbus_have_data - 3
      Modbus_checksum_user = Crcmb(modbus_buffer(1) , Modbus_temp1 )       'checksum from data
      If Modbus_checksum_user = Modbus_checksum_serial Then 'checksum OK?
         Call Debug_modbus(modbus_have_data -1 , "I")
         Register_start = Makeint(modbus_buffer(4) , Modbus_buffer(3))       'get start register
         Incr Register_start
         Modbus_register_count = Makeint(modbus_buffer(6) , Modbus_buffer(5))       'get register count
         Select Case Modbus_buffer(2)
            Case Is = 3                                     'Read Holding Registers
               Call Modbus_fc3()
            Case Is = 16                                    'Preset Multiple Registers
               Call Modbus_fc16()
         End Select
         If Modbus_watchdog_counter < 3 Then                'no comms for ca 3 seconds
            Toggle Led_status
         End If
      End If
   End If
End Sub
 

do
 if is_request=1 then
  waitms 20
  Printbin A(1);8      'A is an array of bytes. Array is Ok (with modbus crc) i've checked in rs485 sniffer
 end if
loop
 

do
 if is_request=1 then
  is_request=0
  Printbin A(1);8      'A is an array of bytes. Array is Ok (with modbus crc) i've checked in rs485 sniffer
 end if
Loop