peripheral.c

浏览该文件的文档.

 
#include <xwcd/ds/standard.h>
#include <xwcd/ds/spi/peripheral.h>
 
static __xwds_vop
xwer_t xwds_spip_vop_probe(struct xwds_spip * spip);
 
static __xwds_vop
xwer_t xwds_spip_vop_remove(struct xwds_spip * spip);
 
static __xwds_vop
xwer_t xwds_spip_vop_start(struct xwds_spip * spip);
 
static __xwds_vop
xwer_t xwds_spip_vop_stop(struct xwds_spip * spip);
 
#if defined(XWCDCFG_ds_PM) && (1 == XWCDCFG_ds_PM)
static __xwds_vop
xwer_t xwds_spip_vop_suspend(struct xwds_spip * spip);
 
static __xwds_vop
xwer_t xwds_spip_vop_resume(struct xwds_spip * spip);
#endif
 
__xwds_rodata const struct xwds_virtual_operation xwds_spip_vop = {
        .probe = (void *)xwds_spip_vop_probe,
        .remove = (void *)xwds_spip_vop_remove,
        .start = (void *)xwds_spip_vop_start,
        .stop = (void *)xwds_spip_vop_stop,
#if defined(XWCDCFG_ds_PM) && (1 == XWCDCFG_ds_PM)
        .suspend = (void *)xwds_spip_vop_suspend,
        .resume = (void *)xwds_spip_vop_resume,
#endif
};
 
/******** ******** ******** constructor & destructor ******** ******** ********/
__xwds_api
void xwds_spip_construct(struct xwds_spip * spip)
{
        xwds_device_construct(&spip->dev);
        spip->dev.vop = &xwds_spip_vop;
}
 
__xwds_api
void xwds_spip_destruct(struct xwds_spip * spip)
{
        xwds_device_destruct(&spip->dev);
}
 
__xwds_api
xwer_t xwds_spip_grab(struct xwds_spip * spip)
{
        return xwds_device_grab(&spip->dev);
}
 
__xwds_api
xwer_t xwds_spip_put(struct xwds_spip * spip)
{
        return xwds_device_put(&spip->dev);
}
 
/******** ******** base virtual operations ******** ********/
static __xwds_vop
xwer_t xwds_spip_vop_probe(struct xwds_spip * spip)
{
        xwer_t rc;
 
        rc = xwds_device_vop_probe(&spip->dev);
        if (rc < 0) {
                goto err_dev_vop_probe;
        }
        return XWOK;
 
err_dev_vop_probe:
        return rc;
}
 
static __xwds_vop
xwer_t xwds_spip_vop_remove(struct xwds_spip * spip)
{
        xwer_t rc;
 
        XWDS_VALIDATE(spip->bus, "nullptr", -EHOSTUNREACH);
 
        rc = xwds_device_vop_remove(&spip->dev);
        if (rc < 0) {
                goto err_dev_vop_remove;
        }
        return XWOK;
 
err_dev_vop_remove:
        return rc;
}
 
static __xwds_vop
xwer_t xwds_spip_vop_start(struct xwds_spip * spip)
{
        xwer_t rc;
 
        if (spip->bus) {
                rc = xwds_spim_grab(spip->bus);
        } else {
                rc = -EHOSTUNREACH;
        }
        if (rc < 0) {
                goto err_spim_grab;
        }
        rc = xwds_device_vop_start(&spip->dev);
        if (rc < 0) {
                goto err_dev_vop_start;
        }
        return XWOK;
 
err_dev_vop_start:
        xwds_spim_put(spip->bus);
err_spim_grab:
        return rc;
}
 
static __xwds_vop
xwer_t xwds_spip_vop_stop(struct xwds_spip * spip)
{
        xwer_t rc;
 
        XWDS_VALIDATE(spip->bus, "nullptr", -EHOSTUNREACH);
 
        rc = xwds_device_vop_stop(&spip->dev);
        if (rc < 0) {
                goto err_dev_vop_stop;
        }
        xwds_spim_put(spip->bus);
        return XWOK;
 
err_dev_vop_stop:
        return rc;
}
 
#if (defined(XWCDCFG_ds_PM)) && (1 == XWCDCFG_ds_PM)
/******** ******** pm ******** ********/
static __xwds_vop
xwer_t xwds_spip_vop_suspend(struct xwds_spip * spip)
{
        xwer_t rc;
 
        XWDS_VALIDATE(spip->bus, "nullptr", -EHOSTUNREACH);
 
        rc = xwds_device_vop_suspend(&spip->dev);
        if (rc < 0) {
                goto err_dev_vop_suspend;
        }
        xwds_spim_put(spip->bus);
        return XWOK;
 
err_dev_vop_suspend:
        return rc;
}
 
static __xwds_vop
xwer_t xwds_spip_vop_resume(struct xwds_spip * spip)
{
        xwer_t rc;
 
        if (spip->bus) {
                rc = xwds_spim_grab(spip->bus);
        } else {
                rc = -EHOSTUNREACH;
        }
        if (rc < 0) {
                goto err_spim_grab;
        }
        rc = xwds_device_vop_resume(&spip->dev);
        if (rc < 0) {
                goto err_dev_vop_resume;
        }
        return XWOK;
 
err_dev_vop_resume:
        xwds_spim_put(spip->bus);
err_spim_grab:
        return rc;
}
#endif