Revision 4:cad5a10b7007, committed 2016-03-07

Comitter:

syafiq8530

Date:

Mon Mar 07 05:28:28 2016 +0000

Parent:

3:999285691154

Commit message:

update test motor

Changed in this revision

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/i2clcd.lib	Mon Mar 07 05:28:28 2016 +0000
@@ -0,0 +1,1 @@
+https://developer.mbed.org/teams/easytronic/code/testmotor/#e6225ada294a

--- a/i2clcd/TextLCD.cpp	Mon Jan 18 05:14:42 2016 +0000
+++ /dev/null	Thu Jan 01 00:00:00 1970 +0000
@@ -1,195 +0,0 @@
-/* mbed I2CTextLCD Library, for a 4-bit LCD driven by I2C and a PCF8574
- * Copyright (c) 2007-2010, sford, rcocking
- *
- * Permission is hereby granted, free of charge, to any person obtaining a copy
- * of this software and associated documentation files (the "Software"), to deal
- * in the Software without restriction, including without limitation the rights
- * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
- * copies of the Software, and to permit persons to whom the Software is
- * furnished to do so, subject to the following conditions:
- *
- * The above copyright notice and this permission notice shall be included in
- * all copies or substantial portions of the Software.
- *
- * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
- * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
- * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
- * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
- * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
- * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
- * THE SOFTWARE.
- */
-
-/* This is a hack of Simon Ford's direct-driven TextLCD code.
-* It should be refactored to extract a common superclass
-* but my C++ isn't yet good enough :) 
-*
-* The code assumes the following connections between the PCF8574
-* and the LCD
-* 
-* nc  - D0
-* nc  - D1
-* nc  - D2
-* nc  - D3
-* P0  - D4
-* P1  - D5
-* P2  - D6
-* P3  - D7
-* P4  - E
-* P5  - nc
-* P6  - nc
-* P7  - RS
-* gnd - R/W
-*
-* D0-3 of the LCD are not connected because we work in 4-bit mode
-* R/W is hardwired to gound, as we only ever write to the LCD
-* A0-2 on the PCF8574 can be set in any combination; you will need to modify
-* the I2C address in the I2CTextLCD constructor.
-* Remember that the mbed uses 8-bit addresses, which should be
-* in the range 0x40-0x4E for the PCF8574
-*/
-#include "TextLCD.h"
-#include "mbed.h"
-
-
-TextLCD::TextLCD(PinName sda, PinName scl, int i2cAddress, LCDType type) : _i2c(sda, scl), _type(type) {
-    _i2cAddress = i2cAddress;
-    wait(0.015);        // Wait 15ms to ensure powered up
-
-    // send "Display Settings" 3 times (Only top nibble of 0x30 as we've got 4-bit bus)
-    for (int i=0; i<3; i++) {
-        writeByte(0x3, false);
-        wait(0.00164);  // this command takes 1.64ms, so wait for it
-    }
-    writeByte(0x2, false);     // 4-bit mode
-    wait(0.000040f);    // most instructions take 40us
-
-    writeCommand(0x28); // Function set 001 BW N F - -
-    writeCommand(0x0C);
-    writeCommand(0x6);  // Cursor Direction and Display Shift : 0000 01 CD S (CD 0-left, 1-right S(hift) 0-no, 1-yes
-    cls();
-}
-
-void TextLCD::character(int column, int row, int c) {
-    int a = address(column, row);
-    writeCommand(a);
-    writeData(c);
-}
-
-void TextLCD::cls() {
-    writeCommand(0x01); // cls, and set cursor to 0
-    wait(0.00164f);     // This command takes 1.64 ms
-    locate(0, 0);
-}
-
-void TextLCD::locate(int column, int row) {
-    _column = column;
-    _row = row;
-}
-
-int TextLCD::_putc(int value) {
-    if (value == '\n') {
-        _column = 0;
-        _row++;
-        if (_row >= rows()) {
-            _row = 0;
-        }
-    } else {
-        character(_column, _row, value);
-        _column++;
-        if (_column >= columns()) {
-            _column = 0;
-            _row++;
-            if (_row >= rows()) {
-                _row = 0;
-            }
-        }
-    }
-    return value;
-}
-
-int TextLCD::_getc() {
-    return -1;
-}
-
-void TextLCD::writeI2CByte(int data) {
-    // equivalent to writeI2CByte
-    char * cmd = new char[1];
-    cmd[0] = data;
-    _i2c.write(_i2cAddress, cmd, 1);
-}
-
-void TextLCD::writeNibble(int data, bool rs) {
-    data = data << 4;
-    data |= BL_ON; // E on
-    if (rs) {
-        data = data | RS_ON; // set rs bit
-    }
-    data |= E_ON; // E on
-    writeI2CByte(data);
-    data ^= E_ON; // E off
-    wait_us(1);
-    writeI2CByte(data);
-    wait_us(1000);
-}
-
-void TextLCD::writeByte(int data, bool rs) {
-    writeNibble(data >> 4, rs);
-    writeNibble(data & 0x0F, rs);
-}
-
-void TextLCD::writeCommand(int command) {
-    // equivalent to ard commandWrite
-    writeByte(command, false);
-}
-
-void TextLCD::writeData(int data) {
-
-    writeByte(data, true);
-}
-
-int TextLCD::address(int column, int row) {
-    switch (_type) {
-        case LCD20x4:
-            switch (row) {
-                case 0:
-                    return 0x80 + column;
-                case 1:
-                    return 0xc0 + column;
-                case 2:
-                    return 0x94 + column;
-                case 3:
-                    return 0xd4 + column;
-            }
-        case LCD16x2B:
-            return 0x80 + (row * 40) + column;
-        case LCD16x2:
-        case LCD20x2:
-        default:
-            return 0x80 + (row * 0x40) + column;
-    }
-}
-
-int TextLCD::columns() {
-    switch (_type) {
-        case LCD20x4:
-        case LCD20x2:
-            return 20;
-        case LCD16x2:
-        case LCD16x2B:
-        default:
-            return 16;
-    }
-}
-
-int TextLCD::rows() {
-    switch (_type) {
-        case LCD20x4:
-            return 4;
-        case LCD16x2:
-        case LCD16x2B:
-        case LCD20x2:
-        default:
-            return 2;
-    }
-}

