PageRenderTime 15ms CodeModel.GetById 11ms app.highlight 3ms RepoModel.GetById 0ms app.codeStats 0ms

/arch/avr32/mach-at32ap/hmatrix.c

https://bitbucket.org/thekraven/iscream_thunderc-2.6.35
C | 88 lines | 47 code | 11 blank | 30 comment | 0 complexity | 4ab29d8146c520079cf9d3786168dba2 MD5 | raw file
Possible License(s): GPL-2.0, LGPL-2.0, AGPL-1.0
 1/*
 2 * High-Speed Bus Matrix helper functions
 3 *
 4 * Copyright (C) 2008 Atmel Corporation
 5 *
 6 * This program is free software; you can redistribute it and/or modify
 7 * it under the terms of the GNU General Public License version 2 as
 8 * published by the Free Software Foundation.
 9 */
10#include <linux/clk.h>
11#include <linux/io.h>
12
13#include <mach/chip.h>
14#include <mach/hmatrix.h>
15
16static inline void __hmatrix_write_reg(unsigned long offset, u32 value)
17{
18	__raw_writel(value, (void __iomem __force *)(HMATRIX_BASE + offset));
19}
20
21static inline u32 __hmatrix_read_reg(unsigned long offset)
22{
23	return __raw_readl((void __iomem __force *)(HMATRIX_BASE + offset));
24}
25
26/**
27 * hmatrix_write_reg - write HMATRIX configuration register
28 * @offset: register offset
29 * @value: value to be written to the register at @offset
30 */
31void hmatrix_write_reg(unsigned long offset, u32 value)
32{
33	clk_enable(&at32_hmatrix_clk);
34	__hmatrix_write_reg(offset, value);
35	__hmatrix_read_reg(offset);
36	clk_disable(&at32_hmatrix_clk);
37}
38
39/**
40 * hmatrix_read_reg - read HMATRIX configuration register
41 * @offset: register offset
42 *
43 * Returns the value of the register at @offset.
44 */
45u32 hmatrix_read_reg(unsigned long offset)
46{
47	u32 value;
48
49	clk_enable(&at32_hmatrix_clk);
50	value = __hmatrix_read_reg(offset);
51	clk_disable(&at32_hmatrix_clk);
52
53	return value;
54}
55
56/**
57 * hmatrix_sfr_set_bits - set bits in a slave's Special Function Register
58 * @slave_id: operate on the SFR belonging to this slave
59 * @mask: mask of bits to be set in the SFR
60 */
61void hmatrix_sfr_set_bits(unsigned int slave_id, u32 mask)
62{
63	u32 value;
64
65	clk_enable(&at32_hmatrix_clk);
66	value = __hmatrix_read_reg(HMATRIX_SFR(slave_id));
67	value |= mask;
68	__hmatrix_write_reg(HMATRIX_SFR(slave_id), value);
69	__hmatrix_read_reg(HMATRIX_SFR(slave_id));
70	clk_disable(&at32_hmatrix_clk);
71}
72
73/**
74 * hmatrix_sfr_set_bits - clear bits in a slave's Special Function Register
75 * @slave_id: operate on the SFR belonging to this slave
76 * @mask: mask of bits to be cleared in the SFR
77 */
78void hmatrix_sfr_clear_bits(unsigned int slave_id, u32 mask)
79{
80	u32 value;
81
82	clk_enable(&at32_hmatrix_clk);
83	value = __hmatrix_read_reg(HMATRIX_SFR(slave_id));
84	value &= ~mask;
85	__hmatrix_write_reg(HMATRIX_SFR(slave_id), value);
86	__hmatrix_read_reg(HMATRIX_SFR(slave_id));
87	clk_disable(&at32_hmatrix_clk);
88}