|
|
|
|
@ -37,6 +37,8 @@ class ModbusMasterUdp { |
|
|
|
|
var $sock; |
|
|
|
|
var $port = "502"; |
|
|
|
|
var $host = "192.168.1.1"; |
|
|
|
|
var $client = ""; |
|
|
|
|
var $client_port = "502"; |
|
|
|
|
var $status; |
|
|
|
|
var $timeout_sec = 5; // 5 sec |
|
|
|
|
var $endianess = 0; // defines endian codding (little endian == 0, big endian == 1) |
|
|
|
|
@ -71,6 +73,16 @@ class ModbusMasterUdp { |
|
|
|
|
private function connect(){ |
|
|
|
|
// UDP socket |
|
|
|
|
$this->sock = socket_create(AF_INET, SOCK_DGRAM, SOL_UDP); |
|
|
|
|
// Bind the client socket to a specific local port |
|
|
|
|
if (strlen($this->client)>0){ |
|
|
|
|
$result = socket_bind($this->sock, $this->client, $this->client_port); |
|
|
|
|
if ($result === false) { |
|
|
|
|
throw new Exception("socket_bind() failed.</br>Reason: ($result)". |
|
|
|
|
socket_strerror(socket_last_error($this->sock))); |
|
|
|
|
} else { |
|
|
|
|
$this->status .= "Bound\n"; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
// connect |
|
|
|
|
$result = @socket_connect($this->sock, $this->host, $this->port); |
|
|
|
|
if ($result === false) { |
|
|
|
|
@ -158,6 +170,121 @@ class ModbusMasterUdp { |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** |
|
|
|
|
* readCoils |
|
|
|
|
* |
|
|
|
|
* Modbus function FC 1(0x01) - Read Coils |
|
|
|
|
* |
|
|
|
|
* Reads {@link $quantity} of Coils (boolean) from reference |
|
|
|
|
* {@link $referenceRead} of a memory of a Modbus device given by |
|
|
|
|
* {@link $unitId}. |
|
|
|
|
* |
|
|
|
|
* @param type $unitId |
|
|
|
|
* @param type $reference |
|
|
|
|
* @param type $quantity |
|
|
|
|
*/ |
|
|
|
|
function readCoils($unitId, $reference, $quantity){ |
|
|
|
|
$this->status .= "readCoils: START\n"; |
|
|
|
|
// connect |
|
|
|
|
$this->connect(); |
|
|
|
|
// send FC 3 |
|
|
|
|
$packet = $this->readCoilsPacketBuilder($unitId, $reference, $quantity); |
|
|
|
|
$this->status .= $this->printPacket($packet); |
|
|
|
|
$this->send($packet); |
|
|
|
|
// receive response |
|
|
|
|
$rpacket = $this->rec(); |
|
|
|
|
$this->status .= $this->printPacket($rpacket); |
|
|
|
|
// parse packet |
|
|
|
|
$receivedData = $this->readCoilsParser($rpacket, $quantity); |
|
|
|
|
// disconnect |
|
|
|
|
$this->disconnect(); |
|
|
|
|
$this->status .= "readCoils: DONE\n"; |
|
|
|
|
// return |
|
|
|
|
return $receivedData; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** |
|
|
|
|
* fc1 |
|
|
|
|
* |
|
|
|
|
* Alias to {@link readMultipleCoils} method |
|
|
|
|
* |
|
|
|
|
* @param type $unitId |
|
|
|
|
* @param type $reference |
|
|
|
|
* @param type $quantity |
|
|
|
|
* @return type |
|
|
|
|
*/ |
|
|
|
|
function fc1($unitId, $reference, $quantity){ |
|
|
|
|
return $this->readCoils($unitId, $reference, $quantity); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** |
|
|
|
|
* readCoilsPacketBuilder |
|
|
|
|
* |
|
|
|
|
* FC1 packet builder - read coils |
|
|
|
|
* |
|
|
|
|
* @param type $unitId |
|
|
|
|
* @param type $reference |
|
|
|
|
* @param type $quantity |
|
|
|
|
* @return type |
|
|
|
|
*/ |
|
|
|
|
private function readCoilsPacketBuilder($unitId, $reference, $quantity){ |
|
|
|
|
$dataLen = 0; |
|
|
|
|
// build data section |
|
|
|
|
$buffer1 = ""; |
|
|
|
|
// build body |
|
|
|
|
$buffer2 = ""; |
|
|
|
|
$buffer2 .= iecType::iecBYTE(1); // FC 1 = 1(0x01) |
|
|
|
|
// build body - read section |
|
|
|
|
$buffer2 .= iecType::iecINT($reference); // refnumber = 12288 |
|
|
|
|
$buffer2 .= iecType::iecINT($quantity); // quantity |
|
|
|
|
$dataLen += 5; |
|
|
|
|
// build header |
|
|
|
|
$buffer3 = ''; |
|
|
|
|
$buffer3 .= iecType::iecINT(rand(0,65000)); // transaction ID |
|
|
|
|
$buffer3 .= iecType::iecINT(0); // protocol ID |
|
|
|
|
$buffer3 .= iecType::iecINT($dataLen + 1); // lenght |
|
|
|
|
$buffer3 .= iecType::iecBYTE($unitId); //unit ID |
|
|
|
|
// return packet string |
|
|
|
|
return $buffer3. $buffer2. $buffer1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** |
|
|
|
|
* readCoilsParser |
|
|
|
|
* |
|
|
|
|
* FC 1 response parser |
|
|
|
|
* |
|
|
|
|
* @param type $packet |
|
|
|
|
* @param type $quantity |
|
|
|
|
* @return type |
|
|
|
|
*/ |
|
|
|
|
private function readCoilsParser($packet, $quantity){ |
|
|
|
|
$data = array(); |
|
|
|
|
// check Response code |
|
|
|
|
$this->responseCode($packet); |
|
|
|
|
// get data from stream |
|
|
|
|
for($i=0;$i<ord($packet[8]);$i++){ |
|
|
|
|
$data[$i] = ord($packet[9+$i]); |
|
|
|
|
} |
|
|
|
|
// get bool values to array |
|
|
|
|
$data_bolean_array = array(); |
|
|
|
|
$di = 0; |
|
|
|
|
foreach($data as $value){ |
|
|
|
|
for($i=0;$i<8;$i++){ |
|
|
|
|
if($di > $quantity) continue; |
|
|
|
|
// get boolean value |
|
|
|
|
$v = ($value >> $i) & 0x01; |
|
|
|
|
// build boolean array |
|
|
|
|
if($v == 0){ |
|
|
|
|
$data_bolean_array[] = FALSE; |
|
|
|
|
} else { |
|
|
|
|
$data_bolean_array[] = TRUE; |
|
|
|
|
} |
|
|
|
|
$di++; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
return $data_bolean_array; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** |
|
|
|
|
* readMultipleRegisters |
|
|
|
|
* |
|
|
|
|
@ -257,6 +384,124 @@ class ModbusMasterUdp { |
|
|
|
|
return $data; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** |
|
|
|
|
* writeMultipleCoils |
|
|
|
|
* |
|
|
|
|
* Modbus function FC15(0x0F) - Write Multiple Coils |
|
|
|
|
* |
|
|
|
|
* This function writes {@link $data} array at {@link $reference} position of |
|
|
|
|
* memory of a Modbus device given by {@link $unitId}. |
|
|
|
|
* |
|
|
|
|
* @param type $unitId |
|
|
|
|
* @param type $reference |
|
|
|
|
* @param type $data |
|
|
|
|
* @return type |
|
|
|
|
*/ |
|
|
|
|
function writeMultipleCoils($unitId, $reference, $data){ |
|
|
|
|
$this->status .= "writeMultipleCoils: START\n"; |
|
|
|
|
// connect |
|
|
|
|
$this->connect(); |
|
|
|
|
// send FC16 |
|
|
|
|
$packet = $this->writeMultipleCoilsPacketBuilder($unitId, $reference, $data); |
|
|
|
|
$this->status .= $this->printPacket($packet); |
|
|
|
|
$this->send($packet); |
|
|
|
|
// receive response |
|
|
|
|
$rpacket = $this->rec(); |
|
|
|
|
$this->status .= $this->printPacket($rpacket); |
|
|
|
|
// parse packet |
|
|
|
|
$this->writeMultipleCoilsParser($rpacket); |
|
|
|
|
// disconnect |
|
|
|
|
$this->disconnect(); |
|
|
|
|
$this->status .= "writeMultipleCoils: DONE\n"; |
|
|
|
|
return true; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** |
|
|
|
|
* fc15 |
|
|
|
|
* |
|
|
|
|
* Alias to {@link writeMultipleCoils} method |
|
|
|
|
* |
|
|
|
|
* @param int $unitId |
|
|
|
|
* @param int $reference |
|
|
|
|
* @param array $data |
|
|
|
|
* @return bool |
|
|
|
|
*/ |
|
|
|
|
function fc15($unitId, $reference, $data){ |
|
|
|
|
return $this->writeMultipleCoils($unitId, $reference, $data); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** |
|
|
|
|
* writeMultipleCoilsPacketBuilder |
|
|
|
|
* |
|
|
|
|
* Packet builder FC15 - Write multiple coils |
|
|
|
|
* |
|
|
|
|
* @param int $unitId |
|
|
|
|
* @param int $reference |
|
|
|
|
* @param array $data |
|
|
|
|
* @return string |
|
|
|
|
*/ |
|
|
|
|
private function writeMultipleCoilsPacketBuilder($unitId, $reference, $data){ |
|
|
|
|
$dataLen = 0; |
|
|
|
|
$endianness = 0; |
|
|
|
|
// build bool stream to the WORD array |
|
|
|
|
$data_word_stream = array(); |
|
|
|
|
$data_word = 0; |
|
|
|
|
$shift = 0; |
|
|
|
|
for($i=0;$i<count($data);$i++) { |
|
|
|
|
if((($i % 8) == 0) && ($i > 0)) { |
|
|
|
|
$data_word_stream[] = $data_word; |
|
|
|
|
$shift = 0; |
|
|
|
|
$data_word = 0; |
|
|
|
|
$data_word |= (0x01 && $data[$i]) << $shift; |
|
|
|
|
$shift++; |
|
|
|
|
} |
|
|
|
|
else { |
|
|
|
|
$data_word |= (0x01 && $data[$i]) << $shift; |
|
|
|
|
$shift++; |
|
|
|
|
} |
|
|
|
|
} |
|
|
|
|
$data_word_stream[] = $data_word; |
|
|
|
|
// show binary stream to status string |
|
|
|
|
foreach($data_word_stream as $d){ |
|
|
|
|
$this->status .= sprintf("byte=b%08b\n", $d); |
|
|
|
|
} |
|
|
|
|
// build data section |
|
|
|
|
$buffer1 = ""; |
|
|
|
|
foreach($data_word_stream as $key=>$dataitem) { |
|
|
|
|
$buffer1 .= iecType::iecBYTE($dataitem); // register values x |
|
|
|
|
$dataLen += 1; |
|
|
|
|
} |
|
|
|
|
// build body |
|
|
|
|
$buffer2 = ""; |
|
|
|
|
$buffer2 .= iecType::iecBYTE(15); // FC 15 = 15(0x0f) |
|
|
|
|
$buffer2 .= iecType::iecINT($reference); // refnumber = 12288 |
|
|
|
|
$buffer2 .= iecType::iecINT(count($data)); // bit count |
|
|
|
|
$buffer2 .= iecType::iecBYTE((count($data)+7)/8); // byte count |
|
|
|
|
$dataLen += 6; |
|
|
|
|
// build header |
|
|
|
|
$buffer3 = ''; |
|
|
|
|
$buffer3 .= iecType::iecINT(rand(0,65000)); // transaction ID |
|
|
|
|
$buffer3 .= iecType::iecINT(0); // protocol ID |
|
|
|
|
$buffer3 .= iecType::iecINT($dataLen + 1); // lenght |
|
|
|
|
$buffer3 .= iecType::iecBYTE($unitId); // unit ID |
|
|
|
|
|
|
|
|
|
// return packet string |
|
|
|
|
return $buffer3. $buffer2. $buffer1; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** |
|
|
|
|
* writeMultipleCoilsParser |
|
|
|
|
* |
|
|
|
|
* FC15 response parser |
|
|
|
|
* |
|
|
|
|
* @param string $packet |
|
|
|
|
* @return bool |
|
|
|
|
*/ |
|
|
|
|
private function writeMultipleCoilsParser($packet){ |
|
|
|
|
$this->responseCode($packet); |
|
|
|
|
return true; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
/** |
|
|
|
|
* writeMultipleRegister |
|
|
|
|
* |
|
|
|
|
@ -322,6 +567,7 @@ class ModbusMasterUdp { |
|
|
|
|
*/ |
|
|
|
|
private function writeMultipleRegisterPacketBuilder($unitId, $reference, $data, $dataTypes){ |
|
|
|
|
$dataLen = 0; |
|
|
|
|
$endianness = 0; |
|
|
|
|
// build data section |
|
|
|
|
$buffer1 = ""; |
|
|
|
|
foreach($data as $key=>$dataitem) { |
|
|
|
|
@ -330,11 +576,11 @@ class ModbusMasterUdp { |
|
|
|
|
$dataLen += 2; |
|
|
|
|
} |
|
|
|
|
elseif($dataTypes[$key]=="DINT"){ |
|
|
|
|
$buffer1 .= iecType::iecDINT($dataitem, $endianess); // register values x |
|
|
|
|
$buffer1 .= iecType::iecDINT($dataitem, $endianness); // register values x |
|
|
|
|
$dataLen += 4; |
|
|
|
|
} |
|
|
|
|
elseif($dataTypes[$key]=="REAL") { |
|
|
|
|
$buffer1 .= iecType::iecREAL($dataitem, $endianess); // register values x |
|
|
|
|
$buffer1 .= iecType::iecREAL($dataitem, $endianness); // register values x |
|
|
|
|
$dataLen += 4; |
|
|
|
|
} |
|
|
|
|
else{ |
|
|
|
|
@ -369,7 +615,7 @@ class ModbusMasterUdp { |
|
|
|
|
* @return bool |
|
|
|
|
*/ |
|
|
|
|
private function writeMultipleRegisterParser($packet){ |
|
|
|
|
$this->responseCode($rpacket); |
|
|
|
|
$this->responseCode($packet); |
|
|
|
|
return true; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
@ -444,6 +690,7 @@ class ModbusMasterUdp { |
|
|
|
|
*/ |
|
|
|
|
private function readWriteRegistersPacketBuilder($unitId, $referenceRead, $quantity, $referenceWrite, $data, $dataTypes){ |
|
|
|
|
$dataLen = 0; |
|
|
|
|
$endianness = 0; |
|
|
|
|
// build data section |
|
|
|
|
$buffer1 = ""; |
|
|
|
|
foreach($data as $key => $dataitem) { |
|
|
|
|
@ -452,11 +699,11 @@ class ModbusMasterUdp { |
|
|
|
|
$dataLen += 2; |
|
|
|
|
} |
|
|
|
|
elseif($dataTypes[$key]=="DINT"){ |
|
|
|
|
$buffer1 .= iecType::iecDINT($dataitem, $endianess); // register values x |
|
|
|
|
$buffer1 .= iecType::iecDINT($dataitem, $endianness); // register values x |
|
|
|
|
$dataLen += 4; |
|
|
|
|
} |
|
|
|
|
elseif($dataTypes[$key]=="REAL") { |
|
|
|
|
$buffer1 .= iecType::iecREAL($dataitem, $endianess); // register values x |
|
|
|
|
$buffer1 .= iecType::iecREAL($dataitem, $endianness); // register values x |
|
|
|
|
$dataLen += 4; |
|
|
|
|
} |
|
|
|
|
else{ |
|
|
|
|
|
John Long
13 years ago