1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528 |
- // SPDX-License-Identifier: GPL-2.0
- #include <linux/bug.h>
- #include <linux/kernel.h>
- #include <linux/bitops.h>
- #include <linux/fixp-arith.h>
- #include <linux/iio/adc/qcom-vadc-common.h>
- #include <linux/math64.h>
- #include <linux/log2.h>
- #include <linux/err.h>
- #include <linux/module.h>
- #include <linux/units.h>
- /**
- * struct vadc_map_pt - Map the graph representation for ADC channel
- * @x: Represent the ADC digitized code.
- * @y: Represent the physical data which can be temperature, voltage,
- * resistance.
- */
- struct vadc_map_pt {
- s32 x;
- s32 y;
- };
- /* Voltage to temperature */
- static const struct vadc_map_pt adcmap_100k_104ef_104fb[] = {
- {1758, -40000 },
- {1742, -35000 },
- {1719, -30000 },
- {1691, -25000 },
- {1654, -20000 },
- {1608, -15000 },
- {1551, -10000 },
- {1483, -5000 },
- {1404, 0 },
- {1315, 5000 },
- {1218, 10000 },
- {1114, 15000 },
- {1007, 20000 },
- {900, 25000 },
- {795, 30000 },
- {696, 35000 },
- {605, 40000 },
- {522, 45000 },
- {448, 50000 },
- {383, 55000 },
- {327, 60000 },
- {278, 65000 },
- {237, 70000 },
- {202, 75000 },
- {172, 80000 },
- {146, 85000 },
- {125, 90000 },
- {107, 95000 },
- {92, 100000 },
- {79, 105000 },
- {68, 110000 },
- {59, 115000 },
- {51, 120000 },
- {44, 125000 }
- };
- /*
- * Voltage to temperature table for 100k pull up for NTCG104EF104 with
- * 1.875V reference.
- */
- static const struct vadc_map_pt adcmap_100k_104ef_104fb_1875_vref[] = {
- { 1831, -40000 },
- { 1814, -35000 },
- { 1791, -30000 },
- { 1761, -25000 },
- { 1723, -20000 },
- { 1675, -15000 },
- { 1616, -10000 },
- { 1545, -5000 },
- { 1463, 0 },
- { 1370, 5000 },
- { 1268, 10000 },
- { 1160, 15000 },
- { 1049, 20000 },
- { 937, 25000 },
- { 828, 30000 },
- { 726, 35000 },
- { 630, 40000 },
- { 544, 45000 },
- { 467, 50000 },
- { 399, 55000 },
- { 340, 60000 },
- { 290, 65000 },
- { 247, 70000 },
- { 209, 75000 },
- { 179, 80000 },
- { 153, 85000 },
- { 130, 90000 },
- { 112, 95000 },
- { 96, 100000 },
- { 82, 105000 },
- { 71, 110000 },
- { 62, 115000 },
- { 53, 120000 },
- { 46, 125000 },
- };
- /*
- * Voltage to temperature table for 100k pull up for bat_therm with
- * Alium.
- */
- static const struct vadc_map_pt adcmap_batt_therm_100k[] = {
- {1840, -400},
- {1835, -380},
- {1828, -360},
- {1821, -340},
- {1813, -320},
- {1803, -300},
- {1793, -280},
- {1781, -260},
- {1768, -240},
- {1753, -220},
- {1737, -200},
- {1719, -180},
- {1700, -160},
- {1679, -140},
- {1655, -120},
- {1630, -100},
- {1603, -80},
- {1574, -60},
- {1543, -40},
- {1510, -20},
- {1475, 0},
- {1438, 20},
- {1400, 40},
- {1360, 60},
- {1318, 80},
- {1276, 100},
- {1232, 120},
- {1187, 140},
- {1142, 160},
- {1097, 180},
- {1051, 200},
- {1005, 220},
- {960, 240},
- {915, 260},
- {871, 280},
- {828, 300},
- {786, 320},
- {745, 340},
- {705, 360},
- {666, 380},
- {629, 400},
- {594, 420},
- {560, 440},
- {527, 460},
- {497, 480},
- {467, 500},
- {439, 520},
- {413, 540},
- {388, 560},
- {365, 580},
- {343, 600},
- {322, 620},
- {302, 640},
- {284, 660},
- {267, 680},
- {251, 700},
- {235, 720},
- {221, 740},
- {208, 760},
- {195, 780},
- {184, 800},
- {173, 820},
- {163, 840},
- {153, 860},
- {144, 880},
- {136, 900},
- {128, 920},
- {120, 940},
- {114, 960},
- {107, 980}
- };
- /*
- * Voltage to temperature table for 30k pull up for bat_therm with
- * Alium.
- */
- static const struct vadc_map_pt adcmap_batt_therm_30k[] = {
- {1864, -400},
- {1863, -380},
- {1861, -360},
- {1858, -340},
- {1856, -320},
- {1853, -300},
- {1850, -280},
- {1846, -260},
- {1842, -240},
- {1837, -220},
- {1831, -200},
- {1825, -180},
- {1819, -160},
- {1811, -140},
- {1803, -120},
- {1794, -100},
- {1784, -80},
- {1773, -60},
- {1761, -40},
- {1748, -20},
- {1734, 0},
- {1718, 20},
- {1702, 40},
- {1684, 60},
- {1664, 80},
- {1643, 100},
- {1621, 120},
- {1597, 140},
- {1572, 160},
- {1546, 180},
- {1518, 200},
- {1489, 220},
- {1458, 240},
- {1426, 260},
- {1393, 280},
- {1359, 300},
- {1324, 320},
- {1288, 340},
- {1252, 360},
- {1214, 380},
- {1176, 400},
- {1138, 420},
- {1100, 440},
- {1061, 460},
- {1023, 480},
- {985, 500},
- {947, 520},
- {910, 540},
- {873, 560},
- {836, 580},
- {801, 600},
- {766, 620},
- {732, 640},
- {699, 660},
- {668, 680},
- {637, 700},
- {607, 720},
- {578, 740},
- {550, 760},
- {524, 780},
- {498, 800},
- {474, 820},
- {451, 840},
- {428, 860},
- {407, 880},
- {387, 900},
- {367, 920},
- {349, 940},
- {332, 960},
- {315, 980}
- };
- /*
- * Voltage to temperature table for 400k pull up for bat_therm with
- * Alium.
- */
- static const struct vadc_map_pt adcmap_batt_therm_400k[] = {
- {1744, -400},
- {1724, -380},
- {1701, -360},
- {1676, -340},
- {1648, -320},
- {1618, -300},
- {1584, -280},
- {1548, -260},
- {1509, -240},
- {1468, -220},
- {1423, -200},
- {1377, -180},
- {1328, -160},
- {1277, -140},
- {1225, -120},
- {1171, -100},
- {1117, -80},
- {1062, -60},
- {1007, -40},
- {953, -20},
- {899, 0},
- {847, 20},
- {795, 40},
- {745, 60},
- {697, 80},
- {651, 100},
- {607, 120},
- {565, 140},
- {526, 160},
- {488, 180},
- {453, 200},
- {420, 220},
- {390, 240},
- {361, 260},
- {334, 280},
- {309, 300},
- {286, 320},
- {265, 340},
- {245, 360},
- {227, 380},
- {210, 400},
- {195, 420},
- {180, 440},
- {167, 460},
- {155, 480},
- {144, 500},
- {133, 520},
- {124, 540},
- {115, 560},
- {107, 580},
- {99, 600},
- {92, 620},
- {86, 640},
- {80, 660},
- {75, 680},
- {70, 700},
- {65, 720},
- {61, 740},
- {57, 760},
- {53, 780},
- {50, 800},
- {46, 820},
- {43, 840},
- {41, 860},
- {38, 880},
- {36, 900},
- {34, 920},
- {32, 940},
- {30, 960},
- {28, 980}
- };
- static const struct vadc_map_pt adcmap7_die_temp[] = {
- { 857300, 160000 },
- { 820100, 140000 },
- { 782500, 120000 },
- { 744600, 100000 },
- { 706400, 80000 },
- { 667900, 60000 },
- { 629300, 40000 },
- { 590500, 20000 },
- { 551500, 0 },
- { 512400, -20000 },
- { 473100, -40000 },
- { 433700, -60000 },
- };
- /*
- * Resistance to temperature table for 100k pull up for NTCG104EF104.
- */
- static const struct vadc_map_pt adcmap7_100k[] = {
- { 4250657, -40960 },
- { 3962085, -39936 },
- { 3694875, -38912 },
- { 3447322, -37888 },
- { 3217867, -36864 },
- { 3005082, -35840 },
- { 2807660, -34816 },
- { 2624405, -33792 },
- { 2454218, -32768 },
- { 2296094, -31744 },
- { 2149108, -30720 },
- { 2012414, -29696 },
- { 1885232, -28672 },
- { 1766846, -27648 },
- { 1656598, -26624 },
- { 1553884, -25600 },
- { 1458147, -24576 },
- { 1368873, -23552 },
- { 1285590, -22528 },
- { 1207863, -21504 },
- { 1135290, -20480 },
- { 1067501, -19456 },
- { 1004155, -18432 },
- { 944935, -17408 },
- { 889550, -16384 },
- { 837731, -15360 },
- { 789229, -14336 },
- { 743813, -13312 },
- { 701271, -12288 },
- { 661405, -11264 },
- { 624032, -10240 },
- { 588982, -9216 },
- { 556100, -8192 },
- { 525239, -7168 },
- { 496264, -6144 },
- { 469050, -5120 },
- { 443480, -4096 },
- { 419448, -3072 },
- { 396851, -2048 },
- { 375597, -1024 },
- { 355598, 0 },
- { 336775, 1024 },
- { 319052, 2048 },
- { 302359, 3072 },
- { 286630, 4096 },
- { 271806, 5120 },
- { 257829, 6144 },
- { 244646, 7168 },
- { 232209, 8192 },
- { 220471, 9216 },
- { 209390, 10240 },
- { 198926, 11264 },
- { 189040, 12288 },
- { 179698, 13312 },
- { 170868, 14336 },
- { 162519, 15360 },
- { 154622, 16384 },
- { 147150, 17408 },
- { 140079, 18432 },
- { 133385, 19456 },
- { 127046, 20480 },
- { 121042, 21504 },
- { 115352, 22528 },
- { 109960, 23552 },
- { 104848, 24576 },
- { 100000, 25600 },
- { 95402, 26624 },
- { 91038, 27648 },
- { 86897, 28672 },
- { 82965, 29696 },
- { 79232, 30720 },
- { 75686, 31744 },
- { 72316, 32768 },
- { 69114, 33792 },
- { 66070, 34816 },
- { 63176, 35840 },
- { 60423, 36864 },
- { 57804, 37888 },
- { 55312, 38912 },
- { 52940, 39936 },
- { 50681, 40960 },
- { 48531, 41984 },
- { 46482, 43008 },
- { 44530, 44032 },
- { 42670, 45056 },
- { 40897, 46080 },
- { 39207, 47104 },
- { 37595, 48128 },
- { 36057, 49152 },
- { 34590, 50176 },
- { 33190, 51200 },
- { 31853, 52224 },
- { 30577, 53248 },
- { 29358, 54272 },
- { 28194, 55296 },
- { 27082, 56320 },
- { 26020, 57344 },
- { 25004, 58368 },
- { 24033, 59392 },
- { 23104, 60416 },
- { 22216, 61440 },
- { 21367, 62464 },
- { 20554, 63488 },
- { 19776, 64512 },
- { 19031, 65536 },
- { 18318, 66560 },
- { 17636, 67584 },
- { 16982, 68608 },
- { 16355, 69632 },
- { 15755, 70656 },
- { 15180, 71680 },
- { 14628, 72704 },
- { 14099, 73728 },
- { 13592, 74752 },
- { 13106, 75776 },
- { 12640, 76800 },
- { 12192, 77824 },
- { 11762, 78848 },
- { 11350, 79872 },
- { 10954, 80896 },
- { 10574, 81920 },
- { 10209, 82944 },
- { 9858, 83968 },
- { 9521, 84992 },
- { 9197, 86016 },
- { 8886, 87040 },
- { 8587, 88064 },
- { 8299, 89088 },
- { 8023, 90112 },
- { 7757, 91136 },
- { 7501, 92160 },
- { 7254, 93184 },
- { 7017, 94208 },
- { 6789, 95232 },
- { 6570, 96256 },
- { 6358, 97280 },
- { 6155, 98304 },
- { 5959, 99328 },
- { 5770, 100352 },
- { 5588, 101376 },
- { 5412, 102400 },
- { 5243, 103424 },
- { 5080, 104448 },
- { 4923, 105472 },
- { 4771, 106496 },
- { 4625, 107520 },
- { 4484, 108544 },
- { 4348, 109568 },
- { 4217, 110592 },
- { 4090, 111616 },
- { 3968, 112640 },
- { 3850, 113664 },
- { 3736, 114688 },
- { 3626, 115712 },
- { 3519, 116736 },
- { 3417, 117760 },
- { 3317, 118784 },
- { 3221, 119808 },
- { 3129, 120832 },
- { 3039, 121856 },
- { 2952, 122880 },
- { 2868, 123904 },
- { 2787, 124928 },
- { 2709, 125952 },
- { 2633, 126976 },
- { 2560, 128000 },
- { 2489, 129024 },
- { 2420, 130048 }
- };
- /*
- * Resistance to temperature table for batt_therm.
- */
- static const struct vadc_map_pt adcmap_gen3_batt_therm_100k[] = {
- { 5319890, -400 },
- { 4555860, -380 },
- { 3911780, -360 },
- { 3367320, -340 },
- { 2905860, -320 },
- { 2513730, -300 },
- { 2179660, -280 },
- { 1894360, -260 },
- { 1650110, -240 },
- { 1440520, -220 },
- { 1260250, -200 },
- { 1104850, -180 },
- { 970600, -160 },
- { 854370, -140 },
- { 753530, -120 },
- { 665860, -100 },
- { 589490, -80 },
- { 522830, -60 },
- { 464540, -40 },
- { 413470, -20 },
- { 368640, 0 },
- { 329220, 20 },
- { 294490, 40 },
- { 263850, 60 },
- { 236770, 80 },
- { 212790, 100 },
- { 191530, 120 },
- { 172640, 140 },
- { 155840, 160 },
- { 140880, 180 },
- { 127520, 200 },
- { 115590, 220 },
- { 104910, 240 },
- { 95350, 260 },
- { 86760, 280 },
- { 79050, 300 },
- { 72110, 320 },
- { 65860, 340 },
- { 60220, 360 },
- { 55130, 380 },
- { 50520, 400 },
- { 46350, 420 },
- { 42570, 440 },
- { 39140, 460 },
- { 36030, 480 },
- { 33190, 500 },
- { 30620, 520 },
- { 28260, 540 },
- { 26120, 560 },
- { 24160, 580 },
- { 22370, 600 },
- { 20730, 620 },
- { 19230, 640 },
- { 17850, 660 },
- { 16580, 680 },
- { 15420, 700 },
- { 14350, 720 },
- { 13370, 740 },
- { 12470, 760 },
- { 11630, 780 },
- { 10860, 800 },
- { 10150, 820 },
- { 9490, 840 },
- { 8880, 860 },
- { 8320, 880 },
- { 7800, 900 },
- { 7310, 920 },
- { 6860, 940 },
- { 6450, 960 },
- { 6060, 980 }
- };
- static const struct u32_fract adc5_prescale_ratios[] = {
- { .numerator = 1, .denominator = 1 },
- { .numerator = 1, .denominator = 3 },
- { .numerator = 1, .denominator = 4 },
- { .numerator = 1, .denominator = 6 },
- { .numerator = 1, .denominator = 20 },
- { .numerator = 1, .denominator = 8 },
- { .numerator = 10, .denominator = 81 },
- { .numerator = 1, .denominator = 10 },
- { .numerator = 1, .denominator = 16 },
- { .numerator = 40, .denominator = 41 }, /* PM7_SMB_TEMP */
- /* Prescale ratios for current channels below */
- { .numerator = 32, .denominator = 100 }, /* IIN_FB, IIN_SMB */
- { .numerator = 16, .denominator = 100 }, /* ICHG_SMB */
- { .numerator = 1280, .denominator = 4100 }, /* IIN_SMB_new */
- { .numerator = 640, .denominator = 4100 }, /* ICHG_SMB_new */
- { .numerator = 1000, .denominator = 305185 }, /* ICHG_FB */
- { .numerator = 1000, .denominator = 610370 }, /* ICHG_FB_2X */
- { .numerator = 1000, .denominator = 366220 }, /* ICHG_FB ADC5_GEN3 */
- { .numerator = 1000, .denominator = 732440 }, /* ICHG_FB_2X ADC5_GEN3 */
- };
- static int qcom_vadc_scale_hw_calib_volt(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_uv);
- /* Current scaling for PMIC7 */
- static int qcom_vadc_scale_hw_calib_current(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_ua);
- /* Raw current for PMIC7 */
- static int qcom_vadc_scale_hw_calib_current_raw(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_ua);
- /* Current scaling for PMIC5 */
- static int qcom_vadc5_scale_hw_calib_current(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_ua);
- static int qcom_vadc_scale_hw_calib_therm(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_vadc_scale_hw_calib_batt_therm_100(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_vadc_scale_hw_calib_batt_therm_30(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_vadc_scale_hw_calib_batt_therm_400(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_vadc7_scale_hw_calib_therm(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_vadc_scale_hw_smb_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_vadc_scale_hw_pm7_smb_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_vadc_scale_hw_smb1398_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_vadc_scale_hw_pm2250_s3_die_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_adc5_gen3_scale_hw_calib_batt_therm_100(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_adc5_gen3_scale_hw_calib_batt_id_100(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_adc5_gen3_scale_hw_calib_usb_in_current(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_vadc_scale_hw_chg5_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_vadc_scale_hw_pm7_chg_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_vadc_scale_hw_calib_die_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static int qcom_vadc7_scale_hw_calib_die_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec);
- static struct qcom_adc5_scale_type scale_adc5_fn[] = {
- [SCALE_HW_CALIB_DEFAULT] = {qcom_vadc_scale_hw_calib_volt},
- [SCALE_HW_CALIB_CUR] = {qcom_vadc_scale_hw_calib_current},
- [SCALE_HW_CALIB_CUR_RAW] = {qcom_vadc_scale_hw_calib_current_raw},
- [SCALE_HW_CALIB_PM5_CUR] = {qcom_vadc5_scale_hw_calib_current},
- [SCALE_HW_CALIB_THERM_100K_PULLUP] = {qcom_vadc_scale_hw_calib_therm},
- [SCALE_HW_CALIB_BATT_THERM_100K] = {
- qcom_vadc_scale_hw_calib_batt_therm_100},
- [SCALE_HW_CALIB_BATT_THERM_30K] = {
- qcom_vadc_scale_hw_calib_batt_therm_30},
- [SCALE_HW_CALIB_BATT_THERM_400K] = {
- qcom_vadc_scale_hw_calib_batt_therm_400},
- [SCALE_HW_CALIB_XOTHERM] = {qcom_vadc_scale_hw_calib_therm},
- [SCALE_HW_CALIB_THERM_100K_PU_PM7] = {
- qcom_vadc7_scale_hw_calib_therm},
- [SCALE_HW_CALIB_PMIC_THERM] = {qcom_vadc_scale_hw_calib_die_temp},
- [SCALE_HW_CALIB_PMIC_THERM_PM7] = {
- qcom_vadc7_scale_hw_calib_die_temp},
- [SCALE_HW_CALIB_PM5_CHG_TEMP] = {qcom_vadc_scale_hw_chg5_temp},
- [SCALE_HW_CALIB_PM5_SMB_TEMP] = {qcom_vadc_scale_hw_smb_temp},
- [SCALE_HW_CALIB_PM5_SMB1398_TEMP] = {qcom_vadc_scale_hw_smb1398_temp},
- [SCALE_HW_CALIB_PM2250_S3_DIE_TEMP] = {qcom_vadc_scale_hw_pm2250_s3_die_temp},
- [SCALE_HW_CALIB_PM5_GEN3_BATT_THERM_100K] = {qcom_adc5_gen3_scale_hw_calib_batt_therm_100},
- [SCALE_HW_CALIB_PM5_GEN3_BATT_ID_100K] = {qcom_adc5_gen3_scale_hw_calib_batt_id_100},
- [SCALE_HW_CALIB_PM5_GEN3_USB_IN_I] = {qcom_adc5_gen3_scale_hw_calib_usb_in_current},
- [SCALE_HW_CALIB_PM7_SMB_TEMP] = {qcom_vadc_scale_hw_pm7_smb_temp},
- [SCALE_HW_CALIB_PM7_CHG_TEMP] = {qcom_vadc_scale_hw_pm7_chg_temp},
- };
- static int qcom_vadc_map_voltage_temp(const struct vadc_map_pt *pts,
- u32 tablesize, s32 input, int *output)
- {
- u32 i = 0;
- if (!pts)
- return -EINVAL;
- while (i < tablesize && pts[i].x > input)
- i++;
- if (i == 0) {
- *output = pts[0].y;
- } else if (i == tablesize) {
- *output = pts[tablesize - 1].y;
- } else {
- /* interpolate linearly */
- *output = fixp_linear_interpolate(pts[i - 1].x, pts[i - 1].y,
- pts[i].x, pts[i].y,
- input);
- }
- return 0;
- }
- static s32 qcom_vadc_map_temp_voltage(const struct vadc_map_pt *pts,
- u32 tablesize, int input)
- {
- u32 i = 0;
- /*
- * Table must be sorted, find the interval of 'y' which contains value
- * 'input' and map it to proper 'x' value
- */
- while (i < tablesize && pts[i].y < input)
- i++;
- if (i == 0)
- return pts[0].x;
- if (i == tablesize)
- return pts[tablesize - 1].x;
- /* interpolate linearly */
- return fixp_linear_interpolate(pts[i - 1].y, pts[i - 1].x,
- pts[i].y, pts[i].x, input);
- }
- static void qcom_vadc_scale_calib(const struct vadc_linear_graph *calib_graph,
- u16 adc_code,
- bool absolute,
- s64 *scale_voltage)
- {
- *scale_voltage = (adc_code - calib_graph->gnd);
- *scale_voltage *= calib_graph->dx;
- *scale_voltage = div64_s64(*scale_voltage, calib_graph->dy);
- if (absolute)
- *scale_voltage += calib_graph->dx;
- if (*scale_voltage < 0)
- *scale_voltage = 0;
- }
- static int qcom_vadc_scale_volt(const struct vadc_linear_graph *calib_graph,
- const struct u32_fract *prescale,
- bool absolute, u16 adc_code,
- int *result_uv)
- {
- s64 voltage = 0, result = 0;
- qcom_vadc_scale_calib(calib_graph, adc_code, absolute, &voltage);
- voltage *= prescale->denominator;
- result = div64_s64(voltage, prescale->numerator);
- *result_uv = result;
- return 0;
- }
- static int qcom_vadc_scale_therm(const struct vadc_linear_graph *calib_graph,
- const struct u32_fract *prescale,
- bool absolute, u16 adc_code,
- int *result_mdec)
- {
- s64 voltage = 0;
- int ret;
- qcom_vadc_scale_calib(calib_graph, adc_code, absolute, &voltage);
- if (absolute)
- voltage = div64_s64(voltage, 1000);
- ret = qcom_vadc_map_voltage_temp(adcmap_100k_104ef_104fb,
- ARRAY_SIZE(adcmap_100k_104ef_104fb),
- voltage, result_mdec);
- if (ret)
- return ret;
- return 0;
- }
- static int qcom_vadc_scale_die_temp(const struct vadc_linear_graph *calib_graph,
- const struct u32_fract *prescale,
- bool absolute,
- u16 adc_code, int *result_mdec)
- {
- s64 voltage = 0;
- u64 temp; /* Temporary variable for do_div */
- qcom_vadc_scale_calib(calib_graph, adc_code, absolute, &voltage);
- if (voltage > 0) {
- temp = voltage * prescale->denominator;
- do_div(temp, prescale->numerator * 2);
- voltage = temp;
- } else {
- voltage = 0;
- }
- *result_mdec = milli_kelvin_to_millicelsius(voltage);
- return 0;
- }
- static int qcom_vadc_scale_chg_temp(const struct vadc_linear_graph *calib_graph,
- const struct u32_fract *prescale,
- bool absolute,
- u16 adc_code, int *result_mdec)
- {
- s64 voltage = 0, result = 0;
- qcom_vadc_scale_calib(calib_graph, adc_code, absolute, &voltage);
- voltage *= prescale->denominator;
- voltage = div64_s64(voltage, prescale->numerator);
- voltage = ((PMI_CHG_SCALE_1) * (voltage * 2));
- voltage = (voltage + PMI_CHG_SCALE_2);
- result = div64_s64(voltage, 1000000);
- *result_mdec = result;
- return 0;
- }
- /* convert voltage to ADC code, using 1.875V reference */
- static u16 qcom_vadc_scale_voltage_code(s32 voltage,
- const struct u32_fract *prescale,
- const u32 full_scale_code_volt,
- unsigned int factor)
- {
- s64 volt = voltage;
- s64 adc_vdd_ref_mv = 1875; /* reference voltage */
- volt *= prescale->numerator * factor * full_scale_code_volt;
- volt = div64_s64(volt, (s64)prescale->denominator * adc_vdd_ref_mv * 1000);
- return volt;
- }
- static int qcom_vadc_scale_code_voltage_factor(u16 adc_code,
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- unsigned int factor)
- {
- s64 voltage, temp, adc_vdd_ref_mv = 1875;
- /*
- * The normal data range is between 0V to 1.875V. On cases where
- * we read low voltage values, the ADC code can go beyond the
- * range and the scale result is incorrect so we clamp the values
- * for the cases where the code represents a value below 0V
- */
- if (adc_code > VADC5_MAX_CODE)
- adc_code = 0;
- /* (ADC code * vref_vadc (1.875V)) / full_scale_code */
- voltage = (s64) adc_code * adc_vdd_ref_mv * 1000;
- voltage = div64_s64(voltage, data->full_scale_code_volt);
- if (voltage > 0) {
- voltage *= prescale->denominator;
- temp = prescale->numerator * factor;
- voltage = div64_s64(voltage, temp);
- } else {
- voltage = 0;
- }
- return (int) voltage;
- }
- static int qcom_vadc7_scale_hw_calib_therm(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- s64 resistance = adc_code;
- int ret, result;
- if (adc_code >= RATIO_MAX_ADC7)
- return -EINVAL;
- /* (ADC code * R_PULLUP (100Kohm)) / (full_scale_code - ADC code)*/
- resistance *= R_PU_100K;
- resistance = div64_s64(resistance, RATIO_MAX_ADC7 - adc_code);
- ret = qcom_vadc_map_voltage_temp(adcmap7_100k,
- ARRAY_SIZE(adcmap7_100k),
- resistance, &result);
- if (ret)
- return ret;
- *result_mdec = result;
- return 0;
- }
- static int qcom_vadc_scale_hw_calib_current_raw(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_ua)
- {
- s64 temp;
- if (!prescale->numerator)
- return -EINVAL;
- temp = div_s64((s64)(s16)adc_code * prescale->denominator,
- prescale->numerator);
- *result_ua = (int) temp;
- pr_debug("raw adc_code: %#x result_ua: %d\n", adc_code, *result_ua);
- return 0;
- }
- static int qcom_vadc_scale_hw_calib_current(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_ua)
- {
- u32 adc_vdd_ref_mv = 1875;
- s64 voltage;
- if (!prescale->numerator)
- return -EINVAL;
- /* (ADC code * vref_vadc (1.875V)) / full_scale_code */
- voltage = (s64)(s16) adc_code * adc_vdd_ref_mv * 1000;
- voltage = div_s64(voltage, data->full_scale_code_volt);
- voltage = div_s64(voltage * prescale->denominator, prescale->numerator);
- *result_ua = (int) voltage;
- pr_debug("adc_code: %#x result_ua: %d\n", adc_code, *result_ua);
- return 0;
- }
- static int qcom_vadc5_scale_hw_calib_current(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_ua)
- {
- s64 voltage = 0, result = 0;
- bool positive = true;
- if (adc_code & ADC5_USR_DATA_CHECK) {
- adc_code = ~adc_code + 1;
- positive = false;
- }
- voltage = (s64)(s16) adc_code * data->full_scale_code_cur * 1000;
- voltage = div64_s64(voltage, VADC5_MAX_CODE);
- result = div64_s64(voltage * prescale->denominator, prescale->numerator);
- *result_ua = result;
- if (!positive)
- *result_ua = -result;
- return 0;
- }
- static int qcom_vadc_scale_hw_calib_volt(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_uv)
- {
- *result_uv = qcom_vadc_scale_code_voltage_factor(adc_code,
- prescale, data, 1);
- return 0;
- }
- static int qcom_vadc_scale_hw_calib_therm(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- int voltage;
- voltage = qcom_vadc_scale_code_voltage_factor(adc_code,
- prescale, data, 1000);
- /* Map voltage to temperature from look-up table */
- return qcom_vadc_map_voltage_temp(adcmap_100k_104ef_104fb_1875_vref,
- ARRAY_SIZE(adcmap_100k_104ef_104fb_1875_vref),
- voltage, result_mdec);
- }
- static int qcom_vadc_scale_hw_calib_batt_therm_100(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- int voltage;
- voltage = qcom_vadc_scale_code_voltage_factor(adc_code,
- prescale, data, 1000);
- /* Map voltage to temperature from look-up table */
- return qcom_vadc_map_voltage_temp(adcmap_batt_therm_100k,
- ARRAY_SIZE(adcmap_batt_therm_100k),
- voltage, result_mdec);
- }
- static int qcom_vadc_scale_hw_calib_batt_therm_30(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- int voltage;
- voltage = qcom_vadc_scale_code_voltage_factor(adc_code,
- prescale, data, 1000);
- /* Map voltage to temperature from look-up table */
- return qcom_vadc_map_voltage_temp(adcmap_batt_therm_30k,
- ARRAY_SIZE(adcmap_batt_therm_30k),
- voltage, result_mdec);
- }
- static int qcom_vadc_scale_hw_calib_batt_therm_400(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- int voltage;
- voltage = qcom_vadc_scale_code_voltage_factor(adc_code,
- prescale, data, 1000);
- /* Map voltage to temperature from look-up table */
- return qcom_vadc_map_voltage_temp(adcmap_batt_therm_400k,
- ARRAY_SIZE(adcmap_batt_therm_400k),
- voltage, result_mdec);
- }
- static int qcom_vadc_scale_hw_calib_die_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- *result_mdec = qcom_vadc_scale_code_voltage_factor(adc_code,
- prescale, data, 2);
- *result_mdec = milli_kelvin_to_millicelsius(*result_mdec);
- return 0;
- }
- static int qcom_vadc7_scale_hw_calib_die_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- int voltage;
- voltage = qcom_vadc_scale_code_voltage_factor(adc_code,
- prescale, data, 1);
- return qcom_vadc_map_voltage_temp(adcmap7_die_temp, ARRAY_SIZE(adcmap7_die_temp),
- voltage, result_mdec);
- }
- static int qcom_vadc_scale_hw_pm7_chg_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- s64 temp;
- int result_uv;
- result_uv = qcom_vadc_scale_code_voltage_factor(adc_code,
- prescale, data, 1);
- /* T(C) = Vadc/0.0033 – 277.12 */
- temp = div_s64((30303LL * result_uv) - (27712 * 1000000LL), 100000);
- pr_debug("adc_code: %u result_uv: %d temp: %lld\n", adc_code, result_uv,
- temp);
- *result_mdec = temp > 0 ? temp : 0;
- return 0;
- }
- static int qcom_vadc_scale_hw_pm7_smb_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- s64 temp;
- int result_uv;
- result_uv = qcom_vadc_scale_code_voltage_factor(adc_code,
- prescale, data, 1);
- /* T(C) = 25 + (25*Vadc - 24.885) / 0.0894 */
- temp = div_s64(((25000LL * result_uv) - (24885 * 1000000LL)) * 10000,
- 894 * 1000000) + 25000;
- pr_debug("adc_code: %#x result_uv: %d temp: %lld\n", adc_code,
- result_uv, temp);
- *result_mdec = temp > 0 ? temp : 0;
- return 0;
- }
- static int qcom_vadc_scale_hw_smb_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- *result_mdec = qcom_vadc_scale_code_voltage_factor(adc_code * 100,
- prescale, data, PMIC5_SMB_TEMP_SCALE_FACTOR);
- *result_mdec = PMIC5_SMB_TEMP_CONSTANT - *result_mdec;
- return 0;
- }
- static int qcom_vadc_scale_hw_smb1398_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- s64 voltage = 0, adc_vdd_ref_mv = 1875;
- u64 temp;
- if (adc_code > VADC5_MAX_CODE)
- adc_code = 0;
- /* (ADC code * vref_vadc (1.875V)) / full_scale_code */
- voltage = (s64) adc_code * adc_vdd_ref_mv * 1000;
- voltage = div64_s64(voltage, data->full_scale_code_volt);
- if (voltage > 0) {
- temp = voltage * prescale->denominator;
- temp *= 100;
- do_div(temp, prescale->numerator * PMIC5_SMB1398_TEMP_SCALE_FACTOR);
- voltage = temp;
- } else {
- voltage = 0;
- }
- voltage = voltage - PMIC5_SMB1398_TEMP_CONSTANT;
- *result_mdec = voltage;
- return 0;
- }
- static int qcom_vadc_scale_hw_pm2250_s3_die_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- s64 voltage = 0, adc_vdd_ref_mv = 1875;
- if (adc_code > VADC5_MAX_CODE)
- adc_code = 0;
- /* (ADC code * vref_vadc (1.875V)) / full_scale_code */
- voltage = (s64) adc_code * adc_vdd_ref_mv * 1000;
- voltage = div64_s64(voltage, data->full_scale_code_volt);
- if (voltage > 0) {
- voltage *= prescale->denominator;
- voltage = div64_s64(voltage, prescale->numerator);
- } else {
- voltage = 0;
- }
- voltage = PMIC5_PM2250_S3_DIE_TEMP_CONSTANT - voltage;
- voltage *= 100000;
- voltage = div64_s64(voltage, PMIC5_PM2250_S3_DIE_TEMP_SCALE_FACTOR);
- *result_mdec = voltage;
- return 0;
- }
- static int qcom_adc5_gen3_scale_hw_calib_batt_therm_100(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- s64 resistance = 0;
- int ret, result = 0;
- if (adc_code >= RATIO_MAX_ADC7)
- return -EINVAL;
- /* (ADC code * R_PULLUP (100Kohm)) / (full_scale_code - ADC code)*/
- resistance = (s64) adc_code * R_PU_100K;
- resistance = div64_s64(resistance, (RATIO_MAX_ADC7 - adc_code));
- ret = qcom_vadc_map_voltage_temp(adcmap_gen3_batt_therm_100k,
- ARRAY_SIZE(adcmap_gen3_batt_therm_100k),
- resistance, &result);
- if (ret)
- return ret;
- *result_mdec = result;
- return 0;
- }
- static int qcom_adc5_gen3_scale_hw_calib_batt_id_100(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- s64 resistance = 0;
- if (adc_code >= RATIO_MAX_ADC7)
- return -EINVAL;
- /* (ADC code * R_PULLUP (100Kohm)) / (full_scale_code - ADC code)*/
- resistance = (s64) adc_code * R_PU_100K;
- resistance = div64_s64(resistance, (RATIO_MAX_ADC7 - adc_code));
- *result_mdec = (int)resistance;
- return 0;
- };
- static int qcom_adc5_gen3_scale_hw_calib_usb_in_current(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_ua)
- {
- s64 voltage = 0, result = 0;
- bool positive = true;
- if (adc_code & ADC5_USR_DATA_CHECK) {
- adc_code = ~adc_code + 1;
- positive = false;
- }
- voltage = (s64)(s16) adc_code * 1000000;
- voltage = div64_s64(voltage, PMIC5_GEN3_USB_IN_I_SCALE_FACTOR);
- result = div64_s64(voltage * prescale->denominator, prescale->numerator);
- *result_ua = (int)result;
- if (!positive)
- *result_ua = -(int)result;
- return 0;
- };
- static int qcom_vadc_scale_hw_chg5_temp(
- const struct u32_fract *prescale,
- const struct adc5_data *data,
- u16 adc_code, int *result_mdec)
- {
- *result_mdec = qcom_vadc_scale_code_voltage_factor(adc_code,
- prescale, data, 4);
- *result_mdec = PMIC5_CHG_TEMP_SCALE_FACTOR - *result_mdec;
- return 0;
- }
- void adc_tm_scale_therm_voltage_100k_gen3(struct adc_tm_config *param)
- {
- int temp, ret;
- int64_t resistance = 0;
- /*
- * High temperature maps to lower threshold voltage.
- * Same API can be used for resistance-temperature table
- */
- resistance = qcom_vadc_map_temp_voltage(adcmap7_100k,
- ARRAY_SIZE(adcmap7_100k),
- param->high_thr_temp);
- param->low_thr_voltage = resistance * RATIO_MAX_ADC7;
- param->low_thr_voltage = div64_s64(param->low_thr_voltage,
- (resistance + R_PU_100K));
- /*
- * low_thr_voltage is ADC raw code corresponding to upper temperature
- * threshold.
- * Instead of returning the ADC raw code obtained at this point,we first
- * do a forward conversion on the (low voltage / high temperature) threshold code,
- * to temperature, to check if that code, when read by TM, would translate to
- * a temperature greater than or equal to the upper temperature limit (which is
- * expected). If it is instead lower than the upper limit (not expected for correct
- * TM functionality), we lower the raw code of the threshold written by 1
- * to ensure TM does see a violation when it reads raw code corresponding
- * to the upper limit temperature specified.
- */
- ret = qcom_vadc7_scale_hw_calib_therm(NULL, NULL, param->low_thr_voltage, &temp);
- if (ret < 0)
- return;
- if (temp < param->high_thr_temp)
- param->low_thr_voltage--;
- /*
- * Low temperature maps to higher threshold voltage
- * Same API can be used for resistance-temperature table
- */
- resistance = qcom_vadc_map_temp_voltage(adcmap7_100k,
- ARRAY_SIZE(adcmap7_100k),
- param->low_thr_temp);
- param->high_thr_voltage = resistance * RATIO_MAX_ADC7;
- param->high_thr_voltage = div64_s64(param->high_thr_voltage,
- (resistance + R_PU_100K));
- /*
- * high_thr_voltage is ADC raw code corresponding to lower temperature
- * threshold.
- * Similar to what is done above for low_thr voltage, we first
- * do a forward conversion on the (high voltage / low temperature)threshold code,
- * to temperature, to check if that code, when read by TM, would translate to a
- * temperature less than or equal to the lower temperature limit (which is expected).
- * If it is instead greater than the lower limit (not expected for correct
- * TM functionality), we increase the raw code of the threshold written by 1
- * to ensure TM does see a violation when it reads raw code corresponding
- * to the lower limit temperature specified.
- */
- ret = qcom_vadc7_scale_hw_calib_therm(NULL, NULL, param->high_thr_voltage, &temp);
- if (ret < 0)
- return;
- if (temp > param->low_thr_temp)
- param->high_thr_voltage++;
- }
- EXPORT_SYMBOL(adc_tm_scale_therm_voltage_100k_gen3);
- int32_t adc_tm_absolute_rthr_gen3(struct adc_tm_config *tm_config)
- {
- int64_t low_thr = 0, high_thr = 0;
- low_thr = tm_config->low_thr_voltage;
- low_thr *= ADC5_FULL_SCALE_CODE;
- low_thr = div64_s64(low_thr, ADC_VDD_REF);
- tm_config->low_thr_voltage = low_thr;
- high_thr = tm_config->high_thr_voltage;
- high_thr *= ADC5_FULL_SCALE_CODE;
- high_thr = div64_s64(high_thr, ADC_VDD_REF);
- tm_config->high_thr_voltage = high_thr;
- return 0;
- }
- EXPORT_SYMBOL(adc_tm_absolute_rthr_gen3);
- int qcom_vadc_scale(enum vadc_scale_fn_type scaletype,
- const struct vadc_linear_graph *calib_graph,
- const struct u32_fract *prescale,
- bool absolute,
- u16 adc_code, int *result)
- {
- switch (scaletype) {
- case SCALE_DEFAULT:
- return qcom_vadc_scale_volt(calib_graph, prescale,
- absolute, adc_code,
- result);
- case SCALE_THERM_100K_PULLUP:
- case SCALE_XOTHERM:
- return qcom_vadc_scale_therm(calib_graph, prescale,
- absolute, adc_code,
- result);
- case SCALE_PMIC_THERM:
- return qcom_vadc_scale_die_temp(calib_graph, prescale,
- absolute, adc_code,
- result);
- case SCALE_PMI_CHG_TEMP:
- return qcom_vadc_scale_chg_temp(calib_graph, prescale,
- absolute, adc_code,
- result);
- default:
- return -EINVAL;
- }
- }
- EXPORT_SYMBOL(qcom_vadc_scale);
- u16 qcom_adc_tm5_temp_volt_scale(unsigned int prescale_ratio,
- u32 full_scale_code_volt, int temp)
- {
- const struct u32_fract *prescale = &adc5_prescale_ratios[prescale_ratio];
- s32 voltage;
- voltage = qcom_vadc_map_temp_voltage(adcmap_100k_104ef_104fb_1875_vref,
- ARRAY_SIZE(adcmap_100k_104ef_104fb_1875_vref),
- temp);
- return qcom_vadc_scale_voltage_code(voltage, prescale, full_scale_code_volt, 1000);
- }
- EXPORT_SYMBOL(qcom_adc_tm5_temp_volt_scale);
- u16 qcom_adc_tm5_gen2_temp_res_scale(int temp)
- {
- int64_t resistance;
- resistance = qcom_vadc_map_temp_voltage(adcmap7_100k,
- ARRAY_SIZE(adcmap7_100k), temp);
- return div64_s64(resistance * RATIO_MAX_ADC7, resistance + R_PU_100K);
- }
- EXPORT_SYMBOL(qcom_adc_tm5_gen2_temp_res_scale);
- int qcom_adc5_hw_scale(enum vadc_scale_fn_type scaletype,
- unsigned int prescale_ratio,
- const struct adc5_data *data,
- u16 adc_code, int *result)
- {
- const struct u32_fract *prescale = &adc5_prescale_ratios[prescale_ratio];
- if (!(scaletype >= SCALE_HW_CALIB_DEFAULT &&
- scaletype < SCALE_HW_CALIB_INVALID)) {
- pr_err("Invalid scale type %d\n", scaletype);
- return -EINVAL;
- }
- return scale_adc5_fn[scaletype].scale_fn(prescale, data,
- adc_code, result);
- }
- EXPORT_SYMBOL(qcom_adc5_hw_scale);
- int qcom_adc5_prescaling_from_dt(u32 numerator, u32 denominator)
- {
- unsigned int pre;
- for (pre = 0; pre < ARRAY_SIZE(adc5_prescale_ratios); pre++)
- if (adc5_prescale_ratios[pre].numerator == numerator &&
- adc5_prescale_ratios[pre].denominator == denominator)
- break;
- if (pre == ARRAY_SIZE(adc5_prescale_ratios))
- return -EINVAL;
- return pre;
- }
- EXPORT_SYMBOL(qcom_adc5_prescaling_from_dt);
- int qcom_adc5_hw_settle_time_from_dt(u32 value,
- const unsigned int *hw_settle)
- {
- unsigned int i;
- for (i = 0; i < VADC_HW_SETTLE_SAMPLES_MAX; i++) {
- if (value == hw_settle[i])
- return i;
- }
- return -EINVAL;
- }
- EXPORT_SYMBOL(qcom_adc5_hw_settle_time_from_dt);
- int qcom_adc5_avg_samples_from_dt(u32 value)
- {
- if (!is_power_of_2(value) || value > ADC5_AVG_SAMPLES_MAX)
- return -EINVAL;
- return __ffs(value);
- }
- EXPORT_SYMBOL(qcom_adc5_avg_samples_from_dt);
- int qcom_adc5_decimation_from_dt(u32 value, const unsigned int *decimation)
- {
- unsigned int i;
- for (i = 0; i < ADC5_DECIMATION_SAMPLES_MAX; i++) {
- if (value == decimation[i])
- return i;
- }
- return -EINVAL;
- }
- EXPORT_SYMBOL(qcom_adc5_decimation_from_dt);
- int qcom_vadc_decimation_from_dt(u32 value)
- {
- if (!is_power_of_2(value) || value < VADC_DECIMATION_MIN ||
- value > VADC_DECIMATION_MAX)
- return -EINVAL;
- return __ffs64(value / VADC_DECIMATION_MIN);
- }
- EXPORT_SYMBOL(qcom_vadc_decimation_from_dt);
- MODULE_LICENSE("GPL v2");
- MODULE_DESCRIPTION("Qualcomm ADC common functionality");
|