mirror of
git://projects.qi-hardware.com/ben-wpan.git
synced 2024-11-23 00:42:28 +02:00
5d63a009c8
- include/atspi.h, lib/atspi.c: new function atspi_test_mode to enter test mode - lib/driver.h (struct atspi_driver): add backend function test_mode - lib/atusb.c (atusb_test_mode), lib/atusb.c (atusb_driver): enter test mode - lib/atusd.c (atusd_driver): test mode is not supported
140 lines
2.4 KiB
C
140 lines
2.4 KiB
C
/*
|
|
* lib/atspi.c - ATSPI access functions library
|
|
*
|
|
* Written 2010 by Werner Almesberger
|
|
* Copyright 2010 Werner Almesberger
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*/
|
|
|
|
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
|
|
#include "driver.h"
|
|
#include "atspi.h"
|
|
|
|
|
|
extern struct atspi_driver atusb_driver;
|
|
extern struct atspi_driver atusd_driver;
|
|
|
|
|
|
struct atspi_dsc {
|
|
struct atspi_driver *driver;
|
|
void *handle;
|
|
};
|
|
|
|
|
|
void *atspi_usb_handle(struct atspi_dsc *dsc)
|
|
{
|
|
#ifdef HAVE_USB
|
|
return dsc->handle;
|
|
#else
|
|
return NULL;
|
|
#endif
|
|
}
|
|
|
|
|
|
int atspi_error(struct atspi_dsc *dsc)
|
|
{
|
|
return dsc->driver->error ? dsc->driver->error(dsc->handle) : 0;
|
|
}
|
|
|
|
|
|
int atspi_clear_error(struct atspi_dsc *dsc)
|
|
{
|
|
return dsc->driver->clear_error ?
|
|
dsc->driver->clear_error(dsc->handle) : 0;
|
|
}
|
|
|
|
|
|
struct atspi_dsc *atspi_open(void)
|
|
{
|
|
struct atspi_dsc *dsc;
|
|
struct atspi_driver *driver;
|
|
void *handle;
|
|
|
|
#ifdef HAVE_USB
|
|
driver = &atusb_driver;
|
|
#elif HAVE_USD
|
|
driver = &atusd_driver;
|
|
#else
|
|
#error Need either HAVE_USB or HAVE_USD
|
|
#endif
|
|
handle = driver->open();
|
|
if (!handle)
|
|
return NULL;
|
|
dsc = malloc(sizeof(*dsc));
|
|
if (!dsc) {
|
|
perror("malloc");
|
|
exit(1);
|
|
}
|
|
dsc->driver = driver;
|
|
dsc->handle = handle;
|
|
return dsc;
|
|
}
|
|
|
|
|
|
void atspi_close(struct atspi_dsc *dsc)
|
|
{
|
|
if (dsc->driver->close)
|
|
dsc->driver->close(dsc->handle);
|
|
free(dsc);
|
|
}
|
|
|
|
|
|
void atspi_reset(struct atspi_dsc *dsc)
|
|
{
|
|
if (dsc->driver->reset)
|
|
dsc->driver->reset(dsc->handle);
|
|
}
|
|
|
|
|
|
void atspi_reset_rf(struct atspi_dsc *dsc)
|
|
{
|
|
dsc->driver->reset_rf(dsc->handle);
|
|
}
|
|
|
|
|
|
int atspi_test_mode(struct atspi_dsc *dsc)
|
|
{
|
|
if (!dsc->driver->test_mode)
|
|
return 0;
|
|
dsc->driver->test_mode(dsc->handle);
|
|
return 1;
|
|
}
|
|
|
|
|
|
void atspi_reg_write(struct atspi_dsc *dsc, uint8_t reg, uint8_t value)
|
|
{
|
|
dsc->driver->reg_write(dsc->handle, reg, value);
|
|
}
|
|
|
|
|
|
uint8_t atspi_reg_read(struct atspi_dsc *dsc, uint8_t reg)
|
|
{
|
|
return dsc->driver->reg_read(dsc->handle, reg);
|
|
}
|
|
|
|
|
|
void atspi_buf_write(struct atspi_dsc *dsc, const void *buf, int size)
|
|
{
|
|
dsc->driver->buf_write(dsc->handle, buf, size);
|
|
}
|
|
|
|
|
|
int atspi_buf_read(struct atspi_dsc *dsc, void *buf, int size)
|
|
{
|
|
return dsc->driver->buf_read(dsc->handle, buf, size);
|
|
}
|
|
|
|
|
|
int atspi_interrupt(struct atspi_dsc *dsc)
|
|
{
|
|
return
|
|
dsc->driver->interrupt ? dsc->driver->interrupt(dsc->handle) : 1;
|
|
}
|