Diff: hl_bertl_portex.cpp

Revision:

1:b924729b5734

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/hl_bertl_portex.cpp	Mon Apr 18 10:07:53 2016 +0000
@@ -0,0 +1,102 @@
+#include "mbed.h"
+#include "hl_bertl_portex.h"
+
+PortEx::PortEx() :
+    _i2c(p28,p27), _p6Event(p6)
+{
+    btns=btnEvent=0;
+    useISR = 1;
+}
+
+void PortEx::Init()
+{
+    char cmd[4];
+    _i2c.frequency(100000);
+    wait(0.01);
+    // Port0 Config  Port0 Out    Port1 In
+    cmd[0]=0x06;
+    cmd[1]=0x00;
+    cmd[2]=0xFF;
+    _i2c.write(DEV, cmd, 3, false);
+    SetLedPort(0);
+    _p6Event.fall(this, &PortEx::p6ISR);
+}
+
+void PortEx::p6ISR()
+{
+    if( !useISR )
+        return;
+    int16_t prev = btns;
+    ReadButtons();
+    if( !btns )
+        btns = prev;
+    else
+        btnEvent = 1;
+}
+
+void PortEx::SetLedPort(uint8_t aBitPattern)
+{
+    char cmd[4];
+    cmd[0]=2;
+    cmd[1]=~aBitPattern;
+    _i2c.write(DEV, cmd, 2, false);
+}
+
+void PortEx::SetLeds(uint8_t aBitPattern)
+{
+    _currLeds |= aBitPattern;
+    SetLedPort(_currLeds);
+}
+
+void PortEx::ToggleLeds(uint8_t aBitPattern)
+{
+    _currLeds ^= aBitPattern;
+    SetLedPort(_currLeds);
+}
+
+void PortEx::ClearLeds()
+{
+    _currLeds=0;
+    SetLedPort(0);
+}
+
+
+void PortEx::ReadButtons()
+{
+    char cmd[4];
+    cmd[0]=1;
+    _i2c.write(DEV, cmd, 1, true);
+    _i2c.read(DEV|1, cmd, 1, false);
+    btns = cmd[0];
+}
+
+void PortEx::WaitUntilButtonPressed()
+{
+    int prev = useISR;
+    useISR = 0;
+    btns = 0;
+    while(1) {
+        ReadButtons();
+        if( btns )
+            break;
+        wait(0.01);
+    }
+    btns=btnEvent=0;
+    useISR = prev;
+}
+
+void PortEx::WaitUntilFrontButtonPressed()
+{
+    int prev = useISR;
+    useISR = 0;
+    btns = 0;
+    while(1) {
+        ReadButtons();
+        if( IsAnyFrontButton() )
+            break;
+        wait(0.01);
+    }
+    btns=btnEvent=0;
+    useISR = prev;
+}
+