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);
187static unsigned int alarm_cb_1e4(
void *userdata)
192 priv->spduart_modem_ops.rcv_len = priv->recv_buf_struct.m_cur_xfer_len;
193 iSetEventFlag(priv->spduart_modem_ops.evfid, 0x100u);
197static unsigned int alarm_cb_1e6(
void *userdata)
202 iSetEventFlag(priv->spduart_ef, 4u);
203 return priv->spduart_clock_1e6.lo;
214 priv->spduart_fcr_cached &= ~2;
215 m_cur_xfer_len = priv->send_buf_struct.m_cur_xfer_len;
217 if ( m_cur_xfer_len > 0 )
219 if ( m_cur_xfer_len > 16 )
221 if ( (priv->spduart_msr_cached & 0x10) != 0 )
223 if ( (spduart_internals.dev9_uart_reg_area->
r_msr & 0x20) != 0 )
227 v6 = m_cur_xfer_len - 1;
230 v7 = *((u8 *)priv->send_buf_struct.m_ptr + (priv->send_buf_struct.m_offset2 & 0x3FF));
231 ++priv->send_buf_struct.m_offset2;
232 priv->send_buf_struct.m_cur_xfer_len -= 1;
237 if ( priv->send_buf_struct.m_cur_xfer_len > 0 )
239 priv->spduart_fcr_cached |= 2;
244 priv->spduart_fcr_cached |= 2;
246 priv->spduart_tx_count += v4;
249 spduart_internals.dev9_uart_reg_area->
r_wrfcr_rdiir = priv->spduart_fcr_cached;
254static int spduart_dev9_intr_cb(
int flag)
269 switch ( spduart_internals.dev9_uart_reg_area->
r_lcr & 0xF )
272 r_scr = spduart_internals.dev9_uart_reg_area->
r_scr;
273 if ( spduart_internals.spduart_start_flag )
275 spduart_internals.spduart_msr_cached = spduart_internals.dev9_uart_reg_area->
r_scr;
278 if ( (spduart_internals.dev9_uart_reg_area->
r_scr & 1) != 0 )
280 if ( (spduart_internals.dev9_uart_reg_area->
r_scr & 0x10) != 0 )
287 if ( (spduart_internals.dev9_uart_reg_area->
r_scr & 0x20) == 0 )
289 spduart_internals.shutdown_flag = 1;
290 iSetEventFlag(spduart_internals.spduart_modem_ops.evfid, 2);
294 if ( !spduart_internals.spduart_data_set_ready_flag )
297 spduart_internals.spduart_data_set_ready_flag = 1;
298 iSetEventFlag(spduart_internals.spduart_modem_ops.evfid, 513);
304 iSetEventFlag(spduart_internals.spduart_modem_ops.evfid, 0x40u);
306 if ( (r_scr & 8) && ((spduart_internals.spduart_msr_cached ^ (u8)r_scr) & 0x80) != 0 )
309 if ( (r_scr & 0x80) != 0 )
311 iSetEventFlag(spduart_internals.spduart_modem_ops.evfid, v18);
313 spduart_internals.spduart_msr_cached = r_scr;
319 spduart_internals.spduart_rx_count += v1;
320 if ( spduart_internals.recv_buf_struct.m_cur_xfer_len < 257 )
322 if ( (spduart_internals.spduart_signal_pin & 2) == 0 )
324 spduart_internals.spduart_signal_pin |= 2u;
325 spduart_internals.dev9_uart_reg_area->
r_lsr = spduart_internals.spduart_signal_pin;
328 if ( spduart_internals.recv_buf_struct.m_cur_xfer_len >= 768 )
330 if ( (spduart_internals.spduart_signal_pin & 2) != 0 )
332 spduart_internals.spduart_signal_pin &= ~2u;
333 spduart_internals.dev9_uart_reg_area->
r_lsr = spduart_internals.spduart_signal_pin;
338 iSetEventFlag(spduart_internals.spduart_ef, v2);
341 spduart_internals.spduart_fcr_cached &= ~2u;
342 spduart_internals.dev9_uart_reg_area->
r_wrfcr_rdiir = spduart_internals.spduart_fcr_cached;
347 while ( (spduart_internals.dev9_uart_reg_area->
r_msr & 1) != 0 && !spduart_internals.spduart_start_flag )
349 if ( spduart_internals.recv_buf_struct.m_cur_xfer_len >= 1024 )
351 ++spduart_internals.spduart_buffer_overflow_count;
356 m_offset1 = spduart_internals.recv_buf_struct.m_offset1;
357 *((u8 *)spduart_internals.recv_buf_struct.m_ptr + (spduart_internals.recv_buf_struct.m_offset1 & 0x3FF)) =
359 spduart_internals.recv_buf_struct.m_offset1 = m_offset1 + 1;
360 ++spduart_internals.recv_buf_struct.m_cur_xfer_len;
365 r_msr = spduart_internals.dev9_uart_reg_area->
r_msr;
368 ++spduart_internals.spduart_overrun_error_count;
372 ++spduart_internals.spduart_parity_error_count;
376 ++spduart_internals.spduart_framing_error_count;
380 ++spduart_internals.spduart_break_interrupt_count;
389static int spduart_set_baud(
int baud)
414 spduart_internals.dev9_uart_reg_area->
r_cr1 = 27;
415 spduart_internals.dev9_uart_reg_area->
r_cr2 = 4;
418 priv->spduart_mcr_cached = -125;
419 spduart_internals.dev9_uart_reg_area->
r_mcr = priv->spduart_mcr_cached;
420 v2 = spduart_set_baud(priv->spduart_baud_);
422 spduart_internals.dev9_uart_reg_area->
r_wrfcr_rdiir = (v2 >> 8) & 0xFF;
423 priv->spduart_mcr_cached = 3;
424 spduart_internals.dev9_uart_reg_area->
r_mcr = priv->spduart_mcr_cached;
425 priv->spduart_signal_pin = 3;
426 spduart_internals.dev9_uart_reg_area->
r_lsr = priv->spduart_signal_pin;
427 switch ( priv->spduart_trig_ )
431 spduart_internals.dev9_uart_reg_area->
r_lcr = 1;
436 spduart_internals.dev9_uart_reg_area->
r_lcr = 65;
442 spduart_internals.dev9_uart_reg_area->
r_lcr = -127;
447 spduart_internals.dev9_uart_reg_area->
r_lcr = -63;
453static void spduart_deinit()
455 spduart_internals.dev9_uart_reg_area->
r_cr2 = -124;
458static void fail_sleep(
const char *fmt)
467 if ( priv->shutdown_flag )
469 fail_sleep(
"spduart: plug-out\n");
473static int spduart_send_now(
struct spduart_internals_ *priv,
const char *in_buf,
char *expected_buf)
492 sleep_on_shutdown(priv);
495 r_scr = spduart_internals.dev9_uart_reg_area->
r_scr;
496 priv->spduart_msr_cached = r_scr;
497 if ( (r_scr & 0x10) != 0 && (spduart_internals.dev9_uart_reg_area->
r_msr & 0x20) != 0 )
513 if ( (spduart_internals.dev9_uart_reg_area->
r_msr & 1) != 0 )
520 if ( v14 != spduart_internals.dev9_uart_reg_area->
r_wrthr_rdrbr )
560 sleep_on_shutdown(priv);
561 spduart_do_init_dev9(priv);
562 for ( i = 0; i < 300; ++i )
564 sleep_on_shutdown(priv);
569 sleep_on_shutdown(priv);
570 priv->spduart_msr_cached = spduart_internals.dev9_uart_reg_area->
r_scr;
571 if ( (priv->spduart_msr_cached & 0x20) != 0 )
575 }
while ( spduart_send_now(priv,
"AT\r",
"OK") < 0 && spduart_send_now(priv,
"AT\r",
"OK") < 0 );
576 if ( spduart_send_now(priv,
"ATI3\r",
"P2109-V90") < 0 )
578 sceInetPrintf(
"spduart: P2109-V90 detected\n");
579 spduart_send_now(priv,
"AT**\r",
"Download initiated ..");
580 sceInetPrintf(
"spduart: downloading (9A-40)\n");
583 while ( modem_firmware_s37[i] )
585 v5 = spduart_send_now(priv, modem_firmware_s37[i],
".");
588 sceInetPrintf(
"spduart: failed to download (1)\n");
593 if ( v5 >= 0 && spduart_send_now(priv,
"S70500000000FA\r",
"OK") >= 0 )
595 sceInetPrintf(
"spduart: download completed\n");
598 sceInetPrintf(
"spduart: failed to download (2)\n");
600 if ( priv->spduart_nogci_ )
602 if ( !priv->spduart_gci_[0] )
604 sprintf(priv->buf2data,
"AT+GCI=%c%c\r", priv->spduart_gci_[0], priv->spduart_gci_[1]);
605 sceInetPrintf(
"spduart: sending \"%S\"\n", priv->buf2data);
606 if ( spduart_send_now(priv, priv->buf2data,
"OK") >= 0 )
608 sceInetPrintf(
"spduart: failed to set GCI (1)\n");
610 if ( !priv->spduart_dial_[0] )
612 fail_sleep(
"spduart: no dial_cnf\n");
614 sceInetPrintf(
"spduart: scanning GCI setting in \"%s\"\n", priv->spduart_dial_);
615 v7 = open(priv->spduart_dial_, 1);
618 fail_sleep(
"spduart: can't open\n");
620 buf1data = priv->buf1data;
621 v10 = read(v7, buf1data, 1024);
624 fail_sleep(
"spduart: read error\n");
627 if ( (
unsigned int)v10 >= 0x400 )
629 fail_sleep(
"spduart: file too big\n");
631 v11 = &buf1data[v10];
634 if ( buf1data >= v11 )
636 fail_sleep(
"spduart: no GCI setting\n");
638 while ( buf1data < v11 )
640 if ( (isspace(*buf1data)) == 0 )
644 if ( *buf1data !=
'#' )
646 while ( buf1data < v11 && *buf1data !=
'+' )
650 if ( (*buf1data ==
'+') && (strncmp(
"+GCI=", buf1data, 5) == 0) )
653 if ( ((isxdigit(buf1data[0])) != 0) && ((isxdigit(buf1data[1])) != 0) )
659 while ( buf1data < v11 && *buf1data !=
'\n' )
663 if ( *buf1data ==
'\n' )
666 sprintf(priv->buf2data,
"AT+GCI=%c%c\r", (u8)*buf1data, (u8)buf1data[1]);
667 sceInetPrintf(
"spduart: sending \"%S\"\n", priv->buf2data);
668 if ( spduart_send_now(priv, priv->buf2data,
"OK") < 0 )
670 sceInetPrintf(
"spduart: failed to set GCI (2)\n");
677static void spduart_thread_proc(
void *arg)
685 spduart_init_hw(priv);
686 priv->spduart_fcr_cached = 13;
687 spduart_internals.dev9_uart_reg_area->
r_wrfcr_rdiir = priv->spduart_fcr_cached;
688 while ( !WaitEventFlag(priv->spduart_ef, 0xFu, 17, &v12) )
690 if ( (v12 & 2) != 0 && !priv->spduart_start_flag )
692 SpdIntrDisable(4096);
693 if ( priv->spduart_alarm_1e4_flag )
695 CancelAlarm(alarm_cb_1e4, priv);
696 priv->spduart_alarm_1e4_flag = 0;
698 if ( priv->spduart_alarm_1e6_flag )
700 CancelAlarm(alarm_cb_1e6, priv);
701 priv->spduart_alarm_1e6_flag = 0;
703 priv->spduart_signal_pin = 0;
704 spduart_internals.dev9_uart_reg_area->
r_lsr = 0;
705 spduart_internals.dev9_uart_reg_area->
r_lcr = -121;
706 priv->recv_buf_struct.m_cur_xfer_len = 0;
707 priv->recv_buf_struct.m_offset1 = 0;
708 priv->recv_buf_struct.m_offset2 = 0;
709 priv->send_buf_struct.m_cur_xfer_len = 0;
710 priv->send_buf_struct.m_offset1 = 0;
711 priv->send_buf_struct.m_offset2 = 0;
713 spduart_internals.dev9_uart_reg_area->
r_lcr = -127;
714 priv->spduart_start_flag = 1;
715 priv->spduart_stop_flag = 0;
716 if ( !priv->shutdown_flag )
718 priv->spduart_mcr_cached = 67;
719 spduart_internals.dev9_uart_reg_area->
r_mcr = priv->spduart_mcr_cached;
720 for ( i = 0; i < 20; i += 1 )
722 if ( priv->shutdown_flag )
724 if ( (priv->spduart_msr_cached & 0x80) == 0 )
726 priv->spduart_mcr_cached = 3;
727 spduart_internals.dev9_uart_reg_area->
r_mcr = 3;
728 for ( i = 0; i < 300; i += 1 )
730 if ( priv->shutdown_flag )
740 if ( !priv->spduart_start_flag )
742 if ( (v12 & 4) != 0 )
744 if ( priv->spduart_data_set_ready_flag )
746 if ( spduart_send(priv) > 0 )
748 m_cur_xfer_len = priv->send_buf_struct.m_cur_xfer_len;
749 if ( m_cur_xfer_len >= 257 )
751 priv->spduart_modem_ops.snd_len = 1024 - m_cur_xfer_len;
752 SetEventFlag(priv->spduart_modem_ops.evfid, 0x200u);
757 if ( (v12 & 8) != 0 )
759 if ( priv->spduart_alarm_1e4_flag )
761 CancelAlarm(alarm_cb_1e4, priv);
762 priv->spduart_alarm_1e4_flag = 0;
764 v10 = priv->recv_buf_struct.m_cur_xfer_len;
767 priv->spduart_modem_ops.rcv_len = v10;
768 SetEventFlag(priv->spduart_modem_ops.evfid, 0x100u);
772 SetAlarm(&priv->spduart_clock_1e4, alarm_cb_1e4, priv);
773 priv->spduart_alarm_1e4_flag = 1;
777 else if ( (v12 & 1) != 0 )
779 priv->shutdown_flag = 0;
780 priv->spduart_data_set_ready_flag = 0;
781 priv->spduart_modem_ops.snd_len = 1024;
782 priv->spduart_signal_pin = 3;
783 spduart_internals.dev9_uart_reg_area->
r_lsr = 3;
784 priv->spduart_msr_cached = spduart_internals.dev9_uart_reg_area->
r_scr;
785 spduart_dump_msr(priv->spduart_msr_cached);
786 if ( (priv->spduart_msr_cached & 0x20) != 0 )
788 SetEventFlag(priv->spduart_modem_ops.evfid, 0x201u);
789 priv->spduart_data_set_ready_flag = 1;
791 if ( (priv->spduart_msr_cached & 0x80) != 0 )
793 SetEventFlag(priv->spduart_modem_ops.evfid, 0x10u);
795 priv->spduart_start_flag = 0;
796 SetAlarm(&priv->spduart_clock_1e6, alarm_cb_1e6, priv);
797 priv->spduart_alarm_1e6_flag = 1;
803static int spduart_op_start(
void *userdata,
int flags)
809 priv->spduart_stop_flag = 0;
810 SetEventFlag(priv->spduart_ef, 1u);
814static int spduart_op_stop(
void *userdata,
int flags)
820 priv->spduart_stop_flag = 1;
821 SetEventFlag(priv->spduart_ef, 2u);
825static int spduart_op_recv(
void *userdata,
void *ptr,
int len)
835 m_cur_xfer_len = len;
837 if ( priv->recv_buf_struct.m_cur_xfer_len < len )
838 m_cur_xfer_len = priv->recv_buf_struct.m_cur_xfer_len;
839 v8 = priv->recv_buf_struct.m_offset2 & 0x3FF;
841 if ( m_cur_xfer_len < 1024 - v8 )
848 bcopy((
char *)priv->recv_buf_struct.m_ptr + v8, ptr, v9);
849 v10 = m_cur_xfer_len - v9;
852 bcopy(priv->recv_buf_struct.m_ptr, (
char *)ptr + v9, v10);
856 priv->recv_buf_struct.m_cur_xfer_len -= v7;
857 priv->recv_buf_struct.m_offset2 += v7;
858 priv->spduart_modem_ops.rcv_len = priv->recv_buf_struct.m_cur_xfer_len;
859 if ( priv->recv_buf_struct.m_cur_xfer_len < 257 )
861 if ( (priv->spduart_signal_pin & 2) == 0 )
863 priv->spduart_signal_pin |= 2;
864 spduart_internals.dev9_uart_reg_area->
r_lsr = priv->spduart_signal_pin;
872static int spduart_op_send(
void *userdata,
void *ptr,
int len)
884 if ( 1024 - priv->send_buf_struct.m_cur_xfer_len < len )
885 v4 = 1024 - priv->send_buf_struct.m_cur_xfer_len;
886 v8 = priv->send_buf_struct.m_offset1 & 0x3FF;
888 if ( (
unsigned int)v4 < v9 )
895 bcopy(ptr, (
char *)priv->send_buf_struct.m_ptr + v8, v9);
899 bcopy((
char *)ptr + v9, priv->send_buf_struct.m_ptr, v10);
903 priv->send_buf_struct.m_cur_xfer_len += v7;
904 priv->send_buf_struct.m_offset1 += v7;
905 priv->spduart_modem_ops.snd_len = 1024 - priv->send_buf_struct.m_cur_xfer_len;
909 SetEventFlag(priv->spduart_ef, 4u);
913static int spduart_op_control(
void *userdata,
int code,
void *ptr,
int len)
939 bcopy(&priv->spduart_thpri_, ptr, 4);
951 priv->recv_buf_struct.m_offset1 = 0;
952 priv->recv_buf_struct.m_offset2 = 0;
953 priv->recv_buf_struct.m_cur_xfer_len = 0;
954 priv->spduart_modem_ops.rcv_len = 0;
961 priv->send_buf_struct.m_offset1 = 0;
962 priv->send_buf_struct.m_offset2 = 0;
963 priv->send_buf_struct.m_cur_xfer_len = 0;
964 priv->spduart_modem_ops.snd_len = 1024;
972 v13 = strlen(priv->spduart_dial_) + 1;
977 bcopy(priv->spduart_dial_, ptr, v13);
982 bcopy(&priv->spduart_rx_count, ptr, 4);
987 bcopy(&priv->spduart_tx_count, ptr, 4);
992 bcopy(&priv->spduart_overrun_error_count, ptr, 4);
997 bcopy(&priv->spduart_parity_error_count, ptr, 4);
1002 bcopy(&priv->spduart_framing_error_count, ptr, 4);
1007 bcopy(&priv->spduart_buffer_overflow_count, ptr, 4);
1012 v25 = ((priv->spduart_mcr_cached & 3) << 28) | ((priv->spduart_mcr_cached & 0x18) << 27) | priv->spduart_baud_
1014 if ( (priv->spduart_mcr_cached & 4) != 0 )
1018 bcopy((
int *)&v25, ptr, 4);
1023 v26 = (16 * (priv->spduart_signal_pin & 3)) | ((u8)priv->spduart_msr_cached >> 4);
1024 bcopy(&v26, ptr, 4);
1031 bcopy(ptr, &priority, 4);
1033 if ( priv->spduart_thread > 0 )
1035 v6 = ChangeThreadPriority(priv->spduart_thread, priority);
1037 priv->spduart_thpri_ = priority;
1039 if ( priv->spduart_thread <= 0 || v6 == -413 )
1041 if ( (
unsigned int)(priority - 9) < 0x73 )
1042 priv->spduart_thpri_ = priority;
1051 bcopy(ptr, &v25, 4);
1052 v17 = spduart_set_baud(v25 & 0x3FFFFF);
1057 if ( ((v25 >> 26) & 1) == 0 || (v25 & 0x1800000) != 0 )
1060 if ( v18 == 1 || (v25 & 0x2000000) == 0 )
1064 priv->spduart_mcr_cached =
1065 v18 | ((int)((v25 >> 26) & 3) >> 1) | ((v25 >> 28) & 3) | (priv->spduart_mcr_cached & 0x40) | 0x80;
1066 spduart_internals.dev9_uart_reg_area->
r_mcr = priv->spduart_mcr_cached;
1068 spduart_internals.dev9_uart_reg_area->
r_wrfcr_rdiir = (v17 >> 8) & 0xFF;
1069 priv->spduart_mcr_cached &= ~0x80;
1071 spduart_internals.dev9_uart_reg_area->
r_mcr = priv->spduart_mcr_cached;
1076 bcopy(ptr, &v26, 4);
1077 if ( (v26 & 0xFFFFFFCF) != 0 )
1081 priv->spduart_signal_pin &= ~3;
1082 priv->spduart_signal_pin |= ((
unsigned int)v26 >> 4);
1083 spduart_internals.dev9_uart_reg_area->
r_lsr = priv->spduart_signal_pin;
1091static void shutdown_cb(
void)
1093 spduart_internals.shutdown_flag = 1;
1096static int print_version(
void)
1098 printf(
"SPDUART (%s)%s\n",
"Version 2.26.0",
"");
1099 return MODULE_NO_RESIDENT_END;
1102static int print_usage(
void)
1104 printf(
"Usage: spduart [-probe] [-nogci] [baud=<baud>] [trig=<trig>] [gci=<gci>] [thpri=<prio>] [thstack=<stack>] "
1106 return MODULE_NO_RESIDENT_END;
1110void spduart_2_deinit(
int a1)
1114 if ( !a1 && (SPD_REG16(SPD_R_REV_3) & 8) != 0 )
1115 spduart_internals.dev9_uart_reg_area->
r_cr2 = -124;
1119static int module_start(
int ac,
char *av[],
void *startaddr,
ModuleInfo_t *mi)
1136 spduart_internals.spduart_thpri_ = 40;
1137 spduart_internals.spduart_thstack_ = 0x2000;
1138 spduart_internals.spduart_dial_[0] = 0;
1139 spduart_internals.spduart_baud_ = 115200;
1140 spduart_internals.spduart_trig_ = 8;
1141 for ( v5 = 1; v5 < ac; v5 += 1 )
1143 if ( !strcmp(
"-help", av[v5]) )
1145 return print_usage();
1147 else if ( !strcmp(
"-version", av[v5]) )
1149 return print_version();
1151 else if ( !strcmp(
"-probe", av[v5]) )
1156 else if ( !strcmp(
"-nogci", av[v5]) )
1158 spduart_internals.spduart_nogci_ = 1;
1161 else if ( !strncmp(
"dial=", av[v5], 5) )
1163 strcpy(spduart_internals.spduart_dial_, av[v5] + 5);
1166 else if ( !strncmp(
"gci=", av[v5], 4) )
1168 v7 = (
char *)(av[v5] + 4);
1169 if ( (isxdigit(*v7)) == 0 || (isxdigit(v7[1])) == 0 )
1170 return print_usage();
1171 spduart_internals.spduart_gci_[0] = v7[0];
1172 spduart_internals.spduart_gci_[1] = v7[1];
1175 else if ( !strncmp(
"thpri=", av[v5], 6) )
1177 v7 = (
char *)(av[v5] + 6);
1178 if ( (isdigit(*v7)) == 0 )
1179 return print_usage();
1180 v11 = strtol(v7, 0, 10);
1181 if ( (
unsigned int)(v11 - 9) >= 0x73 )
1182 return print_usage();
1183 spduart_internals.spduart_thpri_ = v11;
1185 else if ( !strncmp(
"thstack=", av[v5], 8) )
1187 v7 = (
char *)(av[v5] + 8);
1188 if ( (isdigit(*v7)) == 0 )
1189 return print_usage();
1190 spduart_internals.spduart_thstack_ = strtol(v7, 0, 10);
1193 if ( (isdigit(*v7)) == 0 )
1197 if ( !strcmp(v7,
"KB") )
1199 spduart_internals.spduart_thstack_ <<= 10;
1203 else if ( !strncmp(
"baud=", av[v5], 5) )
1205 v7 = (
char *)(av[v5] + 5);
1206 if ( (isdigit(*v7)) == 0 )
1207 return print_usage();
1208 spduart_internals.spduart_baud_ = strtol(v7, 0, 10);
1209 if ( !spduart_set_baud(spduart_internals.spduart_baud_) )
1210 return print_usage();
1212 else if ( !strncmp(
"trig=", av[v5], 5) )
1214 v7 = (
char *)(av[v5] + 5);
1215 if ( (isdigit(*v7)) == 0 )
1216 return print_usage();
1217 v11 = strtol(v7, 0, 10);
1225 spduart_internals.spduart_trig_ = v11;
1230 return print_usage();
1236 return print_usage();
1240 if ( (isdigit(*v7)) == 0 )
1245 return print_usage();
1247 if ( (SPD_REG16(SPD_R_REV_3) & 8) == 0 )
1249 sceInetPrintf(
"spduart: SPEED-UART not found\n");
1252 sceInetPrintf(
"spduart: SPEED-UART detected\n");
1257 if ( RegisterLibraryEntries(&_exp_spduart) )
1259 sceInetPrintf(
"spduart: module already loaded\n");
1265 "spduart: thpri=%d baud=%d trig=%d\n",
1266 spduart_internals.spduart_thpri_,
1267 spduart_internals.spduart_baud_,
1268 spduart_internals.spduart_trig_);
1270 spduart_internals.recv_buf_struct.m_ptr = spduart_internals.buf1data;
1271 spduart_internals.send_buf_struct.m_ptr = spduart_internals.buf2data;
1272 spduart_internals.spduart_start_flag = 1;
1273 spduart_internals.spduart_stop_flag = 0;
1274 spduart_do_init_dev9(&spduart_internals);
1275 for ( v14 = 0; v14 < 30; v14 += 1 )
1277 spduart_internals.spduart_msr_cached = spduart_internals.dev9_uart_reg_area->
r_scr;
1278 if ( (spduart_internals.spduart_msr_cached & 0x20) != 0 )
1280 sceInetPrintf(
"spduart: Modem module detected\n");
1281 Dev9RegisterPowerOffHandler(1, shutdown_cb);
1282 memset(&v17, 0,
sizeof(v17));
1283 spduart_internals.spduart_ef = CreateEventFlag(&v17);
1284 if ( spduart_internals.spduart_ef > 0 )
1286 v18.attr = 0x2000000;
1287 v18.thread = spduart_thread_proc;
1289 v18.priority = spduart_internals.spduart_thpri_;
1290 v18.stacksize = spduart_internals.spduart_thstack_;
1291 v16 = CreateThread(&v18);
1294 spduart_internals.spduart_thread = v16;
1295 if ( !StartThread(v16, &spduart_internals) )
1297 SpdIntrDisable(4096);
1298 SpdRegisterIntrHandler(12, (dev9_intr_cb_t)spduart_dev9_intr_cb);
1299 USec2SysClock(10000u, &spduart_internals.spduart_clock_1e4);
1300 USec2SysClock(1000000u, &spduart_internals.spduart_clock_1e6);
1301 bzero(&spduart_internals.spduart_modem_ops, 108);
1302 spduart_internals.spduart_modem_ops.module_name =
"spduart";
1303 spduart_internals.spduart_modem_ops.vendor_name =
"SCE";
1304 spduart_internals.spduart_modem_ops.device_name =
"Modem (Network Adaptor)";
1305 spduart_internals.spduart_modem_ops.bus_type = 5;
1306 spduart_internals.spduart_modem_ops.start = spduart_op_start;
1307 spduart_internals.spduart_modem_ops.stop = spduart_op_stop;
1308 spduart_internals.spduart_modem_ops.recv = spduart_op_recv;
1309 spduart_internals.spduart_modem_ops.send = spduart_op_send;
1310 spduart_internals.spduart_modem_ops.prot_ver = 0;
1311 spduart_internals.spduart_modem_ops.impl_ver = 0;
1312 spduart_internals.spduart_modem_ops.priv = &spduart_internals;
1313 spduart_internals.spduart_modem_ops.control = spduart_op_control;
1314 if ( sceModemRegisterDevice(&spduart_internals.spduart_modem_ops) >= 0 )
1317 return MODULE_REMOVABLE_END;
1319 if ( mi && ((mi->
newflags & 2) != 0) )
1321 return MODULE_RESIDENT_END;
1325 TerminateThread(spduart_internals.spduart_thread);
1328 DeleteThread(spduart_internals.spduart_thread);
1331 DeleteEventFlag(spduart_internals.spduart_ef);
1334 DelayThread(100000);
1336 sceInetPrintf(
"spduart: Modem module NOT detected\n");
1338 ReleaseLibraryEntries(&_exp_spduart);
1340 sceInetPrintf(
"spduart: not resident end (fail%d)\n", v2);
1341 return MODULE_NO_RESIDENT_END;
1344static int module_stop(
int ac,
char *av[],
void *startaddr,
ModuleInfo_t *mi)
1351 if ( !spduart_internals.spduart_start_flag && !spduart_internals.spduart_stop_flag )
1353 sceInetPrintf(
"spduart: can't unload (busy)\n");
1354 return MODULE_REMOVABLE_END;
1356 sceModemUnregisterDevice(&spduart_internals.spduart_modem_ops);
1357 TerminateThread(spduart_internals.spduart_thread);
1358 DeleteThread(spduart_internals.spduart_thread);
1359 DeleteEventFlag(spduart_internals.spduart_ef);
1360 if ( spduart_internals.spduart_alarm_1e4_flag )
1361 CancelAlarm(alarm_cb_1e4, &spduart_internals);
1362 if ( spduart_internals.spduart_alarm_1e6_flag )
1363 CancelAlarm(alarm_cb_1e6, &spduart_internals);
1364 Dev9RegisterPowerOffHandler(1, 0);
1365 ReleaseLibraryEntries(&_exp_spduart);
1366 SpdIntrDisable(4096);
1368 return MODULE_NO_RESIDENT_END;
int CpuResumeIntr(int state)
int CpuSuspendIntr(int *state)