--- a/i2clcd/TextLCD.h	Mon Jan 18 05:14:42 2016 +0000
+++ /dev/null	Thu Jan 01 00:00:00 1970 +0000
@@ -1,122 +0,0 @@
-/* mbed TextLCD Library, for a 4-bit LCD based on HD44780
- * Copyright (c) 2007-2010, sford
- *
- * Permission is hereby granted, free of charge, to any person obtaining a copy
- * of this software and associated documentation files (the "Software"), to deal
- * in the Software without restriction, including without limitation the rights
- * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
- * copies of the Software, and to permit persons to whom the Software is
- * furnished to do so, subject to the following conditions:
- *
- * The above copyright notice and this permission notice shall be included in
- * all copies or substantial portions of the Software.
- *
- * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
- * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
- * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
- * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
- * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
- * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
- * THE SOFTWARE.
- */
-
-#ifndef MBED_TEXTLCD_H
-#define MBED_TEXTLCD_H
-
-#include "mbed.h"
-
-//#define E_ON 0x10
-//#define RS_ON 0x80
-
-#define E_ON 0x04
-#define RS_ON 0x01
-#define RW_ON 0x02
-#define BL_ON 0x08
-
-/** A TextLCD interface for driving 4-bit HD44780-based LCDs
- *
- * Currently supports 16x2, 20x2 and 20x4 panels
- *
- * @code
- * #include "mbed.h"
- * #include "TextLCD.h"
- * 
- * TextLCD lcd(p10, p12, p15, p16, p29, p30); // rs, e, d0-d3
- * 
- * int main() {
- *     lcd.printf("Hello World!\n");
- * }
- * @endcode
- */
-class TextLCD : public Stream {
-public:
-
-    /** LCD panel format */
-    enum LCDType {
-        LCD16x2     /**< 16x2 LCD panel (default) */
-        , LCD16x2B  /**< 16x2 LCD panel alternate addressing */
-        , LCD20x2   /**< 20x2 LCD panel */
-        , LCD20x4   /**< 20x4 LCD panel */
-    };
-
-    /** Create a TextLCD interface
-     *
-     * @param rs    Instruction/data control line
-     * @param e     Enable line (clock)
-     * @param d0-d3 Data lines
-     * @param type  Sets the panel size/addressing mode (default = LCD16x2)
-     */
-    TextLCD(PinName sda, PinName scl, int i2cAddress = 0x4E, LCDType type = LCD20x4);
-
-#if DOXYGEN_ONLY
-    /** Write a character to the LCD
-     *
-     * @param c The character to write to the display
-     */
-    int putc(int c);
-
-    /** Write a formated string to the LCD
-     *
-     * @param format A printf-style format string, followed by the
-     *               variables to use in formating the string.
-     */
-    int printf(const char* format, ...);
-#endif
-
-    /** Locate to a screen column and row
-     *
-     * @param column  The horizontal position from the left, indexed from 0
-     * @param row     The vertical position from the top, indexed from 0
-     */
-    void locate(int column, int row);
-
-    /** Clear the screen and locate to 0,0 */
-    void cls();
-
-    int rows();
-    int columns();
-
-protected:
-
-    // Stream implementation functions
-    virtual int _putc(int value);
-    virtual int _getc();
-
-    int address(int column, int row);
-    void character(int column, int row, int c);
-    void writeByte(int value, bool rs);
-    void writeCommand(int command);
-    void writeData(int data);
-    void writeNibble(int value, bool rs);
-    void writeI2CByte(int data); 
-
-    LCDType _type;
-    int _rs;
-    I2C _i2c;
-    int _i2cAddress;
-
-    int _column;
-    int _row;
-};
-
-#endif

