Rev 656 | Details | Compare with Previous | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 72 | chrv | 1 | #include <avr/io.h> |
| 2 | #include <avr/interrupt.h> |
||
| 656 | chrv | 3 | #include <avr/eeprom.h> |
| 72 | chrv | 4 | #include <util/twi.h> |
| 126 | chrv | 5 | |
| 72 | chrv | 6 | #include "pins.h" |
| 7 | #include "mytypes.h" |
||
| 126 | chrv | 8 | #include "main.h" |
| 9 | #include "zx.h" |
||
| 72 | chrv | 10 | #include "rtc.h" |
| 149 | chrv | 11 | #include "ps2.h" |
| 179 | chrv | 12 | #include "version.h" |
| 72 | chrv | 13 | #include "rs232.h" |
| 14 | |||
| 179 | chrv | 15 | //if want Log than comment next string |
| 16 | #undef LOGENABLE |
||
| 17 | |||
| 135 | chrv | 18 | volatile UBYTE gluk_regs[14]; |
| 94 | chrv | 19 | |
| 72 | chrv | 20 | //stop transmit |
| 370 | chrv | 21 | static void tw_send_stop(void) |
| 22 | { |
||
| 23 | TWCR = _BV(TWINT)|_BV(TWEN)|_BV(TWSTO); |
||
| 24 | //wait for flag |
||
| 25 | // while ( (TWCR&_BV(TWSTO))!=0 ); |
||
| 26 | // _delay_us(20); //4mks for PCF8583 |
||
| 27 | } |
||
| 72 | chrv | 28 | |
| 29 | static UBYTE tw_send_start(void) |
||
| 30 | { |
||
| 31 | //start transmit |
||
| 370 | chrv | 32 | TWCR =_BV(TWINT)|_BV(TWSTA)|_BV(TWEN); |
| 72 | chrv | 33 | |
| 34 | //wait for flag |
||
| 370 | chrv | 35 | while ( (TWCR&_BV(TWINT))==0 ); |
| 36 | // while ( TWCR & (1<<TWSTA) ); |
||
| 72 | chrv | 37 | |
| 589 | chrv | 38 | //#ifdef LOGENABLE |
| 39 | // char log_reset_type[] = "TWS..[..]..\r\n"; |
||
| 40 | // UBYTE b = TWSR; |
||
| 41 | // log_reset_type[3] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10; |
||
| 42 | // log_reset_type[4] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10; |
||
| 43 | // b=TWCR; |
||
| 44 | // log_reset_type[6] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10; |
||
| 45 | // log_reset_type[7] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10; |
||
| 46 | // b=TWDR; |
||
| 47 | // log_reset_type[9] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10; |
||
| 48 | // log_reset_type[10] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10; |
||
| 49 | // to_log(log_reset_type); |
||
| 50 | //#endif |
||
| 72 | chrv | 51 | //return status |
| 370 | chrv | 52 | return TW_STATUS; |
| 72 | chrv | 53 | } |
| 54 | |||
| 55 | static UBYTE tw_send_addr(UBYTE addr) |
||
| 56 | { |
||
| 57 | //set address |
||
| 58 | TWDR = addr; |
||
| 59 | |||
| 60 | //enable transmit |
||
| 370 | chrv | 61 | TWCR = _BV(TWINT)|_BV(TWEN); |
| 72 | chrv | 62 | |
| 63 | //wait for end transmit |
||
| 370 | chrv | 64 | while ( (TWCR &_BV(TWINT))==0 ); |
| 72 | chrv | 65 | |
| 589 | chrv | 66 | //#ifdef LOGENABLE |
| 67 | // char log_tw[] = "TWA..[..]..\r\n"; |
||
| 68 | // UBYTE b = TWSR; |
||
| 69 | // log_tw[3] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10; |
||
| 70 | // log_tw[4] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10; |
||
| 71 | // b=TWCR; |
||
| 72 | // log_tw[6] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10; |
||
| 73 | // log_tw[7] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10; |
||
| 74 | // log_tw[9] = ((addr >> 4) <= 9 )?'0'+(addr >> 4):'A'+(addr >> 4)-10; |
||
| 75 | // log_tw[10] = ((addr & 0x0F) <= 9 )?'0'+(addr & 0x0F):'A'+(addr & 0x0F)-10; |
||
| 76 | // to_log(log_tw); |
||
| 77 | //#endif |
||
| 72 | chrv | 78 | //return status |
| 370 | chrv | 79 | return TW_STATUS; |
| 72 | chrv | 80 | } |
| 81 | |||
| 82 | static UBYTE tw_send_data(UBYTE data) |
||
| 83 | { |
||
| 84 | //set data |
||
| 85 | TWDR = data; |
||
| 86 | |||
| 87 | //enable transmit |
||
| 370 | chrv | 88 | TWCR = _BV(TWINT)|_BV(TWEN); |
| 72 | chrv | 89 | |
| 90 | //wait for end transmit |
||
| 370 | chrv | 91 | while ( (TWCR&_BV(TWINT))==0 ); |
| 72 | chrv | 92 | |
| 589 | chrv | 93 | //#ifdef LOGENABLE |
| 94 | // char log_tw[] = "TWW..[..]..\r\n"; |
||
| 95 | // UBYTE b = TWSR; |
||
| 96 | // log_tw[3] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10; |
||
| 97 | // log_tw[4] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10; |
||
| 98 | // b=TWCR; |
||
| 99 | // log_tw[6] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10; |
||
| 100 | // log_tw[7] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10; |
||
| 101 | // log_tw[9] = ((data >> 4) <= 9 )?'0'+(data >> 4):'A'+(data >> 4)-10; |
||
| 102 | // log_tw[10] = ((data & 0x0F) <= 9 )?'0'+(data & 0x0F):'A'+(data & 0x0F)-10; |
||
| 103 | // to_log(log_tw); |
||
| 104 | //#endif |
||
| 72 | chrv | 105 | //return status |
| 370 | chrv | 106 | return TW_STATUS; |
| 72 | chrv | 107 | } |
| 108 | |||
| 109 | static UBYTE tw_read_data(UBYTE* data) |
||
| 110 | { |
||
| 111 | //enable |
||
| 370 | chrv | 112 | TWCR = _BV(TWINT)|_BV(TWEN); |
| 72 | chrv | 113 | |
| 114 | //wait for flag set |
||
| 370 | chrv | 115 | while ( (TWCR&_BV(TWINT))==0 ); |
| 72 | chrv | 116 | |
| 589 | chrv | 117 | //#ifdef LOGENABLE |
| 118 | // char log_tw[] = "TWR..[..]..\r\n"; |
||
| 119 | // UBYTE b = TWSR; |
||
| 120 | // log_tw[3] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10; |
||
| 121 | // log_tw[4] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10; |
||
| 122 | // b=TWCR; |
||
| 123 | // log_tw[6] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10; |
||
| 124 | // log_tw[7] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10; |
||
| 125 | // log_tw[9] = ((TWDR >> 4) <= 9 )?'0'+(TWDR >> 4):'A'+(TWDR >> 4)-10; |
||
| 126 | // log_tw[10] = ((TWDR & 0x0F) <= 9 )?'0'+(TWDR & 0x0F):'A'+(TWDR & 0x0F)-10; |
||
| 127 | // to_log(log_tw); |
||
| 128 | //#endif |
||
| 72 | chrv | 129 | //get data |
| 130 | *data = TWDR; |
||
| 131 | |||
| 132 | //return status |
||
| 370 | chrv | 133 | return TW_STATUS; |
| 72 | chrv | 134 | } |
| 135 | |||
| 104 | chrv | 136 | static UBYTE bcd_to_hex(UBYTE data) |
| 137 | { |
||
| 138 | //convert BCD to HEX |
||
| 370 | chrv | 139 | return (UBYTE)(data>>4)*10 + (UBYTE)(data&0x0F); |
| 104 | chrv | 140 | } |
| 72 | chrv | 141 | |
| 104 | chrv | 142 | static UBYTE hex_to_bcd(UBYTE data) |
| 143 | { |
||
| 144 | //convert HEX to BCD |
||
| 370 | chrv | 145 | return (UBYTE)((data/10)<<4) + (UBYTE)(data%10); |
| 104 | chrv | 146 | } |
| 147 | |||
| 148 | static UBYTE days_of_months() |
||
| 149 | { |
||
| 150 | //return number of days in month |
||
| 151 | static const UBYTE days[12] = {31,28,31,30,31,30,31,31,30,31,30,31}; |
||
| 152 | UBYTE tmp = gluk_regs[GLUK_REG_MONTH]-1; |
||
| 153 | |||
| 154 | if ( tmp > sizeof(days)-1 ) tmp = 0; //check range |
||
| 155 | |||
| 156 | tmp = days[tmp]; |
||
| 157 | |||
| 158 | //check leap-year |
||
| 159 | if ( (tmp == 28) && ( ( gluk_regs[GLUK_REG_YEAR]&0x03 ) == 0 ) ) tmp++; |
||
| 160 | |||
| 161 | return tmp; |
||
| 162 | } |
||
| 163 | |||
| 656 | chrv | 164 | static UBYTE read_eeprom(UBYTE offset) |
| 165 | { |
||
| 166 | UWORD ptr = gluk_regs[GLUK_REG_A]; |
||
| 167 | ptr = (ptr<<4) + (0x0F&offset); |
||
| 168 | |||
| 169 | //wait for eeprom |
||
| 170 | eeprom_busy_wait(); |
||
| 171 | |||
| 172 | return eeprom_read_byte((UBYTE*)ptr); |
||
| 173 | } |
||
| 174 | |||
| 175 | static void write_eeprom(UBYTE offset, UBYTE data) |
||
| 176 | { |
||
| 177 | UWORD ptr = gluk_regs[GLUK_REG_A]; |
||
| 178 | ptr = (ptr<<4) + (0x0F&offset); |
||
| 179 | |||
| 180 | //wait for eeprom |
||
| 181 | eeprom_busy_wait(); |
||
| 182 | |||
| 183 | eeprom_write_byte ((UBYTE*)ptr, data); |
||
| 184 | } |
||
| 185 | |||
| 72 | chrv | 186 | void rtc_init(void) |
| 187 | { |
||
| 188 | //SCL frequency = CPU clk/ ( 16 + 2* (TWBR) * 4^(TWPS) ) |
||
| 189 | // 11052000 / (16 + 2*48 ) = 98678,5Hz (100000Hz recommended for PCF8583) |
||
| 190 | TWSR = 0; |
||
| 371 | chrv | 191 | TWBR = 48; |
| 370 | chrv | 192 | TWAR = 0; //disable address match unit |
| 72 | chrv | 193 | |
| 194 | //reset RTC |
||
| 195 | //write 0 to control/status register [0] on PCF8583 |
||
| 196 | rtc_write(0, 0); |
||
| 197 | |||
| 104 | chrv | 198 | //set Gluk clock registers |
| 199 | gluk_init(); |
||
| 200 | if ( gluk_regs[GLUK_REG_SEC] == 0 ) gluk_init(); |
||
| 126 | chrv | 201 | |
| 505 | chrv | 202 | //restore mode register from NVRAM (CAPS LED off on init) |
| 203 | modes_register = rtc_read(RTC_COMMON_MODE_REG) & ~(MODE_CAPSLED); |
||
| 292 | chrv | 204 | |
| 126 | chrv | 205 | //set modes on fpga |
| 292 | chrv | 206 | zx_set_config(0); |
| 72 | chrv | 207 | } |
| 208 | |||
| 209 | void rtc_write(UBYTE addr, UBYTE data) |
||
| 210 | { |
||
| 211 | //set address |
||
| 212 | if ( tw_send_start() & (TW_START|TW_REP_START) ) |
||
| 213 | { |
||
| 370 | chrv | 214 | if ( tw_send_addr(RTC_ADDRESS|TW_WRITE) == TW_MT_SLA_ACK ) |
| 72 | chrv | 215 | { |
| 216 | if ( tw_send_data(addr) == TW_MT_DATA_ACK ) |
||
| 217 | { |
||
| 218 | //write data |
||
| 219 | tw_send_data(data); |
||
| 220 | } |
||
| 221 | } |
||
| 222 | } |
||
| 223 | tw_send_stop(); |
||
| 224 | } |
||
| 225 | |||
| 226 | UBYTE rtc_read(UBYTE addr) |
||
| 227 | { |
||
| 228 | UBYTE ret = 0; |
||
| 370 | chrv | 229 | |
| 72 | chrv | 230 | //set address |
| 231 | if ( tw_send_start() & (TW_START|TW_REP_START) ) |
||
| 232 | { |
||
| 370 | chrv | 233 | if ( tw_send_addr(RTC_ADDRESS|TW_WRITE) == TW_MT_SLA_ACK ) |
| 72 | chrv | 234 | { |
| 235 | if ( tw_send_data(addr) == TW_MT_DATA_ACK ) |
||
| 236 | { |
||
| 237 | //read data |
||
| 238 | if ( tw_send_start() == TW_REP_START ) |
||
| 239 | { |
||
| 370 | chrv | 240 | if ( tw_send_addr(RTC_ADDRESS|TW_READ) == TW_MR_SLA_ACK ) |
| 72 | chrv | 241 | { |
| 242 | tw_read_data(&ret); |
||
| 243 | } |
||
| 244 | } |
||
| 245 | } |
||
| 246 | } |
||
| 247 | } |
||
| 248 | tw_send_stop(); |
||
| 249 | return ret; |
||
| 250 | } |
||
| 94 | chrv | 251 | |
| 104 | chrv | 252 | void gluk_init(void) |
| 253 | { |
||
| 254 | UBYTE tmp; |
||
| 255 | //default values |
||
| 486 | chrv | 256 | gluk_regs[GLUK_REG_A] = GLUK_A_INIT_VALUE; |
| 257 | gluk_regs[GLUK_REG_B] = GLUK_B_INIT_VALUE; |
||
| 258 | gluk_regs[GLUK_REG_C] = GLUK_C_INIT_VALUE; |
||
| 259 | gluk_regs[GLUK_REG_D] = GLUK_D_INIT_VALUE; |
||
| 104 | chrv | 260 | |
| 261 | //setup |
||
| 262 | |||
| 263 | //read month and day of week |
||
| 264 | tmp = rtc_read(6); |
||
| 265 | gluk_regs[GLUK_REG_MONTH] = bcd_to_hex(0x1F&tmp); |
||
| 359 | chrv | 266 | tmp = (tmp>>5); |
| 267 | //PC8583 dayweek 0..6 => DS12788 dayweek 1..7 |
||
| 268 | gluk_regs[GLUK_REG_DAY_WEEK] = (tmp>6)?1:tmp+1; |
||
| 104 | chrv | 269 | |
| 270 | //read year and day of month |
||
| 271 | tmp = rtc_read(5); |
||
| 272 | gluk_regs[GLUK_REG_DAY_MONTH] = bcd_to_hex(0x3F&tmp); |
||
| 273 | gluk_regs[GLUK_REG_YEAR] = tmp>>6; |
||
| 274 | tmp = rtc_read(RTC_YEAR_ADD_REG); |
||
| 275 | if ( (tmp&0x03) > gluk_regs[GLUK_REG_YEAR] ) |
||
| 276 | { |
||
| 277 | //count of year over - correct year |
||
| 278 | tmp += 4; |
||
| 279 | if ( tmp >= 100 ) tmp = 0; |
||
| 280 | } |
||
| 281 | gluk_regs[GLUK_REG_YEAR] += tmp&0xFC; |
||
| 282 | rtc_write(RTC_YEAR_ADD_REG,gluk_regs[GLUK_REG_YEAR]); //save year |
||
| 283 | |||
| 284 | //read time |
||
| 285 | gluk_regs[GLUK_REG_HOUR] = bcd_to_hex(0x3F&rtc_read(4)); //TODO 12/24 format |
||
| 286 | gluk_regs[GLUK_REG_MIN] = bcd_to_hex(rtc_read(3)); |
||
| 287 | gluk_regs[GLUK_REG_SEC] = bcd_to_hex(rtc_read(2)); |
||
| 288 | } |
||
| 289 | |||
| 94 | chrv | 290 | void gluk_inc(void) |
| 291 | { |
||
| 104 | chrv | 292 | if ( ++gluk_regs[GLUK_REG_SEC] >= 60 ) |
| 94 | chrv | 293 | { |
| 294 | gluk_regs[GLUK_REG_SEC] = 0; |
||
| 104 | chrv | 295 | if ( ++gluk_regs[GLUK_REG_MIN] >= 60 ) |
| 94 | chrv | 296 | { |
| 297 | gluk_regs[GLUK_REG_MIN] = 0; |
||
| 104 | chrv | 298 | if ( ++gluk_regs[GLUK_REG_HOUR] >= 24 ) |
| 94 | chrv | 299 | { |
| 300 | gluk_regs[GLUK_REG_HOUR] = 0; |
||
| 104 | chrv | 301 | if ( ++gluk_regs[GLUK_REG_DAY_WEEK] > 7 ) |
| 302 | { |
||
| 303 | gluk_regs[GLUK_REG_DAY_WEEK] = 1; |
||
| 304 | } |
||
| 305 | if ( ++gluk_regs[GLUK_REG_DAY_MONTH] > days_of_months() ) |
||
| 306 | { |
||
| 307 | gluk_regs[GLUK_REG_DAY_MONTH] = 1; |
||
| 308 | if ( ++gluk_regs[GLUK_REG_MONTH] > 12 ) |
||
| 309 | { |
||
| 310 | gluk_regs[GLUK_REG_MONTH] = 1; |
||
| 311 | if( ++gluk_regs[GLUK_REG_YEAR] >= 100 ) |
||
| 312 | { |
||
| 313 | gluk_regs[GLUK_REG_YEAR] = 0; |
||
| 314 | } |
||
| 315 | } |
||
| 316 | } |
||
| 94 | chrv | 317 | } |
| 318 | } |
||
| 319 | } |
||
| 129 | chrv | 320 | |
| 321 | //set update flag |
||
| 322 | gluk_regs[GLUK_REG_C] |= GLUK_C_UPDATE_FLAG; |
||
| 323 | |||
| 100 | chrv | 324 | //#ifdef LOGENABLE |
| 325 | //{ |
||
| 326 | // char log_int_rtc[] = "00.00.00\r\n"; |
||
| 327 | // log_int_rtc[0] = '0' + gluk_regs[GLUK_REG_HOUR]/10; |
||
| 328 | // log_int_rtc[1] = '0' + gluk_regs[GLUK_REG_HOUR]%10; |
||
| 329 | // log_int_rtc[3] = '0' + gluk_regs[GLUK_REG_MIN]/10; |
||
| 330 | // log_int_rtc[4] = '0' + gluk_regs[GLUK_REG_MIN]%10; |
||
| 331 | // log_int_rtc[6] = '0' + gluk_regs[GLUK_REG_SEC]/10; |
||
| 332 | // log_int_rtc[7] = '0' + gluk_regs[GLUK_REG_SEC]%10; |
||
| 333 | // to_log(log_int_rtc); |
||
| 334 | //} |
||
| 335 | //#endif |
||
| 94 | chrv | 336 | } |
| 337 | |||
| 104 | chrv | 338 | UBYTE gluk_get_reg(UBYTE index) |
| 94 | chrv | 339 | { |
| 589 | chrv | 340 | UBYTE tmp; |
| 341 | |||
| 94 | chrv | 342 | if( index < sizeof(gluk_regs)/sizeof(gluk_regs[0]) ) |
| 343 | { |
||
| 100 | chrv | 344 | //clock registers from array |
| 589 | chrv | 345 | tmp = gluk_regs[index]; |
| 104 | chrv | 346 | if ( ( index<10 ) && ( (gluk_regs[GLUK_REG_B]&GLUK_B_DATA_MODE) == 0 ) ) |
| 347 | { |
||
| 348 | //clock registers mast be in BCD if HEX-bit not set in reg B |
||
| 349 | tmp = hex_to_bcd(tmp); |
||
| 350 | } |
||
| 129 | chrv | 351 | |
| 352 | if ( index == GLUK_REG_C ) |
||
| 353 | { |
||
| 354 | //clear update flag |
||
| 355 | gluk_regs[GLUK_REG_C] &= ~GLUK_C_UPDATE_FLAG; |
||
| 562 | chrv | 356 | |
| 357 | //3 bit - SD card detect |
||
| 358 | //2 bit - SD WRP detect |
||
| 672 | chrv | 359 | tmp |= (((~SD_PIN)&((1<<SDWRP)|(1<<SDDET)))>>2); |
| 360 | |||
| 361 | //0 - bit numlock led status on read |
||
| 362 | if ( (PS2KEYBOARD_LED_NUMLOCK&modes_register)!=0 ) |
||
| 363 | { |
||
| 364 | tmp |= GLUK_C_NUM_LED_FLAG; |
||
| 365 | } |
||
| 366 | else |
||
| 367 | { |
||
| 368 | |||
| 369 | tmp &= ~GLUK_C_NUM_LED_FLAG; |
||
| 370 | } |
||
| 129 | chrv | 371 | } |
| 672 | chrv | 372 | |
| 373 | if ( index == GLUK_REG_D ) |
||
| 374 | { |
||
| 375 | //return keyboard statuses |
||
| 376 | tmp &= ~(KB_LCTRL_MASK|KB_RCTRL_MASK|KB_LALT_MASK|KB_RALT_MASK|KB_LSHIFT_MASK|KB_RSHIFT_MASK|KB_F12_MASK); |
||
| 377 | tmp |= (kb_ctrl_status&(KB_LCTRL_MASK|KB_RCTRL_MASK|KB_LALT_MASK|KB_RALT_MASK|KB_LSHIFT_MASK|KB_RSHIFT_MASK|KB_F12_MASK)); |
||
| 378 | } |
||
| 379 | } |
||
| 100 | chrv | 380 | else |
| 381 | { |
||
| 179 | chrv | 382 | if ( index >= 0xF0 ) |
| 383 | { |
||
| 656 | chrv | 384 | if ( (gluk_regs[GLUK_REG_C]&GLUK_C_EEPROM_FLAG)!=0 ) |
| 385 | { |
||
| 386 | //read from eeprom |
||
| 387 | tmp = read_eeprom(index); |
||
| 388 | } |
||
| 389 | else |
||
| 390 | { |
||
| 391 | //read version |
||
| 392 | tmp = GetVersionByte( index&0x0F ); |
||
| 393 | } |
||
| 179 | chrv | 394 | } |
| 364 | chrv | 395 | else |
| 396 | { |
||
| 397 | //other from nvram |
||
| 398 | //- on PCF8583 nvram started from #10 |
||
| 399 | //- on 512vi1[DS12887] nvram started from #0E |
||
| 589 | chrv | 400 | tmp = rtc_read( (index/*&0x3F*/)+2 ); |
| 364 | chrv | 401 | } |
| 100 | chrv | 402 | } |
| 589 | chrv | 403 | |
| 404 | #ifdef LOGENABLE |
||
| 405 | { |
||
| 406 | char log_gs[] = "GR[..]..\r\n"; |
||
| 407 | UBYTE b = index; |
||
| 408 | log_gs[3] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10; |
||
| 409 | log_gs[4] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10; |
||
| 410 | b = tmp; |
||
| 411 | log_gs[6] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10; |
||
| 412 | log_gs[7] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10; |
||
| 413 | to_log(log_gs); |
||
| 414 | } |
||
| 415 | #endif |
||
| 416 | return tmp; |
||
| 94 | chrv | 417 | } |
| 100 | chrv | 418 | |
| 104 | chrv | 419 | void gluk_set_reg(UBYTE index, UBYTE data) |
| 100 | chrv | 420 | { |
| 370 | chrv | 421 | #ifdef LOGENABLE |
| 422 | char log_gs[] = "GS[..]..\r\n"; |
||
| 423 | UBYTE b = index; |
||
| 424 | log_gs[3] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10; |
||
| 425 | log_gs[4] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10; |
||
| 426 | b=data; |
||
| 427 | log_gs[6] = ((b >> 4) <= 9 )?'0'+(b >> 4):'A'+(b >> 4)-10; |
||
| 428 | log_gs[7] = ((b & 0x0F) <= 9 )?'0'+(b & 0x0F):'A'+(b & 0x0F)-10; |
||
| 429 | to_log(log_gs); |
||
| 430 | #endif |
||
| 431 | |||
| 100 | chrv | 432 | if( index < sizeof(gluk_regs)/sizeof(gluk_regs[0]) ) |
| 433 | { |
||
| 104 | chrv | 434 | if ( index<10 ) |
| 435 | { |
||
| 436 | //write to clock registers |
||
| 437 | if ( (gluk_regs[GLUK_REG_B]&GLUK_B_DATA_MODE) == 0 ) |
||
| 438 | { |
||
| 439 | //array of registers must be in Hex, but data in BCD if HEX-bit not set in reg B |
||
| 440 | data = bcd_to_hex(data); |
||
| 441 | } |
||
| 442 | gluk_regs[index] = data; |
||
| 443 | |||
| 444 | //write to nvram if need |
||
| 445 | switch( index ) |
||
| 446 | { |
||
| 447 | case GLUK_REG_SEC: |
||
| 370 | chrv | 448 | if( data <= 59 ) rtc_write(2, hex_to_bcd(data/*gluk_regs[GLUK_REG_SEC]*/)); |
| 104 | chrv | 449 | break; |
| 450 | case GLUK_REG_MIN: |
||
| 370 | chrv | 451 | if( data <= 59) rtc_write(3, hex_to_bcd(data/*gluk_regs[GLUK_REG_MIN]*/)); |
| 104 | chrv | 452 | break; |
| 453 | case GLUK_REG_HOUR: |
||
| 370 | chrv | 454 | if( data <= 23) rtc_write(4, 0x3F&hex_to_bcd(data/*gluk_regs[GLUK_REG_HOUR]*/)); |
| 104 | chrv | 455 | break; |
| 456 | case GLUK_REG_MONTH: |
||
| 457 | case GLUK_REG_DAY_WEEK: |
||
| 370 | chrv | 458 | if( ( gluk_regs[GLUK_REG_DAY_WEEK]-1 <= 6 ) && |
| 459 | ( gluk_regs[GLUK_REG_MONTH] > 0 ) && |
||
| 460 | ( gluk_regs[GLUK_REG_MONTH] <= 12 ) ) |
||
| 461 | { |
||
| 462 | //DS12788 dayweek 1..7 => PC8583 dayweek 0..6 |
||
| 463 | rtc_write(6, ((gluk_regs[GLUK_REG_DAY_WEEK]-1)<<5)+(0x1F&hex_to_bcd(gluk_regs[GLUK_REG_MONTH]))); |
||
| 464 | } |
||
| 104 | chrv | 465 | break; |
| 466 | case GLUK_REG_YEAR: |
||
| 467 | rtc_write(RTC_YEAR_ADD_REG, gluk_regs[GLUK_REG_YEAR]); |
||
| 468 | case GLUK_REG_DAY_MONTH: |
||
| 105 | chrv | 469 | rtc_write(5, (gluk_regs[GLUK_REG_YEAR]<<6)+(0x3F&hex_to_bcd(gluk_regs[GLUK_REG_DAY_MONTH]))); |
| 104 | chrv | 470 | break; |
| 471 | } |
||
| 472 | } |
||
| 486 | chrv | 473 | else |
| 474 | { |
||
| 505 | chrv | 475 | switch( index ) |
| 486 | chrv | 476 | { |
| 656 | chrv | 477 | case GLUK_REG_A: |
| 478 | //EEPROM address |
||
| 479 | gluk_regs[GLUK_REG_A]=data; |
||
| 480 | break; |
||
| 481 | |||
| 505 | chrv | 482 | case GLUK_REG_B: |
| 483 | //BCD or Hex mode set |
||
| 484 | gluk_regs[GLUK_REG_B]=(data&GLUK_B_DATA_MODE)|GLUK_B_INIT_VALUE; |
||
| 485 | break; |
||
| 486 | |||
| 487 | case GLUK_REG_C: |
||
| 488 | if ( (data&GLUK_C_CLEAR_LOG_FLAG) != 0 ) |
||
| 489 | { |
||
| 490 | //clear PS2 keyboard log |
||
| 491 | ps2keyboard_reset_log(); |
||
| 492 | } |
||
| 493 | if ( (data&GLUK_C_CAPS_LED_FLAG) != (gluk_regs[GLUK_REG_C]&GLUK_C_CAPS_LED_FLAG) ) |
||
| 494 | { |
||
| 495 | //switch state of CAPS LED on PS2 keyboard |
||
| 496 | gluk_regs[GLUK_REG_C] = gluk_regs[GLUK_REG_C]^GLUK_C_CAPS_LED_FLAG; |
||
| 497 | modes_register = modes_register^MODE_CAPSLED; |
||
| 498 | //set led on keyboard |
||
| 499 | ps2keyboard_send_cmd(PS2KEYBOARD_CMD_SETLED); |
||
| 500 | } |
||
| 656 | chrv | 501 | if ( (data&GLUK_C_EEPROM_FLAG) != (gluk_regs[GLUK_REG_C]&GLUK_C_EEPROM_FLAG) ) |
| 502 | { |
||
| 503 | //switch EEPROM mode |
||
| 504 | gluk_regs[GLUK_REG_C] = gluk_regs[GLUK_REG_C]^GLUK_C_EEPROM_FLAG; |
||
| 505 | } |
||
| 505 | chrv | 506 | break; |
| 486 | chrv | 507 | } |
| 508 | } |
||
| 100 | chrv | 509 | } |
| 510 | else |
||
| 511 | { |
||
| 179 | chrv | 512 | if ( index >= 0xF0 ) |
| 513 | { |
||
| 656 | chrv | 514 | if ( (gluk_regs[GLUK_REG_C]&GLUK_C_EEPROM_FLAG)!=0 ) |
| 515 | { |
||
| 516 | //write to eeprom |
||
| 517 | write_eeprom(index, data); |
||
| 518 | } |
||
| 519 | else |
||
| 520 | { |
||
| 521 | //set version data type |
||
| 522 | SetVersionType( data ); |
||
| 523 | } |
||
| 179 | chrv | 524 | } |
| 525 | else |
||
| 526 | { |
||
| 527 | //write to nvram |
||
| 528 | //- on PCF8583 nvram started from #10 |
||
| 529 | //- on 512vi1[DS12887] nvram started from #0E |
||
| 364 | chrv | 530 | rtc_write( (index/*&0x3F*/)+2, data); |
| 179 | chrv | 531 | } |
| 100 | chrv | 532 | } |
| 533 | } |
||
| 656 | chrv | 534 |