From e3731bdaa7f1a79e88632c277eb8486d479493a5 Mon Sep 17 00:00:00 2001
From: Ricardo Martins <rasm@oceanscan-mst.com>
Date: Wed, 30 Sep 2015 18:08:10 +0100
Subject: [PATCH] escc: updated package to match 1.9.x developments.

---
 rules/escc/default.bash                 |  8 ++++----
 rules/escc/fs/etc/escc/hg1700-psimar.sh | 18 ++++++++++++------
 rules/escc/fs/etc/escc/hg1700.sh        | 10 +++++++++-
 rules/escc/fs/etc/escc/ifog-imu-1-a.sh  | 16 +++++++++++-----
 rules/escc/fs/etc/rc.d/escc             |  8 ++++++++
 5 files changed, 44 insertions(+), 16 deletions(-)

diff --git a/rules/escc/default.bash b/rules/escc/default.bash
index 8cd10ea..af95772 100644
--- a/rules/escc/default.bash
+++ b/rules/escc/default.bash
@@ -1,6 +1,6 @@
 version=\
 (
-    '1.0.5'
+    '1.0.6'
 )
 
 url=\
@@ -10,7 +10,7 @@ url=\
 
 md5=\
 (
-    '8400860f2daa98d559b1b9b6fcc630c2'
+    '07783e66e27601ab0a8250c328b3d6bf'
 )
 
 if [ -d "$cfg_dir_builds/linux/linux-"* ]; then
@@ -25,7 +25,7 @@ build()
         M=`pwd` \
         -C "$kernel" &&
 
-    for util in setescc esccclock esccsettings; do
+    for util in setescc esccclock esccsettings esccfs6131; do
         make CC="$cmd_target_cc" -C "utils/$util"
     done
 }
@@ -40,7 +40,7 @@ target_install()
         -C "$kernel" \
         modules_install &&
 
-    for util in setescc esccclock esccsettings; do
+    for util in setescc esccclock esccsettings esccfs6131; do
         $cmd_target_strip "utils/$util/$util" -o "$cfg_dir_rootfs/usr/bin/$util"
     done &&
 
diff --git a/rules/escc/fs/etc/escc/hg1700-psimar.sh b/rules/escc/fs/etc/escc/hg1700-psimar.sh
index 66e2571..e37779e 100755
--- a/rules/escc/fs/etc/escc/hg1700-psimar.sh
+++ b/rules/escc/fs/etc/escc/hg1700-psimar.sh
@@ -1,9 +1,15 @@
-# IMU
-/usr/bin/setescc 0 0x200 5 0 0 0
-/usr/bin/esccclock 0 0x5d1460 23
-/usr/bin/esccsettings 0 /etc/escc/hg1700.cfg
+# Channels:
+# * 0: Honeywell HG1700
+# * 1: LSTS PSIMAR
 
-# PSIMAR
+# Create channels.
+/usr/bin/setescc 0 0x200 5 0 0 0
 /usr/bin/setescc 1 0x200 5 0 0 1
+
+# Set clocks (Hz).
+"$cmd_escc_set_clock" 0 1000000
+"$cmd_escc_set_clock" 1 25804800
+
+# Set registers.
+/usr/bin/esccsettings 0 /etc/escc/hg1700.cfg
 /usr/bin/esccsettings 1 /etc/escc/psimar.cfg
-/usr/bin/esccclock 1 0xc8920 22
diff --git a/rules/escc/fs/etc/escc/hg1700.sh b/rules/escc/fs/etc/escc/hg1700.sh
index 2bdb0d9..3a71dda 100755
--- a/rules/escc/fs/etc/escc/hg1700.sh
+++ b/rules/escc/fs/etc/escc/hg1700.sh
@@ -1,3 +1,11 @@
+# Channels:
+# * 0: Honeywell HG1700
+
+# Create channels.
 /usr/bin/setescc 0 0x200 5 0 0 0
-/usr/bin/esccclock 0 0x5d1460 23
+
+# Set clocks (Hz).
+"$cmd_escc_set_clock" 0 1000000
+
+# Set registers.
 /usr/bin/esccsettings 0 /etc/escc/hg1700.cfg
diff --git a/rules/escc/fs/etc/escc/ifog-imu-1-a.sh b/rules/escc/fs/etc/escc/ifog-imu-1-a.sh
index 98f27e9..299734b 100755
--- a/rules/escc/fs/etc/escc/ifog-imu-1-a.sh
+++ b/rules/escc/fs/etc/escc/ifog-imu-1-a.sh
@@ -1,8 +1,14 @@
-# IMU
-/usr/bin/setescc 0 0x200 5 0 0 0
-/usr/bin/esccsettings 0 /etc/escc/ifog-imu-1-a.cfg
+# Channels:
+# * 0: iMAR iFOG-IMU-1-A
+# * 1: LSTS PSIMAR
 
-# PSIMAR
+# Create channels.
+/usr/bin/setescc 0 0x200 5 0 0 0
 /usr/bin/setescc 1 0x200 5 0 0 1
+
+# Set clock.
+"$cmd_escc_set_clock" 1 25804800
+
+# Set registers.
+/usr/bin/esccsettings 0 /etc/escc/ifog-imu-1-a.cfg
 /usr/bin/esccsettings 1 /etc/escc/psimar.cfg
-/usr/bin/esccclock 1 0xc8920 22
diff --git a/rules/escc/fs/etc/rc.d/escc b/rules/escc/fs/etc/rc.d/escc
index 9d2d3d8..7c2eabb 100644
--- a/rules/escc/fs/etc/rc.d/escc
+++ b/rules/escc/fs/etc/rc.d/escc
@@ -5,6 +5,14 @@ start()
     mknod /dev/escc0 c 261 0 &&
     rm -f /dev/escc1 &&
     mknod /dev/escc1 c 261 1 &&
+
+    # Clock command.
+    if [ -z "$cfg_escc_et" ]; then
+        cmd_escc_set_clock='/usr/bin/esccclock'
+    else
+        cmd_escc_set_clock='/usr/bin/esccfs6131'
+    fi &&
+
     if [ -f "$cfg_escc_script" ]; then
         source "$cfg_escc_script"
     fi