summaryrefslogtreecommitdiff
path: root/board/servo_v4p1/tca6416a.c
blob: d776ad86fe148ebd801141ee64cce97c9344e2a3 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
/* Copyright 2020 The Chromium OS Authors. All rights reserved.
 * Use of this source code is governed by a BSD-style license that can be
 * found in the LICENSE file.
 */

#include "i2c.h"
#include "tca6416a.h"

int tca6416a_write_bit(int port, enum tca6416a_bank bank, uint8_t bit, int val)
{
	int tmp;
	int ret;

	/* Read output port register */
	ret = i2c_read8(port, TCA6416A_ADDR_FLAGS, bank, &tmp);
	if (ret != EC_SUCCESS)
		return ret;

	if (val)
		tmp |= BIT(bit);
	else
		tmp &= ~BIT(bit);

	/* Write back modified output port register */
	ret = i2c_write8(port, TCA6416A_ADDR_FLAGS, bank, tmp);
	if (ret != EC_SUCCESS)
		return ret;

	return EC_SUCCESS;
}

int tca6416a_write_byte(int port, enum tca6416a_bank bank, uint8_t val)
{
	int ret;

	ret = i2c_write8(port, TCA6416A_ADDR_FLAGS, bank, val);
	if (ret != EC_SUCCESS)
		return ret;

	return EC_SUCCESS;
}

int tca6416a_read_byte(int port, enum tca6416a_bank bank)
{
	int tmp;

	if (i2c_read8(port, TCA6416A_ADDR_FLAGS, bank, &tmp) != EC_SUCCESS)
		return -1;

	return tmp;
}

int tca6416a_read_bit(int port, enum tca6416a_bank bank, uint8_t bit)
{
	int tmp;
	int mask = 1 << bit;

	/* Read input port register */
	if (i2c_read8(port, TCA6416A_ADDR_FLAGS, bank, &tmp) != EC_SUCCESS)
		return -1;

	return (tmp & mask) >> bit;
}