Subversion Repositories pentevo

Rev

Rev 292 | Rev 382 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | Download | RSS feed

  1. #include <avr/io.h>
  2. #include <avr/interrupt.h>
  3. #include <avr/pgmspace.h>
  4.  
  5. #include <util/delay.h>
  6.  
  7. #include "mytypes.h"
  8. #include "depacker_dirty.h"
  9. #include "getfaraddress.h"
  10. #include "pins.h"
  11. #include "main.h"
  12. #include "ps2.h"
  13. #include "zx.h"
  14. #include "spi.h"
  15. #include "rs232.h"
  16. #include "rtc.h"
  17. #include "atx.h"
  18. #include "joystick.h"
  19. #include "tape.h"
  20. #include "kbmap.h"
  21.  
  22. //if want Log than comment next string
  23. #undef LOGENABLE
  24.  
  25. /** FPGA data pointer [far address] (linker symbol). */
  26. extern ULONG fpga PROGMEM;
  27.  
  28. // FPGA data index..
  29. volatile ULONG curFpga;
  30.  
  31. // Common flag register.
  32. volatile UBYTE flags_register;
  33. volatile UBYTE flags_ex_register;
  34.  
  35. // Common modes register.
  36. volatile UBYTE modes_register;
  37.  
  38. // Buffer for depacking FPGA configuration.
  39. // You can USED for other purposed after setup FPGA.
  40. UBYTE dbuf[DBSIZE];
  41.  
  42. void put_buffer(UWORD size)
  43. {
  44.         // writes specified length of buffer to the output
  45.         UBYTE * ptr = dbuf;
  46.  
  47.         do
  48.         {
  49.                 spi_send( *(ptr++) );
  50.  
  51.         } while(--size);
  52. }
  53.  
  54. void hardware_init(void)
  55. {
  56.         //Initialized AVR pins
  57.  
  58.         cli(); // disable interrupts
  59.  
  60.         // configure pins
  61.  
  62.         PORTG = 0b11111111;
  63.         DDRG  = 0b00000000;
  64.  
  65. //      PORTF = 0b11110000; // ATX off (zero output), fpga config/etc inputs
  66.         DDRF  = 0b00001000;
  67.  
  68.         PORTE = 0b11111111;
  69.         DDRE  = 0b00000000; // inputs pulled up
  70.  
  71.         PORTD = 0b11111111;
  72.         DDRD  = 0b00000000; // same
  73.  
  74.         PORTC = 0b11011111;
  75.         DDRC  = 0b00000000; // PWRGOOD input, other pulled up
  76.  
  77.         PORTB = 0b11110001;
  78.         DDRB  = 0b10000111; // LED off, spi outs inactive
  79.  
  80.         PORTA = 0b11111111;
  81.         DDRA  = 0b00000000; // pulled up
  82.  
  83.         ACSR = 0x80; // DISABLE analog comparator
  84. }
  85.  
  86. int main()
  87. {
  88. start:
  89.  
  90.         hardware_init();
  91.  
  92.         rs232_init();
  93. #ifdef LOGENABLE
  94.         to_log("VER:");
  95.         {
  96.                 UBYTE b,i;
  97.                 ULONG version = 0x1DFF0;
  98.                 char VER[]="..";
  99.                 for( i=0; i<12; i++)
  100.                 {
  101.                         dbuf[i] = pgm_read_byte_far(version+i);
  102.                 }
  103.                 dbuf[i]=0;
  104.                 to_log((char*)dbuf);
  105.                 to_log(" ");
  106.                 UBYTE b1 = pgm_read_byte_far(version+12);
  107.                 UBYTE b2 = pgm_read_byte_far(version+13);
  108.                 UBYTE day = b1&0x1F;
  109.                 UBYTE mon = ((b2<<3)+(b1>>5))&0x0F;
  110.                 UBYTE year = (b2>>1)&0x3F;
  111.                 VER[0] = '0'+(day/10);
  112.                 VER[1] = '0'+(day%10);
  113.         to_log(VER);
  114.         to_log(".");
  115.                 VER[0] = '0'+(mon/10);
  116.                 VER[1] = '0'+(mon%10);
  117.         to_log(VER);
  118.         to_log(".");
  119.                 VER[0] = '0'+(year/10);
  120.                 VER[1] = '0'+(year%10);
  121.         to_log(VER);
  122.         to_log("\r\n");
  123.                 //
  124.                 for( i=0; i<16; i++)
  125.                 {
  126.                         b = pgm_read_byte_far(version+i);
  127.                         VER[0] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10;
  128.                         VER[1] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10;
  129.                         to_log(VER);
  130.                 }
  131.                 to_log("\r\n");
  132.         }
  133. #endif
  134.  
  135.         wait_for_atx_power();
  136.  
  137.         spi_init();
  138.  
  139.         DDRF |= (1<<nCONFIG); // pull low for a time
  140.         _delay_us(40);
  141.         DDRF &= ~(1<<nCONFIG);
  142.         while( !(PINF & (1<<nSTATUS)) ); // wait ready
  143.  
  144.         curFpga = GET_FAR_ADDRESS(fpga); // prepare for data fetching
  145. #ifdef LOGENABLE
  146.         {
  147.         char log_fpga[]="F........\r\n";
  148.         UBYTE b = (UBYTE)((curFpga>>24)&0xFF);
  149.         log_fpga[1] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10;
  150.         log_fpga[2] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10;
  151.         b = (UBYTE)((curFpga>>16)&0xFF);
  152.         log_fpga[3] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10;
  153.         log_fpga[4] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10;
  154.         b = (UBYTE)((curFpga>>8)&0xFF);
  155.         log_fpga[5] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10;
  156.         log_fpga[6] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10;
  157.         b = (UBYTE)(curFpga&0xFF);
  158.         log_fpga[7] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10;
  159.         log_fpga[8] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10;
  160.         to_log(log_fpga);
  161.         }
  162. #endif
  163.         depacker_dirty();
  164. #ifdef LOGENABLE
  165.         to_log("depacker_dirty OK\r\n");
  166. #endif
  167.  
  168.         //power led OFF
  169.         LED_PORT |= 1<<LED;
  170.  
  171.         // start timer (led dimming and timeouts for ps/2)
  172.         TCCR2 = 0b01110011; // FOC2=0, {WGM21,WGM20}=01, {COM21,COM20}=11, {CS22,CS21,CS20}=011
  173.                             // clk/64 clocking,
  174.                             // 1/512 overflow rate, total 11.059/32768 = 337.5 Hz interrupt rate
  175.         TIFR = (1<<TOV2);
  176.         TIMSK = (1<<TOIE2);
  177.  
  178.  
  179.         //init some counters and registers
  180.     ps2keyboard_count = 12;
  181.         ps2keyboard_cmd_count = 0;
  182.         ps2keyboard_cmd = 0;
  183.         ps2mouse_count = 12;
  184.         ps2mouse_initstep = 0;
  185.         ps2mouse_resp_count = 0;
  186.         ps2mouse_cmd = PS2MOUSE_CMD_SET_RESOLUTION;
  187.         flags_register = 0;
  188.         flags_ex_register = 0;
  189.         modes_register = 0;
  190.  
  191.         //enable mouse
  192.         zx_mouse_reset(1);
  193.  
  194.         //set external interrupt
  195.         //INT4 - PS2 Keyboard  (falling edge)
  196.         //INT5 - PS2 Mouse     (falling edge)
  197.         //INT6 - SPI  (falling edge)
  198.         //INT7 - RTC  (falling edge)
  199.         EICRB = (1<<ISC41)+(0<<ISC40) + (1<<ISC51)+(0<<ISC50) + (1<<ISC61)+(0<<ISC60) + (1<<ISC71)+(0<<ISC70); // set condition for interrupt
  200.         EIFR = (1<<INTF4)|(1<<INTF5)|(1<<INTF6)|(1<<INTF7); // clear spurious ints there
  201.         EIMSK |= (1<<INT4)|(1<<INT5)|(1<<INT6)|(1<<INT7); // enable
  202.  
  203.         kbmap_init();
  204.         zx_init();
  205.         rtc_init();
  206.  
  207. #ifdef LOGENABLE
  208.         to_log("zx_init OK\r\n");
  209. #endif
  210.  
  211.         sei(); // globally go interrupting
  212.  
  213.         //set led on keyboard
  214.         ps2keyboard_send_cmd(PS2KEYBOARD_CMD_SETLED);
  215.  
  216.         //main loop
  217.         do
  218.     {
  219.             tape_task();
  220.                 ps2mouse_task();
  221.         ps2keyboard_task();
  222.         zx_task(ZX_TASK_WORK);
  223.                 zx_mouse_task();
  224.                 joystick_task();
  225.  
  226.                 //event from SPI
  227.                 if ( flags_register&FLAG_SPI_INT )
  228.                 {
  229.                         //get status byte
  230.                         UBYTE status;
  231.                         nSPICS_PORT &= ~(1<<nSPICS);
  232.                         nSPICS_PORT |= (1<<nSPICS);
  233.                         status = spi_send(0);
  234.                         zx_wait_task( status );
  235.                 }
  236.  
  237.                 atx_power_task();
  238.     }
  239.         while( (flags_register&FLAG_HARD_RESET) == 0 );
  240.  
  241.         goto start;
  242. }
  243.