Diff: main.cpp

Revision:

5:3e19326b47f7

Parent:

4:f69e05cb6714

Child:

6:7fb2dc9292b7

--- a/main.cpp	Thu Dec 22 15:10:51 2016 +0800
+++ b/main.cpp	Thu Jan 05 13:31:29 2017 +0000
@@ -1,10 +1,16 @@
-/*
-* The program is a sample code. 
-* It needs run with some NuMaker-PFM-NUC472 boards.
-*
-* Please remeber to modify global definition to enable RS485 port on board.
-* Modify '//#define DEF_RS485_PORT 1' to '#define DEF_RS485_PORT 1'
-*/
+//
+// modbus RTU sample code
+// 
+// EVB : NuMaker-PFM-NUC472
+// Connections:
+// D0 & D1 : to USB-to-UART (PC running modbus master software simulator)
+// D2 ~ D7 : to external LEDs
+//
+// if choose on-board RS485, then go to Modbus/portserial.cpp line#38
+// Modify '//#define DEF_RS485_PORT 1' to '#define DEF_RS485_PORT 1'
+//
+// PC modbus master command = Write Single Register
+// ID = 1, Func = 6, Addr = 4, Data = 0x003F (6 bits for 6 LEDs)
 
 /* ----------------------- System includes --------------------------------*/
 #include "mbed.h"
@@ -14,18 +20,23 @@
 #include "mbport.h"
 
 /* ----------------------- Defines ------------------------------------------*/
+#define MODBUS_BAUDRATE 9600
 // Sharing buffer index
-enum {
-  eData_MBInCounter,
-  eData_MBOutCounter,
-  eData_MBError,  
-  eData_DI,
-  eData_DATA,   
-  eData_Cnt
+enum {                      // Modbus Slave Address
+  eData_MBInCounter,        // 0: In  Counter
+  eData_MBOutCounter,       // 1: Out Counter
+  eData_MBError,            // 2: Error code
+  eData_DI,                 // 3: DI
+  eData_DO,                 // 4: DO = LED[x]
+  eData_RGB,                // 5: DO = RGB LED
+  eData_MBResistorVar,      // 6: Variable Resistor
+  eData_TemperatureSensor,  // 7: Temperature Sensor
+  eData_Cnt                 
 } E_DATA_TYPE;
 
 #define REG_INPUT_START 1
 #define REG_INPUT_NREGS eData_Cnt
+#define SLAVE_ID 0x01
 /* ----------------------- Static variables ---------------------------------*/
 static USHORT   usRegInputStart = REG_INPUT_START;
 static USHORT   usRegInputBuf[REG_INPUT_NREGS];
@@ -34,37 +45,20 @@
 DigitalOut led2(LED2);  // For Modbus worker.
 DigitalOut led3(LED3);  // For Holder CB
 
-#define DEF_PIN_NUM 6
+#define DEF_LED_NUM 6
 #if defined(TARGET_NUMAKER_PFM_NUC472)
-DigitalIn DipSwitch[DEF_PIN_NUM] = { PG_1, PG_2, PF_9, PF_10, PC_10, PC_11 } ;
+DigitalOut LED[DEF_LED_NUM] = { PF_9, PF_10, PC_10, PC_11, PA_10, PA_9 } ;
 #elif defined(TARGET_NUMAKER_PFM_M453)
-DigitalIn DipSwitch[DEF_PIN_NUM] = { PD_6, PD_1, PC_6, PC_7, PC_11, PC_12 };
+DigitalOut LED[DEF_LED_NUM] = { PC_6, PC_7, PC_11, PC_12, PC_13, PC_14 } ;
 #endif
 
-unsigned short GetValueOnDipSwitch()
+void light_leds()
 {
     int i=0;
-    unsigned short usDipValue = 0x0;
-    for ( i=0; i<DEF_PIN_NUM ; i++)
-        usDipValue |= DipSwitch[i].read() << i;
-    usDipValue = (~usDipValue) & 0x003F;
-    return usDipValue;
-}
-
-void worker_uart(void const *args)
-{   
-    int counter=0;
-    // For UART-SERIAL Tx/Rx Service.
-    while (true)
-    {
-        //xMBPortSerialPolling();
-        if ( counter > 10000 )
-        {
-            led2 = !led2;
-            counter=0;
-        }    
-        counter++;
-    }
+    USHORT usOutValue = usRegInputBuf[eData_DO];
+    for ( i=0; i<DEF_LED_NUM ; i++)        
+        if((usOutValue&(0x01<<i)) !=0) LED[i]=1;
+        else                           LED[i]=0;
 }
 
 /* ----------------------- Start implementation -----------------------------*/
@@ -72,24 +66,30 @@
 main( void )
 {
     eMBErrorCode    eStatus;
-    //Thread uart_thread(worker_uart);
-    unsigned short usSlaveID=GetValueOnDipSwitch();
     
     // Initialise some registers
     for (int i=0; i<REG_INPUT_NREGS; i++)
          usRegInputBuf[i] = 0x0;
-    
-    printf("We will set modbus slave ID-%d(0x%x) for the device.\r\n", usSlaveID, usSlaveID );
+
+    light_leds(); // Control LEDs
+        
+    printf("\n\r");
+    //printf("We will set modbus slave ID-%d(0x%x) for the device.\r\n", usSlaveID, usSlaveID );
+    printf("modbus master  : %d bps  \r\n", MODBUS_BAUDRATE);
+    printf("modbus slave ID: %d      \r\n", SLAVE_ID, SLAVE_ID );
+    printf("\r\n");
+    printf("To control modbus slave LEDs, use modbus poll\r\n");
+    printf("command: ID= %d, Func = 6, Addr = %d, Data = LED[x] -- Write Single Register\r\n", SLAVE_ID, eData_DO);
 
     /* Enable the Modbus Protocol Stack. */
-    if ( (eStatus = eMBInit( MB_RTU, usSlaveID, 0, 115200, MB_PAR_NONE )) !=  MB_ENOERR )
+    if ( (eStatus = eMBInit( MB_RTU, SLAVE_ID, 0, MODBUS_BAUDRATE, MB_PAR_NONE )) !=  MB_ENOERR )
         goto FAIL_MB;
     else if ( (eStatus = eMBEnable(  ) ) != MB_ENOERR )
         goto FAIL_MB_1;
     else {
         for( ;; )
         {
-            xMBPortSerialPolling();
+            xMBPortSerialPolling();           
             if ( eMBPoll( ) != MB_ENOERR ) break;
         }       
     }    
@@ -105,9 +105,6 @@
     }
 }
 
