Private
Public Access
2
0

pwm: added existing exposition logic

* Understands when pwm pin is already exported.
* Will not unexport if didnt export. Can be forced.

Signed-off-by: Thomas Ingleby <thomas.c.ingleby@intel.com>
Signed-off-by: Brendan Le Foll <brendan.le.foll@intel.com>
This commit is contained in:
Thomas Ingleby
2014-05-20 13:38:15 +01:00
committed by Brendan Le Foll
parent fa7180cb91
commit 5fa6f50edc
3 changed files with 66 additions and 17 deletions

View File

@@ -15,7 +15,7 @@
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND/
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
* LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
* OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
@@ -23,10 +23,12 @@
*/
#include <stdlib.h>
#include <sys/stat.h>
#include "pwm.h"
#define MAX_SIZE 64
#define SYSFS_PWM "/sys/class/pwm"
/**
* A structure representing a PWM pin
@@ -36,6 +38,7 @@ struct _pwm {
int pin; /**< the pin number, as known to the os. */
int chipid; /**< the chip id, which the pwm resides */
int duty_fp; /**< File pointer to duty file */
maa_boolean_t owner; /**< Owner of pwm context*/
/*@}*/
};
@@ -147,23 +150,33 @@ maa_pwm_init_raw(int chipin, int pin)
dev->chipid = chipin;
dev->pin = pin;
char buffer[MAX_SIZE];
snprintf(buffer, MAX_SIZE, "/sys/class/pwm/pwmchip%d/export", dev->chipid);
int export_f = open(buffer, O_WRONLY);
if (export_f == -1) {
fprintf(stderr, "Failed to open export for writing!\n");
free(dev);
return NULL;
}
char directory[MAX_SIZE];
snprintf(directory, MAX_SIZE, SYSFS_PWM "/pwmchip%d/pwm%d", dev->chipid, dev->pin);
struct stat dir;
if (stat(directory, &dir) == 0 && S_ISDIR(dir.st_mode)) {
fprintf(stderr, "PWM Pin already exporting, continuing.\n");
dev->owner = 0; // Not Owner
} else {
char buffer[MAX_SIZE];
snprintf(buffer, MAX_SIZE, "/sys/class/pwm/pwmchip%d/export", dev->chipid);
int export_f = open(buffer, O_WRONLY);
if (export_f == -1) {
fprintf(stderr, "Failed to open export for writing!\n");
free(dev);
return NULL;
}
char out[MAX_SIZE];
int size = snprintf(out, MAX_SIZE, "%d", dev->pin);
if (write(export_f, out, size*sizeof(char)) == -1) {
fprintf(stderr, "Failed to write to export! Potentially already enabled\n");
char out[MAX_SIZE];
int size = snprintf(out, MAX_SIZE, "%d", dev->pin);
if (write(export_f, out, size*sizeof(char)) == -1) {
fprintf(stderr, "Failed to write to export! Potentially already enabled\n");
close(export_f);
return NULL;
}
dev->owner = 1;
close(export_f);
}
close(export_f);
maa_pwm_setup_duty_fp(dev);
return dev;
}
@@ -247,6 +260,15 @@ maa_pwm_enable(maa_pwm_context dev, int enable)
maa_result_t
maa_pwm_unexport(maa_pwm_context dev)
{
if (dev->owner) {
return maa_pwm_unexport_force(dev);
}
return MAA_ERROR_INVALID_RESOURCE;
}
maa_result_t
maa_pwm_unexport_force(maa_pwm_context dev)
{
char filepath[MAX_SIZE];
snprintf(filepath, MAX_SIZE, "/sys/class/pwm/pwmchip%d/unexport", dev->chipid);
@@ -276,3 +298,12 @@ maa_pwm_close(maa_pwm_context dev)
free(dev);
return MAA_SUCCESS;
}
maa_result_t
maa_pwm_owner(maa_pwm_context dev, maa_boolean_t owner_new)
{
if (dev == NULL)
return MAA_ERROR_INVALID_RESOURCE;
dev->owner = owner_new;
return MAA_SUCCESS;
}