--- a/main.cpp	Mon Jan 18 05:14:42 2016 +0000
+++ b/main.cpp	Mon Mar 07 05:28:28 2016 +0000
@@ -1,28 +1,193 @@
+#define NSAMPLES 2500
+#define NSAMPLING 50
+#define V_max 3.3
+
 #include "mbed.h"
 #include "TextLCD.h"
 
-TextLCD lcd(p9,p10); 
-AnalogIn analog_value(p20);
-Serial pc ( USBTX , USBRX ) ; 
-DigitalOut led(LED1);
+
+TextLCD lcd(I2C_SDA,I2C_SCL); 
+//Serial pc ( USBTX , USBRX ) ; 
+//DigitalOut led(LED1);
+
+DigitalIn sw_start(D10,PullUp);
+DigitalIn sw_stop(D11,PullUp);
+DigitalOut motor(D9);
+DigitalOut solenoid(D7);
+DigitalIn lim_1(D2,PullUp);
+DigitalIn lim_2(D3,PullUp);
+DigitalIn lim_3(D4,PullUp);
+AnalogIn ain_1(A0);
+
+
+double vref_1 = 0.0;
+//double v_read=0;
+double v_max;
+
+int readc=100;
+char sequence=0;
+
+void motorcon();
+void press_separuh();
+void press_penuh();
+void current_disp();
+
 
 int main() {
-    float meas;
-    
-    printf("\nAnalogIn example\n");
+   
+   solenoid=1;
+   //acquiring v_ref
+    for (int i=0; i<NSAMPLES; i++) {
+        vref_1 += ain_1;
+    }
+    vref_1 /= NSAMPLES;
+    lcd.printf("Vref 1: %.4f\n", vref_1);
+    //lcd.printf("AnalogIn example");
+   // lcd.locate(0,1);
+   // lcd.printf("TIN CRUSHER");
+    wait(3);
     
     while(1) {
-        meas = analog_value; // Converts and read the analog input value (value from 0.0 to 1.0)
-        meas = meas * 3.3; // Change the value to be in the 0 to 3300 range
-        printf("measure = %.3f V\n", meas);
-        lcd.locate(4,2);
-         lcd.printf("measure = %.3f V", meas);
-        if (meas > 2) { // If the value is greater than 2V then switch the LED on
-          led = 1;
-        }
-        else {
-          led = 0;
-        }
-        wait(0.5); // 200 ms
+        //meas = analog_value; // Converts and read the analog input value (value from 0.0 to 1.0)
+       // value = analog_value* 3300; // Change the value to be in the 0 to 3300 range
+      //  printf("measure = %.3f V\n", meas);
+      //  lcd.locate(0,0);
+      //  lcd.printf("measure = %d mV \n", value);
+      //  lcd.printf("diff = %d mV  \n", value-start_value);
+      //  if((value >0 && value>oldvalue )|| (value<0 && value<oldvalue ))
+      //     lcd.printf("peak = %d mV ",value-start_value);
+      //  oldvalue=value;
+     //  lcd.locate(0,2);
+      //   motorcon();
+    //   lcd.printf("value %d",value);
+        current_disp();
+        v_max=0; //clear v_max
+        motorcon();
+      /// wait(0.5); // 200 ms
+        
+    }
+}
+
+void motorcon()
+{   char i=0;
+    if(sw_start==0)
+    {   while(sw_start==0)
+        {   wait(0.1);
+            i++;              ///tekan kurang dari satu sec gerak separuh
+            }
+       if(i>5)
+        press_penuh();  
+        else
+         press_separuh();
+        
+        //while(sw_start==0); /// selagi tekan duk sini        
+    }
+    else if(sw_stop==1)
+    {   motor=0;      
+        while(sw_stop==1); /// selagi tekan duk sini     
+       
     }
 }
