/*
|
* (C) Copyright 2007-2013
|
* Allwinner Technology Co., Ltd. <www.allwinnertech.com>
|
* Char <yanjianbo@allwinnertech.com>
|
*
|
* See file CREDITS for list of people who contributed to this
|
* project.
|
*
|
* This program is free software; you can redistribute it and/or
|
* modify it under the terms of the GNU General Public License as
|
* published by the Free Software Foundation; either version 2 of
|
* the License, or (at your option) any later version.
|
*
|
* This program is distributed in the hope that it will be useful,
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
* GNU General Public License for more details.
|
*
|
* You should have received a copy of the GNU General Public License
|
* along with this program; if not, write to the Free Software
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
* MA 02111-1307 USA
|
*/
|
|
#include <stdio.h>
|
#include <stdlib.h>
|
#include <sys/ioctl.h>
|
#include <sys/types.h>
|
#include <sys/stat.h>
|
#include <fcntl.h>
|
#include <errno.h>
|
#include <utils/Log.h>
|
#include <pthread.h>
|
#include <string.h>
|
#include "secure_storage_ioctl.h"
|
|
#undef LOG_TAG
|
#define LOG_TAG "sst_storage"
|
#define MAX_SECURE_STORAGE_MAX_ITEM (32)
|
#define SDMMC_SECTOR_SIZE (512)
|
#define SDMMC_SECURE_STORAGE_START_ADD (6*1024*1024/512)//6M
|
#define SDMMC_ITEM_SIZE (4*1024/512)//4K
|
|
/*nand secure storage read/write*/
|
int _nand_read_ioctl(int id, unsigned char *buf, ssize_t len)
|
{
|
int fd;
|
int ret;
|
struct sst_storage_data *secblk_op;
|
|
if(!buf){
|
ALOGE("-buf NULL\n");
|
return -1;
|
}
|
if(id > MAX_SECURE_STORAGE_MAX_ITEM){
|
ALOGE("out of range id %x\n", id);
|
return -1;
|
}
|
fd = open(OEM_PATH, O_RDONLY);
|
if (fd < 0)
|
{
|
ALOGE("Failed to open %s: %s", OEM_PATH, strerror(errno));
|
return -1;
|
}
|
|
secblk_op = (struct sst_storage_data *)malloc(sizeof(*secblk_op));
|
if(!secblk_op){
|
ALOGE("Out of memory\n");
|
close(fd);
|
return -1 ;
|
}
|
|
secblk_op->id = id ;
|
secblk_op->buf = (uint32_t)buf;
|
secblk_op->len = len ;
|
secblk_op->offset = 0;
|
|
ret = ioctl(fd, SST_STORAGE_READ, secblk_op);
|
if( ret <0 ){
|
ALOGE("Nand secblk read fail: ret=%d %s\n",ret, strerror(errno));
|
free(secblk_op);
|
close(fd);
|
return -1 ;
|
}
|
fsync(fd);
|
free(secblk_op);
|
close(fd);
|
return 0;
|
}
|
|
|
int _nand_write_ioctl( int id, unsigned char *buf, ssize_t len)
|
{
|
int fd;
|
int ret;
|
struct sst_storage_data *secblk_op;
|
|
if(!buf){
|
ALOGE("- buf NULL\n");
|
return (-1);
|
}
|
|
if(id > MAX_SECURE_STORAGE_MAX_ITEM){
|
ALOGE("out of range id %x\n", id);
|
return (-1);
|
}
|
|
fd = open(OEM_PATH, O_RDONLY);
|
if (fd < 0)
|
{
|
ALOGE("Failed to open %s: %s", OEM_PATH, strerror(errno));
|
return -1;
|
}
|
|
secblk_op = (struct sst_storage_data *)malloc(sizeof(*secblk_op));
|
if(!secblk_op){
|
ALOGE("Out of memory\n");
|
close(fd);
|
return -1 ;
|
}
|
|
secblk_op->id = id ;
|
secblk_op->buf =(uint32_t)buf;
|
secblk_op->len = len ;
|
secblk_op->offset = 0 ;
|
|
ret = ioctl(fd, SST_STORAGE_WRITE, secblk_op);
|
if (ret < 0){
|
ALOGE("Nand secblk write fail: ret=%d %s\n", ret, strerror(errno));
|
free(secblk_op);
|
close(fd);
|
return -1 ;
|
}
|
fsync(fd);
|
free(secblk_op);
|
close(fd);
|
return 0;
|
}
|
|
/*emmc secure storage read/write*/
|
int _sd_read_ioctl(int id, unsigned char *buf, ssize_t len)
|
{
|
int offset, ret;
|
int fd;
|
struct sst_storage_data *secblk_op;
|
|
if (!buf){
|
ALOGE("-buf NULL\n");
|
return -1;
|
}
|
|
if (id > MAX_SECURE_STORAGE_MAX_ITEM){
|
ALOGE("out of range id %x\n", id);
|
return (-1);
|
}
|
|
fd = open(OEM_PATH, O_RDONLY);
|
if (fd < 0)
|
{
|
ALOGE("Failed to open %s: %s", OEM_PATH, strerror(errno));
|
return -1;
|
}
|
|
secblk_op =(struct sst_storage_data *)malloc(sizeof(*secblk_op));
|
if (!secblk_op){
|
ALOGE("Out of memory\n");
|
close(fd);
|
return -1 ;
|
}
|
|
/* raw */
|
offset = (SDMMC_SECURE_STORAGE_START_ADD+SDMMC_ITEM_SIZE*2*id) *SDMMC_SECTOR_SIZE;
|
|
secblk_op->id = id;
|
secblk_op->buf = (uint32_t)buf;
|
secblk_op->len = len;
|
secblk_op->offset = offset;
|
|
ret = ioctl(fd, SST_STORAGE_READ, secblk_op);
|
if (ret < 0){
|
ALOGE("sd secblk read fail\n");
|
free(secblk_op);
|
close(fd);
|
return -1 ;
|
}
|
|
fsync(fd);
|
free(secblk_op);
|
close(fd);
|
return 0;
|
}
|
|
/*emmc secure storage backup item read*/
|
int _sd_read_backup_ioctl(int id, unsigned char *buf, ssize_t len)
|
{
|
int offset, ret;
|
int fd;
|
struct sst_storage_data *secblk_op;
|
|
if (!buf){
|
ALOGE("-buf NULL\n");
|
return -1;
|
}
|
|
if (id > MAX_SECURE_STORAGE_MAX_ITEM){
|
ALOGE("out of range id %x\n", id);
|
return (-1);
|
}
|
|
fd = open(OEM_PATH, O_RDONLY);
|
if (fd < 0)
|
{
|
ALOGE("Failed to open %s: %s", OEM_PATH, strerror(errno));
|
return -1;
|
}
|
|
secblk_op = (struct sst_storage_data *)malloc(sizeof(*secblk_op));
|
if (!secblk_op){
|
ALOGE("Out of memory\n");
|
close(fd);
|
return -1 ;
|
}
|
|
/*backup */
|
offset = (SDMMC_SECURE_STORAGE_START_ADD+SDMMC_ITEM_SIZE*2*id
|
+ SDMMC_ITEM_SIZE )*SDMMC_SECTOR_SIZE;
|
|
secblk_op->id = id;
|
secblk_op->buf = (uint32_t)buf;
|
secblk_op->len = len;
|
secblk_op->offset = offset;
|
|
ret = ioctl(fd, SST_STORAGE_READ, secblk_op);
|
if(ret < 0){
|
ALOGE("sd secblk read fail\n");
|
free(secblk_op);
|
close(fd);
|
return -1 ;
|
}
|
|
fsync(fd);
|
free(secblk_op);
|
close(fd);
|
return 0;
|
}
|
|
int _sd_write_ioctl( int id, unsigned char *buf, ssize_t len)
|
{
|
int offset, ret;
|
int fd;
|
struct sst_storage_data *secblk_op;
|
|
if (!buf){
|
ALOGE("-buf NULL\n");
|
return -1;
|
}
|
|
if (id > MAX_SECURE_STORAGE_MAX_ITEM){
|
ALOGE("out of range id %x\n", id);
|
return (-1);
|
}
|
|
fd = open(OEM_PATH, O_RDONLY);
|
if (fd < 0)
|
{
|
ALOGE("Failed to open %s: %s", OEM_PATH, strerror(errno));
|
return -1;
|
}
|
|
secblk_op = (struct sst_storage_data *)malloc(sizeof(*secblk_op));
|
if (!secblk_op){
|
ALOGE("Out of memory\n");
|
close(fd);
|
return -1 ;
|
}
|
|
offset = (SDMMC_SECURE_STORAGE_START_ADD+SDMMC_ITEM_SIZE*2*id)*SDMMC_SECTOR_SIZE;
|
secblk_op->id = id;
|
secblk_op->buf = (uint32_t)buf;
|
secblk_op->len = len;
|
secblk_op->offset = offset;
|
|
//ALOGD("size of struct sst_storage_data %d\n", sizeof(struct sst_storage_data));
|
ret = ioctl(fd, SST_STORAGE_WRITE, secblk_op);
|
if (ret < 0){
|
ALOGE("sd ioctl read fail\n");
|
free(secblk_op);
|
close(fd);
|
return -1 ;
|
}
|
|
/*backup */
|
offset = (SDMMC_SECURE_STORAGE_START_ADD+SDMMC_ITEM_SIZE*2*id
|
+ SDMMC_ITEM_SIZE )*SDMMC_SECTOR_SIZE;
|
secblk_op->id = id;
|
secblk_op->buf = (uint32_t)buf;
|
secblk_op->len = len;
|
secblk_op->offset = offset;
|
ret = ioctl(fd, SST_STORAGE_WRITE, secblk_op);
|
if (ret < 0){
|
ALOGE("sd ioctl read fail\n");
|
free(secblk_op);
|
close(fd);
|
return -1 ;
|
}
|
|
fsync(fd);
|
free(secblk_op);
|
close(fd);
|
return 0;
|
}
|
