2012-04-05 06:22:01 +04:00
/*
* Copyright ( c ) 2012 Mike Frysinger < vapier @ gentoo . org >
*
* Redistribution and use in source and binary forms , with or without
* modification , are permitted provided that the following conditions
* are met :
* 1. Redistributions of source code must retain the above copyright
* notice , this list of conditions and the following disclaimer .
* 2. Redistributions in binary form must reproduce the above copyright
* notice , this list of conditions and the following disclaimer in the
* documentation and / or other materials provided with the distribution .
* 3. The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission .
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ` ` AS IS ' ' AND ANY EXPRESS OR
* IMPLIED WARRANTIES , INCLUDING , BUT NOT LIMITED TO , THE IMPLIED WARRANTIES
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED .
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT , INDIRECT ,
* INCIDENTAL , SPECIAL , EXEMPLARY , OR CONSEQUENTIAL DAMAGES ( INCLUDING , BUT
* NOT LIMITED TO , PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES ; LOSS OF USE ,
* DATA , OR PROFITS ; OR BUSINESS INTERRUPTION ) HOWEVER CAUSED AND ON ANY
* THEORY OF LIABILITY , WHETHER IN CONTRACT , STRICT LIABILITY , OR TORT
* ( INCLUDING NEGLIGENCE OR OTHERWISE ) ARISING IN ANY WAY OUT OF THE USE OF
* THIS SOFTWARE , EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE .
*/
# include "defs.h"
2016-05-28 21:46:39 +03:00
# include DEF_MPERS_TYPE(struct_mtd_oob_buf)
2015-07-07 04:12:12 +03:00
# include <linux/ioctl.h>
2012-04-05 06:22:01 +04:00
/* The mtd api changes quickly, so we have to keep a local copy */
# include <linux/version.h>
# if LINUX_VERSION_CODE < KERNEL_VERSION(3, 3, 0)
# include "mtd-abi.h"
# else
# include <mtd / mtd-abi.h>
# endif
2016-05-28 21:46:39 +03:00
typedef struct mtd_oob_buf struct_mtd_oob_buf ;
# include MPERS_DEFS
2014-04-26 03:30:54 +04:00
# include "xlat/mtd_mode_options.h"
2015-07-07 04:12:12 +03:00
# include "xlat/mtd_file_mode_options.h"
2014-04-26 03:30:54 +04:00
# include "xlat/mtd_type_options.h"
# include "xlat/mtd_flags_options.h"
# include "xlat/mtd_otp_options.h"
# include "xlat/mtd_nandecc_options.h"
2012-04-05 06:22:01 +04:00
2016-05-28 21:42:50 +03:00
static void
decode_erase_info_user ( struct tcb * tcp , const long addr )
2012-04-05 06:22:01 +04:00
{
2016-05-28 21:42:50 +03:00
struct erase_info_user einfo ;
2012-04-05 06:22:01 +04:00
2016-05-28 21:42:50 +03:00
tprints ( " , " ) ;
if ( umove_or_printaddr ( tcp , addr , & einfo ) )
return ;
2015-07-07 04:12:12 +03:00
2016-05-28 21:42:50 +03:00
tprintf ( " {start=%#x, length=%#x} " , einfo . start , einfo . length ) ;
}
2012-04-05 06:22:01 +04:00
2016-05-28 21:42:50 +03:00
static void
decode_erase_info_user64 ( struct tcb * tcp , const long addr )
{
struct erase_info_user64 einfo64 ;
2012-04-05 06:22:01 +04:00
2016-05-28 21:42:50 +03:00
tprints ( " , " ) ;
if ( umove_or_printaddr ( tcp , addr , & einfo64 ) )
return ;
2012-04-05 06:22:01 +04:00
2016-05-28 21:42:50 +03:00
tprintf ( " {start=%# " PRIx64 " , length=%# " PRIx64 " } " ,
( uint64_t ) einfo64 . start , ( uint64_t ) einfo64 . length ) ;
}
2015-07-07 04:12:12 +03:00
2016-05-28 21:42:50 +03:00
static void
decode_mtd_oob_buf ( struct tcb * tcp , const long addr )
{
2016-05-28 21:46:39 +03:00
struct_mtd_oob_buf mbuf ;
2012-04-05 06:22:01 +04:00
2016-05-28 21:42:50 +03:00
tprints ( " , " ) ;
if ( umove_or_printaddr ( tcp , addr , & mbuf ) )
return ;
2015-07-07 04:12:12 +03:00
2016-06-11 04:28:21 +03:00
tprintf ( " {start=%#x, length=%#x, ptr= " , mbuf . start , mbuf . length ) ;
printaddr ( ( unsigned long ) mbuf . ptr ) ;
tprints ( " } " ) ;
2016-05-28 21:42:50 +03:00
}
2012-04-05 06:22:01 +04:00
2016-05-28 21:42:50 +03:00
static void
decode_mtd_oob_buf64 ( struct tcb * tcp , const long addr )
{
struct mtd_oob_buf64 mbuf64 ;
2012-04-05 06:22:01 +04:00
2016-05-28 21:42:50 +03:00
tprints ( " , " ) ;
if ( umove_or_printaddr ( tcp , addr , & mbuf64 ) )
return ;
2012-04-05 06:22:01 +04:00
2016-05-28 21:42:50 +03:00
tprintf ( " {start=%# " PRIx64 " , length=%#x, usr_ptr=%# " PRIx64 " } " ,
( uint64_t ) mbuf64 . start , mbuf64 . length ,
( uint64_t ) mbuf64 . usr_ptr ) ;
}
2015-07-07 04:12:12 +03:00
2016-05-28 21:42:50 +03:00
static void
decode_otp_info ( struct tcb * tcp , const long addr )
{
struct otp_info oinfo ;
tprints ( " , " ) ;
if ( umove_or_printaddr ( tcp , addr , & oinfo ) )
return ;
tprintf ( " {start=%#x, length=%#x, locked=%u} " ,
oinfo . start , oinfo . length , oinfo . locked ) ;
}
static void
decode_otp_select ( struct tcb * tcp , const long addr )
{
unsigned int i ;
tprints ( " , " ) ;
if ( umove_or_printaddr ( tcp , addr , & i ) )
return ;
tprints ( " [ " ) ;
printxval ( mtd_otp_options , i , " MTD_OTP_??? " ) ;
tprints ( " ] " ) ;
}
static void
decode_mtd_write_req ( struct tcb * tcp , const long addr )
{
struct mtd_write_req mreq ;
tprints ( " , " ) ;
if ( umove_or_printaddr ( tcp , addr , & mreq ) )
return ;
tprintf ( " {start=%# " PRIx64 " , len=%# " PRIx64
" , ooblen=%# " PRIx64 " , usr_data=%# " PRIx64
" , usr_oob=%# " PRIx64 " , mode= " ,
( uint64_t ) mreq . start , ( uint64_t ) mreq . len ,
( uint64_t ) mreq . ooblen , ( uint64_t ) mreq . usr_data ,
( uint64_t ) mreq . usr_oob ) ;
printxval ( mtd_mode_options , mreq . mode , " MTD_OPS_??? " ) ;
tprints ( " } " ) ;
}
static void
decode_mtd_info_user ( struct tcb * tcp , const long addr )
{
struct mtd_info_user minfo ;
tprints ( " , " ) ;
if ( umove_or_printaddr ( tcp , addr , & minfo ) )
return ;
tprints ( " {type= " ) ;
printxval ( mtd_type_options , minfo . type , " MTD_??? " ) ;
tprints ( " , flags= " ) ;
printflags ( mtd_flags_options , minfo . flags , " MTD_??? " ) ;
tprintf ( " , size=%#x, erasesize=%#x, writesize=%#x, oobsize=%#x "
" , padding=%# " PRIx64 " } " ,
minfo . size , minfo . erasesize , minfo . writesize , minfo . oobsize ,
( uint64_t ) minfo . padding ) ;
}
static void
decode_nand_oobinfo ( struct tcb * tcp , const long addr )
{
struct nand_oobinfo ninfo ;
unsigned int i , j ;
tprints ( " , " ) ;
if ( umove_or_printaddr ( tcp , addr , & ninfo ) )
return ;
tprints ( " {useecc= " ) ;
printxval ( mtd_nandecc_options , ninfo . useecc , " MTD_NANDECC_??? " ) ;
tprintf ( " , eccbytes=%#x " , ninfo . eccbytes ) ;
tprints ( " , oobfree={ " ) ;
for ( i = 0 ; i < ARRAY_SIZE ( ninfo . oobfree ) ; + + i ) {
if ( i )
tprints ( " }, " ) ;
tprints ( " { " ) ;
for ( j = 0 ; j < ARRAY_SIZE ( ninfo . oobfree [ 0 ] ) ; + + j ) {
if ( j )
tprints ( " , " ) ;
tprintf ( " %#x " , ninfo . oobfree [ i ] [ j ] ) ;
}
2015-07-07 04:12:12 +03:00
}
2016-05-28 21:42:50 +03:00
tprints ( " }}, eccpos={ " ) ;
for ( i = 0 ; i < ARRAY_SIZE ( ninfo . eccpos ) ; + + i ) {
if ( i )
tprints ( " , " ) ;
tprintf ( " %#x " , ninfo . eccpos [ i ] ) ;
}
2015-07-07 04:12:12 +03:00
2016-05-28 21:42:50 +03:00
tprints ( " } " ) ;
}
static void
decode_nand_ecclayout_user ( struct tcb * tcp , const long addr )
{
struct nand_ecclayout_user nlay ;
unsigned int i ;
tprints ( " , " ) ;
if ( umove_or_printaddr ( tcp , addr , & nlay ) )
return ;
tprintf ( " {eccbytes=%#x, eccpos={ " , nlay . eccbytes ) ;
for ( i = 0 ; i < ARRAY_SIZE ( nlay . eccpos ) ; + + i ) {
if ( i )
2015-07-07 04:12:12 +03:00
tprints ( " , " ) ;
2016-05-28 21:42:50 +03:00
tprintf ( " %#x " , nlay . eccpos [ i ] ) ;
2015-07-07 04:12:12 +03:00
}
2016-05-28 21:42:50 +03:00
tprintf ( " }, oobavail=%#x, oobfree={ " , nlay . oobavail ) ;
for ( i = 0 ; i < ARRAY_SIZE ( nlay . oobfree ) ; + + i ) {
if ( i )
tprints ( " , " ) ;
tprintf ( " {offset=%#x, length=%#x} " ,
nlay . oobfree [ i ] . offset , nlay . oobfree [ i ] . length ) ;
}
tprints ( " } " ) ;
}
2015-07-07 04:12:12 +03:00
2016-05-28 21:42:50 +03:00
static void
decode_mtd_ecc_stats ( struct tcb * tcp , const long addr )
{
struct mtd_ecc_stats es ;
2015-07-07 04:12:12 +03:00
2016-05-28 21:42:50 +03:00
tprints ( " , " ) ;
if ( umove_or_printaddr ( tcp , addr , & es ) )
return ;
2015-07-07 04:12:12 +03:00
2016-05-28 21:42:50 +03:00
tprintf ( " {corrected=%#x, failed=%#x, badblocks=%#x, bbtblocks=%#x} " ,
es . corrected , es . failed , es . badblocks , es . bbtblocks ) ;
}
2016-05-28 21:46:39 +03:00
MPERS_PRINTER_DECL ( int , mtd_ioctl , struct tcb * tcp ,
const unsigned int code , const long arg )
2016-05-28 21:42:50 +03:00
{
switch ( code ) {
case MEMERASE :
case MEMLOCK :
case MEMUNLOCK :
case MEMISLOCKED :
decode_erase_info_user ( tcp , arg ) ;
2015-07-07 04:12:12 +03:00
break ;
2016-05-28 21:42:50 +03:00
case MEMERASE64 :
decode_erase_info_user64 ( tcp , arg ) ;
break ;
2012-04-05 06:22:01 +04:00
2016-05-28 21:42:50 +03:00
case MEMWRITEOOB :
case MEMREADOOB :
decode_mtd_oob_buf ( tcp , arg ) ;
break ;
2015-07-07 04:12:12 +03:00
2016-05-28 21:42:50 +03:00
case MEMWRITEOOB64 :
case MEMREADOOB64 :
decode_mtd_oob_buf64 ( tcp , arg ) ;
2015-07-07 04:12:12 +03:00
break ;
2016-05-28 21:42:50 +03:00
case MEMWRITE :
decode_mtd_write_req ( tcp , arg ) ;
break ;
2015-07-07 04:12:12 +03:00
2016-05-28 21:42:50 +03:00
case OTPGETREGIONINFO :
if ( entering ( tcp ) )
return 0 ;
/* fall through */
case OTPLOCK :
decode_otp_info ( tcp , arg ) ;
break ;
2015-07-07 04:12:12 +03:00
2016-05-28 21:42:50 +03:00
case OTPSELECT :
decode_otp_select ( tcp , arg ) ;
2015-07-07 04:12:12 +03:00
break ;
case MTDFILEMODE :
tprints ( " , " ) ;
2016-05-17 02:06:17 +03:00
printxval_long ( mtd_file_mode_options , arg , " MTD_FILE_MODE_??? " ) ;
2015-07-07 04:12:12 +03:00
break ;
case MEMGETBADBLOCK :
case MEMSETBADBLOCK :
tprints ( " , " ) ;
2015-07-20 14:14:12 +03:00
printnum_int64 ( tcp , arg , " % " PRIu64 ) ;
2015-07-07 04:12:12 +03:00
break ;
2016-05-28 21:42:50 +03:00
case MEMGETINFO :
2015-07-07 04:12:12 +03:00
if ( entering ( tcp ) )
2012-04-05 06:22:01 +04:00
return 0 ;
2016-05-28 21:42:50 +03:00
decode_mtd_info_user ( tcp , arg ) ;
2015-07-07 04:12:12 +03:00
break ;
2012-04-05 06:22:01 +04:00
2016-05-28 21:42:50 +03:00
case MEMGETOOBSEL :
2015-07-07 04:12:12 +03:00
if ( entering ( tcp ) )
2012-04-05 06:22:01 +04:00
return 0 ;
2016-05-28 21:42:50 +03:00
decode_nand_oobinfo ( tcp , arg ) ;
2015-07-07 04:12:12 +03:00
break ;
2016-05-28 21:42:50 +03:00
case ECCGETLAYOUT :
2015-07-07 04:12:12 +03:00
if ( entering ( tcp ) )
2012-04-05 06:22:01 +04:00
return 0 ;
2016-05-28 21:42:50 +03:00
decode_nand_ecclayout_user ( tcp , arg ) ;
2015-07-07 04:12:12 +03:00
break ;
2012-04-05 06:22:01 +04:00
2016-05-28 21:42:50 +03:00
case ECCGETSTATS :
2015-07-07 04:12:12 +03:00
if ( entering ( tcp ) )
2012-04-05 06:22:01 +04:00
return 0 ;
2016-05-28 21:42:50 +03:00
decode_mtd_ecc_stats ( tcp , arg ) ;
2015-07-07 04:12:12 +03:00
break ;
2012-04-05 06:22:01 +04:00
2015-07-07 04:12:12 +03:00
case OTPGETREGIONCOUNT :
if ( entering ( tcp ) )
2012-04-05 06:22:01 +04:00
return 0 ;
tprints ( " , " ) ;
2015-07-07 04:12:12 +03:00
printnum_int ( tcp , arg , " %u " ) ;
break ;
2012-04-05 06:22:01 +04:00
2015-07-07 04:12:12 +03:00
case MEMGETREGIONCOUNT :
if ( entering ( tcp ) )
2012-04-05 06:22:01 +04:00
return 0 ;
2015-07-07 04:12:12 +03:00
tprints ( " , " ) ;
printnum_int ( tcp , arg , " %d " ) ;
break ;
2012-04-05 06:22:01 +04:00
2016-05-28 21:42:50 +03:00
case MEMGETREGIONINFO :
if ( entering ( tcp ) ) {
struct region_info_user rinfo ;
tprints ( " , " ) ;
if ( umove_or_printaddr ( tcp , arg , & rinfo ) )
break ;
tprintf ( " {regionindex=%#x " , rinfo . regionindex ) ;
return 0 ;
} else {
struct region_info_user rinfo ;
if ( ! syserror ( tcp ) & & ! umove ( tcp , arg , & rinfo ) )
tprintf ( " , offset=%#x "
" , erasesize=%#x "
" , numblocks=%#x} " ,
rinfo . offset ,
rinfo . erasesize ,
rinfo . numblocks ) ;
tprints ( " } " ) ;
break ;
}
2012-04-05 06:22:01 +04:00
default :
2015-07-07 04:12:12 +03:00
return RVAL_DECODED ;
2012-04-05 06:22:01 +04:00
}
2015-07-07 04:12:12 +03:00
return RVAL_DECODED | 1 ;
2012-04-05 06:22:01 +04:00
}