[622] | 1 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 2 | // File : stdio.c |
---|
| 3 | // Written by Alain Greiner |
---|
| 4 | // Date : janvier 2014 |
---|
| 5 | // |
---|
| 6 | // This file define varions functions that can be used by applications to access |
---|
| 7 | // peripherals, for the TSAR multi-processors multi_clusters architecture. |
---|
| 8 | // There is NO separation between application code and system code, as the |
---|
| 9 | // application are running in kernel mode without system calls. |
---|
| 10 | // This basic GIET does not support virtual memory, and does not support multi-tasking. |
---|
| 11 | // |
---|
| 12 | // The supported peripherals are: |
---|
| 13 | // - the SoClib multi_tty |
---|
| 14 | // - The SoCLib frame_buffer |
---|
| 15 | // - The SoCLib block_device |
---|
| 16 | // |
---|
| 17 | // The following parameters must be defined in the hard_config.h file. |
---|
| 18 | // - X_SIZE : number of clusters in a row |
---|
| 19 | // - Y_SIZE : number of clusters in a column |
---|
| 20 | // - X_WIDTH : number of bits for X field in proc_id |
---|
| 21 | // - Y_WIDTH : number of bits for Y field in proc_id |
---|
| 22 | // - NB_PROCS_MAX : max number of processor per cluster |
---|
| 23 | // - NB_TTY_CHANNELS : max number of TTY channels |
---|
| 24 | // |
---|
| 25 | // The follobing base addresses must be defined in the ldscript |
---|
| 26 | // - seg_tty_base |
---|
| 27 | // - seg_fbf_base |
---|
| 28 | // - seg_ioc_base |
---|
| 29 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
[158] | 30 | |
---|
[622] | 31 | #include "stdio.h" |
---|
[158] | 32 | |
---|
[622] | 33 | #define NB_LOCKS 256 |
---|
| 34 | #define NB_BARRIERS 16 |
---|
[158] | 35 | |
---|
[622] | 36 | #define in_drivers __attribute__((section (".drivers"))) |
---|
| 37 | #define in_unckdata __attribute__((section (".unckdata"))) |
---|
[158] | 38 | |
---|
[622] | 39 | ////////////////////////////////////////////////////////////// |
---|
| 40 | // various informations that must be defined in ldscript |
---|
| 41 | ////////////////////////////////////////////////////////////// |
---|
[158] | 42 | |
---|
[622] | 43 | struct plouf; |
---|
| 44 | |
---|
| 45 | extern struct plouf seg_tty_base; |
---|
| 46 | extern struct plouf seg_fbf_base; |
---|
| 47 | extern struct plouf seg_ioc_base; |
---|
| 48 | extern struct plouf seg_mmc_base; |
---|
| 49 | |
---|
| 50 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 51 | // Global uncachable variables for synchronization between drivers and ISRs |
---|
| 52 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 53 | |
---|
| 54 | in_unckdata int volatile _ioc_lock = 0; |
---|
| 55 | in_unckdata int volatile _ioc_done = 0; |
---|
| 56 | in_unckdata int volatile _ioc_status; |
---|
| 57 | |
---|
| 58 | in_unckdata char volatile _tty_get_buf[NB_TTY_CHANNELS]; |
---|
| 59 | in_unckdata int volatile _tty_get_full[NB_TTY_CHANNELS] = { [0 ... NB_TTY_CHANNELS-1] = 0 }; |
---|
| 60 | |
---|
| 61 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 62 | // Global uncachable variables for inter-task barriers |
---|
| 63 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 64 | |
---|
| 65 | in_unckdata int volatile _barrier_value[NB_BARRIERS] = { [0 ... NB_BARRIERS-1] = 0 }; |
---|
| 66 | in_unckdata int volatile _barrier_count[NB_BARRIERS] = { [0 ... NB_BARRIERS-1] = 0 }; |
---|
| 67 | in_unckdata int volatile _barrier_lock[NB_BARRIERS] = { [0 ... NB_BARRIERS-1] = 0 }; |
---|
| 68 | |
---|
| 69 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 70 | // Global uncachable variables for spin_locks using LL/C instructions |
---|
| 71 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 72 | |
---|
| 73 | in_unckdata int volatile _spin_lock[NB_LOCKS] = { [0 ... NB_LOCKS-1] = 0 }; |
---|
| 74 | |
---|
| 75 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 76 | // Taken from MutekH. |
---|
| 77 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 78 | in_drivers void* _memcpy( void* _dst, |
---|
| 79 | const void* _src, |
---|
| 80 | unsigned int size ) |
---|
[158] | 81 | { |
---|
[622] | 82 | unsigned int *dst = _dst; |
---|
| 83 | const unsigned int *src = _src; |
---|
| 84 | if ( ! ((unsigned int)dst & 3) && ! ((unsigned int)src & 3) ) |
---|
| 85 | { |
---|
| 86 | while (size > 3) |
---|
| 87 | { |
---|
| 88 | *dst++ = *src++; |
---|
| 89 | size -= 4; |
---|
| 90 | } |
---|
| 91 | } |
---|
[158] | 92 | |
---|
[622] | 93 | unsigned char *cdst = (unsigned char*)dst; |
---|
| 94 | unsigned char *csrc = (unsigned char*)src; |
---|
| 95 | |
---|
| 96 | while (size--) |
---|
| 97 | { |
---|
| 98 | *cdst++ = *csrc++; |
---|
| 99 | } |
---|
| 100 | return _dst; |
---|
[158] | 101 | } |
---|
| 102 | |
---|
[622] | 103 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 104 | // Access CP0 and returns processor ident |
---|
| 105 | // No more than 1024 processors... |
---|
| 106 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 107 | in_drivers unsigned int _procid() |
---|
[158] | 108 | { |
---|
[622] | 109 | unsigned int ret; |
---|
| 110 | asm volatile( "mfc0 %0, $15, 1": "=r"(ret) ); |
---|
| 111 | return (ret & 0x3FF); |
---|
[158] | 112 | } |
---|
[622] | 113 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 114 | // Access CP0 and returns processor time |
---|
| 115 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 116 | in_drivers unsigned int _proctime() |
---|
[158] | 117 | { |
---|
[622] | 118 | unsigned int ret; |
---|
| 119 | asm volatile( "mfc0 %0, $9": "=r"(ret) ); |
---|
| 120 | return ret; |
---|
[158] | 121 | } |
---|
[622] | 122 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 123 | // Returns the number of processsors controled by the GIET |
---|
| 124 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 125 | in_drivers unsigned int _procnumber() |
---|
[158] | 126 | { |
---|
[622] | 127 | return (unsigned int)(NB_PROCS_MAX * X_SIZE * Y_SIZE); |
---|
[158] | 128 | } |
---|
[622] | 129 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
[626] | 130 | // Returns pseudo-random number |
---|
| 131 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 132 | in_drivers unsigned int _rand() |
---|
| 133 | { |
---|
| 134 | unsigned int x = _proctime(); |
---|
| 135 | if((x & 0xF) > 7) |
---|
| 136 | return (x*x & 0xFFFF); |
---|
| 137 | else |
---|
| 138 | return (x*x*x & 0xFFFF); |
---|
| 139 | } |
---|
| 140 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
[622] | 141 | // Access CP0 and mask IRQs |
---|
| 142 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 143 | in_drivers void _it_mask() |
---|
[158] | 144 | { |
---|
[622] | 145 | int tmp; |
---|
| 146 | asm volatile("mfc0 %0, $12" : "=r" (tmp) ); |
---|
| 147 | asm volatile("ori %0, %0, 1" : "=r" (tmp) ); |
---|
| 148 | asm volatile("mtc0 %0, $12" : "=r" (tmp) ); |
---|
[158] | 149 | } |
---|
[622] | 150 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 151 | // Access CP0 and enable IRQs |
---|
| 152 | //////////////////////////////////////////////////////////////////////////////////////// |
---|
| 153 | in_drivers void _it_enable() |
---|
[158] | 154 | { |
---|
[622] | 155 | int tmp; |
---|
| 156 | asm volatile("mfc0 %0, $12" : "=r" (tmp) ); |
---|
| 157 | asm volatile("addi %0, %0, -1" : "=r" (tmp) ); |
---|
| 158 | asm volatile("mtc0 %0, $12" : "=r" (tmp) ); |
---|
[158] | 159 | } |
---|
[622] | 160 | ////////////////////////////////////////////////////////////////////// |
---|
| 161 | // Invalidate all cache lines corresponding to a memory buffer. |
---|
| 162 | // This is used by the block_device driver. |
---|
| 163 | ///////////////////////////////////////////////////////////////////////// |
---|
| 164 | in_drivers void _dcache_buf_invalidate(const void * buffer, size_t size) |
---|
| 165 | { |
---|
| 166 | size_t i; |
---|
| 167 | size_t dcache_line_size; |
---|
[158] | 168 | |
---|
[622] | 169 | // retrieve dcache line size from config register (bits 12:10) |
---|
| 170 | asm volatile("mfc0 %0, $16, 1" : "=r" (dcache_line_size)); |
---|
| 171 | |
---|
| 172 | dcache_line_size = 2 << ((dcache_line_size>>10) & 0x7); |
---|
| 173 | |
---|
| 174 | // iterate on lines to invalidate each one of them |
---|
| 175 | for ( i=0; i<size; i+=dcache_line_size ) |
---|
| 176 | asm volatile(" cache %0, %1" |
---|
| 177 | : |
---|
| 178 | :"i" (0x11), "R" (*((char*)buffer+i))); |
---|
| 179 | } |
---|
| 180 | |
---|
| 181 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 182 | // Exit (suicide) after printing message on a TTY terminal. |
---|
| 183 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 184 | in_drivers void _exit() |
---|
[158] | 185 | { |
---|
[622] | 186 | unsigned int proc_id = _procid(); |
---|
| 187 | unsigned int l = proc_id % NB_PROCS_MAX; |
---|
| 188 | unsigned int x = (proc_id / NB_PROCS_MAX) >> Y_WIDTH; |
---|
| 189 | unsigned int y = (proc_id / NB_PROCS_MAX) & ((1<<Y_WIDTH) - 1); |
---|
| 190 | |
---|
| 191 | _tty_printf("\n\n!!! Exit Processor (%d,%d,%d) !!!\n", x, y, l ); |
---|
| 192 | |
---|
| 193 | while(1) asm volatile("nop"); // infinite loop... |
---|
[158] | 194 | } |
---|
[622] | 195 | |
---|
| 196 | ///////////////////////////////////////////////////////////////////////// |
---|
| 197 | // convert a 32 bits unsigned int to a string of 10 decimal characters. |
---|
| 198 | ///////////////////////////////////////////////////////////////////////// |
---|
| 199 | in_drivers void _itoa_dec(unsigned val, char* buf) |
---|
[158] | 200 | { |
---|
[622] | 201 | const char DecTab[] = "0123456789"; |
---|
| 202 | unsigned int i; |
---|
| 203 | for( i=0 ; i<10 ; i++ ) |
---|
| 204 | { |
---|
| 205 | if( (val!=0) || (i==0) ) buf[9-i] = DecTab[val % 10]; |
---|
| 206 | else buf[9-i] = 0x20; |
---|
| 207 | val /= 10; |
---|
[158] | 208 | } |
---|
| 209 | } |
---|
[622] | 210 | ////////////////////////////////////////////////////////////////////////// |
---|
| 211 | // convert a 32 bits unsigned int to a string of 8 hexadecimal characters. |
---|
| 212 | /////////////////////////////////////////////////////////////////////////// |
---|
| 213 | in_drivers void _itoa_hex(unsigned int val, char* buf) |
---|
[158] | 214 | { |
---|
[622] | 215 | const char HexaTab[] = "0123456789ABCD"; |
---|
| 216 | unsigned int i; |
---|
| 217 | for( i=0 ; i<8 ; i++ ) |
---|
| 218 | { |
---|
| 219 | buf[7-i] = HexaTab[val % 16]; |
---|
| 220 | val /= 16; |
---|
[158] | 221 | } |
---|
| 222 | } |
---|
[622] | 223 | |
---|
| 224 | |
---|
| 225 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 226 | // VCI MULTI_TTY |
---|
| 227 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 228 | // The total number of TTY terminals is defined by NB_TTY_CHANNELS. |
---|
| 229 | // 1. If there is only one terminal, it is supposed to be shared, and used by |
---|
| 230 | // all processors: a lock must be taken before display. |
---|
| 231 | // 2. If there is several terminals, and the number of processors is smaller |
---|
| 232 | // than the number of terminals, there is one terminal per processor, but |
---|
| 233 | // the TTY index is not equal to the proc_id, due to cluster indexing policy: |
---|
| 234 | // - proc_id = cluster_xy * NB_PROCS_MAX + local_id (with cluster_xy = x << Y_WIDTH + y) |
---|
| 235 | // - tty_id = cluster_id * NB_PROCS_MAX + local_id (with cluster_id = x * Y_SIZE + y) |
---|
| 236 | // 3. If the computed tty_id is larger than NB_TTY_CHANNELS, an error is returned. |
---|
| 237 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 238 | // Write one or several characters directly from a fixed length user buffer |
---|
| 239 | // to the TTY_WRITE register of the TTY controler. |
---|
| 240 | // This is a non blocking call : it test the TTY_STATUS register. |
---|
| 241 | // If the TTY_STATUS_WRITE bit is set, the transfer stops and the function |
---|
| 242 | // returns the number of characters that have been actually written. |
---|
| 243 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 244 | in_drivers int _tty_write( char* buffer, |
---|
| 245 | unsigned int length, |
---|
| 246 | unsigned int channel ) |
---|
[158] | 247 | { |
---|
[622] | 248 | char* tty_address; |
---|
| 249 | unsigned int base = (unsigned int)&seg_tty_base; |
---|
| 250 | unsigned int nwritten = 0; |
---|
| 251 | int i; |
---|
| 252 | |
---|
| 253 | tty_address = (char*)(base + channel*TTY_SPAN*4); |
---|
| 254 | |
---|
| 255 | for ( i=0 ; i < length ; i++ ) |
---|
[158] | 256 | { |
---|
[622] | 257 | if((tty_address[TTY_STATUS*4] & 0x2) == 0x2) break; |
---|
| 258 | else |
---|
| 259 | { |
---|
| 260 | tty_address[TTY_WRITE*4] = buffer[i]; // write character |
---|
| 261 | nwritten++; |
---|
| 262 | } |
---|
[158] | 263 | } |
---|
[622] | 264 | |
---|
| 265 | return nwritten; |
---|
[158] | 266 | } |
---|
[622] | 267 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 268 | // Fetch one character directly from the TTY_READ register of the TTY controler, |
---|
| 269 | // and writes this character to the user buffer. |
---|
| 270 | // This is a non blocking call : it returns 0 if the register is empty, |
---|
| 271 | // and returns 1 if the register is full. |
---|
| 272 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 273 | in_drivers int _tty_read( char* buffer, |
---|
| 274 | unsigned int channel ) |
---|
[158] | 275 | { |
---|
[622] | 276 | char* tty_address; |
---|
| 277 | unsigned int base = (unsigned int)&seg_tty_base; |
---|
| 278 | |
---|
| 279 | tty_address = (char*)(base + channel*TTY_SPAN*4); |
---|
| 280 | |
---|
| 281 | if((tty_address[TTY_STATUS*4] & 0x1) == 0x1) |
---|
[158] | 282 | { |
---|
[622] | 283 | buffer[0] = tty_address[TTY_READ*4]; |
---|
| 284 | return 1; |
---|
[158] | 285 | } |
---|
[622] | 286 | else |
---|
| 287 | { |
---|
| 288 | return 0; |
---|
| 289 | } |
---|
[158] | 290 | } |
---|
[622] | 291 | ////////////////////////////////////////////////////////////////////////////// |
---|
| 292 | // This function displays a string on TTY0. |
---|
| 293 | // The string must be terminated by a NUL character. |
---|
| 294 | ////////////////////////////////////////////////////////////////////////////// |
---|
| 295 | in_drivers void _tty_puts( char* string ) |
---|
[158] | 296 | { |
---|
[622] | 297 | int length = 0; |
---|
| 298 | while (string[length] != 0) length++; |
---|
| 299 | _tty_write( string, length, 0 ); |
---|
| 300 | } |
---|
[158] | 301 | |
---|
[622] | 302 | /////////////////////////////////////////////////////////////////////////////// |
---|
| 303 | // This function displays a 32 bits unsigned int as an hexa string on TTY0. |
---|
| 304 | /////////////////////////////////////////////////////////////////////////////// |
---|
| 305 | in_drivers void _tty_putx(unsigned int val) |
---|
| 306 | { |
---|
| 307 | static const char HexaTab[] = "0123456789ABCDEF"; |
---|
| 308 | char buf[11]; |
---|
| 309 | unsigned int c; |
---|
| 310 | |
---|
| 311 | buf[0] = '0'; |
---|
| 312 | buf[1] = 'x'; |
---|
| 313 | buf[10] = 0; |
---|
| 314 | |
---|
| 315 | for (c = 0; c < 8; c++) |
---|
| 316 | { |
---|
| 317 | buf[9 - c] = HexaTab[val & 0xF]; |
---|
| 318 | val = val >> 4; |
---|
| 319 | } |
---|
| 320 | _tty_puts( buf ); |
---|
| 321 | } |
---|
| 322 | |
---|
| 323 | /////////////////////////////////////////////////////////////////////////////// |
---|
| 324 | // This function displays a 32 bits unsigned int as a decimal string on TTY0. |
---|
| 325 | /////////////////////////////////////////////////////////////////////////////// |
---|
| 326 | in_drivers void _tty_putd( unsigned int val ) |
---|
| 327 | { |
---|
| 328 | static const char DecTab[] = "0123456789"; |
---|
| 329 | char buf[11]; |
---|
| 330 | unsigned int i; |
---|
| 331 | unsigned int first; |
---|
| 332 | |
---|
| 333 | buf[10] = 0; |
---|
| 334 | |
---|
| 335 | for (i = 0; i < 10; i++) |
---|
[158] | 336 | { |
---|
[622] | 337 | if ((val != 0) || (i == 0)) |
---|
| 338 | { |
---|
| 339 | buf[9 - i] = DecTab[val % 10]; |
---|
| 340 | first = 9 - i; |
---|
| 341 | } |
---|
| 342 | else |
---|
| 343 | { |
---|
| 344 | break; |
---|
| 345 | } |
---|
| 346 | val /= 10; |
---|
| 347 | } |
---|
| 348 | _tty_puts( &buf[first] ); |
---|
| 349 | } |
---|
[158] | 350 | |
---|
[622] | 351 | ////////////////////////////////////////////////////////////////////////////// |
---|
| 352 | // This function try to take the hardwired lock protecting exclusive access |
---|
| 353 | // to TTY terminal identified by the channel argument. |
---|
| 354 | // It returns only when the lock has been successfully taken. |
---|
| 355 | ////////////////////////////////////////////////////////////////////////////// |
---|
| 356 | in_drivers void _tty_get_lock( unsigned int channel ) |
---|
| 357 | { |
---|
| 358 | unsigned int* tty_address = (unsigned int *) &seg_tty_base; |
---|
| 359 | while ( tty_address[channel * TTY_SPAN + TTY_CONFIG] ) asm volatile("nop"); |
---|
| 360 | } |
---|
[158] | 361 | |
---|
[622] | 362 | ////////////////////////////////////////////////////////////////////////////// |
---|
| 363 | // This function releases the hardwired lock protecting exclusive access |
---|
| 364 | // to TTY terminal identified by the channel argument. |
---|
| 365 | ////////////////////////////////////////////////////////////////////////////// |
---|
| 366 | in_drivers void _tty_release_lock( unsigned int channel ) |
---|
| 367 | { |
---|
| 368 | unsigned int* tty_address = (unsigned int *) &seg_tty_base; |
---|
| 369 | tty_address[channel * TTY_SPAN + TTY_CONFIG] = 0; |
---|
| 370 | } |
---|
| 371 | |
---|
| 372 | ////////////////////////////////////////////////////////////////////////////// |
---|
| 373 | // This function fetch a single ascii character from a terminal |
---|
| 374 | // implicitely defined by the processor ID. |
---|
| 375 | // It is a blocking function. |
---|
| 376 | ////////////////////////////////////////////////////////////////////////////// |
---|
| 377 | in_drivers void _tty_getc( char* buf ) |
---|
| 378 | { |
---|
| 379 | unsigned int proc_id = _procid(); |
---|
| 380 | unsigned int channel; |
---|
| 381 | unsigned int l; |
---|
| 382 | unsigned int x; |
---|
| 383 | unsigned int y; |
---|
| 384 | |
---|
| 385 | // compute TTY terminal index |
---|
| 386 | if ( NB_TTY_CHANNELS == 1 ) |
---|
| 387 | { |
---|
| 388 | channel = 0; |
---|
| 389 | } |
---|
| 390 | else |
---|
| 391 | { |
---|
| 392 | l = (proc_id % NB_PROCS_MAX); |
---|
| 393 | x = (proc_id / NB_PROCS_MAX) >> Y_WIDTH; |
---|
| 394 | y = (proc_id / NB_PROCS_MAX) & ((1<<Y_WIDTH) - 1); |
---|
| 395 | channel = (x * Y_SIZE + y) * NB_PROCS_MAX + l; |
---|
| 396 | if (channel >= NB_TTY_CHANNELS ) |
---|
[158] | 397 | { |
---|
[622] | 398 | _tty_get_lock( 0 ); |
---|
| 399 | _tty_puts( "ERROR in _tty_getc()\n" ); |
---|
| 400 | _tty_release_lock( 0 ); |
---|
| 401 | _exit(); |
---|
[158] | 402 | } |
---|
[622] | 403 | } |
---|
| 404 | |
---|
| 405 | while( _tty_read( buf, channel ) == 0 ) asm volatile("nop"); |
---|
[158] | 406 | } |
---|
[622] | 407 | |
---|
| 408 | ////////////////////////////////////////////////////////////////////////////// |
---|
| 409 | // Fetch a string of decimal characters (most significant digit first) |
---|
| 410 | // to build a 32 bits unsigned int. |
---|
| 411 | // The terminal index is implicitely defined by the processor ID. |
---|
| 412 | // This is a blocking function. |
---|
| 413 | // The decimal characters are written in a 32 characters buffer |
---|
| 414 | // until a <LF> or <CR> character is read. |
---|
| 415 | // The <DEL> character is interpreted, and previous characters can be |
---|
| 416 | // cancelled. All others characters are ignored. |
---|
| 417 | // When the <LF> or <CR> character is received, the string is converted |
---|
| 418 | // to an unsigned int value. If the number of decimal digit is too large |
---|
| 419 | // for the 32 bits range, the zero value is returned. |
---|
| 420 | ////////////////////////////////////////////////////////////////////////////// |
---|
| 421 | in_drivers void _tty_getw( unsigned int* word_buffer ) |
---|
[158] | 422 | { |
---|
[622] | 423 | char buf[32]; |
---|
| 424 | char byte; |
---|
| 425 | char cancel_string[3] = { 0x08, 0x20, 0x08 }; |
---|
| 426 | char zero = 0x30; |
---|
| 427 | unsigned int save = 0; |
---|
| 428 | unsigned int val = 0; |
---|
| 429 | unsigned int done = 0; |
---|
| 430 | unsigned int overflow = 0; |
---|
| 431 | unsigned int max = 0; |
---|
| 432 | unsigned int proc_id = _procid(); |
---|
| 433 | unsigned int i; |
---|
| 434 | unsigned int channel; |
---|
| 435 | unsigned int l; |
---|
| 436 | unsigned int x; |
---|
| 437 | unsigned int y; |
---|
[158] | 438 | |
---|
[622] | 439 | // compute TTY terminal index |
---|
| 440 | if ( NB_TTY_CHANNELS == 1 ) |
---|
[158] | 441 | { |
---|
[622] | 442 | channel = 0; |
---|
| 443 | } |
---|
| 444 | else |
---|
| 445 | { |
---|
| 446 | l = (proc_id % NB_PROCS_MAX); |
---|
| 447 | x = (proc_id / NB_PROCS_MAX) >> Y_WIDTH; |
---|
| 448 | y = (proc_id / NB_PROCS_MAX) & ((1<<Y_WIDTH) - 1); |
---|
| 449 | channel = (x * Y_SIZE + y) * NB_PROCS_MAX + l; |
---|
| 450 | if (channel >= NB_TTY_CHANNELS ) |
---|
| 451 | { |
---|
| 452 | _tty_get_lock( 0 ); |
---|
| 453 | _tty_puts( "ERROR in _tty_getw()\n" ); |
---|
| 454 | _tty_release_lock( 0 ); |
---|
| 455 | _exit(); |
---|
| 456 | } |
---|
| 457 | } |
---|
[158] | 458 | |
---|
[622] | 459 | while( done == 0 ) |
---|
| 460 | { |
---|
| 461 | _tty_read( &byte, channel ); |
---|
| 462 | |
---|
| 463 | if (( byte > 0x2F) && (byte < 0x3A)) // decimal character |
---|
[158] | 464 | { |
---|
[622] | 465 | buf[max] = byte; |
---|
| 466 | max++; |
---|
| 467 | _tty_write( &byte, 1, channel ); |
---|
| 468 | } |
---|
| 469 | else if ( (byte == 0x0A) || (byte == 0x0D) ) // LF or CR character |
---|
| 470 | { |
---|
| 471 | done = 1; |
---|
| 472 | } |
---|
| 473 | else if ( byte == 0x7F ) // DEL character |
---|
| 474 | { |
---|
| 475 | if (max > 0) |
---|
[158] | 476 | { |
---|
[622] | 477 | max--; // cancel the character |
---|
| 478 | _tty_write( cancel_string, 3, channel ); |
---|
[158] | 479 | } |
---|
| 480 | } |
---|
| 481 | } // end while |
---|
| 482 | |
---|
| 483 | // string conversion |
---|
| 484 | for( i=0 ; i<max ; i++ ) |
---|
| 485 | { |
---|
| 486 | val = val*10 + (buf[i] - 0x30); |
---|
| 487 | if (val < save) overflow = 1; |
---|
| 488 | save = val; |
---|
| 489 | } |
---|
| 490 | if (overflow == 0) |
---|
| 491 | { |
---|
| 492 | *word_buffer = val; // return decimal value |
---|
| 493 | } |
---|
| 494 | else |
---|
| 495 | { |
---|
| 496 | for( i=0 ; i<max ; i++) // cancel the string |
---|
| 497 | { |
---|
[622] | 498 | _tty_write( cancel_string, 3, channel ); |
---|
[158] | 499 | } |
---|
[622] | 500 | _tty_write( &zero, 1, channel ); |
---|
[158] | 501 | *word_buffer = 0; // return 0 value |
---|
| 502 | } |
---|
| 503 | } |
---|
[622] | 504 | |
---|
| 505 | ////////////////////////////////////////////////////////////////////////////// |
---|
| 506 | // This function is a simplified version of the mutek_printf() function. |
---|
| 507 | // It takes the TTY lock on the selected channel for exclusive access. |
---|
| 508 | // Only a limited number of formats are supported: |
---|
| 509 | // - %d : signed decimal |
---|
| 510 | // - %u : unsigned decimal |
---|
| 511 | // - %x : hexadecimal |
---|
| 512 | // - %c : char |
---|
| 513 | // - %s : string |
---|
| 514 | ////////////////////////////////////////////////////////////////////////////// |
---|
| 515 | in_drivers void _tty_printf( char *format, ...) |
---|
[158] | 516 | { |
---|
| 517 | va_list ap; |
---|
[622] | 518 | va_start( ap, format ); |
---|
[158] | 519 | |
---|
[622] | 520 | unsigned int channel; |
---|
| 521 | unsigned int l; |
---|
| 522 | unsigned int x; |
---|
| 523 | unsigned int y; |
---|
| 524 | unsigned int proc_id = _procid(); |
---|
| 525 | |
---|
| 526 | // compute TTY channel |
---|
| 527 | if ( NB_TTY_CHANNELS == 1 ) |
---|
| 528 | { |
---|
| 529 | channel = 0; |
---|
| 530 | } |
---|
| 531 | else |
---|
| 532 | { |
---|
| 533 | l = (proc_id % NB_PROCS_MAX); |
---|
| 534 | x = (proc_id / NB_PROCS_MAX) >> Y_WIDTH; |
---|
| 535 | y = (proc_id / NB_PROCS_MAX) & ((1<<Y_WIDTH) - 1); |
---|
| 536 | channel = (x * Y_SIZE + y) * NB_PROCS_MAX + l; |
---|
| 537 | if (channel >= NB_TTY_CHANNELS ) |
---|
| 538 | { |
---|
| 539 | _tty_get_lock( 0 ); |
---|
| 540 | _tty_puts("ERROR in _tty_printf() for proc[" ); |
---|
| 541 | _tty_putd( x ); |
---|
| 542 | _tty_puts(","); |
---|
| 543 | _tty_putd( y ); |
---|
| 544 | _tty_puts(","); |
---|
| 545 | _tty_putd( l ); |
---|
| 546 | _tty_puts("] / TTY channel too large = "); |
---|
| 547 | _tty_putd( channel ); |
---|
| 548 | _tty_puts("\n"); |
---|
| 549 | _tty_release_lock( 0 ); |
---|
| 550 | _exit(); |
---|
| 551 | } |
---|
| 552 | } |
---|
| 553 | |
---|
| 554 | // take the TTY lock |
---|
| 555 | _tty_get_lock( channel ); |
---|
| 556 | |
---|
[158] | 557 | printf_text: |
---|
| 558 | |
---|
[622] | 559 | while (*format) |
---|
| 560 | { |
---|
[158] | 561 | unsigned int i; |
---|
| 562 | for (i = 0; format[i] && format[i] != '%'; i++) |
---|
| 563 | ; |
---|
[622] | 564 | if (i) |
---|
| 565 | { |
---|
| 566 | _tty_write( format, i, channel ); |
---|
[158] | 567 | format += i; |
---|
| 568 | } |
---|
[622] | 569 | if (*format == '%') |
---|
| 570 | { |
---|
[158] | 571 | format++; |
---|
| 572 | goto printf_arguments; |
---|
| 573 | } |
---|
| 574 | } // end while |
---|
| 575 | |
---|
[622] | 576 | va_end( ap ); |
---|
[158] | 577 | |
---|
[622] | 578 | // release lock |
---|
| 579 | _tty_release_lock( 0 ); |
---|
| 580 | |
---|
| 581 | return; |
---|
| 582 | |
---|
[158] | 583 | printf_arguments: |
---|
| 584 | |
---|
| 585 | { |
---|
[622] | 586 | int val = va_arg(ap, long); |
---|
| 587 | char buf[20]; |
---|
| 588 | char* pbuf; |
---|
[158] | 589 | unsigned int len = 0; |
---|
| 590 | static const char HexaTab[] = "0123456789ABCDEF"; |
---|
| 591 | unsigned int i; |
---|
| 592 | |
---|
| 593 | switch (*format++) { |
---|
| 594 | case ('c'): // char conversion |
---|
| 595 | len = 1; |
---|
| 596 | buf[0] = val; |
---|
| 597 | pbuf = buf; |
---|
| 598 | break; |
---|
| 599 | case ('d'): // decimal signed integer |
---|
[622] | 600 | if (val < 0) |
---|
| 601 | { |
---|
[158] | 602 | val = -val; |
---|
[622] | 603 | _tty_write( "_" , 1, channel ); |
---|
[158] | 604 | } |
---|
| 605 | case ('u'): // decimal unsigned integer |
---|
[622] | 606 | for( i=0 ; i<10 ; i++) |
---|
| 607 | { |
---|
[158] | 608 | buf[9-i] = HexaTab[val % 10]; |
---|
| 609 | if (!(val /= 10)) break; |
---|
| 610 | } |
---|
| 611 | len = i+1; |
---|
| 612 | pbuf = &buf[9-i]; |
---|
| 613 | break; |
---|
| 614 | case ('x'): // hexadecimal integer |
---|
[622] | 615 | _tty_write( "0x", 2, channel ); |
---|
| 616 | for( i=0 ; i<8 ; i++) |
---|
| 617 | { |
---|
[158] | 618 | buf[7-i] = HexaTab[val % 16U]; |
---|
| 619 | if (!(val /= 16U)) break; |
---|
| 620 | } |
---|
| 621 | len = i+1; |
---|
| 622 | pbuf = &buf[7-i]; |
---|
| 623 | break; |
---|
| 624 | case ('s'): // string |
---|
| 625 | { |
---|
| 626 | char *str = (char*)val; |
---|
| 627 | while ( str[len] ) len++; |
---|
| 628 | pbuf = (char*)val; |
---|
| 629 | } |
---|
| 630 | break; |
---|
| 631 | default: |
---|
| 632 | goto printf_text; |
---|
| 633 | } // end switch |
---|
| 634 | |
---|
[622] | 635 | _tty_write( pbuf, len, channel ); |
---|
[158] | 636 | goto printf_text; |
---|
| 637 | } |
---|
| 638 | } // end printf() |
---|
| 639 | |
---|
[622] | 640 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 641 | // These functions are the ISRs that must be executed when an IRQ is activated |
---|
| 642 | // by the TTY: _tty_isr_X is associated to channel [X]. |
---|
| 643 | // It save the character in the communication buffer _tty_get_buf[X], |
---|
| 644 | // and set the set/reset variable _tty_get_full[X]. |
---|
| 645 | // A character is lost if the buffer is full when the ISR is executed. |
---|
| 646 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 647 | in_drivers void _tty_isr_indexed(size_t index) |
---|
[158] | 648 | { |
---|
[622] | 649 | char* base = (char*)&seg_tty_base; |
---|
| 650 | char* tty_address = (char*)(base + index*TTY_SPAN*4); |
---|
| 651 | |
---|
| 652 | _tty_get_buf[index] = tty_address[TTY_READ*4]; // save character and reset IRQ |
---|
| 653 | _tty_get_full[index] = 1; // signals character available |
---|
[158] | 654 | } |
---|
[622] | 655 | |
---|
| 656 | in_drivers void _tty_isr_00() { _tty_isr_indexed(0); } |
---|
| 657 | in_drivers void _tty_isr_01() { _tty_isr_indexed(1); } |
---|
| 658 | in_drivers void _tty_isr_02() { _tty_isr_indexed(2); } |
---|
| 659 | in_drivers void _tty_isr_03() { _tty_isr_indexed(3); } |
---|
| 660 | in_drivers void _tty_isr_04() { _tty_isr_indexed(4); } |
---|
| 661 | in_drivers void _tty_isr_05() { _tty_isr_indexed(5); } |
---|
| 662 | in_drivers void _tty_isr_06() { _tty_isr_indexed(6); } |
---|
| 663 | in_drivers void _tty_isr_07() { _tty_isr_indexed(7); } |
---|
| 664 | in_drivers void _tty_isr_08() { _tty_isr_indexed(8); } |
---|
| 665 | in_drivers void _tty_isr_09() { _tty_isr_indexed(9); } |
---|
| 666 | in_drivers void _tty_isr_10() { _tty_isr_indexed(10); } |
---|
| 667 | in_drivers void _tty_isr_11() { _tty_isr_indexed(11); } |
---|
| 668 | in_drivers void _tty_isr_12() { _tty_isr_indexed(12); } |
---|
| 669 | in_drivers void _tty_isr_13() { _tty_isr_indexed(13); } |
---|
| 670 | in_drivers void _tty_isr_14() { _tty_isr_indexed(14); } |
---|
| 671 | in_drivers void _tty_isr_15() { _tty_isr_indexed(15); } |
---|
| 672 | in_drivers void _tty_isr_16() { _tty_isr_indexed(16); } |
---|
| 673 | in_drivers void _tty_isr_17() { _tty_isr_indexed(17); } |
---|
| 674 | in_drivers void _tty_isr_18() { _tty_isr_indexed(18); } |
---|
| 675 | in_drivers void _tty_isr_19() { _tty_isr_indexed(19); } |
---|
| 676 | in_drivers void _tty_isr_20() { _tty_isr_indexed(20); } |
---|
| 677 | in_drivers void _tty_isr_21() { _tty_isr_indexed(21); } |
---|
| 678 | in_drivers void _tty_isr_22() { _tty_isr_indexed(22); } |
---|
| 679 | in_drivers void _tty_isr_23() { _tty_isr_indexed(23); } |
---|
| 680 | in_drivers void _tty_isr_24() { _tty_isr_indexed(24); } |
---|
| 681 | in_drivers void _tty_isr_25() { _tty_isr_indexed(25); } |
---|
| 682 | in_drivers void _tty_isr_26() { _tty_isr_indexed(26); } |
---|
| 683 | in_drivers void _tty_isr_27() { _tty_isr_indexed(27); } |
---|
| 684 | in_drivers void _tty_isr_28() { _tty_isr_indexed(28); } |
---|
| 685 | in_drivers void _tty_isr_29() { _tty_isr_indexed(29); } |
---|
| 686 | in_drivers void _tty_isr_30() { _tty_isr_indexed(30); } |
---|
| 687 | in_drivers void _tty_isr_31() { _tty_isr_indexed(31); } |
---|
| 688 | |
---|
| 689 | |
---|
| 690 | ////////////////////////////////////////////////////////////////////////////////////////// |
---|
| 691 | // I/O BLOCK_DEVICE |
---|
| 692 | // The three functions below use the three variables _ioc_lock _ioc_done, |
---|
| 693 | // and _ioc_status for synchronisation. |
---|
| 694 | // - As the IOC component can be used by several programs running in parallel, |
---|
| 695 | // the _ioc_lock variable guaranties exclusive access to the device. |
---|
| 696 | // The _ioc_read() and _ioc_write() functions use atomic LL/SC to get the lock. |
---|
| 697 | // and set _ioc_lock to a non zero value. |
---|
| 698 | // The _ioc_write() and _ioc_read() functions are blocking, polling the _ioc_lock |
---|
| 699 | // variable until the device is available. |
---|
| 700 | // - When the tranfer is completed, the ISR routine activated by the IOC IRQ |
---|
| 701 | // set the _ioc_done variable to a non-zero value. Possible address errors detected |
---|
| 702 | // by the IOC peripheral are reported by the ISR in the _ioc_status variable. |
---|
| 703 | // The _ioc_completed() function is polling the _ioc_done variable, waiting for |
---|
| 704 | // tranfer conpletion. When the completion is signaled, the _ioc_completed() function |
---|
| 705 | // reset the _ioc_done variable to zero, and releases the _ioc_lock variable. |
---|
| 706 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 707 | // This blocking function is used by the _ioc_read() and _ioc_write() functions |
---|
| 708 | // to get _ioc_lock using LL/SC. |
---|
| 709 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 710 | in_drivers void _ioc_get_lock() |
---|
[158] | 711 | { |
---|
[622] | 712 | register unsigned int* plock = (unsigned int*)&_ioc_lock; |
---|
| 713 | |
---|
| 714 | asm volatile ("_ioc_llsc: \n" |
---|
| 715 | "ll $2, 0(%0) \n" // $2 <= _ioc_lock |
---|
| 716 | "bnez $2, _ioc_llsc \n" // retry if busy |
---|
| 717 | "li $3, 1 \n" // prepare argument for sc |
---|
| 718 | "sc $3, 0(%0) \n" // try to set _ioc_busy |
---|
| 719 | "beqz $3, _ioc_llsc \n" // retry if not atomic |
---|
| 720 | ::"r"(plock):"$2","$3"); |
---|
[158] | 721 | } |
---|
[622] | 722 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 723 | // Transfer data from a memory buffer to the block_device. |
---|
| 724 | // - lba : first block index on the disk |
---|
| 725 | // - buffer : base address of the memory buffer |
---|
| 726 | // - count : number of blocks to be transfered |
---|
| 727 | // The source buffer must be in user address space. |
---|
| 728 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 729 | in_drivers void _ioc_write( size_t lba, |
---|
| 730 | void* buffer, |
---|
| 731 | size_t count, |
---|
| 732 | size_t ext ) |
---|
[158] | 733 | { |
---|
[622] | 734 | volatile unsigned int* ioc_address = (unsigned int*)&seg_ioc_base; |
---|
| 735 | |
---|
| 736 | // get the lock |
---|
| 737 | _ioc_get_lock(); |
---|
| 738 | |
---|
| 739 | // block_device configuration |
---|
| 740 | ioc_address[BLOCK_DEVICE_BUFFER] = (unsigned int)buffer; |
---|
| 741 | ioc_address[BLOCK_DEVICE_BUFFER_EXT] = ext; |
---|
| 742 | ioc_address[BLOCK_DEVICE_COUNT] = count; |
---|
| 743 | ioc_address[BLOCK_DEVICE_LBA] = lba; |
---|
| 744 | ioc_address[BLOCK_DEVICE_IRQ_ENABLE] = 1; |
---|
| 745 | ioc_address[BLOCK_DEVICE_OP] = BLOCK_DEVICE_WRITE; |
---|
[158] | 746 | } |
---|
[622] | 747 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 748 | // Transfer data from a file on the block device to a memory buffer. |
---|
| 749 | // - lba : first block index on the disk |
---|
| 750 | // - buffer : base address of the memory buffer |
---|
| 751 | // - count : number of blocks to be transfered |
---|
| 752 | // The destination buffer must be in user address space. |
---|
| 753 | // All cache lines corresponding to the the target buffer must be invalidated |
---|
| 754 | // for cache coherence. |
---|
| 755 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 756 | in_drivers void _ioc_read( size_t lba, |
---|
| 757 | void* buffer, |
---|
| 758 | size_t count, |
---|
| 759 | size_t ext ) |
---|
[158] | 760 | { |
---|
[622] | 761 | volatile unsigned int* ioc_address = (unsigned int*)&seg_ioc_base; |
---|
[158] | 762 | |
---|
[622] | 763 | // get the lock |
---|
| 764 | _ioc_get_lock(); |
---|
| 765 | |
---|
| 766 | // block_device configuration |
---|
| 767 | ioc_address[BLOCK_DEVICE_BUFFER] = (unsigned int)buffer; |
---|
| 768 | ioc_address[BLOCK_DEVICE_BUFFER_EXT] = ext; |
---|
| 769 | ioc_address[BLOCK_DEVICE_COUNT] = count; |
---|
| 770 | ioc_address[BLOCK_DEVICE_LBA] = lba; |
---|
| 771 | ioc_address[BLOCK_DEVICE_IRQ_ENABLE] = 1; |
---|
| 772 | ioc_address[BLOCK_DEVICE_OP] = BLOCK_DEVICE_READ; |
---|
[158] | 773 | } |
---|
[622] | 774 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 775 | // This blocking function cheks completion of an I/O transfer and reports errors. |
---|
| 776 | // It returns 0 if the transfer is successfully completed. |
---|
| 777 | // It returns -1 if an error has been reported. |
---|
| 778 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 779 | in_drivers void _ioc_completed() |
---|
[158] | 780 | { |
---|
[622] | 781 | // waiting for completion |
---|
| 782 | while (_ioc_done == 0) asm volatile("nop"); |
---|
| 783 | |
---|
| 784 | // reset synchronisation variables |
---|
| 785 | _ioc_done = 0; |
---|
| 786 | _ioc_lock = 0; |
---|
| 787 | |
---|
| 788 | if( (_ioc_status != BLOCK_DEVICE_READ_SUCCESS) && |
---|
| 789 | (_ioc_status != BLOCK_DEVICE_WRITE_SUCCESS) ) |
---|
| 790 | { |
---|
| 791 | _tty_get_lock( 0 ); |
---|
| 792 | _tty_puts( "ERROR in _ioc_completed()\n"); |
---|
| 793 | _tty_release_lock( 0 ); |
---|
| 794 | _exit(); |
---|
| 795 | } |
---|
[158] | 796 | } |
---|
[622] | 797 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 798 | // This ISR must be executed when an IRQ is activated by IOC to signal completion. |
---|
| 799 | // It acknowledge the IRQ using the ioc base address, save the status in _ioc_status, |
---|
| 800 | // and set the _ioc_done variable to signal completion. |
---|
| 801 | // This variable is defined in the drivers.c file. |
---|
| 802 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 803 | in_drivers void _ioc_isr() |
---|
[158] | 804 | { |
---|
[622] | 805 | int* ioc_address = (int*)&seg_ioc_base; |
---|
| 806 | |
---|
| 807 | _ioc_status = ioc_address[BLOCK_DEVICE_STATUS]; // save status & reset IRQ |
---|
| 808 | _ioc_done = 1; // signals completion |
---|
[158] | 809 | } |
---|
[622] | 810 | |
---|
| 811 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 812 | // This ISR must be executed when an IRQ is activated by MEMC to signal |
---|
| 813 | // an error detected by the TSAR memory cache after a write transaction. |
---|
| 814 | // It displays an error message on the TTY terminal allocated to the processor |
---|
| 815 | // executing the ISR. |
---|
| 816 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 817 | in_drivers void _mmc_isr() |
---|
[158] | 818 | { |
---|
[622] | 819 | int* mmc_address = (int*)&seg_mmc_base; |
---|
| 820 | unsigned int cluster_xy = _procid() / NB_PROCS_MAX; |
---|
| 821 | |
---|
| 822 | _tty_printf( "WRITE ERROR signaled by Memory Cache in cluster %x\n", cluster_xy ); |
---|
[158] | 823 | } |
---|
[622] | 824 | |
---|
| 825 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 826 | // FRAME_BUFFER |
---|
| 827 | // The _fb_sync_write & _fb_sync_read functions use a memcpy strategy to implement |
---|
| 828 | // the transfer between a data buffer and the frame buffer. |
---|
| 829 | // They are blocking until completion of the transfer. |
---|
| 830 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 831 | // _fb_sync_write() |
---|
| 832 | // Transfer data from an user buffer to the frame_buffer device with a memcpy. |
---|
| 833 | // - offset : offset (in bytes) in the frame buffer |
---|
| 834 | // - buffer : base address of the memory buffer |
---|
| 835 | // - length : number of bytes to be transfered |
---|
| 836 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 837 | in_drivers void _fb_sync_write( size_t offset, |
---|
| 838 | void* buffer, |
---|
| 839 | size_t length, |
---|
| 840 | size_t ext ) |
---|
[158] | 841 | { |
---|
[622] | 842 | volatile char* fb = (char*)(void*)&seg_fbf_base + offset; |
---|
| 843 | char* ub = buffer; |
---|
[158] | 844 | |
---|
[622] | 845 | _memcpy( (void*)fb, (void*)ub, length ); |
---|
[158] | 846 | } |
---|
[622] | 847 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 848 | // _fb_sync_read() |
---|
| 849 | // Transfer data from the frame_buffer device to an user buffer with a memcpy. |
---|
| 850 | // - offset : offset (in bytes) in the frame buffer |
---|
| 851 | // - buffer : base address of the memory buffer |
---|
| 852 | // - length : number of bytes to be transfered |
---|
| 853 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 854 | in_drivers void _fb_sync_read( size_t offset, |
---|
| 855 | void* buffer, |
---|
| 856 | size_t length, |
---|
| 857 | size_t ext ) |
---|
[158] | 858 | { |
---|
[622] | 859 | volatile char* fb = (char*)(void*)&seg_fbf_base + offset; |
---|
| 860 | char* ub = buffer; |
---|
| 861 | |
---|
| 862 | _memcpy( (void*)ub, (void*)fb, length ); |
---|
[158] | 863 | } |
---|
[622] | 864 | |
---|
| 865 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 866 | // Release a software spin-lock |
---|
| 867 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 868 | in_drivers void _release_lock(size_t index) |
---|
| 869 | |
---|
[158] | 870 | { |
---|
[622] | 871 | if( index >= NB_LOCKS ) |
---|
| 872 | { |
---|
| 873 | _tty_get_lock( 0 ); |
---|
| 874 | _tty_puts( "ERROR in _release_lock()" ); |
---|
| 875 | _tty_release_lock( 0 ); |
---|
| 876 | _exit(); |
---|
| 877 | } |
---|
| 878 | |
---|
| 879 | _spin_lock[index] = 0; |
---|
[158] | 880 | } |
---|
[622] | 881 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 882 | // Try to take a software spin-lock. |
---|
| 883 | // This is a blocking call, as there is a busy-waiting loop, |
---|
| 884 | // until the lock is granted to the requester. |
---|
| 885 | // There is an internal delay of about 100 cycles between |
---|
| 886 | // two successive lock read, to avoid bus saturation. |
---|
| 887 | /////////////////////////////////////////////////////////////////////////////////////// |
---|
| 888 | in_drivers void _get_lock(size_t index) |
---|
[158] | 889 | { |
---|
[622] | 890 | if( index >= NB_LOCKS ) |
---|
| 891 | { |
---|
| 892 | _tty_get_lock( 0 ); |
---|
| 893 | _tty_puts( "ERROR in _get_lock()" ); |
---|
| 894 | _tty_release_lock( 0 ); |
---|
| 895 | _exit(); |
---|
| 896 | } |
---|
[158] | 897 | |
---|
[622] | 898 | register int delay = ((_proctime() +_procid()) & 0xF) << 4; |
---|
| 899 | register int * plock = (int *) &_spin_lock[index]; |
---|
[158] | 900 | |
---|
[622] | 901 | asm volatile ("_locks_llsc: \n" |
---|
| 902 | "ll $2, 0(%0) \n" // $2 <= _locks_lock |
---|
| 903 | "bnez $2, _locks_delay \n" // random delay if busy |
---|
| 904 | "li $3, 1 \n" // prepare argument for sc |
---|
| 905 | "sc $3, 0(%0) \n" // try to set _locks_busy |
---|
| 906 | "bnez $3, _locks_ok \n" // exit if atomic |
---|
| 907 | "_locks_delay: \n" |
---|
| 908 | "move $4, %1 \n" // $4 <= delay |
---|
| 909 | "_locks_loop: \n" |
---|
| 910 | "addi $4, $4, -1 \n" // $4 <= $4 - 1 |
---|
| 911 | "beqz $4, _locks_loop \n" // test end delay |
---|
| 912 | "j _locks_llsc \n" // retry |
---|
| 913 | "_locks_ok: \n" |
---|
| 914 | ::"r"(plock),"r"(delay):"$2","$3","$4"); |
---|
[158] | 915 | } |
---|
| 916 | |
---|
[622] | 917 | |
---|
| 918 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 919 | // This function makes a cooperative initialisation of the barrier: |
---|
| 920 | // - barrier_count[index] <= N |
---|
| 921 | // - barrier_lock[index] <= 0 |
---|
| 922 | // All tasks try to initialize the barrier, but the initialisation |
---|
| 923 | // is done by only one task, using LL/SC instructions. |
---|
| 924 | // This cooperative initialisation is questionnable, |
---|
| 925 | // because the barrier can ony be initialised once... |
---|
| 926 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 927 | in_drivers void _barrier_init(unsigned int index, unsigned int value) |
---|
[158] | 928 | { |
---|
| 929 | |
---|
[622] | 930 | register int* pinit = (int*)&_barrier_value[index]; |
---|
| 931 | register int* pcount = (int*)&_barrier_count[index]; |
---|
| 932 | register int* plock = (int*)&_barrier_lock[index]; |
---|
| 933 | |
---|
| 934 | if ( index >= NB_BARRIERS ) |
---|
| 935 | { |
---|
| 936 | _tty_get_lock( 0 ); |
---|
| 937 | _tty_puts( "ERROR in _barrier_init()" ); |
---|
| 938 | _tty_release_lock( 0 ); |
---|
| 939 | _exit(); |
---|
| 940 | } |
---|
| 941 | |
---|
| 942 | // parallel initialisation using atomic instructions LL/SC |
---|
| 943 | asm volatile ("_barrier_init_test: \n" |
---|
| 944 | "ll $2, 0(%0) \n" // read barrier_value |
---|
| 945 | "bnez $2, _barrier_init_done \n" |
---|
| 946 | "move $3, %3 \n" |
---|
| 947 | "sc $3, 0(%0) \n" // try to write barrier_value |
---|
| 948 | "beqz $3, _barrier_init_test \n" |
---|
| 949 | "move $3, %3 \n" |
---|
| 950 | "sw $3, 0(%1) \n" // barrier_count <= barrier_value |
---|
| 951 | "move $3, $0 \n" // |
---|
| 952 | "sw $3, 0(%2) \n" // barrier_lock <= 0 |
---|
| 953 | "_barrier_init_done: \n" |
---|
| 954 | ::"r"(pinit),"r"(pcount),"r"(plock),"r"(value):"$2","$3"); |
---|
[158] | 955 | } |
---|
[622] | 956 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 957 | // This blocking function uses a busy_wait technics (on the barrier_lock value), |
---|
| 958 | // because the GIET does not support dynamic scheduling/descheduling of tasks. |
---|
| 959 | // The barrier state is actually defined by two variables: |
---|
| 960 | // _barrier_count[index] define the number of particpants that are waiting |
---|
| 961 | // _barrier_lock[index] define the bool variable whose value is polled |
---|
| 962 | // The last participant change the value of _barrier_lock[index] to release the barrier... |
---|
| 963 | // There is at most 16 independant barriers, and an error is returned |
---|
| 964 | // if the barrier index is larger than 15. |
---|
| 965 | ////////////////////////////////////////////////////////////////////////////////////// |
---|
| 966 | in_drivers void _barrier_wait(unsigned int index) |
---|
[158] | 967 | { |
---|
[622] | 968 | register int* pcount = (int*)&_barrier_count[index]; |
---|
| 969 | register int count; |
---|
[158] | 970 | |
---|
[622] | 971 | int lock = _barrier_lock[index]; |
---|
| 972 | |
---|
| 973 | if ( index >= NB_BARRIERS ) |
---|
| 974 | { |
---|
| 975 | _tty_get_lock( 0 ); |
---|
| 976 | _tty_puts( "ERROR in _barrier_wait()" ); |
---|
| 977 | _tty_release_lock( 0 ); |
---|
| 978 | _exit(); |
---|
| 979 | } |
---|
| 980 | |
---|
| 981 | // parallel decrement _barrier_count[index] using atomic instructions LL/SC |
---|
| 982 | // input : pointer on _barrier_count[index] |
---|
| 983 | // output : count = _barrier_count[index] (before decrementation) |
---|
| 984 | asm volatile ("_barrier_decrement: \n" |
---|
| 985 | "ll %0, 0(%1) \n" |
---|
| 986 | "addi $3, %0, -1 \n" |
---|
| 987 | "sc $3, 0(%1) \n" |
---|
| 988 | "beqz $3, _barrier_decrement \n" |
---|
| 989 | :"=&r"(count) |
---|
| 990 | :"r"(pcount) |
---|
| 991 | :"$2","$3"); |
---|
| 992 | |
---|
| 993 | // the last task re-initializes the barrier_ count variable |
---|
| 994 | // and the barrier_lock variable, waking up all other waiting tasks |
---|
| 995 | |
---|
| 996 | if ( count == 1 ) // last task |
---|
| 997 | { |
---|
| 998 | _barrier_count[index] = _barrier_value[index]; |
---|
| 999 | asm volatile( "sync" ); |
---|
| 1000 | _barrier_lock[index] = (lock == 0) ? 1 : 0; |
---|
| 1001 | } |
---|
| 1002 | else // other tasks |
---|
| 1003 | { |
---|
| 1004 | while ( lock == _barrier_lock[index] ) asm volatile("nop"); |
---|
| 1005 | } |
---|
| 1006 | } |
---|
| 1007 | |
---|
| 1008 | |
---|
[158] | 1009 | // Local Variables: |
---|
| 1010 | // tab-width: 4; |
---|
| 1011 | // c-basic-offset: 4; |
---|
| 1012 | // c-file-offsets:((innamespace . 0)(inline-open . 0)); |
---|
| 1013 | // indent-tabs-mode: nil; |
---|
| 1014 | // End: |
---|
| 1015 | // |
---|
| 1016 | // vim: filetype=cpp:expandtab:shiftwidth=4:tabstop=4:softtabstop=4 |
---|
| 1017 | |
---|