AudDrv_Clk.c 49 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940
  1. /*
  2. * Copyright (C) 2007 The Android Open Source Project
  3. *
  4. * Licensed under the Apache License, Version 2.0 (the "License");
  5. * you may not use this file except in compliance with the License.
  6. * You may obtain a copy of the License at
  7. *
  8. * http://www.apache.org/licenses/LICENSE-2.0
  9. *
  10. * Unless required by applicable law or agreed to in writing, software
  11. * distributed under the License is distributed on an "AS IS" BASIS,
  12. * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  13. * See the License for the specific language governing permissions and
  14. * limitations under the License.
  15. */
  16. /*******************************************************************************
  17. *
  18. * Filename:
  19. * ---------
  20. * AudDrv_Clk.c
  21. *
  22. * Project:
  23. * --------
  24. * MT6735 Audio Driver clock control implement
  25. *
  26. * Description:
  27. * ------------
  28. * Audio register
  29. *
  30. * Author:
  31. * -------
  32. *
  33. *
  34. *------------------------------------------------------------------------------
  35. *
  36. *
  37. *******************************************************************************/
  38. /*****************************************************************************
  39. * C O M P I L E R F L A G S
  40. *****************************************************************************/
  41. /*****************************************************************************
  42. * E X T E R N A L R E F E R E N C E S
  43. *****************************************************************************/
  44. #ifndef CONFIG_MTK_CLKMGR
  45. #include <linux/clk.h>
  46. #else
  47. #include <mach/mt_clkmgr.h>
  48. #endif
  49. /*#define _MT_IDLE_HEADER*/
  50. /*#include <mach/mt_pm_ldo.h>*/
  51. /*#include <mach/pmic_mt6325_sw.h>
  52. #include <mach/upmu_common.h>
  53. #include <mach/upmu_hw.h>*/
  54. #include <mt-plat/upmu_common.h>
  55. #include <linux/spinlock.h>
  56. #include <linux/delay.h>
  57. #ifdef _MT_IDLE_HEADER
  58. #include "mt_idle.h"
  59. #include "mt_clk_id.h"
  60. #endif
  61. #include <linux/err.h>
  62. #include <linux/platform_device.h>
  63. #include "AudDrv_Common.h"
  64. #include "AudDrv_Clk.h"
  65. #include "AudDrv_Afe.h"
  66. /*****************************************************************************
  67. * D A T A T Y P E S
  68. *****************************************************************************/
  69. int Aud_Core_Clk_cntr = 0;
  70. int Aud_AFE_Clk_cntr = 0;
  71. int Aud_I2S_Clk_cntr = 0;
  72. int Aud_ADC_Clk_cntr = 0;
  73. int Aud_ADC2_Clk_cntr = 0;
  74. int Aud_ADC3_Clk_cntr = 0;
  75. int Aud_ANA_Clk_cntr = 0;
  76. int Aud_HDMI_Clk_cntr = 0;
  77. int Aud_APLL22M_Clk_cntr = 0;
  78. int Aud_APLL24M_Clk_cntr = 0;
  79. int Aud_APLL1_Tuner_cntr = 0;
  80. int Aud_APLL2_Tuner_cntr = 0;
  81. static int Aud_EMI_cntr;
  82. static DEFINE_SPINLOCK(auddrv_Clk_lock);
  83. /* amp mutex lock */
  84. static DEFINE_MUTEX(auddrv_pmic_mutex);
  85. static DEFINE_MUTEX(audEMI_Clk_mutex);
  86. #ifndef CONFIG_MTK_CLKMGR
  87. enum audio_system_clock_type {
  88. CLOCK_AFE = 0,
  89. CLOCK_I2S,
  90. CLOCK_DAC,
  91. CLOCK_DAC_PREDIS,
  92. CLOCK_ADC,
  93. CLOCK_TML,
  94. CLOCK_APLL22M,
  95. CLOCK_APLL24M,
  96. CLOCK_APLL1_TUNER,
  97. CLOCK_APLL2_TUNER,
  98. CLOCK_INFRA_SYS_AUDIO,
  99. CLOCK_TOP_AUD_MUX1,
  100. CLOCK_TOP_AUD_MUX2,
  101. CLOCK_TOP_AD_APLL1_CK,
  102. CLOCK_WHPLL_AUDIO_CK,
  103. CLOCK_MUX_AUDIO,
  104. CLOCK_MUX_AUDIOINTBUS,
  105. CLOCK_TOP_SYSPLL1_D4,
  106. CLOCK_APMIXED_APLL1_CK,
  107. CLOCK_APMIXED_APLL2_CK,
  108. CLOCK_CLK26M,
  109. CLOCK_NUM
  110. };
  111. struct audio_clock_attr {
  112. const char *name;
  113. bool clk_prepare;
  114. bool clk_status;
  115. struct clk *clock;
  116. };
  117. static struct audio_clock_attr aud_clks[CLOCK_NUM] = {
  118. [CLOCK_AFE] = {"aud_afe_clk", false, false, NULL},
  119. [CLOCK_I2S] = {"aud_i2s_clk", false, false, NULL},
  120. [CLOCK_DAC] = {"aud_dac_clk", false, false, NULL},
  121. [CLOCK_DAC_PREDIS] = {"aud_dac_predis_clk", false, false, NULL},
  122. [CLOCK_ADC] = {"aud_adc_clk", false, false, NULL},
  123. [CLOCK_TML] = {"aud_tml_clk", false, false, NULL},
  124. [CLOCK_APLL22M] = {"aud_apll22m_clk", false, false, NULL},
  125. [CLOCK_APLL24M] = {"aud_apll24m_clk", false, false, NULL},
  126. [CLOCK_APLL1_TUNER] = {"aud_apll1_tuner_clk", false, false, NULL},
  127. [CLOCK_APLL2_TUNER] = {"aud_apll2_tuner_clk", false, false, NULL},
  128. [CLOCK_INFRA_SYS_AUDIO] = {"aud_infra_clk", true, false, NULL},
  129. [CLOCK_TOP_AUD_MUX1] = {"aud_mux1_clk", false, false, NULL},
  130. [CLOCK_TOP_AUD_MUX2] = {"aud_mux2_clk", false, false, NULL},
  131. [CLOCK_TOP_AD_APLL1_CK] = {"top_ad_apll1_clk", false, false, NULL},
  132. [CLOCK_WHPLL_AUDIO_CK] = {"top_whpll_audio_clk", false, false, NULL},
  133. [CLOCK_MUX_AUDIO] = {"top_mux_audio", false, false, NULL},
  134. [CLOCK_MUX_AUDIOINTBUS] = {"top_mux_audio_int", false, false, NULL},
  135. [CLOCK_TOP_SYSPLL1_D4] = {"top_sys_pll1_d4", false, false, NULL},
  136. [CLOCK_APMIXED_APLL1_CK] = {"apmixed_apll1_clk", false, false, NULL},
  137. [CLOCK_APMIXED_APLL2_CK] = {"apmixed_apll2_clk", false, false, NULL},
  138. [CLOCK_CLK26M] = {"top_clk26m_clk", false, false, NULL}
  139. };
  140. void AudDrv_Clk_probe(void *dev)
  141. {
  142. size_t i;
  143. int ret = 0;
  144. Aud_EMI_cntr = 0;
  145. pr_debug("%s\n", __func__);
  146. for (i = 0; i < ARRAY_SIZE(aud_clks); i++) {
  147. aud_clks[i].clock = devm_clk_get(dev, aud_clks[i].name);
  148. if (IS_ERR(aud_clks[i].clock)) {
  149. ret = PTR_ERR(aud_clks[i].clock);
  150. pr_err("%s devm_clk_get %s fail %d\n", __func__, aud_clks[i].name, ret);
  151. break;
  152. }
  153. aud_clks[i].clk_status = true;
  154. }
  155. if (ret)
  156. return;
  157. for (i = 0; i < ARRAY_SIZE(aud_clks); i++) {
  158. if (aud_clks[i].clk_status) {
  159. ret = clk_prepare(aud_clks[i].clock);
  160. if (ret) {
  161. pr_err("%s clk_prepare %s fail %d\n",
  162. __func__, aud_clks[i].name, ret);
  163. break;
  164. }
  165. aud_clks[i].clk_prepare = true;
  166. }
  167. }
  168. if (aud_clks[CLOCK_MUX_AUDIOINTBUS].clk_prepare) {
  169. ret = clk_enable(aud_clks[CLOCK_MUX_AUDIOINTBUS].clock);
  170. if (ret) {
  171. pr_err
  172. ("%s [CCF]Aud enable_clock enable_clock CLOCK_MUX_AUDIOINTBUS fail",
  173. __func__);
  174. BUG();
  175. return;
  176. }
  177. } else {
  178. pr_err
  179. ("%s [CCF]clk_prepare error Aud enable_clock CLOCK_MUX_AUDIOINTBUS fail",
  180. __func__);
  181. BUG();
  182. return;
  183. }
  184. if (aud_clks[CLOCK_MUX_AUDIO].clk_prepare) {
  185. ret = clk_enable(aud_clks[CLOCK_MUX_AUDIO].clock);
  186. if (ret) {
  187. pr_err
  188. ("%s [CCF]Aud enable_clock enable_clock CLOCK_MUX_AUDIO fail",
  189. __func__);
  190. BUG();
  191. return;
  192. }
  193. } else {
  194. pr_err
  195. ("%s [CCF]clk_prepare error Aud enable_clock CLOCK_MUX_AUDIO fail",
  196. __func__);
  197. BUG();
  198. return;
  199. }
  200. }
  201. void AudDrv_Clk_Deinit(void *dev)
  202. {
  203. size_t i;
  204. pr_debug("%s\n", __func__);
  205. for (i = 0; i < ARRAY_SIZE(aud_clks); i++) {
  206. if (aud_clks[i].clock && !IS_ERR(aud_clks[i].clock) && aud_clks[i].clk_prepare) {
  207. clk_unprepare(aud_clks[i].clock);
  208. aud_clks[i].clk_prepare = false;
  209. }
  210. }
  211. }
  212. #endif
  213. void AudDrv_Clk_AllOn(void)
  214. {
  215. unsigned long flags;
  216. pr_debug("AudDrv_Clk_AllOn\n");
  217. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  218. Afe_Set_Reg(AUDIO_TOP_CON0, 0x00004000, 0xffffffff);
  219. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  220. }
  221. void Auddrv_Bus_Init(void)
  222. {
  223. unsigned long flags;
  224. #ifdef CONFIG_MTK_CLKMGR
  225. Aud_EMI_cntr = 0;
  226. #endif
  227. pr_debug("%s\n", __func__);
  228. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  229. Afe_Set_Reg(AUDIO_TOP_CON0, 0x00004000, 0x00004000); /* must set, system will default set bit14 to 0 */
  230. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  231. }
  232. /*****************************************************************************
  233. * FUNCTION
  234. * AudDrv_Clk_Power_On / AudDrv_Clk_Power_Off
  235. *
  236. * DESCRIPTION
  237. * Power on this function , then all register can be access and set.
  238. *
  239. *****************************************************************************
  240. */
  241. void AudDrv_Clk_Power_On(void)
  242. {
  243. volatile uint32 *AFE_Register = (volatile uint32 *)Get_Afe_Powertop_Pointer();
  244. volatile uint32 val_tmp;
  245. pr_debug("%s", __func__);
  246. val_tmp = 0xd;
  247. mt_reg_sync_writel(val_tmp, AFE_Register);
  248. }
  249. void AudDrv_Clk_Power_Off(void)
  250. {
  251. }
  252. /*****************************************************************************
  253. * FUNCTION
  254. * AudDrv_Clk_On / AudDrv_Clk_Off
  255. *
  256. * DESCRIPTION
  257. * Enable/Disable PLL(26M clock) \ AFE clock
  258. *
  259. *****************************************************************************
  260. */
  261. #ifndef CONFIG_MTK_CLKMGR
  262. void AudDrv_AUDINTBUS_Sel(int parentidx)
  263. {
  264. int ret = 0;
  265. if (parentidx == 1) {
  266. if (aud_clks[CLOCK_MUX_AUDIOINTBUS].clk_prepare) {
  267. ret = clk_enable(aud_clks[CLOCK_MUX_AUDIOINTBUS].clock);
  268. if (ret) {
  269. pr_err
  270. ("%s [CCF]Aud enable_clock enable_clock CLOCK_MUX_AUDIOINTBUS fail",
  271. __func__);
  272. BUG();
  273. return;
  274. }
  275. } else {
  276. pr_err
  277. ("%s [CCF]clk_prepare error Aud enable_clock CLOCK_MUX_AUDIOINTBUS fail",
  278. __func__);
  279. BUG();
  280. return;
  281. }
  282. ret = clk_set_parent(aud_clks[CLOCK_MUX_AUDIOINTBUS].clock,
  283. aud_clks[CLOCK_TOP_SYSPLL1_D4].clock);
  284. if (ret) {
  285. pr_err("%s clk_set_parent %s-%s fail %d\n",
  286. __func__, aud_clks[CLOCK_MUX_AUDIOINTBUS].name,
  287. aud_clks[CLOCK_TOP_SYSPLL1_D4].name, ret);
  288. BUG();
  289. return;
  290. }
  291. } else if (parentidx == 0) {
  292. if (aud_clks[CLOCK_MUX_AUDIOINTBUS].clk_prepare) {
  293. ret = clk_enable(aud_clks[CLOCK_MUX_AUDIOINTBUS].clock);
  294. if (ret) {
  295. pr_err
  296. ("%s [CCF]Aud enable_clock enable_clock CLOCK_MUX_AUDIOINTBUS fail",
  297. __func__);
  298. BUG();
  299. return;
  300. }
  301. } else {
  302. pr_err
  303. ("%s [CCF]clk_prepare error Aud enable_clock CLOCK_MUX_AUDIOINTBUS fail",
  304. __func__);
  305. BUG();
  306. return;
  307. }
  308. ret = clk_set_parent(aud_clks[CLOCK_MUX_AUDIOINTBUS].clock,
  309. aud_clks[CLOCK_CLK26M].clock);
  310. if (ret) {
  311. pr_err("%s clk_set_parent %s-%s fail %d\n",
  312. __func__, aud_clks[CLOCK_MUX_AUDIOINTBUS].name,
  313. aud_clks[CLOCK_CLK26M].name, ret);
  314. BUG();
  315. return;
  316. }
  317. }
  318. }
  319. #endif
  320. void AudDrv_Clk_On(void)
  321. {
  322. unsigned long flags;
  323. #ifndef CONFIG_MTK_CLKMGR
  324. int ret = 0;
  325. #endif
  326. PRINTK_AUD_CLK("+AudDrv_Clk_On, Aud_AFE_Clk_cntr:%d\n", Aud_AFE_Clk_cntr);
  327. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  328. if (Aud_AFE_Clk_cntr == 0) {
  329. PRINTK_AUD_CLK("-----------AudDrv_Clk_On, Aud_AFE_Clk_cntr:%d\n", Aud_AFE_Clk_cntr);
  330. #ifdef PM_MANAGER_API
  331. #ifdef CONFIG_MTK_CLKMGR
  332. if (enable_clock(MT_CG_INFRA_AUDIO, "AUDIO"))
  333. PRINTK_AUD_CLK("%s Aud enable_clock MT_CG_INFRA_AUDIO fail", __func__);
  334. SetClkCfg(CLK_MISC_CFG_0, 0x00000000, 0x00000008);
  335. if (enable_clock(MT_CG_AUDIO_AFE, "AUDIO"))
  336. PRINTK_AUD_CLK("%s Aud enable_clock MT_CG_AUDIO_AFE fail", __func__);
  337. if (enable_clock(MT_CG_AUDIO_DAC, "AUDIO"))
  338. PRINTK_AUD_CLK("%s MT_CG_AUDIO_DAC fail", __func__);
  339. if (enable_clock(MT_CG_AUDIO_DAC_PREDIS, "AUDIO"))
  340. PRINTK_AUD_CLK("%s MT_CG_AUDIO_DAC_PREDIS fail", __func__);
  341. #else
  342. PRINTK_AUD_CLK("-----------[CCF]AudDrv_Clk_On, aud_infra_clk:%d\n",
  343. aud_clks[CLOCK_INFRA_SYS_AUDIO].clk_prepare);
  344. if (aud_clks[CLOCK_INFRA_SYS_AUDIO].clk_prepare) {
  345. ret = clk_enable(aud_clks[CLOCK_INFRA_SYS_AUDIO].clock);
  346. if (ret) {
  347. pr_err("%s [CCF]Aud enable_clock %s fail\n", __func__,
  348. aud_clks[CLOCK_INFRA_SYS_AUDIO].name);
  349. BUG();
  350. goto UNLOCK;
  351. }
  352. } else {
  353. pr_err
  354. ("%s [CCF]clk_prepare error Aud enable_clock MT_CG_INFRA_AUDIO fail\n",
  355. __func__);
  356. BUG();
  357. goto UNLOCK;
  358. }
  359. SetClkCfg(CLK_MISC_CFG_0, 0x00000000, 0x00000008);
  360. if (aud_clks[CLOCK_AFE].clk_prepare) {
  361. ret = clk_enable(aud_clks[CLOCK_AFE].clock);
  362. if (ret) {
  363. pr_err("%s [CCF]Aud enable_clock %s fail\n", __func__,
  364. aud_clks[CLOCK_AFE].name);
  365. BUG();
  366. goto UNLOCK;
  367. }
  368. } else {
  369. pr_err("%s [CCF]clk_prepare error Aud enable_clock MT_CG_AUDIO_AFE fail\n",
  370. __func__);
  371. BUG();
  372. goto UNLOCK;
  373. }
  374. if (aud_clks[CLOCK_DAC].clk_prepare) {
  375. ret = clk_enable(aud_clks[CLOCK_DAC].clock);
  376. if (ret) {
  377. pr_err("%s [CCF]Aud enable_clock MT_CG_AUDIO_DAC fail\n", __func__);
  378. BUG();
  379. goto UNLOCK;
  380. }
  381. } else {
  382. pr_err("%s [CCF]clk_status error Aud enable_clock MT_CG_AUDIO_DAC fail\n",
  383. __func__);
  384. BUG();
  385. goto UNLOCK;
  386. }
  387. if (aud_clks[CLOCK_DAC_PREDIS].clk_prepare) {
  388. ret = clk_enable(aud_clks[CLOCK_DAC_PREDIS].clock);
  389. if (ret) {
  390. pr_err("%s [CCF]Aud enable_clock MT_CG_AUDIO_DAC_PREDIS fail\n",
  391. __func__);
  392. BUG();
  393. goto UNLOCK;
  394. }
  395. } else {
  396. pr_err
  397. ("%s [CCF]clk_status error Aud enable_clock MT_CG_AUDIO_DAC_PREDIS fail\n",
  398. __func__);
  399. BUG();
  400. goto UNLOCK;
  401. }
  402. /*pr_debug("-----------[CCF]AudDrv_Clk_On, aud_dac_predis_clk:%d\n",
  403. aud_clks[CLOCK_DAC_PREDIS].clk_prepare);*/
  404. #endif
  405. #else
  406. SetInfraCfg(AUDIO_CG_CLR, 0x2000000, 0x2000000);
  407. SetClkCfg(CLK_MISC_CFG_0, 0x00000000, 0x00000008);
  408. /* bit 25=0, without 133m master and 66m slave bus clock cg gating */
  409. Afe_Set_Reg(AUDIO_TOP_CON0, 0x4000, 0x06004044);
  410. #endif
  411. }
  412. Aud_AFE_Clk_cntr++;
  413. #ifndef CONFIG_MTK_CLKMGR
  414. UNLOCK:
  415. #endif
  416. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  417. PRINTK_AUD_CLK("-AudDrv_Clk_On, Aud_AFE_Clk_cntr:%d\n", Aud_AFE_Clk_cntr);
  418. }
  419. EXPORT_SYMBOL(AudDrv_Clk_On);
  420. void AudDrv_Clk_Off(void)
  421. {
  422. unsigned long flags;
  423. PRINTK_AUD_CLK("+!! AudDrv_Clk_Off, Aud_AFE_Clk_cntr:%d\n", Aud_AFE_Clk_cntr);
  424. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  425. Aud_AFE_Clk_cntr--;
  426. if (Aud_AFE_Clk_cntr == 0) {
  427. PRINTK_AUD_CLK("------------AudDrv_Clk_Off, Aud_AFE_Clk_cntr:%d\n", Aud_AFE_Clk_cntr);
  428. {
  429. /* Disable AFE clock */
  430. #ifdef PM_MANAGER_API
  431. #ifdef CONFIG_MTK_CLKMGR
  432. if (disable_clock(MT_CG_AUDIO_AFE, "AUDIO"))
  433. PRINTK_AUD_CLK("%s disable_clock MT_CG_AUDIO_AFE fail", __func__);
  434. if (disable_clock(MT_CG_AUDIO_DAC, "AUDIO"))
  435. PRINTK_AUD_CLK("%s MT_CG_AUDIO_DAC fail", __func__);
  436. if (disable_clock(MT_CG_AUDIO_DAC_PREDIS, "AUDIO"))
  437. PRINTK_AUD_CLK("%s MT_CG_AUDIO_DAC_PREDIS fail", __func__);
  438. SetClkCfg(CLK_MISC_CFG_0, 0x00000008, 0x00000008);
  439. if (disable_clock(MT_CG_INFRA_AUDIO, "AUDIO"))
  440. PRINTK_AUD_CLK("%s disable_clock MT_CG_INFRA_AUDIO fail", __func__);
  441. #else
  442. PRINTK_AUD_CLK
  443. ("-----------[CCF]AudDrv_Clk_Off, paudclk->aud_infra_clk_prepare:%d\n",
  444. aud_clks[CLOCK_INFRA_SYS_AUDIO].clk_prepare);
  445. if (aud_clks[CLOCK_AFE].clk_prepare)
  446. clk_disable(aud_clks[CLOCK_AFE].clock);
  447. if (aud_clks[CLOCK_DAC].clk_prepare)
  448. clk_disable(aud_clks[CLOCK_DAC].clock);
  449. if (aud_clks[CLOCK_DAC_PREDIS].clk_prepare)
  450. clk_disable(aud_clks[CLOCK_DAC_PREDIS].clock);
  451. SetClkCfg(CLK_MISC_CFG_0, 0x00000008, 0x00000008);
  452. if (aud_clks[CLOCK_INFRA_SYS_AUDIO].clk_prepare)
  453. clk_disable(aud_clks[CLOCK_INFRA_SYS_AUDIO].clock);
  454. #endif
  455. #else
  456. Afe_Set_Reg(AUDIO_TOP_CON0, 0x06000044, 0x06000044);
  457. SetClkCfg(CLK_MISC_CFG_0, 0x00000008, 0x00000008);
  458. SetInfraCfg(AUDIO_CG_SET, 0x2000000, 0x2000000);
  459. /* bit25=1, with 133m mastesr and 66m slave bus clock cg gating */
  460. #endif
  461. }
  462. } else if (Aud_AFE_Clk_cntr < 0) {
  463. PRINTK_AUD_ERROR("!! AudDrv_Clk_Off, Aud_AFE_Clk_cntr<0 (%d)\n", Aud_AFE_Clk_cntr);
  464. AUDIO_ASSERT(true);
  465. Aud_AFE_Clk_cntr = 0;
  466. }
  467. PRINTK_AUD_CLK("-!! AudDrv_Clk_Off, Aud_AFE_Clk_cntr:%d\n", Aud_AFE_Clk_cntr);
  468. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  469. }
  470. EXPORT_SYMBOL(AudDrv_Clk_Off);
  471. /*****************************************************************************
  472. * FUNCTION
  473. * AudDrv_ANA_Clk_On / AudDrv_ANA_Clk_Off
  474. *
  475. * DESCRIPTION
  476. * Enable/Disable analog part clock
  477. *
  478. *****************************************************************************/
  479. void AudDrv_ANA_Clk_On(void)
  480. {
  481. mutex_lock(&auddrv_pmic_mutex);
  482. if (Aud_ANA_Clk_cntr == 0)
  483. PRINTK_AUD_CLK("+AudDrv_ANA_Clk_On, Aud_ANA_Clk_cntr:%d\n", Aud_ANA_Clk_cntr);
  484. Aud_ANA_Clk_cntr++;
  485. mutex_unlock(&auddrv_pmic_mutex);
  486. /* PRINTK_AUD_CLK("-AudDrv_ANA_Clk_Off, Aud_ANA_Clk_cntr:%d\n",Aud_ANA_Clk_cntr); */
  487. }
  488. EXPORT_SYMBOL(AudDrv_ANA_Clk_On);
  489. void AudDrv_ANA_Clk_Off(void)
  490. {
  491. /* PRINTK_AUD_CLK("+AudDrv_ANA_Clk_Off, Aud_ADC_Clk_cntr:%d\n", Aud_ANA_Clk_cntr); */
  492. mutex_lock(&auddrv_pmic_mutex);
  493. Aud_ANA_Clk_cntr--;
  494. if (Aud_ANA_Clk_cntr == 0) {
  495. PRINTK_AUD_CLK("+AudDrv_ANA_Clk_Off disable_clock Ana clk(%x)\n", Aud_ANA_Clk_cntr);
  496. /* Disable ADC clock */
  497. #ifdef PM_MANAGER_API
  498. #else
  499. /* TODO:: open ADC clock.... */
  500. #endif
  501. } else if (Aud_ANA_Clk_cntr < 0) {
  502. PRINTK_AUD_ERROR("!! AudDrv_ANA_Clk_Off, Aud_ADC_Clk_cntr<0 (%d)\n",
  503. Aud_ANA_Clk_cntr);
  504. AUDIO_ASSERT(true);
  505. Aud_ANA_Clk_cntr = 0;
  506. }
  507. mutex_unlock(&auddrv_pmic_mutex);
  508. /* PRINTK_AUD_CLK("-AudDrv_ANA_Clk_Off, Aud_ADC_Clk_cntr:%d\n", Aud_ANA_Clk_cntr); */
  509. }
  510. EXPORT_SYMBOL(AudDrv_ANA_Clk_Off);
  511. /*****************************************************************************
  512. * FUNCTION
  513. * AudDrv_ADC_Clk_On / AudDrv_ADC_Clk_Off
  514. *
  515. * DESCRIPTION
  516. * Enable/Disable analog part clock
  517. *
  518. *****************************************************************************/
  519. void AudDrv_ADC_Clk_On(void)
  520. {
  521. /* PRINTK_AUDDRV("+AudDrv_ADC_Clk_On, Aud_ADC_Clk_cntr:%d\n", Aud_ADC_Clk_cntr); */
  522. #ifndef CONFIG_MTK_CLKMGR
  523. int ret = 0;
  524. #endif
  525. mutex_lock(&auddrv_pmic_mutex);
  526. if (Aud_ADC_Clk_cntr == 0) {
  527. PRINTK_AUDDRV("+AudDrv_ADC_Clk_On enable_clock ADC clk(%x)\n", Aud_ADC_Clk_cntr);
  528. /* Afe_Set_Reg(AUDIO_TOP_CON0, 0 << 24 , 1 << 24); */
  529. #ifdef PM_MANAGER_API
  530. #ifdef CONFIG_MTK_CLKMGR
  531. if (enable_clock(MT_CG_AUDIO_ADC, "AUDIO"))
  532. PRINTK_AUD_CLK("%s fail", __func__);
  533. #else
  534. if (aud_clks[CLOCK_ADC].clk_prepare) {
  535. ret = clk_enable(aud_clks[CLOCK_ADC].clock);
  536. if (ret) {
  537. pr_err("%s [CCF]Aud enable_clock enable_clock ADC fail", __func__);
  538. BUG();
  539. goto UNLOCK;
  540. }
  541. } else {
  542. pr_err("%s [CCF]clk_prepare error Aud enable_clock ADC fail", __func__);
  543. BUG();
  544. goto UNLOCK;
  545. }
  546. #endif
  547. #else
  548. Afe_Set_Reg(AUDIO_TOP_CON0, 0 << 24, 1 << 24);
  549. #endif
  550. }
  551. Aud_ADC_Clk_cntr++;
  552. #ifndef CONFIG_MTK_CLKMGR
  553. UNLOCK:
  554. #endif
  555. mutex_unlock(&auddrv_pmic_mutex);
  556. }
  557. void AudDrv_ADC_Clk_Off(void)
  558. {
  559. /* PRINTK_AUDDRV("+AudDrv_ADC_Clk_Off, Aud_ADC_Clk_cntr:%d\n", Aud_ADC_Clk_cntr); */
  560. mutex_lock(&auddrv_pmic_mutex);
  561. Aud_ADC_Clk_cntr--;
  562. if (Aud_ADC_Clk_cntr == 0) {
  563. PRINTK_AUDDRV("+AudDrv_ADC_Clk_On disable_clock ADC clk(%x)\n", Aud_ADC_Clk_cntr);
  564. /* Afe_Set_Reg(AUDIO_TOP_CON0, 1 << 24 , 1 << 24); */
  565. #ifdef PM_MANAGER_API
  566. #ifdef CONFIG_MTK_CLKMGR
  567. if (disable_clock(MT_CG_AUDIO_ADC, "AUDIO"))
  568. PRINTK_AUD_CLK("%s fail", __func__);
  569. #else
  570. if (aud_clks[CLOCK_ADC].clk_prepare)
  571. clk_disable(aud_clks[CLOCK_ADC].clock);
  572. #endif
  573. #else
  574. Afe_Set_Reg(AUDIO_TOP_CON0, 1 << 24, 1 << 24);
  575. #endif
  576. }
  577. if (Aud_ADC_Clk_cntr < 0) {
  578. PRINTK_AUDDRV("!! AudDrv_ADC_Clk_Off, Aud_ADC_Clk_cntr<0 (%d)\n", Aud_ADC_Clk_cntr);
  579. Aud_ADC_Clk_cntr = 0;
  580. }
  581. mutex_unlock(&auddrv_pmic_mutex);
  582. /* PRINTK_AUDDRV("-AudDrv_ADC_Clk_Off, Aud_ADC_Clk_cntr:%d\n", Aud_ADC_Clk_cntr); */
  583. }
  584. /*****************************************************************************
  585. * FUNCTION
  586. * AudDrv_ADC2_Clk_On / AudDrv_ADC2_Clk_Off
  587. *
  588. * DESCRIPTION
  589. * Enable/Disable clock
  590. *
  591. *****************************************************************************/
  592. void AudDrv_ADC2_Clk_On(void)
  593. {
  594. PRINTK_AUD_CLK("+%s %d\n", __func__, Aud_ADC2_Clk_cntr);
  595. mutex_lock(&auddrv_pmic_mutex);
  596. if (Aud_ADC2_Clk_cntr == 0)
  597. PRINTK_AUDDRV("+%s enable_clock ADC2 clk(%x)\n", __func__, Aud_ADC2_Clk_cntr);
  598. Aud_ADC2_Clk_cntr++;
  599. mutex_unlock(&auddrv_pmic_mutex);
  600. }
  601. void AudDrv_ADC2_Clk_Off(void)
  602. {
  603. /* PRINTK_AUDDRV("+%s %d\n", __func__,Aud_ADC2_Clk_cntr); */
  604. mutex_lock(&auddrv_pmic_mutex);
  605. Aud_ADC2_Clk_cntr--;
  606. if (Aud_ADC2_Clk_cntr == 0)
  607. PRINTK_AUDDRV("+%s disable_clock ADC clk(%x)\n", __func__, Aud_ADC2_Clk_cntr);
  608. if (Aud_ADC2_Clk_cntr < 0) {
  609. PRINTK_AUDDRV("%s <0 (%d)\n", __func__, Aud_ADC2_Clk_cntr);
  610. Aud_ADC2_Clk_cntr = 0;
  611. }
  612. mutex_unlock(&auddrv_pmic_mutex);
  613. /* PRINTK_AUDDRV("-AudDrv_ADC_Clk_Off, Aud_ADC_Clk_cntr:%d\n", Aud_ADC_Clk_cntr); */
  614. }
  615. /*****************************************************************************
  616. * FUNCTION
  617. * AudDrv_ADC3_Clk_On / AudDrv_ADC3_Clk_Off
  618. *
  619. * DESCRIPTION
  620. * Enable/Disable clock
  621. *
  622. *****************************************************************************/
  623. void AudDrv_ADC3_Clk_On(void)
  624. {
  625. PRINTK_AUD_CLK("+%s %d\n", __func__, Aud_ADC3_Clk_cntr);
  626. mutex_lock(&auddrv_pmic_mutex);
  627. if (Aud_ADC3_Clk_cntr == 0)
  628. PRINTK_AUDDRV("+%s enable_clock ADC clk(%x)\n", __func__, Aud_ADC3_Clk_cntr);
  629. Aud_ADC3_Clk_cntr++;
  630. mutex_unlock(&auddrv_pmic_mutex);
  631. }
  632. void AudDrv_ADC3_Clk_Off(void)
  633. {
  634. /* PRINTK_AUDDRV("+%s %d\n", __func__,Aud_ADC2_Clk_cntr); */
  635. mutex_lock(&auddrv_pmic_mutex);
  636. Aud_ADC3_Clk_cntr--;
  637. if (Aud_ADC3_Clk_cntr == 0)
  638. PRINTK_AUDDRV("+%s disable_clock ADC clk(%x)\n", __func__, Aud_ADC3_Clk_cntr);
  639. if (Aud_ADC3_Clk_cntr < 0) {
  640. PRINTK_AUDDRV("%s <0 (%d)\n", __func__, Aud_ADC3_Clk_cntr);
  641. Aud_ADC3_Clk_cntr = 0;
  642. }
  643. mutex_unlock(&auddrv_pmic_mutex);
  644. /* PRINTK_AUDDRV("-AudDrv_ADC_Clk_Off, Aud_ADC_Clk_cntr:%d\n", Aud_ADC_Clk_cntr); */
  645. }
  646. /*****************************************************************************
  647. * FUNCTION
  648. * AudDrv_APLL22M_Clk_On / AudDrv_APLL22M_Clk_Off
  649. *
  650. * DESCRIPTION
  651. * Enable/Disable clock
  652. *
  653. *****************************************************************************/
  654. void AudDrv_APLL22M_Clk_On(void)
  655. {
  656. #ifndef CONFIG_MTK_CLKMGR
  657. int ret = 0;
  658. #endif
  659. pr_debug("+%s %d\n", __func__, Aud_APLL22M_Clk_cntr);
  660. mutex_lock(&auddrv_pmic_mutex);
  661. if (Aud_APLL22M_Clk_cntr == 0) {
  662. PRINTK_AUDDRV("+%s enable_clock ADC clk(%x)\n", __func__, Aud_APLL22M_Clk_cntr);
  663. #ifdef PM_MANAGER_API
  664. pr_debug("+%s enable_mux ADC\n", __func__);
  665. /* pdn_aud_1 => power down hf_faud_1_ck, hf_faud_1_ck is mux of 26M and APLL1_CK */
  666. /* pdn_aud_2 => power down hf_faud_2_ck, hf_faud_2_ck is mux of 26M and APLL2_CK (D1 is WHPLL) */
  667. #ifdef CONFIG_MTK_CLKMGR
  668. enable_mux(MT_MUX_AUD1, "AUDIO");
  669. /* MT_MUX_AUD1 CLK_CFG_6 => [7]: pdn_aud_1 [15]: ,MT_MUX_AUD2: pdn_aud_2 */
  670. clkmux_sel(MT_MUX_AUD1, 1, "AUDIO");
  671. /* select APLL1 ,hf_faud_1_ck is mux of 26M and APLL1_CK */
  672. pll_fsel(APLL1, 0xb7945ea6); /* APLL1 90.3168M */
  673. if (enable_clock(MT_CG_AUDIO_22M, "AUDIO"))
  674. PRINTK_AUD_CLK("%s fail", __func__);
  675. if (enable_clock(MT_CG_AUDIO_APLL_TUNER, "AUDIO"))
  676. PRINTK_AUD_CLK("%s fail", __func__);
  677. #else
  678. if (aud_clks[CLOCK_TOP_AUD_MUX1].clk_prepare) {
  679. ret = clk_enable(aud_clks[CLOCK_TOP_AUD_MUX1].clock);
  680. if (ret) {
  681. pr_err
  682. ("%s [CCF]Aud enable_clock enable_clock CLOCK_TOP_AUD_MUX1 fail",
  683. __func__);
  684. BUG();
  685. goto UNLOCK;
  686. }
  687. } else {
  688. pr_err("%s [CCF]clk_prepare error Aud enable_clock CLOCK_TOP_AUD_MUX1 fail",
  689. __func__);
  690. BUG();
  691. goto UNLOCK;
  692. }
  693. ret = clk_set_parent(aud_clks[CLOCK_TOP_AUD_MUX1].clock,
  694. aud_clks[CLOCK_TOP_AD_APLL1_CK].clock);
  695. if (ret) {
  696. pr_err("%s clk_set_parent %s-%s fail %d\n",
  697. __func__, aud_clks[CLOCK_TOP_AUD_MUX1].name,
  698. aud_clks[CLOCK_TOP_AD_APLL1_CK].name, ret);
  699. BUG();
  700. goto UNLOCK;
  701. }
  702. if (aud_clks[CLOCK_APMIXED_APLL1_CK].clk_prepare) {
  703. ret = clk_set_rate(aud_clks[CLOCK_APMIXED_APLL1_CK].clock, 90316800);
  704. if (ret) {
  705. pr_err("%s clk_set_rate %s-90316800 fail %d\n",
  706. __func__, aud_clks[CLOCK_APMIXED_APLL1_CK].name, ret);
  707. BUG();
  708. goto UNLOCK;
  709. }
  710. }
  711. if (aud_clks[CLOCK_APLL22M].clk_prepare) {
  712. ret = clk_enable(aud_clks[CLOCK_APLL22M].clock);
  713. if (ret) {
  714. pr_err("%s [CCF]Aud enable_clock enable_clock aud_apll22m_clk fail",
  715. __func__);
  716. BUG();
  717. goto UNLOCK;
  718. }
  719. } else {
  720. pr_err("%s [CCF]clk_prepare error Aud enable_clock aud_apll22m_clk fail",
  721. __func__);
  722. BUG();
  723. goto UNLOCK;
  724. }
  725. if (aud_clks[CLOCK_APLL1_TUNER].clk_prepare) {
  726. ret = clk_enable(aud_clks[CLOCK_APLL1_TUNER].clock);
  727. if (ret) {
  728. pr_err
  729. ("%s [CCF]Aud enable_clock enable_clock aud_apll1_tuner_clk fail",
  730. __func__);
  731. BUG();
  732. goto UNLOCK;
  733. }
  734. } else {
  735. pr_err
  736. ("%s [CCF]clk_prepare error Aud enable_clock aud_apll1_tuner_clk fail",
  737. __func__);
  738. BUG();
  739. goto UNLOCK;
  740. }
  741. #endif
  742. #endif
  743. }
  744. Aud_APLL22M_Clk_cntr++;
  745. #ifndef CONFIG_MTK_CLKMGR
  746. UNLOCK:
  747. #endif
  748. mutex_unlock(&auddrv_pmic_mutex);
  749. }
  750. void AudDrv_APLL22M_Clk_Off(void)
  751. {
  752. #ifndef CONFIG_MTK_CLKMGR
  753. int ret = 0;
  754. #endif
  755. pr_debug("+%s %d\n", __func__, Aud_APLL22M_Clk_cntr);
  756. mutex_lock(&auddrv_pmic_mutex);
  757. Aud_APLL22M_Clk_cntr--;
  758. if (Aud_APLL22M_Clk_cntr == 0) {
  759. PRINTK_AUDDRV("+%s disable_clock ADC clk(%x)\n", __func__, Aud_APLL22M_Clk_cntr);
  760. #ifdef PM_MANAGER_API
  761. #ifdef CONFIG_MTK_CLKMGR
  762. if (disable_clock(MT_CG_AUDIO_22M, "AUDIO"))
  763. PRINTK_AUD_CLK("%s fail", __func__);
  764. if (disable_clock(MT_CG_AUDIO_APLL_TUNER, "AUDIO"))
  765. PRINTK_AUD_CLK("%s fail", __func__);
  766. clkmux_sel(MT_MUX_AUD1, 0, "AUDIO"); /* select 26M */
  767. disable_mux(MT_MUX_AUD1, "AUDIO");
  768. #else
  769. if (aud_clks[CLOCK_APLL22M].clk_prepare)
  770. clk_disable(aud_clks[CLOCK_APLL22M].clock);
  771. if (aud_clks[CLOCK_APLL1_TUNER].clk_prepare)
  772. clk_disable(aud_clks[CLOCK_APLL1_TUNER].clock);
  773. ret = clk_set_parent(aud_clks[CLOCK_TOP_AUD_MUX1].clock,
  774. aud_clks[CLOCK_CLK26M].clock);
  775. if (ret) {
  776. pr_err("%s clk_set_parent %s-%s fail %d\n",
  777. __func__, aud_clks[CLOCK_TOP_AUD_MUX1].name,
  778. aud_clks[CLOCK_CLK26M].name, ret);
  779. BUG();
  780. goto UNLOCK;
  781. }
  782. if (aud_clks[CLOCK_TOP_AUD_MUX1].clk_prepare) {
  783. clk_disable(aud_clks[CLOCK_TOP_AUD_MUX1].clock);
  784. pr_debug("%s [CCF]Aud clk_disable CLOCK_TOP_AUD_MUX1 fail", __func__);
  785. } else {
  786. pr_err
  787. ("%s [CCF]clk_prepare error clk_disable CLOCK_TOP_AUD_MUX1 fail",
  788. __func__);
  789. BUG();
  790. goto UNLOCK;
  791. }
  792. #endif
  793. #endif
  794. }
  795. if (Aud_APLL22M_Clk_cntr < 0) {
  796. PRINTK_AUDDRV("%s <0 (%d)\n", __func__, Aud_APLL22M_Clk_cntr);
  797. Aud_APLL22M_Clk_cntr = 0;
  798. }
  799. #ifndef CONFIG_MTK_CLKMGR
  800. UNLOCK:
  801. #endif
  802. mutex_unlock(&auddrv_pmic_mutex);
  803. }
  804. /*****************************************************************************
  805. * FUNCTION
  806. * AudDrv_APLL24M_Clk_On / AudDrv_APLL24M_Clk_Off
  807. *
  808. * DESCRIPTION
  809. * Enable/Disable clock
  810. *
  811. *****************************************************************************/
  812. void AudDrv_APLL24M_Clk_On(void)
  813. {
  814. #ifndef CONFIG_MTK_CLKMGR
  815. int ret = 0;
  816. #endif
  817. pr_debug("+%s %d\n", __func__, Aud_APLL24M_Clk_cntr);
  818. mutex_lock(&auddrv_pmic_mutex);
  819. if (Aud_APLL24M_Clk_cntr == 0) {
  820. PRINTK_AUDDRV("+%s enable_clock ADC clk(%x)\n", __func__, Aud_APLL24M_Clk_cntr);
  821. #ifdef PM_MANAGER_API
  822. #ifdef CONFIG_MTK_CLKMGR
  823. enable_mux(MT_MUX_AUD1, "AUDIO");
  824. clkmux_sel(MT_MUX_AUD1, 1, "AUDIO"); /* hf_faud_1_ck apll1_ck */
  825. pll_fsel(APLL1, 0xbc7ea932); /* APLL1 98.303999M */
  826. if (enable_clock(MT_CG_AUDIO_24M, "AUDIO"))
  827. PRINTK_AUD_CLK("%s fail", __func__);
  828. if (enable_clock(MT_CG_AUDIO_APLL_TUNER, "AUDIO"))
  829. PRINTK_AUD_CLK("%s fail", __func__);
  830. #else
  831. #if 0 /* if clock from WHPLL, but WHPLL used by RF in denali */
  832. if (aud_clks[CLOCK_TOP_AUD_MUX2].clk_prepare) {
  833. ret = clk_enable(aud_clks[CLOCK_TOP_AUD_MUX2].clock);
  834. if (ret) {
  835. pr_err
  836. ("%s [CCF]Aud enable_clock enable_clock CLOCK_TOP_AUD_MUX2 fail",
  837. __func__);
  838. BUG();
  839. goto UNLOCK;
  840. }
  841. } else {
  842. pr_err("%s [CCF]clk_prepare error Aud enable_clock CLOCK_TOP_AUD_MUX2 fail",
  843. __func__);
  844. BUG();
  845. goto UNLOCK;
  846. }
  847. ret = clk_set_parent(aud_clks[CLOCK_TOP_AUD_MUX2].clock,
  848. aud_clks[CLOCK_WHPLL_AUDIO_CK].clock);
  849. if (ret) {
  850. pr_err("%s clk_set_parent %s-%s fail %d\n",
  851. __func__, aud_clks[CLOCK_TOP_AUD_MUX2].name,
  852. aud_clks[CLOCK_WHPLL_AUDIO_CK].name, ret);
  853. BUG();
  854. goto UNLOCK;
  855. }
  856. if (aud_clks[CLOCK_APMIXED_APLL2_CK].clk_prepare) {
  857. ret = clk_set_rate(aud_clks[CLOCK_APMIXED_APLL2_CK].clock, 98303999);
  858. if (ret) {
  859. pr_err("%s clk_set_rate %s-90316800 fail %d\n",
  860. __func__, aud_clks[CLOCK_APMIXED_APLL1_CK].name, ret);
  861. BUG();
  862. goto UNLOCK;
  863. }
  864. }
  865. if (aud_clks[CLOCK_APLL2_TUNER].clk_prepare) {
  866. ret = clk_enable(aud_clks[CLOCK_APLL2_TUNER].clock);
  867. if (ret) {
  868. pr_err
  869. ("%s [CCF]Aud enable_clock enable_clock aud_apll2_tuner_clk fail",
  870. __func__);
  871. BUG();
  872. goto UNLOCK;
  873. }
  874. } else {
  875. pr_err
  876. ("%s [CCF]clk_prepare error Aud enable_clock aud_apll2_tuner_clk fail",
  877. __func__);
  878. BUG();
  879. goto UNLOCK;
  880. }
  881. #endif
  882. if (aud_clks[CLOCK_TOP_AUD_MUX1].clk_prepare) {
  883. ret = clk_enable(aud_clks[CLOCK_TOP_AUD_MUX1].clock);
  884. if (ret) {
  885. pr_err
  886. ("%s [CCF]Aud enable_clock enable_clock CLOCK_TOP_AUD_MUX1 fail",
  887. __func__);
  888. BUG();
  889. goto UNLOCK;
  890. }
  891. } else {
  892. pr_err("%s [CCF]clk_prepare error Aud enable_clock CLOCK_TOP_AUD_MUX1 fail",
  893. __func__);
  894. BUG();
  895. goto UNLOCK;
  896. }
  897. ret = clk_set_parent(aud_clks[CLOCK_TOP_AUD_MUX1].clock,
  898. aud_clks[CLOCK_TOP_AD_APLL1_CK].clock);
  899. if (ret) {
  900. pr_err("%s clk_set_parent %s-%s fail %d\n",
  901. __func__, aud_clks[CLOCK_TOP_AUD_MUX1].name,
  902. aud_clks[CLOCK_TOP_AD_APLL1_CK].name, ret);
  903. BUG();
  904. goto UNLOCK;
  905. }
  906. if (aud_clks[CLOCK_APMIXED_APLL1_CK].clk_prepare) {
  907. ret = clk_set_rate(aud_clks[CLOCK_APMIXED_APLL1_CK].clock, 98303999);
  908. if (ret) {
  909. pr_err("%s clk_set_rate %s-98303000 fail %d\n",
  910. __func__, aud_clks[CLOCK_APMIXED_APLL1_CK].name, ret);
  911. BUG();
  912. goto UNLOCK;
  913. }
  914. }
  915. if (aud_clks[CLOCK_APLL24M].clk_prepare) {
  916. ret = clk_enable(aud_clks[CLOCK_APLL24M].clock);
  917. if (ret) {
  918. pr_err("%s [CCF]Aud enable_clock enable_clock aud_apll24m_clk fail",
  919. __func__);
  920. BUG();
  921. goto UNLOCK;
  922. }
  923. } else {
  924. pr_err("%s [CCF]clk_prepare error Aud enable_clock aud_apll24m_clk fail",
  925. __func__);
  926. BUG();
  927. goto UNLOCK;
  928. }
  929. if (aud_clks[CLOCK_APLL1_TUNER].clk_prepare) {
  930. ret = clk_enable(aud_clks[CLOCK_APLL1_TUNER].clock);
  931. if (ret) {
  932. pr_err
  933. ("%s [CCF]Aud enable_clock enable_clock aud_apll1_tuner_clk fail",
  934. __func__);
  935. BUG();
  936. goto UNLOCK;
  937. }
  938. } else {
  939. pr_err
  940. ("%s [CCF]clk_prepare error Aud enable_clock aud_apll1_tuner_clk fail",
  941. __func__);
  942. BUG();
  943. goto UNLOCK;
  944. }
  945. #endif
  946. #endif
  947. }
  948. Aud_APLL24M_Clk_cntr++;
  949. #ifndef CONFIG_MTK_CLKMGR
  950. UNLOCK:
  951. #endif
  952. mutex_unlock(&auddrv_pmic_mutex);
  953. }
  954. void AudDrv_APLL24M_Clk_Off(void)
  955. {
  956. #ifndef CONFIG_MTK_CLKMGR
  957. int ret = 0;
  958. #endif
  959. pr_debug("+%s %d\n", __func__, Aud_APLL24M_Clk_cntr);
  960. mutex_lock(&auddrv_pmic_mutex);
  961. Aud_APLL24M_Clk_cntr--;
  962. if (Aud_APLL24M_Clk_cntr == 0) {
  963. PRINTK_AUDDRV("+%s disable_clock ADC clk(%x)\n", __func__, Aud_APLL24M_Clk_cntr);
  964. #ifdef PM_MANAGER_API
  965. #ifdef CONFIG_MTK_CLKMGR
  966. if (disable_clock(MT_CG_AUDIO_24M, "AUDIO"))
  967. PRINTK_AUD_CLK("%s fail", __func__);
  968. if (disable_clock(MT_CG_AUDIO_APLL_TUNER, "AUDIO"))
  969. PRINTK_AUD_CLK("%s fail", __func__);
  970. clkmux_sel(MT_MUX_AUD1, 0, "AUDIO"); /* select 26M */
  971. disable_mux(MT_MUX_AUD1, "AUDIO");
  972. #else
  973. if (aud_clks[CLOCK_APLL24M].clk_prepare)
  974. clk_disable(aud_clks[CLOCK_APLL24M].clock);
  975. if (aud_clks[CLOCK_APLL1_TUNER].clk_prepare)
  976. clk_disable(aud_clks[CLOCK_APLL1_TUNER].clock);
  977. ret = clk_set_parent(aud_clks[CLOCK_TOP_AUD_MUX1].clock,
  978. aud_clks[CLOCK_CLK26M].clock);
  979. if (ret) {
  980. pr_err("%s clk_set_parent %s-%s fail %d\n",
  981. __func__, aud_clks[CLOCK_TOP_AUD_MUX1].name,
  982. aud_clks[CLOCK_CLK26M].name, ret);
  983. BUG();
  984. goto UNLOCK;
  985. }
  986. if (aud_clks[CLOCK_TOP_AUD_MUX1].clk_prepare) {
  987. clk_disable(aud_clks[CLOCK_TOP_AUD_MUX1].clock);
  988. pr_err("%s [CCF]Aud clk_disable CLOCK_TOP_AUD_MUX1 fail", __func__);
  989. } else {
  990. pr_err
  991. ("%s [CCF]clk_prepare error clk_disable CLOCK_TOP_AUD_MUX1 fail",
  992. __func__);
  993. BUG();
  994. goto UNLOCK;
  995. }
  996. #endif
  997. #endif
  998. }
  999. if (Aud_APLL24M_Clk_cntr < 0) {
  1000. PRINTK_AUDDRV("%s <0 (%d)\n", __func__, Aud_APLL24M_Clk_cntr);
  1001. Aud_APLL24M_Clk_cntr = 0;
  1002. }
  1003. #ifndef CONFIG_MTK_CLKMGR
  1004. UNLOCK:
  1005. #endif
  1006. mutex_unlock(&auddrv_pmic_mutex);
  1007. }
  1008. /*****************************************************************************
  1009. * FUNCTION
  1010. * AudDrv_I2S_Clk_On / AudDrv_I2S_Clk_Off
  1011. *
  1012. * DESCRIPTION
  1013. * Enable/Disable analog part clock
  1014. *
  1015. *****************************************************************************/
  1016. void AudDrv_I2S_Clk_On(void)
  1017. {
  1018. unsigned long flags;
  1019. #ifndef CONFIG_MTK_CLKMGR
  1020. int ret = 0;
  1021. #endif
  1022. /* PRINTK_AUD_CLK("+AudDrv_I2S_Clk_On, Aud_I2S_Clk_cntr:%d\n", Aud_I2S_Clk_cntr); */
  1023. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  1024. if (Aud_I2S_Clk_cntr == 0) {
  1025. #ifdef PM_MANAGER_API
  1026. #ifdef CONFIG_MTK_CLKMGR
  1027. if (enable_clock(MT_CG_AUDIO_I2S, "AUDIO"))
  1028. PRINTK_AUD_ERROR("Aud enable_clock MT65XX_PDN_AUDIO_I2S fail !!!\n");
  1029. #else
  1030. if (aud_clks[CLOCK_I2S].clk_prepare) {
  1031. ret = clk_enable(aud_clks[CLOCK_I2S].clock);
  1032. if (ret) {
  1033. pr_err("%s [CCF]Aud enable_clock enable_clock aud_i2s_clk fail",
  1034. __func__);
  1035. BUG();
  1036. goto UNLOCK;
  1037. }
  1038. } else {
  1039. pr_err("%s [CCF]clk_prepare error Aud enable_clock aud_i2s_clk fail",
  1040. __func__);
  1041. BUG();
  1042. goto UNLOCK;
  1043. }
  1044. #endif
  1045. #else
  1046. Afe_Set_Reg(AUDIO_TOP_CON0, 0x00000000, 0x00000040); /* power on I2S clock */
  1047. #endif
  1048. }
  1049. Aud_I2S_Clk_cntr++;
  1050. #ifndef CONFIG_MTK_CLKMGR
  1051. UNLOCK:
  1052. #endif
  1053. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  1054. }
  1055. EXPORT_SYMBOL(AudDrv_I2S_Clk_On);
  1056. void AudDrv_I2S_Clk_Off(void)
  1057. {
  1058. unsigned long flags;
  1059. /* PRINTK_AUD_CLK("+AudDrv_I2S_Clk_Off, Aud_I2S_Clk_cntr:%d\n", Aud_I2S_Clk_cntr); */
  1060. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  1061. Aud_I2S_Clk_cntr--;
  1062. if (Aud_I2S_Clk_cntr == 0) {
  1063. #ifdef PM_MANAGER_API
  1064. #ifdef CONFIG_MTK_CLKMGR
  1065. if (disable_clock(MT_CG_AUDIO_I2S, "AUDIO"))
  1066. PRINTK_AUD_ERROR("disable_clock MT_CG_AUDIO_I2S fail");
  1067. #else
  1068. if (aud_clks[CLOCK_I2S].clk_prepare)
  1069. clk_disable(aud_clks[CLOCK_I2S].clock);
  1070. #endif
  1071. #else
  1072. Afe_Set_Reg(AUDIO_TOP_CON0, 0x00000040, 0x00000040); /* power off I2S clock */
  1073. #endif
  1074. } else if (Aud_I2S_Clk_cntr < 0) {
  1075. PRINTK_AUD_ERROR("!! AudDrv_I2S_Clk_Off, Aud_I2S_Clk_cntr<0 (%d)\n",
  1076. Aud_I2S_Clk_cntr);
  1077. AUDIO_ASSERT(true);
  1078. Aud_I2S_Clk_cntr = 0;
  1079. }
  1080. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  1081. /* PRINTK_AUD_CLK("-AudDrv_I2S_Clk_Off, Aud_I2S_Clk_cntr:%d\n",Aud_I2S_Clk_cntr); */
  1082. }
  1083. EXPORT_SYMBOL(AudDrv_I2S_Clk_Off);
  1084. /*****************************************************************************
  1085. * FUNCTION
  1086. * AudDrv_Core_Clk_On / AudDrv_Core_Clk_Off
  1087. *
  1088. * DESCRIPTION
  1089. * Enable/Disable analog part clock
  1090. *
  1091. *****************************************************************************/
  1092. void AudDrv_Core_Clk_On(void)
  1093. {
  1094. /* PRINTK_AUD_CLK("+AudDrv_Core_Clk_On, Aud_Core_Clk_cntr:%d\n", Aud_Core_Clk_cntr); */
  1095. unsigned long flags;
  1096. #ifndef CONFIG_MTK_CLKMGR
  1097. int ret = 0;
  1098. #endif
  1099. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  1100. if (Aud_Core_Clk_cntr == 0) {
  1101. #ifdef PM_MANAGER_API
  1102. #ifdef CONFIG_MTK_CLKMGR
  1103. if (enable_clock(MT_CG_AUDIO_AFE, "AUDIO")) {
  1104. PRINTK_AUD_ERROR
  1105. ("AudDrv_Core_Clk_On Aud enable_clock MT_CG_AUDIO_AFE fail !!!\n");
  1106. }
  1107. #else
  1108. if (aud_clks[CLOCK_AFE].clk_prepare) {
  1109. ret = clk_enable(aud_clks[CLOCK_AFE].clock);
  1110. if (ret) {
  1111. pr_err("%s [CCF]Aud enable_clock enable_clock aud_afe_clk fail",
  1112. __func__);
  1113. BUG();
  1114. goto UNLOCK;
  1115. }
  1116. } else {
  1117. pr_err("%s [CCF]clk_prepare error Aud enable_clock aud_afe_clk fail",
  1118. __func__);
  1119. BUG();
  1120. goto UNLOCK;
  1121. }
  1122. #endif
  1123. #endif
  1124. }
  1125. Aud_Core_Clk_cntr++;
  1126. #ifndef CONFIG_MTK_CLKMGR
  1127. UNLOCK:
  1128. #endif
  1129. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  1130. /* PRINTK_AUD_CLK("-AudDrv_Core_Clk_On, Aud_Core_Clk_cntr:%d\n", Aud_Core_Clk_cntr); */
  1131. }
  1132. void AudDrv_Core_Clk_Off(void)
  1133. {
  1134. /* PRINTK_AUD_CLK("+AudDrv_Core_Clk_On, Aud_Core_Clk_cntr:%d\n", Aud_Core_Clk_cntr); */
  1135. unsigned long flags;
  1136. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  1137. if (Aud_Core_Clk_cntr == 0) {
  1138. #ifdef PM_MANAGER_API
  1139. #ifdef CONFIG_MTK_CLKMGR
  1140. if (disable_clock(MT_CG_AUDIO_AFE, "AUDIO")) {
  1141. PRINTK_AUD_ERROR
  1142. ("AudDrv_Core_Clk_On Aud disable_clock MT_CG_AUDIO_AFE fail !!!\n");
  1143. }
  1144. #else
  1145. if (aud_clks[CLOCK_AFE].clk_prepare)
  1146. clk_disable(aud_clks[CLOCK_AFE].clock);
  1147. #endif
  1148. #endif
  1149. }
  1150. Aud_Core_Clk_cntr++;
  1151. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  1152. /* PRINTK_AUD_CLK("-AudDrv_Core_Clk_On, Aud_Core_Clk_cntr:%d\n", Aud_Core_Clk_cntr); */
  1153. }
  1154. void AudDrv_APLL1Tuner_Clk_On(void)
  1155. {
  1156. unsigned long flags;
  1157. #ifndef CONFIG_MTK_CLKMGR
  1158. int ret = 0;
  1159. #endif
  1160. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  1161. if (Aud_APLL1_Tuner_cntr == 0) {
  1162. PRINTK_AUD_CLK("+AudDrv_APLLTuner_Clk_On, Aud_APLL1_Tuner_cntr:%d\n",
  1163. Aud_APLL1_Tuner_cntr);
  1164. #ifdef CONFIG_MTK_CLKMGR
  1165. Afe_Set_Reg(AUDIO_TOP_CON0, 0x0 << 19, 0x1 << 19);
  1166. #else
  1167. if (aud_clks[CLOCK_APLL1_TUNER].clk_prepare) {
  1168. ret = clk_enable(aud_clks[CLOCK_APLL1_TUNER].clock);
  1169. if (ret) {
  1170. pr_err
  1171. ("%s [CCF]Aud enable_clock enable_clock aud_apll1_tuner_clk fail",
  1172. __func__);
  1173. BUG();
  1174. goto UNLOCK;
  1175. }
  1176. } else {
  1177. pr_err
  1178. ("%s [CCF]clk_prepare error Aud enable_clock aud_apll1_tuner_clk fail",
  1179. __func__);
  1180. BUG();
  1181. goto UNLOCK;
  1182. }
  1183. #endif
  1184. }
  1185. Aud_APLL1_Tuner_cntr++;
  1186. #ifndef CONFIG_MTK_CLKMGR
  1187. UNLOCK:
  1188. #endif
  1189. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  1190. }
  1191. void AudDrv_APLL1Tuner_Clk_Off(void)
  1192. {
  1193. unsigned long flags;
  1194. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  1195. Aud_APLL1_Tuner_cntr--;
  1196. if (Aud_APLL1_Tuner_cntr == 0) {
  1197. #ifdef CONFIG_MTK_CLKMGR
  1198. Afe_Set_Reg(AUDIO_TOP_CON0, 0x1 << 19, 0x1 << 19);
  1199. /*Afe_Set_Reg(AFE_APLL1_TUNER_CFG, 0x00000033, 0x1 << 19); */
  1200. #else
  1201. if (aud_clks[CLOCK_APLL1_TUNER].clk_prepare)
  1202. clk_disable(aud_clks[CLOCK_APLL1_TUNER].clock);
  1203. #endif
  1204. }
  1205. /* handle for clock error */
  1206. else if (Aud_APLL1_Tuner_cntr < 0) {
  1207. PRINTK_AUD_ERROR("!! AudDrv_APLLTuner_Clk_Off, Aud_APLL1_Tuner_cntr<0 (%d)\n",
  1208. Aud_APLL1_Tuner_cntr);
  1209. Aud_APLL1_Tuner_cntr = 0;
  1210. }
  1211. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  1212. }
  1213. void AudDrv_APLL2Tuner_Clk_On(void)
  1214. {
  1215. unsigned long flags;
  1216. #ifndef CONFIG_MTK_CLKMGR
  1217. int ret = 0;
  1218. #endif
  1219. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  1220. if (Aud_APLL2_Tuner_cntr == 0) {
  1221. PRINTK_AUD_CLK("+Aud_APLL2_Tuner_cntr, Aud_APLL2_Tuner_cntr:%d\n",
  1222. Aud_APLL2_Tuner_cntr);
  1223. #ifdef CONFIG_MTK_CLKMGR
  1224. Afe_Set_Reg(AUDIO_TOP_CON0, 0x0 << 18, 0x1 << 18);
  1225. /*Afe_Set_Reg(AFE_APLL2_TUNER_CFG, 0x00000033, 0x1 << 19); */
  1226. #else
  1227. if (aud_clks[CLOCK_APLL2_TUNER].clk_prepare) {
  1228. ret = clk_enable(aud_clks[CLOCK_APLL2_TUNER].clock);
  1229. if (ret) {
  1230. pr_err
  1231. ("%s [CCF]Aud enable_clock enable_clock aud_apll2_tuner_clk fail",
  1232. __func__);
  1233. BUG();
  1234. goto UNLOCK;
  1235. }
  1236. } else {
  1237. pr_err
  1238. ("%s [CCF]clk_prepare error Aud enable_clock aud_apll2_tuner_clk fail",
  1239. __func__);
  1240. BUG();
  1241. goto UNLOCK;
  1242. }
  1243. #endif
  1244. }
  1245. Aud_APLL2_Tuner_cntr++;
  1246. #ifndef CONFIG_MTK_CLKMGR
  1247. UNLOCK:
  1248. #endif
  1249. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  1250. }
  1251. void AudDrv_APLL2Tuner_Clk_Off(void)
  1252. {
  1253. unsigned long flags;
  1254. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  1255. Aud_APLL2_Tuner_cntr--;
  1256. if (Aud_APLL2_Tuner_cntr == 0) {
  1257. #ifdef CONFIG_MTK_CLKMGR
  1258. Afe_Set_Reg(AUDIO_TOP_CON0, 0x1 << 18, 0x1 << 18);
  1259. #else
  1260. if (aud_clks[CLOCK_APLL2_TUNER].clk_prepare)
  1261. clk_disable(aud_clks[CLOCK_APLL2_TUNER].clock);
  1262. #endif
  1263. pr_debug("AudDrv_APLL2Tuner_Clk_Off\n");
  1264. }
  1265. /* handle for clock error */
  1266. else if (Aud_APLL2_Tuner_cntr < 0) {
  1267. PRINTK_AUD_ERROR("!! AudDrv_APLL2Tuner_Clk_Off, Aud_APLL1_Tuner_cntr<0 (%d)\n",
  1268. Aud_APLL2_Tuner_cntr);
  1269. Aud_APLL2_Tuner_cntr = 0;
  1270. }
  1271. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  1272. }
  1273. /*****************************************************************************
  1274. * FUNCTION
  1275. * AudDrv_HDMI_Clk_On / AudDrv_HDMI_Clk_Off
  1276. *
  1277. * DESCRIPTION
  1278. * Enable/Disable analog part clock
  1279. *
  1280. *****************************************************************************/
  1281. void AudDrv_HDMI_Clk_On(void)
  1282. {
  1283. PRINTK_AUD_CLK("+AudDrv_HDMI_Clk_On, Aud_I2S_Clk_cntr:%d\n", Aud_HDMI_Clk_cntr);
  1284. if (Aud_HDMI_Clk_cntr == 0) {
  1285. AudDrv_ANA_Clk_On();
  1286. AudDrv_Clk_On();
  1287. }
  1288. Aud_HDMI_Clk_cntr++;
  1289. }
  1290. void AudDrv_HDMI_Clk_Off(void)
  1291. {
  1292. PRINTK_AUD_CLK("+AudDrv_HDMI_Clk_Off, Aud_I2S_Clk_cntr:%d\n", Aud_HDMI_Clk_cntr);
  1293. Aud_HDMI_Clk_cntr--;
  1294. if (Aud_HDMI_Clk_cntr == 0) {
  1295. AudDrv_ANA_Clk_Off();
  1296. AudDrv_Clk_Off();
  1297. } else if (Aud_HDMI_Clk_cntr < 0) {
  1298. PRINTK_AUD_ERROR("!! AudDrv_Linein_Clk_Off, Aud_I2S_Clk_cntr<0 (%d)\n",
  1299. Aud_HDMI_Clk_cntr);
  1300. AUDIO_ASSERT(true);
  1301. Aud_HDMI_Clk_cntr = 0;
  1302. }
  1303. PRINTK_AUD_CLK("-AudDrv_I2S_Clk_Off, Aud_I2S_Clk_cntr:%d\n", Aud_HDMI_Clk_cntr);
  1304. }
  1305. /*****************************************************************************
  1306. * FUNCTION
  1307. * AudDrv_Suspend_Clk_Off / AudDrv_Suspend_Clk_On
  1308. *
  1309. * DESCRIPTION
  1310. * Enable/Disable AFE clock for suspend
  1311. *
  1312. *****************************************************************************
  1313. */
  1314. void AudDrv_Suspend_Clk_Off(void)
  1315. {
  1316. unsigned long flags;
  1317. #ifndef CONFIG_MTK_CLKMGR
  1318. int ret = 0;
  1319. #endif
  1320. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  1321. if (Aud_Core_Clk_cntr > 0) {
  1322. #ifdef PM_MANAGER_API
  1323. if (Aud_AFE_Clk_cntr > 0) {
  1324. #ifdef CONFIG_MTK_CLKMGR
  1325. if (disable_clock(MT_CG_AUDIO_AFE, "AUDIO"))
  1326. pr_debug("Aud enable_clock MT_CG_AUDIO_AFE fail !!!\n");
  1327. #else
  1328. if (aud_clks[CLOCK_AFE].clk_prepare)
  1329. clk_disable(aud_clks[CLOCK_AFE].clock);
  1330. #endif
  1331. }
  1332. if (Aud_I2S_Clk_cntr > 0) {
  1333. #ifdef CONFIG_MTK_CLKMGR
  1334. if (disable_clock(MT_CG_AUDIO_I2S, "AUDIO"))
  1335. PRINTK_AUD_ERROR("disable_clock MT_CG_AUDIO_I2S fail");
  1336. #else
  1337. if (aud_clks[CLOCK_I2S].clk_prepare)
  1338. clk_disable(aud_clks[CLOCK_I2S].clock);
  1339. #endif
  1340. }
  1341. if (Aud_ADC_Clk_cntr > 0)
  1342. Afe_Set_Reg(AUDIO_TOP_CON0, 1 << 24, 1 << 24);
  1343. if (Aud_APLL22M_Clk_cntr > 0) {
  1344. #ifdef CONFIG_MTK_CLKMGR
  1345. if (disable_clock(MT_CG_AUDIO_22M, "AUDIO"))
  1346. PRINTK_AUD_CLK("%s fail", __func__);
  1347. if (disable_clock(MT_CG_AUDIO_APLL_TUNER, "AUDIO"))
  1348. PRINTK_AUD_CLK("%s fail", __func__);
  1349. clkmux_sel(MT_MUX_AUD1, 0, "AUDIO"); /* select 26M */
  1350. disable_mux(MT_MUX_AUD1, "AUDIO");
  1351. #else
  1352. if (aud_clks[CLOCK_APLL22M].clk_prepare)
  1353. clk_disable(aud_clks[CLOCK_APLL22M].clock);
  1354. if (aud_clks[CLOCK_APLL1_TUNER].clk_prepare)
  1355. clk_disable(aud_clks[CLOCK_APLL1_TUNER].clock);
  1356. ret = clk_set_parent(aud_clks[CLOCK_TOP_AUD_MUX1].clock,
  1357. aud_clks[CLOCK_CLK26M].clock);
  1358. if (ret) {
  1359. pr_err("%s clk_set_parent %s-%s fail %d\n",
  1360. __func__, aud_clks[CLOCK_TOP_AUD_MUX1].name,
  1361. aud_clks[CLOCK_CLK26M].name, ret);
  1362. BUG();
  1363. goto UNLOCK;
  1364. }
  1365. if (aud_clks[CLOCK_TOP_AUD_MUX1].clk_prepare) {
  1366. clk_disable(aud_clks[CLOCK_TOP_AUD_MUX1].clock);
  1367. pr_debug("%s [CCF]Aud clk_disable CLOCK_TOP_AUD_MUX1 fail",
  1368. __func__);
  1369. } else {
  1370. pr_err
  1371. ("%s [CCF]clk_prepare error clk_disable CLOCK_TOP_AUD_MUX1 fail",
  1372. __func__);
  1373. BUG();
  1374. goto UNLOCK;
  1375. }
  1376. #endif
  1377. }
  1378. if (Aud_APLL24M_Clk_cntr > 0) {
  1379. #ifdef CONFIG_MTK_CLKMGR
  1380. if (disable_clock(MT_CG_AUDIO_24M, "AUDIO"))
  1381. PRINTK_AUD_CLK("%s fail", __func__);
  1382. if (disable_clock(MT_CG_AUDIO_APLL_TUNER, "AUDIO"))
  1383. PRINTK_AUD_CLK("%s fail", __func__);
  1384. clkmux_sel(MT_MUX_AUD1, 0, "AUDIO");
  1385. /* select 26M */
  1386. disable_mux(MT_MUX_AUD1, "AUDIO");
  1387. #else
  1388. if (aud_clks[CLOCK_APLL24M].clk_prepare)
  1389. clk_disable(aud_clks[CLOCK_APLL24M].clock);
  1390. if (aud_clks[CLOCK_APLL1_TUNER].clk_prepare)
  1391. clk_disable(aud_clks[CLOCK_APLL1_TUNER].clock);
  1392. ret = clk_set_parent(aud_clks[CLOCK_TOP_AUD_MUX1].clock,
  1393. aud_clks[CLOCK_CLK26M].clock);
  1394. if (ret) {
  1395. pr_err("%s clk_set_parent %s-%s fail %d\n",
  1396. __func__, aud_clks[CLOCK_TOP_AUD_MUX1].name,
  1397. aud_clks[CLOCK_CLK26M].name, ret);
  1398. BUG();
  1399. goto UNLOCK;
  1400. }
  1401. if (aud_clks[CLOCK_TOP_AUD_MUX1].clk_prepare) {
  1402. clk_disable(aud_clks[CLOCK_TOP_AUD_MUX1].clock);
  1403. pr_debug("%s [CCF]Aud clk_disable CLOCK_TOP_AUD_MUX1 fail",
  1404. __func__);
  1405. } else {
  1406. pr_err
  1407. ("%s [CCF]clk_prepare error clk_disable CLOCK_TOP_AUD_MUX1 fail",
  1408. __func__);
  1409. BUG();
  1410. goto UNLOCK;
  1411. }
  1412. #endif
  1413. }
  1414. #endif
  1415. }
  1416. #ifndef CONFIG_MTK_CLKMGR
  1417. UNLOCK:
  1418. #endif
  1419. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  1420. }
  1421. void AudDrv_Suspend_Clk_On(void)
  1422. {
  1423. unsigned long flags;
  1424. #ifndef CONFIG_MTK_CLKMGR
  1425. int ret = 0;
  1426. #endif
  1427. spin_lock_irqsave(&auddrv_Clk_lock, flags);
  1428. if (Aud_Core_Clk_cntr > 0) {
  1429. #ifdef PM_MANAGER_API
  1430. #ifdef CONFIG_MTK_CLKMGR
  1431. if (enable_clock(MT_CG_AUDIO_AFE, "AUDIO"))
  1432. PRINTK_AUD_ERROR("Aud enable_clock MT_CG_AUDIO_AFE fail !!!\n");
  1433. #else
  1434. if (aud_clks[CLOCK_AFE].clk_prepare) {
  1435. ret = clk_enable(aud_clks[CLOCK_AFE].clock);
  1436. if (ret) {
  1437. pr_err("%s [CCF]Aud enable_clock enable_clock aud_afe_clk fail",
  1438. __func__);
  1439. BUG();
  1440. goto UNLOCK;
  1441. }
  1442. } else {
  1443. pr_err("%s [CCF]clk_prepare error Aud enable_clock aud_afe_clk fail",
  1444. __func__);
  1445. BUG();
  1446. goto UNLOCK;
  1447. }
  1448. #endif
  1449. if (Aud_I2S_Clk_cntr > 0) {
  1450. #ifdef CONFIG_MTK_CLKMGR
  1451. if (enable_clock(MT_CG_AUDIO_I2S, "AUDIO"))
  1452. PRINTK_AUD_ERROR("enable_clock MT_CG_AUDIO_I2S fail");
  1453. #else
  1454. if (aud_clks[CLOCK_I2S].clk_prepare) {
  1455. ret = clk_enable(aud_clks[CLOCK_I2S].clock);
  1456. if (ret) {
  1457. pr_err
  1458. ("%s [CCF]Aud enable_clock enable_clock aud_i2s_clk fail",
  1459. __func__);
  1460. BUG();
  1461. goto UNLOCK;
  1462. }
  1463. } else {
  1464. pr_err
  1465. ("%s [CCF]clk_prepare error Aud enable_clock aud_i2s_clk fail",
  1466. __func__);
  1467. BUG();
  1468. goto UNLOCK;
  1469. }
  1470. #endif
  1471. }
  1472. if (Aud_ADC_Clk_cntr > 0)
  1473. Afe_Set_Reg(AUDIO_TOP_CON0, 0 << 24, 1 << 24);
  1474. if (Aud_APLL22M_Clk_cntr > 0) {
  1475. #ifdef CONFIG_MTK_CLKMGR
  1476. enable_mux(MT_MUX_AUD1, "AUDIO");
  1477. clkmux_sel(MT_MUX_AUD1, 1, "AUDIO"); /* select APLL1 */
  1478. if (enable_clock(MT_CG_AUDIO_22M, "AUDIO"))
  1479. PRINTK_AUD_CLK("%s fail", __func__);
  1480. if (enable_clock(MT_CG_AUDIO_APLL_TUNER, "AUDIO"))
  1481. PRINTK_AUD_CLK("%s fail", __func__);
  1482. #else
  1483. if (aud_clks[CLOCK_TOP_AUD_MUX1].clk_prepare) {
  1484. ret = clk_enable(aud_clks[CLOCK_TOP_AUD_MUX1].clock);
  1485. if (ret) {
  1486. pr_err
  1487. ("%s [CCF]Aud enable_clock enable_clock CLOCK_TOP_AUD_MUX1 fail",
  1488. __func__);
  1489. BUG();
  1490. goto UNLOCK;
  1491. }
  1492. } else {
  1493. pr_err
  1494. ("%s [CCF]clk_prepare error Aud enable_clock CLOCK_TOP_AUD_MUX1 fail",
  1495. __func__);
  1496. BUG();
  1497. goto UNLOCK;
  1498. }
  1499. ret = clk_set_parent(aud_clks[CLOCK_TOP_AUD_MUX1].clock,
  1500. aud_clks[CLOCK_TOP_AD_APLL1_CK].clock);
  1501. if (ret) {
  1502. pr_err("%s clk_set_parent %s-%s fail %d\n",
  1503. __func__, aud_clks[CLOCK_TOP_AUD_MUX1].name,
  1504. aud_clks[CLOCK_TOP_AD_APLL1_CK].name, ret);
  1505. BUG();
  1506. goto UNLOCK;
  1507. }
  1508. if (aud_clks[CLOCK_APMIXED_APLL1_CK].clk_prepare) {
  1509. ret =
  1510. clk_set_rate(aud_clks[CLOCK_APMIXED_APLL1_CK].clock, 90316800);
  1511. if (ret) {
  1512. pr_err("%s clk_set_rate %s-90316800 fail %d\n",
  1513. __func__, aud_clks[CLOCK_APMIXED_APLL1_CK].name,
  1514. ret);
  1515. BUG();
  1516. goto UNLOCK;
  1517. }
  1518. }
  1519. if (aud_clks[CLOCK_APLL22M].clk_prepare) {
  1520. ret = clk_enable(aud_clks[CLOCK_APLL22M].clock);
  1521. if (ret) {
  1522. pr_err
  1523. ("%s [CCF]Aud enable_clock enable_clock aud_apll22m_clk fail",
  1524. __func__);
  1525. BUG();
  1526. goto UNLOCK;
  1527. }
  1528. } else {
  1529. pr_err
  1530. ("%s [CCF]clk_prepare error Aud enable_clock aud_apll22m_clk fail",
  1531. __func__);
  1532. BUG();
  1533. goto UNLOCK;
  1534. }
  1535. if (aud_clks[CLOCK_APLL1_TUNER].clk_prepare) {
  1536. ret = clk_enable(aud_clks[CLOCK_APLL1_TUNER].clock);
  1537. if (ret) {
  1538. pr_err
  1539. ("%s [CCF]Aud enable_clock enable_clock aud_apll1_tuner_clk fail",
  1540. __func__);
  1541. BUG();
  1542. goto UNLOCK;
  1543. }
  1544. } else {
  1545. pr_err
  1546. ("%s [CCF]clk_prepare error Aud enable_clock aud_apll1_tuner_clk fail",
  1547. __func__);
  1548. BUG();
  1549. goto UNLOCK;
  1550. }
  1551. #endif
  1552. }
  1553. if (Aud_APLL24M_Clk_cntr > 0) {
  1554. #ifdef CONFIG_MTK_CLKMGR
  1555. enable_mux(MT_MUX_AUD1, "AUDIO");
  1556. clkmux_sel(MT_MUX_AUD1, 1, "AUDIO"); /* APLL2 */
  1557. if (enable_clock(MT_CG_AUDIO_24M, "AUDIO"))
  1558. PRINTK_AUD_CLK("%s fail", __func__);
  1559. if (enable_clock(MT_CG_AUDIO_APLL_TUNER, "AUDIO"))
  1560. PRINTK_AUD_CLK("%s fail", __func__);
  1561. #else
  1562. if (aud_clks[CLOCK_TOP_AUD_MUX1].clk_prepare) {
  1563. ret = clk_enable(aud_clks[CLOCK_TOP_AUD_MUX1].clock);
  1564. if (ret) {
  1565. pr_err
  1566. ("%s [CCF]Aud enable_clock enable_clock CLOCK_TOP_AUD_MUX1 fail",
  1567. __func__);
  1568. BUG();
  1569. goto UNLOCK;
  1570. }
  1571. } else {
  1572. pr_err
  1573. ("%s [CCF]clk_prepare error Aud enable_clock CLOCK_TOP_AUD_MUX1 fail",
  1574. __func__);
  1575. BUG();
  1576. goto UNLOCK;
  1577. }
  1578. ret = clk_set_parent(aud_clks[CLOCK_TOP_AUD_MUX1].clock,
  1579. aud_clks[CLOCK_TOP_AD_APLL1_CK].clock);
  1580. if (ret) {
  1581. pr_err("%s clk_set_parent %s-%s fail %d\n",
  1582. __func__, aud_clks[CLOCK_TOP_AUD_MUX1].name,
  1583. aud_clks[CLOCK_TOP_AD_APLL1_CK].name, ret);
  1584. BUG();
  1585. goto UNLOCK;
  1586. }
  1587. if (aud_clks[CLOCK_APMIXED_APLL1_CK].clk_prepare) {
  1588. ret =
  1589. clk_set_rate(aud_clks[CLOCK_APMIXED_APLL1_CK].clock, 98303999);
  1590. if (ret) {
  1591. pr_err("%s clk_set_rate %s-98303000 fail %d\n",
  1592. __func__, aud_clks[CLOCK_APMIXED_APLL1_CK].name,
  1593. ret);
  1594. BUG();
  1595. goto UNLOCK;
  1596. }
  1597. }
  1598. if (aud_clks[CLOCK_APLL24M].clk_prepare) {
  1599. ret = clk_enable(aud_clks[CLOCK_APLL24M].clock);
  1600. if (ret) {
  1601. pr_err
  1602. ("%s [CCF]Aud enable_clock enable_clock aud_apll24m_clk fail",
  1603. __func__);
  1604. BUG();
  1605. goto UNLOCK;
  1606. }
  1607. } else {
  1608. pr_err
  1609. ("%s [CCF]clk_prepare error Aud enable_clock aud_apll24m_clk fail",
  1610. __func__);
  1611. BUG();
  1612. goto UNLOCK;
  1613. }
  1614. if (aud_clks[CLOCK_APLL1_TUNER].clk_prepare) {
  1615. ret = clk_enable(aud_clks[CLOCK_APLL1_TUNER].clock);
  1616. if (ret) {
  1617. pr_err
  1618. ("%s [CCF]Aud enable_clock enable_clock aud_apll1_tuner_clk fail",
  1619. __func__);
  1620. BUG();
  1621. goto UNLOCK;
  1622. }
  1623. } else {
  1624. pr_err
  1625. ("%s [CCF]clk_prepare error Aud enable_clock aud_apll1_tuner_clk fail",
  1626. __func__);
  1627. BUG();
  1628. goto UNLOCK;
  1629. }
  1630. #endif
  1631. }
  1632. #endif
  1633. }
  1634. #ifndef CONFIG_MTK_CLKMGR
  1635. UNLOCK:
  1636. #endif
  1637. spin_unlock_irqrestore(&auddrv_Clk_lock, flags);
  1638. }
  1639. void AudDrv_Emi_Clk_On(void)
  1640. {
  1641. mutex_lock(&auddrv_pmic_mutex);
  1642. if (Aud_EMI_cntr == 0) {
  1643. #ifndef CONFIG_FPGA_EARLY_PORTING /* george early porting disable */
  1644. #ifdef _MT_IDLE_HEADER
  1645. disable_dpidle_by_bit(MT_CG_AUDIO_AFE);
  1646. disable_soidle_by_bit(MT_CG_AUDIO_AFE);
  1647. #endif
  1648. #endif
  1649. }
  1650. Aud_EMI_cntr++;
  1651. mutex_unlock(&auddrv_pmic_mutex);
  1652. }
  1653. void AudDrv_Emi_Clk_Off(void)
  1654. {
  1655. mutex_lock(&auddrv_pmic_mutex);
  1656. Aud_EMI_cntr--;
  1657. if (Aud_EMI_cntr == 0) {
  1658. #ifndef CONFIG_FPGA_EARLY_PORTING /* george early porting disable */
  1659. #ifdef _MT_IDLE_HEADER
  1660. enable_dpidle_by_bit(MT_CG_AUDIO_AFE);
  1661. enable_soidle_by_bit(MT_CG_AUDIO_AFE);
  1662. #endif
  1663. #endif
  1664. }
  1665. if (Aud_EMI_cntr < 0) {
  1666. Aud_EMI_cntr = 0;
  1667. pr_debug("Aud_EMI_cntr = %d\n", Aud_EMI_cntr);
  1668. }
  1669. mutex_unlock(&auddrv_pmic_mutex);
  1670. }
  1671. /* export symbol for other module use */