-
-
-
 eMBErrorCode
 eMBRegInputCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs )
 {
@@ -132,10 +129,10 @@
     {
         eStatus = MB_ENOREG;
     }
-
+ 
     return eStatus;
 }
-
+ 
 eMBErrorCode
 eMBRegHoldingCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs, eMBRegisterMode eMode )
 {
@@ -147,8 +144,7 @@
         
     if (eMode == MB_REG_READ)
     {
-        usRegInputBuf[eData_DI] = GetValueOnDipSwitch();
-
+        printf("modbus : MB REG READ...\r\n");
         if( ( usAddress >= REG_INPUT_START )
             && ( usAddress + usNRegs <= REG_INPUT_START + REG_INPUT_NREGS ) )
         {
@@ -164,36 +160,38 @@
             }
         }
     }
-
+ 
     if (eMode == MB_REG_WRITE)
     {
+        printf("modbus : MB REG Write...\r\n");
         if( ( usAddress >= REG_INPUT_START )
             && ( usAddress + usNRegs <= REG_INPUT_START + REG_INPUT_NREGS ) )
         {
-            iRegIndex = ( int )( usAddress - usRegInputStart );
+            iRegIndex = ( int )( usAddress - usRegInputStart );            
             while( usNRegs > 0 )
             {
-                usRegInputBuf[iRegIndex] =  ((unsigned int) *pucRegBuffer << 8) | ((unsigned int) *(pucRegBuffer+1));
+                usRegInputBuf[iRegIndex] =  ((unsigned int) *pucRegBuffer << 8) | ((unsigned int) *(pucRegBuffer+1));                
                 pucRegBuffer+=2;
                 iRegIndex++;
                 usNRegs--;
-            }
+            }                     
+            light_leds(); // Control LEDs
         }
     }
-
+ 
     led3=!led3;
         
     return eStatus;
 }
-
-
+ 
+ 
 eMBErrorCode
 eMBRegCoilsCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNCoils,
                eMBRegisterMode eMode )
 {
     return MB_ENOREG;
 }
-
+ 
 eMBErrorCode
 eMBRegDiscreteCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNDiscrete )
 {