Implement api docking of rt_pin_get. (#6102)

* Implement api docking of rt_pin_get.
This commit is contained in:
solar_li 2022-06-23 21:26:55 +08:00 committed by GitHub
parent 8275e90203
commit 8f09245ed5
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
1 changed files with 43 additions and 1 deletions

View File

@ -6,6 +6,7 @@
* Change Logs:
* Date Author Notes
* 2018-4-30 misonyo the first version.
* 2022-6-22 solar Implement api docking of rt_pin_get.
*/
#include <rtthread.h>
@ -20,6 +21,8 @@
#define LOG_TAG "drv.gpio"
#include <drv_log.h>
#define IMX_PIN_NUM(port, no) (((((port) & 0x5u) << 5) | ((no) & 0x1Fu)))
#if defined(FSL_SDK_DISABLE_DRIVER_CLOCK_CONTROL) && FSL_SDK_DISABLE_DRIVER_CLOCK_CONTROL
#error "Please don't define 'FSL_SDK_DISABLE_DRIVER_CLOCK_CONTROL'!"
#endif
@ -758,6 +761,45 @@ static rt_err_t imxrt_pin_irq_enable(struct rt_device *device, rt_base_t pin, rt
return RT_EOK;
}
/* Example of use: Px.0 ~ Px.31, x:1,2,3,4,5 */
static rt_base_t imxrt_pin_get(const char *name)
{
rt_base_t pin = 0;
int hw_port_num, hw_pin_num = 0;
int i, name_len;
name_len = rt_strlen(name);
if ((name_len < 4) || (name_len >= 6))
{
return -RT_EINVAL;
}
if ((name[0] != 'P') || (name[2] != '.'))
{
return -RT_EINVAL;
}
if ((name[1] >= '1') && (name[1] <= '5'))
{
hw_port_num = (int)(name[1] - '1');
}
else
{
return -RT_EINVAL;
}
for (i = 3; i < name_len; i++)
{
hw_pin_num *= 10;
hw_pin_num += name[i] - '0';
}
pin = IMX_PIN_NUM(hw_port_num, hw_pin_num);
return pin;
}
const static struct rt_pin_ops imxrt_pin_ops =
{
imxrt_pin_mode,
@ -766,7 +808,7 @@ const static struct rt_pin_ops imxrt_pin_ops =
imxrt_pin_attach_irq,
imxrt_pin_detach_irq,
imxrt_pin_irq_enable,
RT_NULL,
imxrt_pin_get,
};
int rt_hw_pin_init(void)