X-Git-Url: https://git.rohieb.name/openwrt.git/blobdiff_plain/2d2ad6f7042e9f6c3f7574958016b3cc8aa77d28..ef0f04cf2591d7c9ca2cc2d3ba1bcb291e3d4d1f:/package/mmc_over_gpio/files/mmc_over_gpio.init

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"
 }