+
+
+void press_separuh()
+{   while(1)
+    {    motor=1;
+        lcd.cls();
+         lcd.printf("press separuh\n");
+        lcd.printf("init pos\n");
+      
+        while(lim_1==1)
+         {   current_disp();
+            if(sw_stop==1)
+              break;
+           }  
+     
+        solenoid=0;
+        lcd.printf("press down\n");
+        while(lim_2==1)
+        {   current_disp();
+              if(sw_stop==1)
+                break;    
+        }
+        
+        solenoid=1;
+        lcd.printf("up position\n");
+        while(lim_1==1)
+            {  current_disp();
+               if(sw_stop==1)
+                break;
+            }
+      
+        lcd.cls();
+         motor=0; 
+         break;   
+    }
+}
+
+
+
+    
+void press_penuh()
+{   while(1)
+    {    motor=1;
+        lcd.cls();
+         lcd.printf("press penuh\n");
+        lcd.printf("init pos\n");
+      
+        while(lim_1==1)
+        {   current_disp();
+            if(sw_stop==1)
+                break;
+            }
+     
+        solenoid=0;
+        lcd.printf("press down\n");
+        while(lim_3==1)
+        {   current_disp();
+              if(sw_stop==1)
+                break;  
+            }  
+     
+        solenoid=1;
+        lcd.printf("up position\n");
+        while(lim_1==1)
+        {   current_disp();
+               if(sw_stop==1)
+                break;
+        }
+      
+        lcd.cls();
+         motor=0; 
+         break;   
+    }
+}
+
+void current_disp()
+{   // for (int i=0; i<NSAMPLING; i++) {
+           //acquisition
+           double sum_1 = 0.0;
+           //long v_max;
+            
+            for (int samples = 0; samples<NSAMPLES; samples++) {
+                sum_1 += ain_1;
+            }
+            sum_1 /= NSAMPLES;
+            sum_1 = (sum_1-vref_1)*V_max/0.185;
+            if(sum_1>0 && sum_1>v_max )
+                v_max=sum_1;
+            //vread
+            lcd.locate(1,2);
+            lcd.printf("c.max");
+            lcd.locate(8,2);
+            lcd.printf("%.4f A  ", v_max);//max
+            lcd.locate(1,3);
+            lcd.printf("cbace");
+                 lcd.locate(8,3);
+                lcd.printf("%.4f A  ", sum_1);//current reading
+              
+
+
+       // }
+    
+}

--- a/mbed.bld	Mon Jan 18 05:14:42 2016 +0000
+++ b/mbed.bld	Mon Mar 07 05:28:28 2016 +0000
@@ -1,1 +1,1 @@
-http://mbed.org/users/mbed_official/code/mbed/builds/7e07b6fb45cf
\ No newline at end of file
+http://mbed.org/users/mbed_official/code/mbed/builds/252557024ec3
\ No newline at end of file