12#include <irx_imports.h>
15#define MODNAME "INET_SPEED_UART_driver"
18IRX_ID(MODNAME, 0x2, 0x1A);
63 int spduart_overrun_error_count;
64 int spduart_parity_error_count;
65 int spduart_framing_error_count;
66 int spduart_break_interrupt_count;
67 int spduart_buffer_overflow_count;
70 char spduart_fcr_cached;
71 char spduart_msr_cached;
72 char spduart_signal_pin;
73 char spduart_mcr_cached;
78 int spduart_alarm_1e4_flag;
79 int spduart_alarm_1e6_flag;
80 int spduart_start_flag;
81 int spduart_stop_flag;
83 int spduart_data_set_ready_flag;
93 char spduart_dial_[1024];
103static const char *modem_firmware_s37[54] = {
104 "S3100000A000B20269A9008DBC044C0EE101\r",
105 "S31500009DA560606060606060606B606B606060606092\r",
106 "S31500009DB56B60606B60606060606060606060606082\r",
107 "S31500009DC56060606060606B606B60606B6060606067\r",
108 "S31500009DD5606060606060606B6B6060606B60606B4C\r",
109 "S31500009DE560606B606060606060606060606B606052\r",
110 "S31500009EB000000600000000004E0003000000000045\r",
111 "S31500009EC09300002A000000000000000000000000CF\r",
112 "S31500009ED00000000000006E006100006E000000003F\r",
113 "S31500009EE0000000000000004B7100000074000098A4\r",
114 "S31500009EF000009B000000000000000000005E000063\r",
115 "S30600009F00005A\r",
116 "S31500009F019A284C5F86A9608DA79DADA102D019A99B\r",
117 "S31500009F11048DEC02A973CD0D01B0038D0D01A9418C\r",
118 "S31500009F21CD110190038D110160C2016001FF4C1931\r",
119 "S31500009F31AD6487D014D2105D01A9328D1D87A900A9\r",
120 "S31500009F418D1E8748C2105D0168604CC686A9603FB8\r",
121 "S31500009F516B02A96B8DE49DA96B8DA79D604C008159\r",
122 "S31500009F61A21820445A0DEB02A2184CF5584C6986EA\r",
123 "S31500009F714C449EAE59048A2902F0168A29FD8D5950\r",
124 "S31500009F8104A9528D1C06A9807B09208D1806A9A05B\r",
125 "S31200009F917B60D2083906604CEF864C548682\r",
126 "S31500009DF9AD4B878540AD4C878541A541C900D00447\r",
127 "S31500009E09A540C996B033AD43878540AD44878541A2\r",
128 "S31500009E1938A540E98C8540A541E9008541A540ED75\r",
129 "S31500009E2952878540A541ED53878541B26444207820\r",
130 "S30F00009E3969A5408D439E4C708660BB\r",
131 "S31500009E447F4C04D21060016087FFAD9602C971F0A1\r",
132 "S31500009E542C206067A540E9588540A541E902854163\r",
133 "S31500009E64900BAD588789018D58874C4575AD960280\r",
134 "S31500009E74C971F009ADA89E8DA79E4CAE77ADA89E7C\r",
135 "S31500009E8438EDA79E9004C902B00160A900854085FB\r",
136 "S31500009E9441A5408D5887A5418D598707FF20DD7759\r",
137 "S30800009EA44C1361F5\r",
138 "S31500008654A950CD0286B0038D028660E2750102043C\r",
139 "S3150000866497FF27FF60A203A9004C9BE4AD478785CB\r",
140 "S3150000867440AD48878541B26444207869AD439E8500\r",
141 "S3150000868442208B69A541C907D004A540C9089012A8\r",
142 "S31500008694A9758D3F87A9778D4087B200AEB248B1E0\r",
143 "S315000086A4B759601FFF1BAFFF09A7FFC2027501B2CE\r",
144 "S315000086B414FEE25D01100AC6FED00617FFD202754B\r",
145 "S315000086C40160AD5702C93CD021BF6B1EB20747B249\r",
146 "S315000086D45046B20A45B2B9442096E3B20747B250AF\r",
147 "S315000086E446B20B45B2B9442096E360E21106100681\r",
148 "S30C000086F47F5C032095026084\r",
149 "S3150000810020A786E25D0110374F63342073E7AD96F2\r",
150 "S3150000811002C971D00FF24E01100AAD0404C960B055\r",
151 "S31500008120034CF960AD3F87C9B1F00FAD4D87C9006B\r",
152 "S31500008130F00DE2600110094C7E9EA9008D4D87600E\r",
153 "S3150000814020F99DADEC02C903D0F5AD3F87C9DBD060\r",
154 "S31500008150EEE25E0101E920C466A5406D45878540D3\r",
155 "S31500008160A5416D46878541B26444207869A5408D56\r",
156 "S31500008170A89E38E92890C8A54038E93290060FFF36\r",
157 "S30C00008180BE4C719E4C4C9EA3\r"};
161#define sceInetPrintf(...) printf(__VA_ARGS__)
163static int module_start(
int ac,
char *av[],
void *startaddr,
ModuleInfo_t *mi);
164static int module_stop(
int ac,
char *av[],
void *startaddr,
ModuleInfo_t *mi);
166int _start(
int argc,
char *argv[],
void *startaddr,
ModuleInfo_t *mi)
169 return module_start(argc, argv, startaddr, mi);
171 return module_stop(argc, argv, startaddr, mi);
174static void spduart_dump_msr(u8 msr)
177 "spduart: MSR=%02x (DCTS=%d DDSR=%d TERI=%d DDCD=%d\n",
184 "spduart: CTS=%d DSR=%d RI=%d DCD=%d)\n", (msr >> 4) & 1, (msr >> 5) & 1, (msr >> 6) & 1, msr >> 7);
189 priv->spduart_modem_ops.rcv_len = priv->recv_buf_struct.m_cur_xfer_len;
190 iSetEventFlag(priv->spduart_modem_ops.evfid, 0x100u);
196 iSetEventFlag(priv->spduart_ef, 4u);
197 return priv->spduart_clock_1e6.lo;
208 priv->spduart_fcr_cached &= ~2;
209 m_cur_xfer_len = priv->send_buf_struct.m_cur_xfer_len;
211 if ( m_cur_xfer_len > 0 )
213 if ( m_cur_xfer_len > 16 )
215 if ( (priv->spduart_msr_cached & 0x10) != 0 )
217 if ( (spduart_internals.dev9_uart_reg_area->
r_msr & 0x20) != 0 )
221 v6 = m_cur_xfer_len - 1;
224 v7 = *((u8 *)priv->send_buf_struct.m_ptr + (priv->send_buf_struct.m_offset2 & 0x3FF));
225 ++priv->send_buf_struct.m_offset2;
226 priv->send_buf_struct.m_cur_xfer_len -= 1;
231 if ( priv->send_buf_struct.m_cur_xfer_len > 0 )
233 priv->spduart_fcr_cached |= 2;
238 priv->spduart_fcr_cached |= 2;
240 priv->spduart_tx_count += v4;
243 spduart_internals.dev9_uart_reg_area->
r_wrfcr_rdiir = priv->spduart_fcr_cached;
248static int spduart_dev9_intr_cb(
int flag)
263 switch ( spduart_internals.dev9_uart_reg_area->
r_lcr & 0xF )
266 r_scr = spduart_internals.dev9_uart_reg_area->
r_scr;
267 if ( spduart_internals.spduart_start_flag )
269 spduart_internals.spduart_msr_cached = spduart_internals.dev9_uart_reg_area->
r_scr;
272 if ( (spduart_internals.dev9_uart_reg_area->
r_scr & 1) != 0 )
274 if ( (spduart_internals.dev9_uart_reg_area->
r_scr & 0x10) != 0 )
281 if ( (spduart_internals.dev9_uart_reg_area->
r_scr & 0x20) == 0 )
283 spduart_internals.shutdown_flag = 1;
284 iSetEventFlag(spduart_internals.spduart_modem_ops.evfid, 2);
288 if ( !spduart_internals.spduart_data_set_ready_flag )
291 spduart_internals.spduart_data_set_ready_flag = 1;
292 iSetEventFlag(spduart_internals.spduart_modem_ops.evfid, 513);
298 iSetEventFlag(spduart_internals.spduart_modem_ops.evfid, 0x40u);
300 if ( (r_scr & 8) && ((spduart_internals.spduart_msr_cached ^ (u8)r_scr) & 0x80) != 0 )
303 if ( (r_scr & 0x80) != 0 )
305 iSetEventFlag(spduart_internals.spduart_modem_ops.evfid, v18);
307 spduart_internals.spduart_msr_cached = r_scr;
313 spduart_internals.spduart_rx_count += v1;
314 if ( spduart_internals.recv_buf_struct.m_cur_xfer_len < 257 )
316 if ( (spduart_internals.spduart_signal_pin & 2) == 0 )
318 spduart_internals.spduart_signal_pin |= 2u;
319 spduart_internals.dev9_uart_reg_area->
r_lsr = spduart_internals.spduart_signal_pin;
322 if ( spduart_internals.recv_buf_struct.m_cur_xfer_len >= 768 )
324 if ( (spduart_internals.spduart_signal_pin & 2) != 0 )
326 spduart_internals.spduart_signal_pin &= ~2u;
327 spduart_internals.dev9_uart_reg_area->
r_lsr = spduart_internals.spduart_signal_pin;
332 iSetEventFlag(spduart_internals.spduart_ef, v2);
335 spduart_internals.spduart_fcr_cached &= ~2u;
336 spduart_internals.dev9_uart_reg_area->
r_wrfcr_rdiir = spduart_internals.spduart_fcr_cached;
341 while ( (spduart_internals.dev9_uart_reg_area->
r_msr & 1) != 0 && !spduart_internals.spduart_start_flag )
343 if ( spduart_internals.recv_buf_struct.m_cur_xfer_len >= 1024 )
345 ++spduart_internals.spduart_buffer_overflow_count;
350 m_offset1 = spduart_internals.recv_buf_struct.m_offset1;
351 *((u8 *)spduart_internals.recv_buf_struct.m_ptr + (spduart_internals.recv_buf_struct.m_offset1 & 0x3FF)) =
353 spduart_internals.recv_buf_struct.m_offset1 = m_offset1 + 1;
354 ++spduart_internals.recv_buf_struct.m_cur_xfer_len;
359 r_msr = spduart_internals.dev9_uart_reg_area->
r_msr;
362 ++spduart_internals.spduart_overrun_error_count;
366 ++spduart_internals.spduart_parity_error_count;
370 ++spduart_internals.spduart_framing_error_count;
374 ++spduart_internals.spduart_break_interrupt_count;
383static int spduart_set_baud(
int baud)
408 spduart_internals.dev9_uart_reg_area->
r_cr1 = 27;
409 spduart_internals.dev9_uart_reg_area->
r_cr2 = 4;
412 priv->spduart_mcr_cached = -125;
413 spduart_internals.dev9_uart_reg_area->
r_mcr = priv->spduart_mcr_cached;
414 v2 = spduart_set_baud(priv->spduart_baud_);
416 spduart_internals.dev9_uart_reg_area->
r_wrfcr_rdiir = (v2 >> 8) & 0xFF;
417 priv->spduart_mcr_cached = 3;
418 spduart_internals.dev9_uart_reg_area->
r_mcr = priv->spduart_mcr_cached;
419 priv->spduart_signal_pin = 3;
420 spduart_internals.dev9_uart_reg_area->
r_lsr = priv->spduart_signal_pin;
421 switch ( priv->spduart_trig_ )
425 spduart_internals.dev9_uart_reg_area->
r_lcr = 1;
430 spduart_internals.dev9_uart_reg_area->
r_lcr = 65;
436 spduart_internals.dev9_uart_reg_area->
r_lcr = -127;
441 spduart_internals.dev9_uart_reg_area->
r_lcr = -63;
447static void spduart_deinit()
449 spduart_internals.dev9_uart_reg_area->
r_cr2 = -124;
452static void fail_sleep(
const char *fmt)
461 if ( priv->shutdown_flag )
463 fail_sleep(
"spduart: plug-out\n");
467static int spduart_send_now(
struct spduart_internals_ *priv,
const char *in_buf,
char *expected_buf)
486 sleep_on_shutdown(priv);
489 r_scr = spduart_internals.dev9_uart_reg_area->
r_scr;
490 priv->spduart_msr_cached = r_scr;
491 if ( (r_scr & 0x10) != 0 && (spduart_internals.dev9_uart_reg_area->
r_msr & 0x20) != 0 )
507 if ( (spduart_internals.dev9_uart_reg_area->
r_msr & 1) != 0 )
514 if ( v14 != spduart_internals.dev9_uart_reg_area->
r_wrthr_rdrbr )
554 sleep_on_shutdown(priv);
555 spduart_do_init_dev9(priv);
556 for ( i = 0; i < 300; ++i )
558 sleep_on_shutdown(priv);
563 sleep_on_shutdown(priv);
564 priv->spduart_msr_cached = spduart_internals.dev9_uart_reg_area->
r_scr;
565 if ( (priv->spduart_msr_cached & 0x20) != 0 )
569 }
while ( spduart_send_now(priv,
"AT\r",
"OK") < 0 && spduart_send_now(priv,
"AT\r",
"OK") < 0 );
570 if ( spduart_send_now(priv,
"ATI3\r",
"P2109-V90") < 0 )
572 sceInetPrintf(
"spduart: P2109-V90 detected\n");
573 spduart_send_now(priv,
"AT**\r",
"Download initiated ..");
574 sceInetPrintf(
"spduart: downloading (9A-40)\n");
577 while ( modem_firmware_s37[i] )
579 v5 = spduart_send_now(priv, modem_firmware_s37[i],
".");
582 sceInetPrintf(
"spduart: failed to download (1)\n");
587 if ( v5 >= 0 && spduart_send_now(priv,
"S70500000000FA\r",
"OK") >= 0 )
589 sceInetPrintf(
"spduart: download completed\n");
592 sceInetPrintf(
"spduart: failed to download (2)\n");
594 if ( priv->spduart_nogci_ )
596 if ( !priv->spduart_gci_[0] )
598 sprintf(priv->buf2data,
"AT+GCI=%c%c\r", priv->spduart_gci_[0], priv->spduart_gci_[1]);
599 sceInetPrintf(
"spduart: sending \"%S\"\n", priv->buf2data);
600 if ( spduart_send_now(priv, priv->buf2data,
"OK") >= 0 )
602 sceInetPrintf(
"spduart: failed to set GCI (1)\n");
604 if ( !priv->spduart_dial_[0] )
606 fail_sleep(
"spduart: no dial_cnf\n");
608 sceInetPrintf(
"spduart: scanning GCI setting in \"%s\"\n", priv->spduart_dial_);
609 v7 = open(priv->spduart_dial_, 1);
612 fail_sleep(
"spduart: can't open\n");
614 buf1data = priv->buf1data;
615 v10 = read(v7, buf1data, 1024);
618 fail_sleep(
"spduart: read error\n");
621 if ( (
unsigned int)v10 >= 0x400 )
623 fail_sleep(
"spduart: file too big\n");
625 v11 = &buf1data[v10];
628 if ( buf1data >= v11 )
630 fail_sleep(
"spduart: no GCI setting\n");
632 while ( buf1data < v11 )
634 if ( (isspace(*buf1data)) == 0 )
638 if ( *buf1data !=
'#' )
640 while ( buf1data < v11 && *buf1data !=
'+' )
644 if ( (*buf1data ==
'+') && (strncmp(
"+GCI=", buf1data, 5) == 0) )
647 if ( ((isxdigit(buf1data[0])) != 0) && ((isxdigit(buf1data[1])) != 0) )
653 while ( buf1data < v11 && *buf1data !=
'\n' )
657 if ( *buf1data ==
'\n' )
660 sprintf(priv->buf2data,
"AT+GCI=%c%c\r", (u8)*buf1data, (u8)buf1data[1]);
661 sceInetPrintf(
"spduart: sending \"%S\"\n", priv->buf2data);
662 if ( spduart_send_now(priv, priv->buf2data,
"OK") < 0 )
664 sceInetPrintf(
"spduart: failed to set GCI (2)\n");
671static void spduart_thread_proc(
void *arg)
679 spduart_init_hw(priv);
680 priv->spduart_fcr_cached = 13;
681 spduart_internals.dev9_uart_reg_area->
r_wrfcr_rdiir = priv->spduart_fcr_cached;
682 while ( !WaitEventFlag(priv->spduart_ef, 0xFu, 17, &v12) )
684 if ( (v12 & 2) != 0 && !priv->spduart_start_flag )
686 SpdIntrDisable(4096);
687 if ( priv->spduart_alarm_1e4_flag )
689 CancelAlarm((
unsigned int (*)(
void *))alarm_cb_1e4, priv);
690 priv->spduart_alarm_1e4_flag = 0;
692 if ( priv->spduart_alarm_1e6_flag )
694 CancelAlarm((
unsigned int (*)(
void *))alarm_cb_1e6, priv);
695 priv->spduart_alarm_1e6_flag = 0;
697 priv->spduart_signal_pin = 0;
698 spduart_internals.dev9_uart_reg_area->
r_lsr = 0;
699 spduart_internals.dev9_uart_reg_area->
r_lcr = -121;
700 priv->recv_buf_struct.m_cur_xfer_len = 0;
701 priv->recv_buf_struct.m_offset1 = 0;
702 priv->recv_buf_struct.m_offset2 = 0;
703 priv->send_buf_struct.m_cur_xfer_len = 0;
704 priv->send_buf_struct.m_offset1 = 0;
705 priv->send_buf_struct.m_offset2 = 0;
707 spduart_internals.dev9_uart_reg_area->
r_lcr = -127;
708 priv->spduart_start_flag = 1;
709 priv->spduart_stop_flag = 0;
710 if ( !priv->shutdown_flag )
712 priv->spduart_mcr_cached = 67;
713 spduart_internals.dev9_uart_reg_area->
r_mcr = priv->spduart_mcr_cached;
714 for ( i = 0; i < 20; i += 1 )
716 if ( priv->shutdown_flag )
718 if ( (priv->spduart_msr_cached & 0x80) == 0 )
720 priv->spduart_mcr_cached = 3;
721 spduart_internals.dev9_uart_reg_area->
r_mcr = 3;
722 for ( i = 0; i < 300; i += 1 )
724 if ( priv->shutdown_flag )
734 if ( !priv->spduart_start_flag )
736 if ( (v12 & 4) != 0 )
738 if ( priv->spduart_data_set_ready_flag )
740 if ( spduart_send(priv) > 0 )
742 m_cur_xfer_len = priv->send_buf_struct.m_cur_xfer_len;
743 if ( m_cur_xfer_len >= 257 )
745 priv->spduart_modem_ops.snd_len = 1024 - m_cur_xfer_len;
746 SetEventFlag(priv->spduart_modem_ops.evfid, 0x200u);
751 if ( (v12 & 8) != 0 )
753 if ( priv->spduart_alarm_1e4_flag )
755 CancelAlarm((
unsigned int (*)(
void *))alarm_cb_1e4, priv);
756 priv->spduart_alarm_1e4_flag = 0;
758 v10 = priv->recv_buf_struct.m_cur_xfer_len;
761 priv->spduart_modem_ops.rcv_len = v10;
762 SetEventFlag(priv->spduart_modem_ops.evfid, 0x100u);
766 SetAlarm(&priv->spduart_clock_1e4, (
unsigned int (*)(
void *))alarm_cb_1e4, priv);
767 priv->spduart_alarm_1e4_flag = 1;
771 else if ( (v12 & 1) != 0 )
773 priv->shutdown_flag = 0;
774 priv->spduart_data_set_ready_flag = 0;
775 priv->spduart_modem_ops.snd_len = 1024;
776 priv->spduart_signal_pin = 3;
777 spduart_internals.dev9_uart_reg_area->
r_lsr = 3;
778 priv->spduart_msr_cached = spduart_internals.dev9_uart_reg_area->
r_scr;
779 spduart_dump_msr(priv->spduart_msr_cached);
780 if ( (priv->spduart_msr_cached & 0x20) != 0 )
782 SetEventFlag(priv->spduart_modem_ops.evfid, 0x201u);
783 priv->spduart_data_set_ready_flag = 1;
785 if ( (priv->spduart_msr_cached & 0x80) != 0 )
787 SetEventFlag(priv->spduart_modem_ops.evfid, 0x10u);
789 priv->spduart_start_flag = 0;
790 SetAlarm(&priv->spduart_clock_1e6, (
unsigned int (*)(
void *))alarm_cb_1e6, priv);
791 priv->spduart_alarm_1e6_flag = 1;
801 priv->spduart_stop_flag = 0;
802 SetEventFlag(priv->spduart_ef, 1u);
810 priv->spduart_stop_flag = 1;
811 SetEventFlag(priv->spduart_ef, 2u);
823 m_cur_xfer_len = len;
825 if ( priv->recv_buf_struct.m_cur_xfer_len < len )
826 m_cur_xfer_len = priv->recv_buf_struct.m_cur_xfer_len;
827 v8 = priv->recv_buf_struct.m_offset2 & 0x3FF;
829 if ( m_cur_xfer_len < 1024 - v8 )
836 bcopy((
char *)priv->recv_buf_struct.m_ptr + v8, ptr, v9);
837 v10 = m_cur_xfer_len - v9;
840 bcopy(priv->recv_buf_struct.m_ptr, (
char *)ptr + v9, v10);
844 priv->recv_buf_struct.m_cur_xfer_len -= v7;
845 priv->recv_buf_struct.m_offset2 += v7;
846 priv->spduart_modem_ops.rcv_len = priv->recv_buf_struct.m_cur_xfer_len;
847 if ( priv->recv_buf_struct.m_cur_xfer_len < 257 )
849 if ( (priv->spduart_signal_pin & 2) == 0 )
851 priv->spduart_signal_pin |= 2;
852 spduart_internals.dev9_uart_reg_area->
r_lsr = priv->spduart_signal_pin;
870 if ( 1024 - priv->send_buf_struct.m_cur_xfer_len < len )
871 v4 = 1024 - priv->send_buf_struct.m_cur_xfer_len;
872 v8 = priv->send_buf_struct.m_offset1 & 0x3FF;
874 if ( (
unsigned int)v4 < v9 )
881 bcopy(ptr, (
char *)priv->send_buf_struct.m_ptr + v8, v9);
885 bcopy((
char *)ptr + v9, priv->send_buf_struct.m_ptr, v10);
889 priv->send_buf_struct.m_cur_xfer_len += v7;
890 priv->send_buf_struct.m_offset1 += v7;
891 priv->spduart_modem_ops.snd_len = 1024 - priv->send_buf_struct.m_cur_xfer_len;
895 SetEventFlag(priv->spduart_ef, 4u);
899static int spduart_op_control(
struct spduart_internals_ *priv,
int code,
void *ptr,
int len)
923 bcopy(&priv->spduart_thpri_, ptr, 4);
935 priv->recv_buf_struct.m_offset1 = 0;
936 priv->recv_buf_struct.m_offset2 = 0;
937 priv->recv_buf_struct.m_cur_xfer_len = 0;
938 priv->spduart_modem_ops.rcv_len = 0;
945 priv->send_buf_struct.m_offset1 = 0;
946 priv->send_buf_struct.m_offset2 = 0;
947 priv->send_buf_struct.m_cur_xfer_len = 0;
948 priv->spduart_modem_ops.snd_len = 1024;
956 v13 = strlen(priv->spduart_dial_) + 1;
961 bcopy(priv->spduart_dial_, ptr, v13);
966 bcopy(&priv->spduart_rx_count, ptr, 4);
971 bcopy(&priv->spduart_tx_count, ptr, 4);
976 bcopy(&priv->spduart_overrun_error_count, ptr, 4);
981 bcopy(&priv->spduart_parity_error_count, ptr, 4);
986 bcopy(&priv->spduart_framing_error_count, ptr, 4);
991 bcopy(&priv->spduart_buffer_overflow_count, ptr, 4);
996 v25 = ((priv->spduart_mcr_cached & 3) << 28) | ((priv->spduart_mcr_cached & 0x18) << 27) | priv->spduart_baud_
998 if ( (priv->spduart_mcr_cached & 4) != 0 )
1002 bcopy((
int *)&v25, ptr, 4);
1007 v26 = (16 * (priv->spduart_signal_pin & 3)) | ((u8)priv->spduart_msr_cached >> 4);
1008 bcopy(&v26, ptr, 4);
1015 bcopy(ptr, &priority, 4);
1017 if ( priv->spduart_thread > 0 )
1019 v6 = ChangeThreadPriority(priv->spduart_thread, priority);
1021 priv->spduart_thpri_ = priority;
1023 if ( priv->spduart_thread <= 0 || v6 == -413 )
1025 if ( (
unsigned int)(priority - 9) < 0x73 )
1026 priv->spduart_thpri_ = priority;
1035 bcopy(ptr, &v25, 4);
1036 v17 = spduart_set_baud(v25 & 0x3FFFFF);
1041 if ( ((v25 >> 26) & 1) == 0 || (v25 & 0x1800000) != 0 )
1044 if ( v18 == 1 || (v25 & 0x2000000) == 0 )
1048 priv->spduart_mcr_cached =
1049 v18 | ((int)((v25 >> 26) & 3) >> 1) | ((v25 >> 28) & 3) | (priv->spduart_mcr_cached & 0x40) | 0x80;
1050 spduart_internals.dev9_uart_reg_area->
r_mcr = priv->spduart_mcr_cached;
1052 spduart_internals.dev9_uart_reg_area->
r_wrfcr_rdiir = (v17 >> 8) & 0xFF;
1053 priv->spduart_mcr_cached &= ~0x80;
1055 spduart_internals.dev9_uart_reg_area->
r_mcr = priv->spduart_mcr_cached;
1060 bcopy(ptr, &v26, 4);
1061 if ( (v26 & 0xFFFFFFCF) != 0 )
1065 priv->spduart_signal_pin &= ~3;
1066 priv->spduart_signal_pin |= ((
unsigned int)v26 >> 4);
1067 spduart_internals.dev9_uart_reg_area->
r_lsr = priv->spduart_signal_pin;
1075static void shutdown_cb(
void)
1077 spduart_internals.shutdown_flag = 1;
1080static int print_version(
void)
1082 printf(
"SPDUART (%s)%s\n",
"Version 2.26.0",
"");
1083 return MODULE_NO_RESIDENT_END;
1086static int print_usage(
void)
1088 printf(
"Usage: spduart [-probe] [-nogci] [baud=<baud>] [trig=<trig>] [gci=<gci>] [thpri=<prio>] [thstack=<stack>] "
1090 return MODULE_NO_RESIDENT_END;
1094void spduart_2_deinit(
int a1)
1098 if ( !a1 && (SPD_REG16(SPD_R_REV_3) & 8) != 0 )
1099 spduart_internals.dev9_uart_reg_area->
r_cr2 = -124;
1103static int module_start(
int ac,
char *av[],
void *startaddr,
ModuleInfo_t *mi)
1120 spduart_internals.spduart_thpri_ = 40;
1121 spduart_internals.spduart_thstack_ = 0x2000;
1122 spduart_internals.spduart_dial_[0] = 0;
1123 spduart_internals.spduart_baud_ = 115200;
1124 spduart_internals.spduart_trig_ = 8;
1125 for ( v5 = 1; v5 < ac; v5 += 1 )
1127 if ( !strcmp(
"-help", av[v5]) )
1129 return print_usage();
1131 else if ( !strcmp(
"-version", av[v5]) )
1133 return print_version();
1135 else if ( !strcmp(
"-probe", av[v5]) )
1140 else if ( !strcmp(
"-nogci", av[v5]) )
1142 spduart_internals.spduart_nogci_ = 1;
1145 else if ( !strncmp(
"dial=", av[v5], 5) )
1147 strcpy(spduart_internals.spduart_dial_, av[v5] + 5);
1150 else if ( !strncmp(
"gci=", av[v5], 4) )
1152 v7 = (
char *)(av[v5] + 4);
1153 if ( (isxdigit(*v7)) == 0 || (isxdigit(v7[1])) == 0 )
1154 return print_usage();
1155 spduart_internals.spduart_gci_[0] = v7[0];
1156 spduart_internals.spduart_gci_[1] = v7[1];
1159 else if ( !strncmp(
"thpri=", av[v5], 6) )
1161 v7 = (
char *)(av[v5] + 6);
1162 if ( (isdigit(*v7)) == 0 )
1163 return print_usage();
1164 v11 = strtol(v7, 0, 10);
1165 if ( (
unsigned int)(v11 - 9) >= 0x73 )
1166 return print_usage();
1167 spduart_internals.spduart_thpri_ = v11;
1169 else if ( !strncmp(
"thstack=", av[v5], 8) )
1171 v7 = (
char *)(av[v5] + 8);
1172 if ( (isdigit(*v7)) == 0 )
1173 return print_usage();
1174 spduart_internals.spduart_thstack_ = strtol(v7, 0, 10);
1177 if ( (isdigit(*v7)) == 0 )
1181 if ( !strcmp(v7,
"KB") )
1183 spduart_internals.spduart_thstack_ <<= 10;
1187 else if ( !strncmp(
"baud=", av[v5], 5) )
1189 v7 = (
char *)(av[v5] + 5);
1190 if ( (isdigit(*v7)) == 0 )
1191 return print_usage();
1192 spduart_internals.spduart_baud_ = strtol(v7, 0, 10);
1193 if ( !spduart_set_baud(spduart_internals.spduart_baud_) )
1194 return print_usage();
1196 else if ( !strncmp(
"trig=", av[v5], 5) )
1198 v7 = (
char *)(av[v5] + 5);
1199 if ( (isdigit(*v7)) == 0 )
1200 return print_usage();
1201 v11 = strtol(v7, 0, 10);
1209 spduart_internals.spduart_trig_ = v11;
1214 return print_usage();
1220 return print_usage();
1224 if ( (isdigit(*v7)) == 0 )
1229 return print_usage();
1231 if ( (SPD_REG16(SPD_R_REV_3) & 8) == 0 )
1233 sceInetPrintf(
"spduart: SPEED-UART not found\n");
1236 sceInetPrintf(
"spduart: SPEED-UART detected\n");
1241 if ( RegisterLibraryEntries(&_exp_spduart) )
1243 sceInetPrintf(
"spduart: module already loaded\n");
1249 "spduart: thpri=%d baud=%d trig=%d\n",
1250 spduart_internals.spduart_thpri_,
1251 spduart_internals.spduart_baud_,
1252 spduart_internals.spduart_trig_);
1254 spduart_internals.recv_buf_struct.m_ptr = spduart_internals.buf1data;
1255 spduart_internals.send_buf_struct.m_ptr = spduart_internals.buf2data;
1256 spduart_internals.spduart_start_flag = 1;
1257 spduart_internals.spduart_stop_flag = 0;
1258 spduart_do_init_dev9(&spduart_internals);
1259 for ( v14 = 0; v14 < 30; v14 += 1 )
1261 spduart_internals.spduart_msr_cached = spduart_internals.dev9_uart_reg_area->
r_scr;
1262 if ( (spduart_internals.spduart_msr_cached & 0x20) != 0 )
1264 sceInetPrintf(
"spduart: Modem module detected\n");
1265 Dev9RegisterPowerOffHandler(1, shutdown_cb);
1266 memset(&v17, 0,
sizeof(v17));
1267 spduart_internals.spduart_ef = CreateEventFlag(&v17);
1268 if ( spduart_internals.spduart_ef > 0 )
1270 v18.attr = 0x2000000;
1271 v18.thread = spduart_thread_proc;
1273 v18.priority = spduart_internals.spduart_thpri_;
1274 v18.stacksize = spduart_internals.spduart_thstack_;
1275 v16 = CreateThread(&v18);
1278 spduart_internals.spduart_thread = v16;
1279 if ( !StartThread(v16, &spduart_internals) )
1281 SpdIntrDisable(4096);
1282 SpdRegisterIntrHandler(12, (dev9_intr_cb_t)spduart_dev9_intr_cb);
1283 USec2SysClock(10000u, &spduart_internals.spduart_clock_1e4);
1284 USec2SysClock(1000000u, &spduart_internals.spduart_clock_1e6);
1285 bzero(&spduart_internals.spduart_modem_ops, 108);
1286 spduart_internals.spduart_modem_ops.module_name =
"spduart";
1287 spduart_internals.spduart_modem_ops.vendor_name =
"SCE";
1288 spduart_internals.spduart_modem_ops.device_name =
"Modem (Network Adaptor)";
1289 spduart_internals.spduart_modem_ops.bus_type = 5;
1290 spduart_internals.spduart_modem_ops.start = (int (*)(
void *, int))spduart_op_start;
1291 spduart_internals.spduart_modem_ops.stop = (int (*)(
void *, int))spduart_op_stop;
1292 spduart_internals.spduart_modem_ops.recv = (int (*)(
void *,
void *, int))spduart_op_recv;
1293 spduart_internals.spduart_modem_ops.send = (int (*)(
void *,
void *, int))spduart_op_send;
1294 spduart_internals.spduart_modem_ops.prot_ver = 0;
1295 spduart_internals.spduart_modem_ops.impl_ver = 0;
1296 spduart_internals.spduart_modem_ops.priv = &spduart_internals;
1297 spduart_internals.spduart_modem_ops.control = (int (*)(
void *, int,
void *, int))spduart_op_control;
1298 if ( sceModemRegisterDevice(&spduart_internals.spduart_modem_ops) >= 0 )
1301 return MODULE_REMOVABLE_END;
1303 if ( mi && ((mi->
newflags & 2) != 0) )
1305 return MODULE_RESIDENT_END;
1309 TerminateThread(spduart_internals.spduart_thread);
1312 DeleteThread(spduart_internals.spduart_thread);
1315 DeleteEventFlag(spduart_internals.spduart_ef);
1318 DelayThread(100000);
1320 sceInetPrintf(
"spduart: Modem module NOT detected\n");
1322 ReleaseLibraryEntries(&_exp_spduart);
1324 sceInetPrintf(
"spduart: not resident end (fail%d)\n", v2);
1325 return MODULE_NO_RESIDENT_END;
1328static int module_stop(
int ac,
char *av[],
void *startaddr,
ModuleInfo_t *mi)
1335 if ( !spduart_internals.spduart_start_flag && !spduart_internals.spduart_stop_flag )
1337 sceInetPrintf(
"spduart: can't unload (busy)\n");
1338 return MODULE_REMOVABLE_END;
1340 sceModemUnregisterDevice(&spduart_internals.spduart_modem_ops);
1341 TerminateThread(spduart_internals.spduart_thread);
1342 DeleteThread(spduart_internals.spduart_thread);
1343 DeleteEventFlag(spduart_internals.spduart_ef);
1344 if ( spduart_internals.spduart_alarm_1e4_flag )
1345 CancelAlarm((
unsigned int (*)(
void *))alarm_cb_1e4, &spduart_internals);
1346 if ( spduart_internals.spduart_alarm_1e6_flag )
1347 CancelAlarm((
unsigned int (*)(
void *))alarm_cb_1e6, &spduart_internals);
1348 Dev9RegisterPowerOffHandler(1, 0);
1349 ReleaseLibraryEntries(&_exp_spduart);
1350 SpdIntrDisable(4096);
1352 return MODULE_NO_RESIDENT_END;
int CpuResumeIntr(int state)
int CpuSuspendIntr(int *state)