pio: clean offset pattern in pio_get() and pio_set()

This commit is contained in:
Alejandro Mery 2012-07-31 18:48:55 +02:00
parent 22e82981c5
commit af8146eff7

8
pio.c
View File

@ -77,10 +77,10 @@ static int pio_get(const char *buf, uint32_t port, uint32_t port_num, struct pio
uint32_t offset_func, offset_pull;
port_num_func = port_num >> 3;
offset_func = ((port_num - (port_num_func << 3)) << 2);
offset_func = ((port_num & 0x07) << 2);
port_num_pull = port_num >> 4;
offset_pull = ((port_num - (port_num_pull << 4)) << 1);
offset_pull = ((port_num & 0x0f) << 1);
/* func */
val = LE32TOH(PIO_REG_CFG(buf, port, port_num_func));
@ -111,10 +111,10 @@ static int pio_set(char *buf, uint32_t port, uint32_t port_num, struct pio_statu
uint32_t offset_func, offset_pull;
port_num_func = port_num >> 3;
offset_func = ((port_num - (port_num_func << 3)) << 2);
offset_func = ((port_num & 0x07) << 2);
port_num_pull = port_num >> 4;
offset_pull = ((port_num - (port_num_pull << 4)) << 1);
offset_pull = ((port_num & 0x0f) << 1);
/* func */
if (pio->mul_sel >= 0) {