File indexing completed on 2025-05-11 08:24:04
0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011
0012
0013
0014
0015
0016
0017
0018
0019
0020
0021
0022
0023
0024
0025
0026
0027
0028
0029
0030
0031
0032
0033
0034 #include <libchip/i2c-sc620.h>
0035
0036 #include <rtems/libio.h>
0037
0038 #define SC620_REG_COUNT 10
0039
0040 static rtems_status_code i2c_sc620_write(
0041 rtems_device_major_number major,
0042 rtems_device_minor_number minor,
0043 void *arg
0044 )
0045 {
0046 rtems_status_code sc = RTEMS_IO_ERROR;
0047 rtems_libio_rw_args_t *rw = arg;
0048 unsigned char *buf = (unsigned char *) &rw->buffer[0];
0049
0050 if (rw->count == 2 && buf[0] < SC620_REG_COUNT) {
0051 int rv;
0052
0053 rv = rtems_libi2c_start_write_bytes(
0054 minor, buf, 2
0055 );
0056 if (rv == 2) {
0057 sc = rtems_libi2c_send_stop(minor);
0058 }
0059 }
0060
0061 rw->bytes_moved = sc == RTEMS_SUCCESSFUL ? 2 : 0;
0062
0063 return sc;
0064 }
0065
0066 static rtems_status_code i2c_sc620_read(
0067 rtems_device_major_number major,
0068 rtems_device_minor_number minor,
0069 void *arg
0070 )
0071 {
0072 rtems_status_code sc = RTEMS_IO_ERROR;
0073 rtems_libio_rw_args_t *rw = arg;
0074 unsigned char *buf = (unsigned char *) &rw->buffer[0];
0075
0076 if (rw->count == 1 && buf[0] < SC620_REG_COUNT) {
0077 int rv;
0078
0079 rv = rtems_libi2c_start_write_bytes(minor, buf, 1);
0080 if (rv == 1) {
0081 sc = rtems_libi2c_send_addr(minor, 0);
0082 if (sc == RTEMS_SUCCESSFUL) {
0083 rv = rtems_libi2c_read_bytes(minor, buf, 1);
0084 if (rv == 1) {
0085 sc = rtems_libi2c_send_stop(minor);
0086 }
0087 }
0088 }
0089 }
0090
0091 rw->bytes_moved = sc == RTEMS_SUCCESSFUL ? 1 : 0;
0092
0093 return sc;
0094 }
0095
0096 static rtems_driver_address_table i2c_sc620_ops = {
0097 .read_entry = i2c_sc620_read,
0098 .write_entry = i2c_sc620_write
0099 };
0100
0101 rtems_libi2c_drv_t i2c_sc620_driver = {
0102 .ops = &i2c_sc620_ops,
0103 .size = sizeof(i2c_sc620_driver)
0104 };