diff options
Diffstat (limited to 'firmware/drivers')
-rw-r--r-- | firmware/drivers/audio/tsc2100.c | 20 |
1 files changed, 19 insertions, 1 deletions
diff --git a/firmware/drivers/audio/tsc2100.c b/firmware/drivers/audio/tsc2100.c index 8a71d57e78..a926b4464b 100644 --- a/firmware/drivers/audio/tsc2100.c +++ b/firmware/drivers/audio/tsc2100.c | |||
@@ -116,5 +116,23 @@ void audiohw_close(void) | |||
116 | 116 | ||
117 | void audiohw_set_frequency(int fsel) | 117 | void audiohw_set_frequency(int fsel) |
118 | { | 118 | { |
119 | (void)fsel; | 119 | int reg_val; |
120 | reg_val = tsc2100_readreg(TSAC1_PAGE, TSAC1_ADDRESS); | ||
121 | |||
122 | reg_val &= ~(0x07<<3); | ||
123 | |||
124 | switch(fsel) | ||
125 | { | ||
126 | case HW_FREQ_8: | ||
127 | reg_val |= (0x06<<3); | ||
128 | break; | ||
129 | case HW_FREQ_11: | ||
130 | reg_val |= (0x04<<3); | ||
131 | break; | ||
132 | case HW_FREQ_44: | ||
133 | default: | ||
134 | break; | ||
135 | } | ||
136 | |||
137 | tsc2100_writereg(TSAC1_PAGE, TSAC1_ADDRESS, reg_val); | ||
120 | } | 138 | } |