109c434b8SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
21da177e4SLinus Torvalds /* radio-trust.c - Trust FM Radio card driver for Linux 2.2
31da177e4SLinus Torvalds * by Eric Lammerts <eric@scintilla.utwente.nl>
41da177e4SLinus Torvalds *
51da177e4SLinus Torvalds * Based on radio-aztech.c. Original notes:
61da177e4SLinus Torvalds *
71da177e4SLinus Torvalds * Adapted to support the Video for Linux API by
81da177e4SLinus Torvalds * Russell Kroll <rkroll@exploits.org>. Based on original tuner code by:
91da177e4SLinus Torvalds *
101da177e4SLinus Torvalds * Quay Ly
111da177e4SLinus Torvalds * Donald Song
121da177e4SLinus Torvalds * Jason Lewis (jlewis@twilight.vtc.vsc.edu)
131da177e4SLinus Torvalds * Scott McGrath (smcgrath@twilight.vtc.vsc.edu)
141da177e4SLinus Torvalds * William McGrath (wmcgrath@twilight.vtc.vsc.edu)
151da177e4SLinus Torvalds *
1632590819SMauro Carvalho Chehab * Converted to V4L2 API by Mauro Carvalho Chehab <mchehab@kernel.org>
171da177e4SLinus Torvalds */
181da177e4SLinus Torvalds
191da177e4SLinus Torvalds #include <linux/module.h>
201da177e4SLinus Torvalds #include <linux/init.h>
211da177e4SLinus Torvalds #include <linux/ioport.h>
22982eddb9SMauro Carvalho Chehab #include <linux/videodev2.h>
231dc8aafcSHans Verkuil #include <linux/io.h>
249f1dfccfSHans Verkuil #include <linux/slab.h>
251dc8aafcSHans Verkuil #include <media/v4l2-device.h>
2635ea11ffSHans Verkuil #include <media/v4l2-ioctl.h>
271d211f26SHans Verkuil #include "radio-isa.h"
281da177e4SLinus Torvalds
291dc8aafcSHans Verkuil MODULE_AUTHOR("Eric Lammerts, Russell Kroll, Quay Lu, Donald Song, Jason Lewis, Scott McGrath, William McGrath");
301dc8aafcSHans Verkuil MODULE_DESCRIPTION("A driver for the Trust FM Radio card.");
311dc8aafcSHans Verkuil MODULE_LICENSE("GPL");
321d211f26SHans Verkuil MODULE_VERSION("0.1.99");
33982eddb9SMauro Carvalho Chehab
341da177e4SLinus Torvalds /* acceptable ports: 0x350 (JP3 shorted), 0x358 (JP3 open) */
351da177e4SLinus Torvalds
361da177e4SLinus Torvalds #ifndef CONFIG_RADIO_TRUST_PORT
371da177e4SLinus Torvalds #define CONFIG_RADIO_TRUST_PORT -1
381da177e4SLinus Torvalds #endif
391da177e4SLinus Torvalds
401d211f26SHans Verkuil #define TRUST_MAX 2
411dc8aafcSHans Verkuil
421d211f26SHans Verkuil static int io[TRUST_MAX] = { [0] = CONFIG_RADIO_TRUST_PORT,
431d211f26SHans Verkuil [1 ... (TRUST_MAX - 1)] = -1 };
441d211f26SHans Verkuil static int radio_nr[TRUST_MAX] = { [0 ... (TRUST_MAX - 1)] = -1 };
451d211f26SHans Verkuil
461d211f26SHans Verkuil module_param_array(io, int, NULL, 0444);
471d211f26SHans Verkuil MODULE_PARM_DESC(io, "I/O addresses of the Trust FM Radio card (0x350 or 0x358)");
481d211f26SHans Verkuil module_param_array(radio_nr, int, NULL, 0444);
491d211f26SHans Verkuil MODULE_PARM_DESC(radio_nr, "Radio device numbers");
501dc8aafcSHans Verkuil
511dc8aafcSHans Verkuil struct trust {
521d211f26SHans Verkuil struct radio_isa_card isa;
531dc8aafcSHans Verkuil int ioval;
541dc8aafcSHans Verkuil };
551dc8aafcSHans Verkuil
trust_alloc(void)561d211f26SHans Verkuil static struct radio_isa_card *trust_alloc(void)
571d211f26SHans Verkuil {
581d211f26SHans Verkuil struct trust *tr = kzalloc(sizeof(*tr), GFP_KERNEL);
591d211f26SHans Verkuil
601d211f26SHans Verkuil return tr ? &tr->isa : NULL;
611d211f26SHans Verkuil }
621da177e4SLinus Torvalds
631da177e4SLinus Torvalds /* i2c addresses */
641da177e4SLinus Torvalds #define TDA7318_ADDR 0x88
651da177e4SLinus Torvalds #define TSA6060T_ADDR 0xc4
661da177e4SLinus Torvalds
671d211f26SHans Verkuil #define TR_DELAY do { inb(tr->isa.io); inb(tr->isa.io); inb(tr->isa.io); } while (0)
681d211f26SHans Verkuil #define TR_SET_SCL outb(tr->ioval |= 2, tr->isa.io)
691d211f26SHans Verkuil #define TR_CLR_SCL outb(tr->ioval &= 0xfd, tr->isa.io)
701d211f26SHans Verkuil #define TR_SET_SDA outb(tr->ioval |= 1, tr->isa.io)
711d211f26SHans Verkuil #define TR_CLR_SDA outb(tr->ioval &= 0xfe, tr->isa.io)
721da177e4SLinus Torvalds
write_i2c(struct trust * tr,int n,...)731dc8aafcSHans Verkuil static void write_i2c(struct trust *tr, int n, ...)
741da177e4SLinus Torvalds {
751da177e4SLinus Torvalds unsigned char val, mask;
761da177e4SLinus Torvalds va_list args;
771da177e4SLinus Torvalds
781da177e4SLinus Torvalds va_start(args, n);
791da177e4SLinus Torvalds
801da177e4SLinus Torvalds /* start condition */
811da177e4SLinus Torvalds TR_SET_SDA;
821da177e4SLinus Torvalds TR_SET_SCL;
831da177e4SLinus Torvalds TR_DELAY;
841da177e4SLinus Torvalds TR_CLR_SDA;
851da177e4SLinus Torvalds TR_CLR_SCL;
861da177e4SLinus Torvalds TR_DELAY;
871da177e4SLinus Torvalds
881da177e4SLinus Torvalds for (; n; n--) {
891da177e4SLinus Torvalds val = va_arg(args, unsigned);
901da177e4SLinus Torvalds for (mask = 0x80; mask; mask >>= 1) {
911da177e4SLinus Torvalds if (val & mask)
921da177e4SLinus Torvalds TR_SET_SDA;
931da177e4SLinus Torvalds else
941da177e4SLinus Torvalds TR_CLR_SDA;
951da177e4SLinus Torvalds TR_SET_SCL;
961da177e4SLinus Torvalds TR_DELAY;
971da177e4SLinus Torvalds TR_CLR_SCL;
981da177e4SLinus Torvalds TR_DELAY;
991da177e4SLinus Torvalds }
1001da177e4SLinus Torvalds /* acknowledge bit */
1011da177e4SLinus Torvalds TR_SET_SDA;
1021da177e4SLinus Torvalds TR_SET_SCL;
1031da177e4SLinus Torvalds TR_DELAY;
1041da177e4SLinus Torvalds TR_CLR_SCL;
1051da177e4SLinus Torvalds TR_DELAY;
1061da177e4SLinus Torvalds }
1071da177e4SLinus Torvalds
1081da177e4SLinus Torvalds /* stop condition */
1091da177e4SLinus Torvalds TR_CLR_SDA;
1101da177e4SLinus Torvalds TR_DELAY;
1111da177e4SLinus Torvalds TR_SET_SCL;
1121da177e4SLinus Torvalds TR_DELAY;
1131da177e4SLinus Torvalds TR_SET_SDA;
1141da177e4SLinus Torvalds TR_DELAY;
1151da177e4SLinus Torvalds
1161da177e4SLinus Torvalds va_end(args);
1171da177e4SLinus Torvalds }
1181da177e4SLinus Torvalds
trust_s_mute_volume(struct radio_isa_card * isa,bool mute,int vol)1191d211f26SHans Verkuil static int trust_s_mute_volume(struct radio_isa_card *isa, bool mute, int vol)
1201da177e4SLinus Torvalds {
1211d211f26SHans Verkuil struct trust *tr = container_of(isa, struct trust, isa);
1221d211f26SHans Verkuil
1231d211f26SHans Verkuil tr->ioval = (tr->ioval & 0xf7) | (mute << 3);
1241d211f26SHans Verkuil outb(tr->ioval, isa->io);
1251d211f26SHans Verkuil write_i2c(tr, 2, TDA7318_ADDR, vol ^ 0x1f);
1261d211f26SHans Verkuil return 0;
1271d211f26SHans Verkuil }
1281d211f26SHans Verkuil
trust_s_stereo(struct radio_isa_card * isa,bool stereo)1291d211f26SHans Verkuil static int trust_s_stereo(struct radio_isa_card *isa, bool stereo)
1301d211f26SHans Verkuil {
1311d211f26SHans Verkuil struct trust *tr = container_of(isa, struct trust, isa);
1321d211f26SHans Verkuil
1331d211f26SHans Verkuil tr->ioval = (tr->ioval & 0xfb) | (!stereo << 2);
1341d211f26SHans Verkuil outb(tr->ioval, isa->io);
1351d211f26SHans Verkuil return 0;
1361d211f26SHans Verkuil }
1371d211f26SHans Verkuil
trust_g_signal(struct radio_isa_card * isa)1381d211f26SHans Verkuil static u32 trust_g_signal(struct radio_isa_card *isa)
1391d211f26SHans Verkuil {
1401d211f26SHans Verkuil int i, v;
1411d211f26SHans Verkuil
1421d211f26SHans Verkuil for (i = 0, v = 0; i < 100; i++)
1431d211f26SHans Verkuil v |= inb(isa->io);
1441d211f26SHans Verkuil return (v & 1) ? 0 : 0xffff;
1451d211f26SHans Verkuil }
1461d211f26SHans Verkuil
trust_s_frequency(struct radio_isa_card * isa,u32 freq)1471d211f26SHans Verkuil static int trust_s_frequency(struct radio_isa_card *isa, u32 freq)
1481d211f26SHans Verkuil {
1491d211f26SHans Verkuil struct trust *tr = container_of(isa, struct trust, isa);
1501d211f26SHans Verkuil
1511d211f26SHans Verkuil freq /= 160; /* Convert to 10 kHz units */
1521d211f26SHans Verkuil freq += 1070; /* Add 10.7 MHz IF */
1531d211f26SHans Verkuil write_i2c(tr, 5, TSA6060T_ADDR, (freq << 1) | 1,
1541d211f26SHans Verkuil freq >> 7, 0x60 | ((freq >> 15) & 1), 0);
1551d211f26SHans Verkuil return 0;
1561da177e4SLinus Torvalds }
1571da177e4SLinus Torvalds
1581da177e4SLinus Torvalds static int basstreble2chip[15] = {
1591da177e4SLinus Torvalds 0, 1, 2, 3, 4, 5, 6, 7, 14, 13, 12, 11, 10, 9, 8
1601da177e4SLinus Torvalds };
1611da177e4SLinus Torvalds
trust_s_ctrl(struct v4l2_ctrl * ctrl)1621d211f26SHans Verkuil static int trust_s_ctrl(struct v4l2_ctrl *ctrl)
1631da177e4SLinus Torvalds {
1641d211f26SHans Verkuil struct radio_isa_card *isa =
1651d211f26SHans Verkuil container_of(ctrl->handler, struct radio_isa_card, hdl);
1661d211f26SHans Verkuil struct trust *tr = container_of(isa, struct trust, isa);
1671dc8aafcSHans Verkuil
168982eddb9SMauro Carvalho Chehab switch (ctrl->id) {
169982eddb9SMauro Carvalho Chehab case V4L2_CID_AUDIO_BASS:
1701d211f26SHans Verkuil write_i2c(tr, 2, TDA7318_ADDR, 0x60 | basstreble2chip[ctrl->val]);
171c5f822bfSDouglas Landgraf return 0;
172982eddb9SMauro Carvalho Chehab case V4L2_CID_AUDIO_TREBLE:
1731d211f26SHans Verkuil write_i2c(tr, 2, TDA7318_ADDR, 0x70 | basstreble2chip[ctrl->val]);
174c5f822bfSDouglas Landgraf return 0;
175982eddb9SMauro Carvalho Chehab }
176982eddb9SMauro Carvalho Chehab return -EINVAL;
177982eddb9SMauro Carvalho Chehab }
178982eddb9SMauro Carvalho Chehab
1791d211f26SHans Verkuil static const struct v4l2_ctrl_ops trust_ctrl_ops = {
1801d211f26SHans Verkuil .s_ctrl = trust_s_ctrl,
1811da177e4SLinus Torvalds };
1821da177e4SLinus Torvalds
trust_initialize(struct radio_isa_card * isa)1831d211f26SHans Verkuil static int trust_initialize(struct radio_isa_card *isa)
1841da177e4SLinus Torvalds {
1851d211f26SHans Verkuil struct trust *tr = container_of(isa, struct trust, isa);
1861dc8aafcSHans Verkuil
1871dc8aafcSHans Verkuil tr->ioval = 0xf;
1881dc8aafcSHans Verkuil write_i2c(tr, 2, TDA7318_ADDR, 0x80); /* speaker att. LF = 0 dB */
1891dc8aafcSHans Verkuil write_i2c(tr, 2, TDA7318_ADDR, 0xa0); /* speaker att. RF = 0 dB */
1901dc8aafcSHans Verkuil write_i2c(tr, 2, TDA7318_ADDR, 0xc0); /* speaker att. LR = 0 dB */
1911dc8aafcSHans Verkuil write_i2c(tr, 2, TDA7318_ADDR, 0xe0); /* speaker att. RR = 0 dB */
1921dc8aafcSHans Verkuil write_i2c(tr, 2, TDA7318_ADDR, 0x40); /* stereo 1 input, gain = 18.75 dB */
1931da177e4SLinus Torvalds
1941d211f26SHans Verkuil v4l2_ctrl_new_std(&isa->hdl, &trust_ctrl_ops,
1951d211f26SHans Verkuil V4L2_CID_AUDIO_BASS, 0, 15, 1, 8);
1961d211f26SHans Verkuil v4l2_ctrl_new_std(&isa->hdl, &trust_ctrl_ops,
1971d211f26SHans Verkuil V4L2_CID_AUDIO_TREBLE, 0, 15, 1, 8);
1981d211f26SHans Verkuil return isa->hdl.error;
19932958fddSHans Verkuil }
20032958fddSHans Verkuil
2011d211f26SHans Verkuil static const struct radio_isa_ops trust_ops = {
2021d211f26SHans Verkuil .init = trust_initialize,
2031d211f26SHans Verkuil .alloc = trust_alloc,
2041d211f26SHans Verkuil .s_mute_volume = trust_s_mute_volume,
2051d211f26SHans Verkuil .s_frequency = trust_s_frequency,
2061d211f26SHans Verkuil .s_stereo = trust_s_stereo,
2071d211f26SHans Verkuil .g_signal = trust_g_signal,
2081d211f26SHans Verkuil };
20932958fddSHans Verkuil
2101d211f26SHans Verkuil static const int trust_ioports[] = { 0x350, 0x358 };
2111da177e4SLinus Torvalds
2121d211f26SHans Verkuil static struct radio_isa_driver trust_driver = {
2131d211f26SHans Verkuil .driver = {
2141d211f26SHans Verkuil .match = radio_isa_match,
2151d211f26SHans Verkuil .probe = radio_isa_probe,
2161d211f26SHans Verkuil .remove = radio_isa_remove,
2171d211f26SHans Verkuil .driver = {
2181d211f26SHans Verkuil .name = "radio-trust",
2191d211f26SHans Verkuil },
2201d211f26SHans Verkuil },
2211d211f26SHans Verkuil .io_params = io,
2221d211f26SHans Verkuil .radio_nr_params = radio_nr,
2231d211f26SHans Verkuil .io_ports = trust_ioports,
2241d211f26SHans Verkuil .num_of_io_ports = ARRAY_SIZE(trust_ioports),
2251d211f26SHans Verkuil .region_size = 2,
2261d211f26SHans Verkuil .card = "Trust FM Radio",
2271d211f26SHans Verkuil .ops = &trust_ops,
2281d211f26SHans Verkuil .has_stereo = true,
2291d211f26SHans Verkuil .max_volume = 31,
2301d211f26SHans Verkuil };
2311d211f26SHans Verkuil
trust_init(void)2321d211f26SHans Verkuil static int __init trust_init(void)
2331da177e4SLinus Torvalds {
2341d211f26SHans Verkuil return isa_register_driver(&trust_driver.driver, TRUST_MAX);
2351d211f26SHans Verkuil }
2361dc8aafcSHans Verkuil
trust_exit(void)2371d211f26SHans Verkuil static void __exit trust_exit(void)
2381d211f26SHans Verkuil {
2391d211f26SHans Verkuil isa_unregister_driver(&trust_driver.driver);
2401da177e4SLinus Torvalds }
2411da177e4SLinus Torvalds
2421da177e4SLinus Torvalds module_init(trust_init);
2431d211f26SHans Verkuil module_exit(trust_exit);
244