2 files changed, 31 insertions, 4 deletions
diff --git a/package/mmc_over_gpio/files/mmc_over_gpio.config b/package/mmc_over_gpio/files/mmc_over_gpio.config
new file mode 100644
index 000000000..77a9e304c
--- /dev/null
+++ b/package/mmc_over_gpio/files/mmc_over_gpio.config
@@ -0,0 +1,8 @@
+config 'mmc_over_gpio'
+	option 'name' 'default'
+	option 'enabled' '0'
+	option 'DI_pin' '1'
+	option 'DO_pin' '3'
+	option 'CLK_pin' '4'
+	option 'CS_pin' '7'
+	option 'mode' '0'
diff --git a/package/mmc_over_gpio/files/mmc_over_gpio.init b/package/mmc_over_gpio/files/mmc_over_gpio.init
index e276dfd1c..121c80398 100644
--- a/package/mmc_over_gpio/files/mmc_over_gpio.init
+++ b/package/mmc_over_gpio/files/mmc_over_gpio.init
@@ -8,7 +8,7 @@ CONFIGFS_DIR="/config/gpiommc"
 add_device() {
 	local dir="$CONFIGFS_DIR/$1"
 
-	mkdir $dir
+	mkdir -p $dir
 	[ $? -eq 0 ] || return 1
 	echo $2 > $dir/gpio_data_in
 	[ $? -eq 0 ] || return 1
@@ -50,15 +50,34 @@ mount_configfs() {
 	return 0
 }
 
+start_service() {
+	local section="$1"
+	config_get "name" "$section" "name"
+	config_get "DI_pin" "$section" "DI_pin"
+	config_get "DO_pin" "$section" "DO_pin"
+	config_get "CLK_pin" "$section" "CLK_pin"
+	config_get "CS_pin" "$section" "CS_pin"
+	config_get "mode" "$section" "mode"
+	config_get_bool "enabled" "$section" "enabled" '1'
+	[ "$enabled" -gt 0 ] && add_device "$name" $DI_pin $DO_pin $CLK_pin $CS_pin $mode &
+}
+
+stop_service() {
+	local section="$1"
+	config_get "name" "$section" "name"
+	remove_device "$name"
+}
+
 start() {
 	# Make sure configfs is mounted
 	mount_configfs
 	[ $? -eq 0 ] || return 1
 
-	#FIXME we should use a config file, but I dunno how that parser works.
-	add_device "default" 5 4 3 7 0
+	config_load "mmc_over_gpio"
+	config_foreach start_service "mmc_over_gpio"
 }
 
 stop() {
-	remove_device "default"
+	config_load "mmc_over_gpio"
+	config_foreach stop_service "mmc_over_gpio"
 }