source: trunk/hal/tsar_mips32/drivers/soclib_fbf.c @ 654

Last change on this file since 654 was 654, checked in by alain, 2 years ago

euh...

File size: 4.9 KB
Line 
1/*
2 * soclib_fbf.c - soclib frame-buffer driver implementation.
3 *
4 * Author Alain greiner (2016,2017,2018,2019)
5 *
6 * Copyright (c) UPMC Sorbonne Universites
7 *
8 * This file is part of ALMOS-MKH..
9 *
10 * ALMOS-MKH. is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; version 2.0 of the License.
13 *
14 * ALMOS-MKH. is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
17 * General Public License for more details.
18 *
19 * You should have received a copy of the GNU General Public License
20 * along with ALMOS-MKH.; if not, write to the Free Software Foundation,
21 * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
22 */
23
24#include <soclib_fbf.h>
25#include <hal_kernel_types.h>
26#include <hal_uspace.h>
27#include <chdev.h>
28#include <dev_fbf.h>
29#include <printk.h>
30#include <thread.h>
31
32///////////////////////////////////////
33void soclib_fbf_init( chdev_t * chdev )
34{
35    // set driver specific fields in FBF chdev
36    chdev->cmd = &soclib_fbf_cmd;
37    chdev->isr = NULL;
38
39    // get extended pointer on SOCLIB_FBF peripheral segment base
40        xptr_t  base_xp = chdev->base;
41
42    // get cluster and local pointer for the SOCLIB_FBF peripheral segment
43    cxy_t      base_cxy  = GET_CXY( base_xp );
44    uint32_t * base_ptr  = GET_PTR( base_xp );
45
46    // get frame buffer width, height, and type 
47        uint32_t width  = hal_remote_l32( XPTR( base_cxy , base_ptr + FBF_WIDTH_REG ) );
48        uint32_t height = hal_remote_l32( XPTR( base_cxy , base_ptr + FBF_HEIGHT_REG ) );
49    uint32_t type   = hal_remote_l32( XPTR( base_cxy , base_ptr + FBF_SUBSAMPLING_REG ) );
50
51    // set FBF chdev extension fields
52    chdev->ext.fbf.width       = width;
53    chdev->ext.fbf.height      = height;
54    chdev->ext.fbf.subsampling = type;
55
56}  // end soclib_fbf_init()
57
58/////////////////////////////////////////////////////////////////
59void __attribute__((noinline)) soclib_fbf_cmd( xptr_t thread_xp )
60{
61    uint32_t   cmd_type;    // READ / WRITE / SYNC_READ / SYNC_WRITE
62    uint32_t   offset;
63    uint32_t   length;
64    void     * buffer;      // pointer on memory buffer in user space
65    xptr_t     fbf_xp;
66    uint32_t   status;      // I/0 operation status (from BDV)
67
68    // get client thread cluster and local pointer
69    cxy_t      th_cxy = GET_CXY( thread_xp );
70    thread_t * th_ptr = GET_PTR( thread_xp );
71
72#if (DEBUG_HAL_FBF|| DEBUG_HAL_FBF)
73uint32_t    cycle        = (uint32_t)hal_get_cycles();
74process_t * process      = hal_remote_lpt( XPTR( th_cxy , &th_ptr->process ) );
75pid_t       client_pid   = hal_remote_l32( XPTR( th_cxy , &process->pid ) );
76trdid_t     client_trdid = hal_remote_l32( XPTR( th_cxy , &th_ptr->trdid ) );
77#endif
78
79    // get command arguments
80    cmd_type =         hal_remote_l32( XPTR( th_cxy , &th_ptr->fbf_cmd.type   ) );
81    offset   =         hal_remote_l32( XPTR( th_cxy , &th_ptr->fbf_cmd.offset ) );
82    length   =         hal_remote_l32( XPTR( th_cxy , &th_ptr->fbf_cmd.length ) );
83    buffer   =         hal_remote_lpt( XPTR( th_cxy , &th_ptr->fbf_cmd.buffer ) );
84    fbf_xp   = (xptr_t)hal_remote_l64( XPTR( th_cxy , &th_ptr->fbf_cmd.dev_xp ) );
85
86    // get cluster and local pointer on FBF chdev
87    cxy_t     fbf_cxy = GET_CXY( fbf_xp );
88    chdev_t * fbf_ptr = GET_PTR( fbf_xp );
89
90    // get extended pointer on SOCLIB_FBF peripheral segment base
91        xptr_t  base_xp = (xptr_t)hal_remote_l64( XPTR( fbf_cxy , &fbf_ptr->base ) );
92
93    // execute command
94    if( cmd_type == FBF_READ )     // use a (kernel -> user) memcpy
95    {
96
97#if DEBUG_HAL_FBF
98if( DEBUG_HAL_FBF < cycle )
99printk("\n[%s] client thread[%x,%x] / READ / offset %d / length %d / buffer %x / fbf (%x,%x)\n",
100__FUNCTION__ , client_pid, client_trdid,
101offset, length, buffer, GET_CXY(base_xp), GET_PTR(base_xp) );
102#endif
103        hal_copy_to_uspace( buffer,
104                            base_xp + offset,
105                            length );
106#if DEBUG_HAL_FBF
107if( DEBUG_HAL_FBF < cycle )
108printk("\n[%s] client thread[%x,%x] / READ successful / cycle %d\n",
109__FUNCTION__ , client_pid, client_trdid , cycle );
110#endif
111
112    }
113    else  // cmd_type == FBF_WRITE => use a (user -> kernel)  memcpy
114    {
115
116#if DEBUG_HAL_FBF
117if( DEBUG_HAL_FBF < cycle )
118printk("\n[%s] client thread[%x,%x] / WRITE / offset %d / length %d / buffer %x / fbf (%x,%x)\n",
119__FUNCTION__ , client_pid, client_trdid, 
120offset, length, buffer, GET_CXY(base_xp), GET_PTR(base_xp) );
121#endif
122        hal_copy_from_uspace( base_xp + offset,
123                              buffer,
124                              length );
125#if DEBUG_HAL_FBF
126if( DEBUG_HAL_FBF < cycle )
127printk("\n[%s] client thread[%x,%x] / WRITE successful / cycle %d\n",
128__FUNCTION__ , client_pid, client_trdid , cycle );
129#endif
130
131    }
132
133    // set success in command
134    hal_remote_s32( XPTR( th_cxy , &th_ptr->fbf_cmd.error ) , 0 );
135           
136}  // end soclib_fbf_cmd()
137
Note: See TracBrowser for help on using the repository browser.