streaming server for AM/FM radio via UDP connection.
Dependencies: mbed EthernetNetIf
Revision 0:bd865e5a3df3, committed 2011-02-28
- Comitter:
- soramimi
- Date:
- Mon Feb 28 11:49:39 2011 +0000
- Child:
- 1:3357273c97f8
- Commit message:
Changed in this revision
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/EthernetNetIf.lib Mon Feb 28 11:49:39 2011 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/donatien/code/EthernetNetIf/#bc7df6da7589
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/HTTPServer.lib Mon Feb 28 11:49:39 2011 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/donatien/code/HTTPServer/#d753966e4d97
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/RadioServer.cpp Mon Feb 28 11:49:39 2011 +0000 @@ -0,0 +1,227 @@ +#include "mbed.h" +#include "EthernetNetIf.h" +#include "UDPSocket.h" +#include "TextLCD.h" +#include "crc32.h" +#include "ns9542.h" +#include <vector> + +DigitalOut led1(LED1); +DigitalOut led2(LED2); +TextLCD lcd(p21, p22, p23, p24, p25, p26); + +Ticker ticker; + +SPI spi(p5, p6, p7); // mosi, miso, sclk +DigitalOut spi_cs(p8); + +EthernetNetIf eth(IpAddr(192,168,0,100), //IP Address + IpAddr(255,255,255,0), //Network Mask + IpAddr(192,168,0,1), //Gateway + IpAddr(192,168,0,1) //DNS + ); + +UDPSocket udpsocket; + +unsigned short sample_l; +unsigned short sample_r; + +unsigned short sample_left() +{ + spi_cs = 0; + int v = spi.write(0x6800) & 0x03ff; + spi_cs = 1; + return (v << 6) | (v >> 4); +} + +unsigned short sample_right() +{ + spi_cs = 0; + int v = spi.write(0x7800) & 0x03ff; + spi_cs = 1; + return (v << 6) | (v >> 4); +} + +struct host_info_t { + Host host; + int timer; + host_info_t() + { + } + host_info_t(Host h) + : host(h) + , timer(0) + { + } +}; + +std::vector<host_info_t> hostlist; + +void on_udp_socket_event(UDPSocketEvent e) +{ + if (e == UDPSOCKET_READABLE) { + char buf[64] = {0}; + Host host; + while (int len = udpsocket.recvfrom(buf, 63, &host)) { + if (len <= 0) { + break; + } + if (len == 7 && memcmp(buf, "request", len) == 0) { + __disable_irq(); + size_t i, n; + n = hostlist.size(); + for (i = 0; i < n; i++) { + if (memcmp(&host, &hostlist[i].host, sizeof(Host)) == 0) { + hostlist[i].timer = 0; + break; + } + } + if (i == n) { + hostlist.push_back(host_info_t(host)); + } + __enable_irq(); + continue; + } + if (len > 2 && memcmp(buf, "am", 2) == 0) { + buf[len] = 0; + int f = atoi(buf + 2); + ns9542_tune_am9(f); + continue; + } + if (len > 2 && memcmp(buf, "fm", 2) == 0) { + buf[len] = 0; + int f = atoi(buf + 2); + ns9542_tune_fm(f); + continue; + } + if (len > 4 && memcmp(buf, "mute", 4) == 0) { + ns9542_mute(true); + continue; + } + } + } +} + +static inline void store(unsigned short *p, unsigned short n) +{ + ((unsigned char *)p)[0] = n >> 8; + ((unsigned char *)p)[1] = n & 0xff; +} + +static inline void store(unsigned long *p, unsigned long n) +{ + ((unsigned char *)p)[0] = n >> 24; + ((unsigned char *)p)[1] = n >> 16; + ((unsigned char *)p)[2] = n >> 8; + ((unsigned char *)p)[3] = n & 0xff; +} + +class Sampler { +private: + unsigned long buffer_a[257]; + unsigned long buffer_b[257]; + unsigned long *in_ptr; + unsigned long *out_ptr; + bool output_available; + unsigned long crc; + int offset; +public: + Sampler() + { + in_ptr = buffer_a; + out_ptr = buffer_b; + output_available = false; + offset = 0; + crc = 0; + } + + void on_tick() + { + if (output_available) { + return; + } + unsigned short *p = (unsigned short *)in_ptr; + p += offset * 2; + store(p + 0, sample_l); + store(p + 1, sample_r); + crc = crc32(crc, (unsigned char *)p, 4); + offset++; + if (offset >= 256) { + std::swap(in_ptr, out_ptr); + store(&out_ptr[256], crc); + output_available = true; + offset = 0; + crc = 0; + } + } + + char const *output_buffer() + { + return output_available ? (char const *)out_ptr : 0; + } + + void output_done() + { + output_available = false; + } +}; + +Sampler sampler; + +void on_tick() +{ + sampler.on_tick(); +} + +int main() +{ + spi_cs = 1; + spi.format(16, 0); + spi.frequency(3000000); + + ns9542_init(); + + eth.setup(); + Host host(IpAddr(), 2000); + udpsocket.bind(host); + udpsocket.setOnEvent(&on_udp_socket_event); + + led1 = 0; + ticker.attach(&on_tick, 1.0 / 32000); + + int led1_timer = 0; + + while (1) { + sample_l = sample_left(); + sample_r = sample_right(); + + Net::poll(); + + char const *p = sampler.output_buffer(); + if (p) { + for (std::vector<host_info_t>::iterator it = hostlist.begin(); it != hostlist.end(); it++) { + udpsocket.sendto(p, 1028, (Host *)&it->host); + } + sampler.output_done(); + + __disable_irq(); + int i = hostlist.size(); + while (i > 0) { + i--; + hostlist[i].timer++; + if (hostlist[i].timer > 125) { + hostlist.erase(hostlist.begin() + i); + } + } + __enable_irq(); + + led1_timer++; + if (led1_timer >= 125) { + led1 = !led1; + led1_timer = 0; + } + } + } + + return 0; +}
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/TextLCD.lib Mon Feb 28 11:49:39 2011 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/simon/code/TextLCD/#44f34c09bd37
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/crc32.c Mon Feb 28 11:49:39 2011 +0000 @@ -0,0 +1,80 @@ + +#include "crc32.h" + +static unsigned long crc32_table[] = { + 0x00000000, 0x77073096, 0xee0e612c, 0x990951ba, + 0x076dc419, 0x706af48f, 0xe963a535, 0x9e6495a3, + 0x0edb8832, 0x79dcb8a4, 0xe0d5e91e, 0x97d2d988, + 0x09b64c2b, 0x7eb17cbd, 0xe7b82d07, 0x90bf1d91, + 0x1db71064, 0x6ab020f2, 0xf3b97148, 0x84be41de, + 0x1adad47d, 0x6ddde4eb, 0xf4d4b551, 0x83d385c7, + 0x136c9856, 0x646ba8c0, 0xfd62f97a, 0x8a65c9ec, + 0x14015c4f, 0x63066cd9, 0xfa0f3d63, 0x8d080df5, + 0x3b6e20c8, 0x4c69105e, 0xd56041e4, 0xa2677172, + 0x3c03e4d1, 0x4b04d447, 0xd20d85fd, 0xa50ab56b, + 0x35b5a8fa, 0x42b2986c, 0xdbbbc9d6, 0xacbcf940, + 0x32d86ce3, 0x45df5c75, 0xdcd60dcf, 0xabd13d59, + 0x26d930ac, 0x51de003a, 0xc8d75180, 0xbfd06116, + 0x21b4f4b5, 0x56b3c423, 0xcfba9599, 0xb8bda50f, + 0x2802b89e, 0x5f058808, 0xc60cd9b2, 0xb10be924, + 0x2f6f7c87, 0x58684c11, 0xc1611dab, 0xb6662d3d, + 0x76dc4190, 0x01db7106, 0x98d220bc, 0xefd5102a, + 0x71b18589, 0x06b6b51f, 0x9fbfe4a5, 0xe8b8d433, + 0x7807c9a2, 0x0f00f934, 0x9609a88e, 0xe10e9818, + 0x7f6a0dbb, 0x086d3d2d, 0x91646c97, 0xe6635c01, + 0x6b6b51f4, 0x1c6c6162, 0x856530d8, 0xf262004e, + 0x6c0695ed, 0x1b01a57b, 0x8208f4c1, 0xf50fc457, + 0x65b0d9c6, 0x12b7e950, 0x8bbeb8ea, 0xfcb9887c, + 0x62dd1ddf, 0x15da2d49, 0x8cd37cf3, 0xfbd44c65, + 0x4db26158, 0x3ab551ce, 0xa3bc0074, 0xd4bb30e2, + 0x4adfa541, 0x3dd895d7, 0xa4d1c46d, 0xd3d6f4fb, + 0x4369e96a, 0x346ed9fc, 0xad678846, 0xda60b8d0, + 0x44042d73, 0x33031de5, 0xaa0a4c5f, 0xdd0d7cc9, + 0x5005713c, 0x270241aa, 0xbe0b1010, 0xc90c2086, + 0x5768b525, 0x206f85b3, 0xb966d409, 0xce61e49f, + 0x5edef90e, 0x29d9c998, 0xb0d09822, 0xc7d7a8b4, + 0x59b33d17, 0x2eb40d81, 0xb7bd5c3b, 0xc0ba6cad, + 0xedb88320, 0x9abfb3b6, 0x03b6e20c, 0x74b1d29a, + 0xead54739, 0x9dd277af, 0x04db2615, 0x73dc1683, + 0xe3630b12, 0x94643b84, 0x0d6d6a3e, 0x7a6a5aa8, + 0xe40ecf0b, 0x9309ff9d, 0x0a00ae27, 0x7d079eb1, + 0xf00f9344, 0x8708a3d2, 0x1e01f268, 0x6906c2fe, + 0xf762575d, 0x806567cb, 0x196c3671, 0x6e6b06e7, + 0xfed41b76, 0x89d32be0, 0x10da7a5a, 0x67dd4acc, + 0xf9b9df6f, 0x8ebeeff9, 0x17b7be43, 0x60b08ed5, + 0xd6d6a3e8, 0xa1d1937e, 0x38d8c2c4, 0x4fdff252, + 0xd1bb67f1, 0xa6bc5767, 0x3fb506dd, 0x48b2364b, + 0xd80d2bda, 0xaf0a1b4c, 0x36034af6, 0x41047a60, + 0xdf60efc3, 0xa867df55, 0x316e8eef, 0x4669be79, + 0xcb61b38c, 0xbc66831a, 0x256fd2a0, 0x5268e236, + 0xcc0c7795, 0xbb0b4703, 0x220216b9, 0x5505262f, + 0xc5ba3bbe, 0xb2bd0b28, 0x2bb45a92, 0x5cb36a04, + 0xc2d7ffa7, 0xb5d0cf31, 0x2cd99e8b, 0x5bdeae1d, + 0x9b64c2b0, 0xec63f226, 0x756aa39c, 0x026d930a, + 0x9c0906a9, 0xeb0e363f, 0x72076785, 0x05005713, + 0x95bf4a82, 0xe2b87a14, 0x7bb12bae, 0x0cb61b38, + 0x92d28e9b, 0xe5d5be0d, 0x7cdcefb7, 0x0bdbdf21, + 0x86d3d2d4, 0xf1d4e242, 0x68ddb3f8, 0x1fda836e, + 0x81be16cd, 0xf6b9265b, 0x6fb077e1, 0x18b74777, + 0x88085ae6, 0xff0f6a70, 0x66063bca, 0x11010b5c, + 0x8f659eff, 0xf862ae69, 0x616bffd3, 0x166ccf45, + 0xa00ae278, 0xd70dd2ee, 0x4e048354, 0x3903b3c2, + 0xa7672661, 0xd06016f7, 0x4969474d, 0x3e6e77db, + 0xaed16a4a, 0xd9d65adc, 0x40df0b66, 0x37d83bf0, + 0xa9bcae53, 0xdebb9ec5, 0x47b2cf7f, 0x30b5ffe9, + 0xbdbdf21c, 0xcabac28a, 0x53b39330, 0x24b4a3a6, + 0xbad03605, 0xcdd70693, 0x54de5729, 0x23d967bf, + 0xb3667a2e, 0xc4614ab8, 0x5d681b02, 0x2a6f2b94, + 0xb40bbe37, 0xc30c8ea1, 0x5a05df1b, 0x2d02ef8d, +}; + +unsigned long crc32(unsigned long crc, unsigned char const *ptr, size_t len) +{ + crc = ~crc; + while (len > 0) { + crc = crc32_table[(crc ^ *ptr) & 255] ^ (crc >> 8); + ptr++; + len--; + } + return ~crc; +}
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/crc32.h Mon Feb 28 11:49:39 2011 +0000 @@ -0,0 +1,19 @@ + +#ifndef __CRC32_H +#define __CRC32_H + +#include <stdlib.h> + +#ifdef __cplusplus +extern "C" { +#endif + + +unsigned long crc32(unsigned long crc, unsigned char const *ptr, size_t len); + + +#ifdef __cplusplus +} +#endif + +#endif
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed.bld Mon Feb 28 11:49:39 2011 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/mbed_official/code/mbed/builds/9114680c05da
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/ns9542.c Mon Feb 28 11:49:39 2011 +0000 @@ -0,0 +1,452 @@ +#include "mbed.h" + +//I2C i2c(p9, p10); // sda, scl + +DigitalInOut i2c_sda(p9); +DigitalInOut i2c_scl(p10); + +void wait10us() +{ + wait(0.000001); +} + +void wait10ms() +{ + wait(0.001); +} + +void wait100ms() +{ + wait(0.01); +} + + + +#if 1 + +// i2c + +void i2c_cl_0() +{ + i2c_scl.output(); +} + +void i2c_cl_1() +{ + i2c_scl.input(); +} + +void i2c_da_0() +{ + i2c_sda.output(); +} + +void i2c_da_1() +{ + i2c_sda.input(); +} + +int i2c_get_da() +{ + return i2c_sda.read(); +} + +void i2c_start() +{ + i2c_da_0(); + wait10us(); + i2c_cl_0(); + wait10us(); +} + +void i2c_stop() +{ + i2c_cl_1(); + wait10us(); + i2c_da_1(); + wait10us(); +} + +void i2c_repeat() +{ + i2c_cl_1(); + wait10us(); + i2c_da_0(); + wait10us(); + i2c_cl_0(); + wait10us(); +} + +bool i2c_write(int c) +{ + int i; + bool nack; + + wait10us(); + + for (i = 0; i < 8; i++) { + if (c & 0x80) { + i2c_da_1(); + } else { + i2c_da_0(); + } + c <<= 1; + wait10us(); + i2c_cl_1(); + wait10us(); + i2c_cl_0(); + wait10us(); + } + + i2c_da_1(); + wait10us(); + + i2c_cl_1(); + wait10us(); + nack = i2c_get_da(); + i2c_cl_0(); + + return nack; +} + +int i2c_read(bool nack) +{ + int i, c; + + i2c_da_1(); + wait10us(); + + c = 0; + + for (i = 0; i < 8; i++) { + i2c_cl_1(); + wait10us(); + c <<= 1; + if (i2c_get_da()) { + c |= 1; + } + i2c_cl_0(); + wait10us(); + } + + if (nack) { + i2c_da_1(); + } else { + i2c_da_0(); + } + wait10us(); + i2c_cl_1(); + wait10us(); + i2c_cl_0(); + wait10us(); + + return c; +} + +#endif + + +// ns9542 + +void ns9542_write(int a, int c) +{ +#if 01 + i2c_start(); + i2c_write(0xc8); + i2c_write(a); + i2c_write(c); + i2c_stop(); +#else + char tmp[2]; + i2c.start(); + tmp[0] = a; + tmp[1] = c; + i2c.write(0xc8, tmp, 2); + i2c.stop(); +#endif +} + +int ns9542_read(int a) +{ +#if 01 + int c; + i2c_start(); + i2c_write(0xc8); + i2c_write(a); + i2c_repeat(); + i2c_write(0xc9); + c = i2c_read(true); + i2c_stop(); + return c; +#else + char tmp[2]; + i2c.start(); + tmp[0] = a; + tmp[1] = 0xc9; + i2c.write(0xc8, tmp, 1); + i2c.write(0xc8, tmp + 1, 1, true); + unsigned char c = i2c.read(1); + i2c.stop(); + return c; +#endif +} + +void ns9542_imf_adjust() +{ + int bF, imf, fhm, g_fhm; + bF = 0; + g_fhm = 0xf0; + ns9542_write(0x15, 0x0e); + ns9542_write(0x3d, 0x27); + for (fhm = 0; fhm < 4; fhm++) { + bF = 0; + for (imf = 0; imf < 3; imf++) { + ns9542_write(0x37, fhm); + ns9542_write(0x16, 22 + imf); + wait10ms(); + if ((ns9542_read(0x70) & 0x0c) == 0x0c) { + bF++; + if (imf == 1 && g_fhm == 0xf0) { + g_fhm = fhm; + } + } + } + if (bF == 3) { + g_fhm = fhm; + break; + } + } + ns9542_write(0x37, 0x80 | g_fhm); + ns9542_write(0x16, 23); + ns9542_write(0x3d, 0x37); + wait100ms(); +} + +void ns9542_best_iml(int iml) +{ + ns9542_write(0x32, 0x00); + while (iml < 16) { + ns9542_write(0x17, 0xc0 | iml); + wait10ms(); + if (!(ns9542_read(0x70) & 0x08)) { + break; + } + iml++; + } + iml--; + ns9542_write(0x17, 0xc0 | iml); + ns9542_write(0x32, 0x80); + wait10ms(); + ns9542_write(0xfe, 0x0a); + wait10ms(); + wait10ms(); +} + +void ns9542_find_pg(int ialgn, int *fine_phase, int *fine_gain, int *result_pg) +{ + int i, j; + for (i = 0; i < 16; i++) { + ns9542_write(0x15, 0x0a | (ialgn << 4)); + ns9542_write(0x15, 0x0b | (ialgn << 4)); + if (ns9542_read(0x05) & 0x08) { + for (j = 0; j < 20; j++) { + if (!(ns9542_read(0x05) & 0x08)) { + int g = ns9542_read(0x65); + int p = ns9542_read(0x66); + if (g >= 103 && g <= 138 && 2 >= p && p <= 14) { + *fine_gain = g; + *fine_phase = p; + *result_pg = 1; + return; + } + } + wait10ms(); + } + } + } + *result_pg = 0; +} + +void ns9542_table_write(int *fine_p, int *fine_g) +{ + int i, j, k, result; + result = 0; + for (i = 0; i < 4; i++) { + ns9542_write(0x38, fine_g[i]); + ns9542_write(0x39, fine_p[i] << 4); + for (j = 0; j < 10; j++) { + ns9542_write(0x15, 0x0e | (i << 4)); + ns9542_write(0x15, 0x03 | (i << 4)); + if (ns9542_read(0x05) & 0x08) { + wait100ms(); + for (k = 0; k < 10; k++) { + if (!(ns9542_read(0x05) & 0x08)) { + result++; + goto L1; + } + wait10ms(); + } + break; + } + } +L1:; + if (result != i + 1) { + break; + } + } +} + +void ns9542_dsp_align_body() +{ + int iml, imf, ialgn, cnt, fp, fg; + int fine_p[5] = { 0, 0, 0, 0, 0 }; + int fine_g[5] = { 0, 0, 0, 0, 0 }; + iml = 5; + for (ialgn = 0; ialgn < 4; ialgn++) { + ns9542_write(0x15, 0x0a | (ialgn << 4)); + wait100ms(); + wait100ms(); + ns9542_best_iml(iml); + imf = 0; + cnt = 0; + fp = 0; + fg = 0; + for (cnt = 0; cnt < 5; cnt++) { + int fine_phase, fine_gain, result_pg; + ns9542_find_pg(ialgn, &fine_phase, &fine_gain, &result_pg); + if (result_pg == 0) { + return; + } + fp = fp + fine_phase; + fg = fg + fine_gain; + if (cnt == 2 && ialgn < 2) { + cnt++; + break; + } + } + fine_p[ialgn] = fp / cnt; + fine_g[ialgn] = fg / cnt; + } + ns9542_table_write(fine_p, fine_g); +} + +void ns9542_mute(bool mute) +{ + if (mute) { + ns9542_write(0x00, ns9542_read(0x00) | 0x02); + } else { + ns9542_write(0x00, ns9542_read(0x00) & ~0x02); + } +} + +void ns9542_tune_am9(int freq) // freq = kHz +{ + unsigned short psy; + + psy = freq; + + ns9542_write(0x00, 0x23); + + wait10ms(); + wait10ms(); + + ns9542_write(0x04, 0x80); + ns9542_write(0x0c, 0xf0); + + ns9542_write(0x10, 0x10); + + ns9542_write(0x02, psy & 0xff); + ns9542_write(0x03, psy >> 8); + + ns9542_write(0x00, 0x21); +} + +void ns9542_tune_fm(int freq) // freq = MHz * 100 +{ + unsigned short psy; + + psy = freq / 5; + + ns9542_write(0x00, 0x03); + + ns9542_write(0x10, 0x10); + + ns9542_write(0x02, psy & 0xff); + ns9542_write(0x03, psy >> 8); + + ns9542_write(0x00, 0x01); +} + +void ns9542_reset() +{ + ns9542_write(0xfe, 0xaa); +} + +void ns9542_power_on() +{ + static unsigned char power_on[] = { + 0x01, 0x30, + 0x0c, 0x80, + 0x0e, 0x34, + 0x15, 0xc4, + 0x20, 0x3c, + 0x21, 0x03, + 0x22, 0x0a, + 0x23, 0x0a, + 0x30, 0xff, + 0x3d, 0x07, + 0x40, 0x1a, + 0x41, 0x9a, + 0x50, 0xe1, + 0x54, 0xb0, + 0x55, 0x36, + 0x5c, 0xc8, + 0x5d, 0x61, + 0x5e, 0x88, + 0x5f, 0xa5, + 0x71, 0x2c, + 0x72, 0x06, + }; + int i; + for (i = 0; i < sizeof(power_on); i += 2) { + ns9542_write(power_on[i], power_on[i + 1]); + } + + ns9542_write(0x00, ns9542_read(0x00) | 0x03); +} + +void ns9542_dsp_alignment() +{ + ns9542_write(0x0e, ns9542_read(0x0e) & ~0x60 | 0x40); + ns9542_write(0x01, 0x08); + ns9542_write(0x15, 0x0c); + ns9542_write(0x16, 0x17); + ns9542_write(0x37, 0x82); + ns9542_write(0x3d, 0x37); + wait100ms(); + + ns9542_imf_adjust(); + ns9542_dsp_align_body(); + + ns9542_write(0x01, 0x38); + ns9542_write(0x0e, ns9542_read(0x0e) & ~0x60 | 0x20); + ns9542_write(0x15, 0xc0); + ns9542_write(0x17, 0x20); + ns9542_write(0x32, 0x00); + ns9542_write(0x37, 0x01); +} + +void ns9542_init() +{ + i2c_sda.mode(PullUp); + i2c_scl.mode(PullUp); + i2c_sda.input(); + i2c_scl.input(); + i2c_sda.write(0); + i2c_scl.write(0); + + ns9542_reset(); + ns9542_power_on(); + ns9542_dsp_alignment(); +} +
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/ns9542.h Mon Feb 28 11:49:39 2011 +0000 @@ -0,0 +1,9 @@ +#ifndef __NS9542_H +#define __NS9542_H + +void ns9542_init(); +void ns9542_tune_am9(int freq); // freq = kHz +void ns9542_tune_fm(int freq); // freq = MHz * 100 +void ns9542_mute(bool mute); + +#endif