Handle bonescript compatible pin names in ocp set pin mode function (bonescript uses eg, P8_6 instead of P8_06 which OCP needs)

Author: JesseMcL

source/c_pinmux.c

@@ -10,19 +10,25 @@ BBIO_err set_pin_mode(const char *key, const char *mode)
 	// char ocp_dir[] defined in common.h
 	char path[60]; // "/sys/devices/platform/ocp/ocp:P#_##_pinmux/state"
 	char pinmux_dir[20]; // "ocp:P#_##_pinmux"
+	char pin[6]; //"P#_##"
 	FILE *f = NULL;
+	
+	if (strlen(key) == 4)	// Key P#_# format, must inject '0' to be P#_0#
+		snprintf(pin, sizeof(pin), "%.3s0%c", key,key[3]);
+	else	//copy string
+		snprintf(pin, sizeof(pin), "%s", key);
 
 #ifndef BBBVERSION41
 	BBIO_err err;
-	err = build_path("/sys/devices", "ocp", ocp_dir, sizeof(ocp_dir));
+	err = build_path("/sys/devices/platform", "ocp", ocp_dir, sizeof(ocp_dir));
 	if (err != BBIO_OK) {
 		return err;
 	}
 #else
 	strncpy(ocp_dir, "/sys/devices/platform/ocp", sizeof(ocp_dir));
 #endif
 
-	snprintf(pinmux_dir, sizeof(pinmux_dir), "ocp:%s_pinmux", key);
+	snprintf(pinmux_dir, sizeof(pinmux_dir), "ocp:%s_pinmux", pin);
 	snprintf(path, sizeof(path), "%s/%s/state", ocp_dir, pinmux_dir);
 
 	f = fopen(path, "w");