410 lines
12 KiB
C
Executable File
410 lines
12 KiB
C
Executable File
/* arch/arm/mach-exynos/cal_bts.c
|
|
*
|
|
* Copyright (c) 2014 Samsung Electronics Co., Ltd.
|
|
* http://www.samsung.com/
|
|
*
|
|
* EXYNOS - BTS CAL code.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*/
|
|
|
|
#include "cal_bts8890.h"
|
|
|
|
void bts_setqos(addr_u32 base, unsigned int priority, unsigned int master_id) //QOS : [RRRRWWWW]
|
|
{
|
|
Outp32(base + BTS_RCON, 0x0);
|
|
Outp32(base + BTS_RCON, 0x0);
|
|
Outp32(base + BTS_WCON, 0x0);
|
|
Outp32(base + BTS_WCON, 0x0);
|
|
|
|
Outp32(base + BTS_PRIORITY, ((priority >> 16) & 0xFFFF));
|
|
Outp32(base + BTS_TOKENMAX, 0xFFDF);
|
|
Outp32(base + BTS_BWUPBOUND, 0x18);
|
|
Outp32(base + BTS_BWLOBOUND, 0x1);
|
|
Outp32(base + BTS_INITTKN, 0x8);
|
|
|
|
Outp32(base + BTS_PRIORITY + WOFFSET, (priority & 0xFFFF));
|
|
Outp32(base + BTS_TOKENMAX + WOFFSET, 0xFFDF);
|
|
Outp32(base + BTS_BWUPBOUND + WOFFSET, 0x18);
|
|
Outp32(base + BTS_BWLOBOUND + WOFFSET, 0x1);
|
|
Outp32(base + BTS_INITTKN + WOFFSET, 0x8);
|
|
|
|
Outp32(base + BTS_EMERGENTRID, master_id);
|
|
Outp32(base + BTS_EMERGENTWID, master_id);
|
|
Outp32(base + BTS_RCON, 0x1);
|
|
Outp32(base + BTS_WCON, 0x1);
|
|
}
|
|
|
|
void bts_setqos_bw(addr_u32 base, unsigned int priority,
|
|
unsigned int window, unsigned int token, unsigned int master_id) //QOS : [RRRRWWWW]
|
|
{
|
|
Outp32(base + BTS_RCON, 0x0);
|
|
Outp32(base + BTS_RCON, 0x0);
|
|
Outp32(base + BTS_WCON, 0x0);
|
|
Outp32(base + BTS_WCON, 0x0);
|
|
|
|
Outp32(base + BTS_PRIORITY, ((priority >> 16) & 0xFFFF));
|
|
Outp32(base + BTS_TOKENMAX, 0xFFDF);
|
|
Outp32(base + BTS_BWUPBOUND, 0x18);
|
|
Outp32(base + BTS_BWLOBOUND, 0x1);
|
|
Outp32(base + BTS_INITTKN, 0x8);
|
|
Outp32(base + BTS_DEMWIN, window);
|
|
Outp32(base + BTS_DEMTKN, token);
|
|
Outp32(base + BTS_DEFWIN, window);
|
|
Outp32(base + BTS_DEFTKN, token);
|
|
Outp32(base + BTS_PRMWIN, window);
|
|
Outp32(base + BTS_PRMTKN, token);
|
|
Outp32(base + BTS_FLEXIBLE, 0x0);
|
|
|
|
Outp32(base + BTS_PRIORITY + WOFFSET, (priority & 0xFFFF));
|
|
Outp32(base + BTS_TOKENMAX + WOFFSET, 0xFFDF);
|
|
Outp32(base + BTS_BWUPBOUND + WOFFSET, 0x18);
|
|
Outp32(base + BTS_BWLOBOUND + WOFFSET, 0x1);
|
|
Outp32(base + BTS_INITTKN + WOFFSET, 0x8);
|
|
Outp32(base + BTS_DEMWIN + WOFFSET, window);
|
|
Outp32(base + BTS_DEMTKN + WOFFSET, token);
|
|
Outp32(base + BTS_DEFWIN + WOFFSET, window);
|
|
Outp32(base + BTS_DEFTKN + WOFFSET, token);
|
|
Outp32(base + BTS_PRMWIN + WOFFSET, window);
|
|
Outp32(base + BTS_PRMTKN + WOFFSET, token);
|
|
Outp32(base + BTS_FLEXIBLE + WOFFSET, 0x0);
|
|
|
|
Outp32(base + BTS_RMODE, 0x1);
|
|
Outp32(base + BTS_WMODE, 0x1);
|
|
Outp32(base + BTS_EMERGENTRID, master_id);
|
|
Outp32(base + BTS_EMERGENTWID, master_id);
|
|
Outp32(base + BTS_RCON, 0x3);
|
|
Outp32(base + BTS_WCON, 0x3);
|
|
}
|
|
|
|
void bts_setqos_mo(addr_u32 base, unsigned int priority, unsigned int mo, unsigned int master_id) //QOS : [RRRRWWWW]
|
|
{
|
|
Outp32(base + BTS_RCON, 0x0);
|
|
Outp32(base + BTS_RCON, 0x0);
|
|
Outp32(base + BTS_WCON, 0x0);
|
|
Outp32(base + BTS_WCON, 0x0);
|
|
|
|
Outp32(base + BTS_PRIORITY, ((priority >> 16) & 0xFFFF));
|
|
Outp32(base + BTS_MOUPBOUND, 0x7F - mo);
|
|
Outp32(base + BTS_MOLOBOUND, mo);
|
|
Outp32(base + BTS_FLEXIBLE, 0x0);
|
|
|
|
Outp32(base + BTS_PRIORITY + WOFFSET, (priority & 0xFFFF));
|
|
Outp32(base + BTS_MOUPBOUND + WOFFSET, 0x7F - mo);
|
|
Outp32(base + BTS_MOLOBOUND + WOFFSET, mo);
|
|
Outp32(base + BTS_FLEXIBLE + WOFFSET, 0x0);
|
|
|
|
Outp32(base + BTS_RMODE, 0x2);
|
|
Outp32(base + BTS_WMODE, 0x2);
|
|
Outp32(base + BTS_EMERGENTRID, master_id);
|
|
Outp32(base + BTS_EMERGENTWID, master_id);
|
|
Outp32(base + BTS_RCON, 0x3);
|
|
Outp32(base + BTS_WCON, 0x3);
|
|
}
|
|
|
|
void bts_setqos_fbmbw(addr_u32 base, unsigned int priority, unsigned int window,
|
|
unsigned int token, unsigned int fbm, unsigned int master_id) //QOS : [RRRRWWWW]
|
|
{
|
|
Outp32(base + BTS_RCON, 0x0);
|
|
Outp32(base + BTS_RCON, 0x0);
|
|
Outp32(base + BTS_WCON, 0x0);
|
|
Outp32(base + BTS_WCON, 0x0);
|
|
|
|
Outp32(base + BTS_PRIORITY, ((priority >> 16) & 0xFFFF));
|
|
Outp32(base + BTS_TOKENMAX, 0xFFDF);
|
|
Outp32(base + BTS_BWUPBOUND, 0x18);
|
|
Outp32(base + BTS_BWLOBOUND, 0x1);
|
|
Outp32(base + BTS_INITTKN, 0x8);
|
|
Outp32(base + BTS_DEMWIN, window);
|
|
Outp32(base + BTS_DEMTKN, token);
|
|
Outp32(base + BTS_DEFWIN, window);
|
|
Outp32(base + BTS_DEFTKN, token);
|
|
Outp32(base + BTS_PRMWIN, window);
|
|
Outp32(base + BTS_PRMTKN, token);
|
|
Outp32(base + BTS_FLEXIBLE, 0x2);
|
|
|
|
Outp32(base + BTS_PRIORITY + WOFFSET, (priority & 0xFFFF));
|
|
Outp32(base + BTS_TOKENMAX + WOFFSET, 0xFFDF);
|
|
Outp32(base + BTS_BWUPBOUND + WOFFSET, 0x18);
|
|
Outp32(base + BTS_BWLOBOUND + WOFFSET, 0x1);
|
|
Outp32(base + BTS_INITTKN + WOFFSET, 0x8);
|
|
Outp32(base + BTS_DEMWIN + WOFFSET, window);
|
|
Outp32(base + BTS_DEMTKN + WOFFSET, token);
|
|
Outp32(base + BTS_DEFWIN + WOFFSET, window);
|
|
Outp32(base + BTS_DEFTKN + WOFFSET, token);
|
|
Outp32(base + BTS_PRMWIN + WOFFSET, window);
|
|
Outp32(base + BTS_PRMTKN + WOFFSET, token);
|
|
Outp32(base + BTS_FLEXIBLE + WOFFSET, 0x1);
|
|
|
|
Outp32(base + BTS_RMODE, 0x1);
|
|
Outp32(base + BTS_WMODE, 0x1);
|
|
|
|
Outp32(base + BTS_EMERGENTRID, master_id);
|
|
Outp32(base + BTS_EMERGENTWID, master_id);
|
|
if(fbm == 1) {
|
|
Outp32(base + BTS_RCON, 0x7);
|
|
Outp32(base + BTS_WCON, 0x7);
|
|
} else {
|
|
Outp32(base + BTS_RCON, 0x3);
|
|
Outp32(base + BTS_WCON, 0x3);
|
|
}
|
|
}
|
|
|
|
|
|
void bts_setemergentID(addr_u32 base, unsigned int master_id)
|
|
{
|
|
Outp32(base + BTS_PRIORITY, 0x4444);
|
|
Outp32(base + BTS_PRIORITY + WOFFSET, 0x4444);
|
|
|
|
Outp32(base + BTS_EMERGENTRID, master_id);
|
|
Outp32(base + BTS_EMERGENTWID, master_id);
|
|
}
|
|
|
|
|
|
void bts_disable(addr_u32 base, unsigned int master_id)
|
|
{
|
|
/* reset to default */
|
|
Outp32(base + BTS_RCON, 0x0);
|
|
Outp32(base + BTS_RCON, 0x0);
|
|
Outp32(base + BTS_WCON, 0x0);
|
|
Outp32(base + BTS_WCON, 0x0);
|
|
|
|
Outp32(base + BTS_RMODE, 0x1);
|
|
Outp32(base + BTS_WMODE, 0x1);
|
|
|
|
Outp32(base + BTS_PRIORITY, 0xA942);
|
|
Outp32(base + BTS_TOKENMAX, 0x0);
|
|
Outp32(base + BTS_BWUPBOUND, 0x3FFF);
|
|
Outp32(base + BTS_BWLOBOUND, 0x3FFF);
|
|
Outp32(base + BTS_INITTKN, 0x7FFF);
|
|
Outp32(base + BTS_DEMWIN, 0x7FFF);
|
|
Outp32(base + BTS_DEMTKN, 0x1FFF);
|
|
Outp32(base + BTS_DEFWIN, 0x7FFF);
|
|
Outp32(base + BTS_DEFTKN, 0x1FFF);
|
|
Outp32(base + BTS_PRMWIN, 0x7FFF);
|
|
Outp32(base + BTS_PRMTKN, 0x1FFF);
|
|
Outp32(base + BTS_MOUPBOUND, 0x1F);
|
|
Outp32(base + BTS_MOLOBOUND, 0x1F);
|
|
Outp32(base + BTS_FLEXIBLE, 0x0);
|
|
|
|
Outp32(base + BTS_PRIORITY + WOFFSET, 0xA942);
|
|
Outp32(base + BTS_TOKENMAX + WOFFSET, 0x0);
|
|
Outp32(base + BTS_BWUPBOUND + WOFFSET, 0x3FFF);
|
|
Outp32(base + BTS_BWLOBOUND + WOFFSET, 0x3FFF);
|
|
Outp32(base + BTS_INITTKN + WOFFSET, 0x7FFF);
|
|
Outp32(base + BTS_DEMWIN + WOFFSET, 0x7FFF);
|
|
Outp32(base + BTS_DEMTKN + WOFFSET, 0x1FFF);
|
|
Outp32(base + BTS_DEFWIN + WOFFSET, 0x7FFF);
|
|
Outp32(base + BTS_DEFTKN + WOFFSET, 0x1FFF);
|
|
Outp32(base + BTS_PRMWIN + WOFFSET, 0x7FFF);
|
|
Outp32(base + BTS_PRMTKN + WOFFSET, 0x1FFF);
|
|
Outp32(base + BTS_MOUPBOUND + WOFFSET, 0x1F);
|
|
Outp32(base + BTS_MOLOBOUND + WOFFSET, 0x1F);
|
|
Outp32(base + BTS_FLEXIBLE + WOFFSET, 0x0);
|
|
Outp32(base + BTS_EMERGENTRID, master_id);
|
|
Outp32(base + BTS_EMERGENTWID, master_id);
|
|
}
|
|
|
|
void bts_settrexqos(addr_u32 base, unsigned int priority, unsigned int master_id, unsigned int mask)
|
|
{
|
|
Outp32(base + TBTS_CON, 0x0);
|
|
Outp32(base + TBTS_RCON, 0x0);
|
|
Outp32(base + TBTS_WCON, 0x0);
|
|
|
|
Outp32(base + TBTS_DEMQOS, priority & 0xF);
|
|
Outp32(base + TBTS_DEFQOS, priority & 0xF);
|
|
Outp32(base + TBTS_PRMQOS, priority & 0xF);
|
|
|
|
Outp32(base + TBTS_EMERGENTID, master_id);
|
|
Outp32(base + TBTS_MASK, mask);
|
|
Outp32(base + TBTS_CON, 0x1001);
|
|
}
|
|
|
|
void bts_settrexqos_mo(addr_u32 base, unsigned int priority, unsigned int mo, unsigned int master_id, unsigned int mask)
|
|
{
|
|
Outp32(base + TBTS_CON, 0x0);
|
|
Outp32(base + TBTS_RCON, 0x0);
|
|
Outp32(base + TBTS_WCON, 0x0);
|
|
|
|
Outp32(base + TBTS_TKNUPBOUND, mo);
|
|
Outp32(base + TBTS_TKNLOBOUND, mo);
|
|
|
|
Outp32(base + TBTS_DEMTH, mo);
|
|
Outp32(base + TBTS_PRMTH, mo);
|
|
|
|
Outp32(base + TBTS_DEMQOS, priority & 0xF);
|
|
Outp32(base + TBTS_DEFQOS, priority & 0xF);
|
|
Outp32(base + TBTS_PRMQOS, priority & 0xF);
|
|
|
|
Outp32(base + TBTS_RCON, 0x11); // MO mode & Blocking on
|
|
Outp32(base + TBTS_WCON, 0x11);
|
|
Outp32(base + TBTS_EMERGENTID, master_id);
|
|
Outp32(base + TBTS_MASK, mask);
|
|
Outp32(base + TBTS_CON, 0x1001);
|
|
}
|
|
|
|
void bts_settrexqos_mo_rt(addr_u32 base, unsigned int priority, unsigned int mo, unsigned int master_id, unsigned int mask,
|
|
unsigned int time_out, unsigned int bypass_en)
|
|
{
|
|
Outp32(base + TBTS_CON, 0x0);
|
|
Outp32(base + TBTS_RCON, 0x0);
|
|
Outp32(base + TBTS_WCON, 0x0);
|
|
|
|
Outp32(base + TBTS_TKNUPBOUND, mo);
|
|
Outp32(base + TBTS_TKNLOBOUND, mo);
|
|
|
|
Outp32(base + TBTS_DEMTH, mo);
|
|
Outp32(base + TBTS_PRMTH, mo);
|
|
|
|
Outp32(base + TBTS_DEMQOS, priority & 0xF);
|
|
Outp32(base + TBTS_DEFQOS, priority & 0xF);
|
|
Outp32(base + TBTS_PRMQOS, priority & 0xF);
|
|
|
|
Outp32(base + TBTS_TIMEOUT, time_out);
|
|
|
|
if(bypass_en) {
|
|
Outp32(base + TBTS_RCON, 0x111); // MO mode & Qos bypass
|
|
Outp32(base + TBTS_WCON, 0x111);
|
|
} else {
|
|
Outp32(base + TBTS_RCON, 0x11); // MO mode
|
|
Outp32(base + TBTS_WCON, 0x11);
|
|
}
|
|
Outp32(base + TBTS_EMERGENTID, master_id);
|
|
Outp32(base + TBTS_MASK, mask);
|
|
Outp32(base + TBTS_CON, 0x1001); // Time out, Urgent enable
|
|
}
|
|
|
|
void bts_settrexqos_mo_cp(addr_u32 base, unsigned int priority, unsigned int mo, unsigned int master_id, unsigned int mask,
|
|
unsigned int time_out, unsigned int bypass_en)
|
|
{
|
|
Outp32(base + TBTS_CON, 0x0);
|
|
Outp32(base + TBTS_RCON, 0x0);
|
|
Outp32(base + TBTS_WCON, 0x0);
|
|
|
|
Outp32(base + TBTS_TKNUPBOUND, mo);
|
|
Outp32(base + TBTS_TKNLOBOUND, mo);
|
|
|
|
Outp32(base + TBTS_DEMTH, mo);
|
|
Outp32(base + TBTS_PRMTH, mo);
|
|
|
|
Outp32(base + TBTS_DEMQOS, priority & 0xF);
|
|
Outp32(base + TBTS_DEFQOS, priority & 0xF);
|
|
Outp32(base + TBTS_PRMQOS, priority & 0xF);
|
|
|
|
Outp32(base + TBTS_TIMEOUT, time_out);
|
|
|
|
if(bypass_en) {
|
|
Outp32(base + TBTS_RCON, 0x111); // MO mode & Qos bypass
|
|
Outp32(base + TBTS_WCON, 0x111);
|
|
} else {
|
|
Outp32(base + TBTS_RCON, 0x11); // MO mode
|
|
Outp32(base + TBTS_WCON, 0x11);
|
|
}
|
|
Outp32(base + TBTS_EMERGENTID, master_id);
|
|
Outp32(base + TBTS_MASK, mask);
|
|
Outp32(base + TBTS_CON, 0x101101); // Time out, Urgent enable
|
|
}
|
|
|
|
void bts_settrexqos_mo_change(addr_u32 base, unsigned int mo)
|
|
{
|
|
Outp32(base + TBTS_RCON, 0x0);
|
|
Outp32(base + TBTS_WCON, 0x0);
|
|
|
|
Outp32(base + TBTS_TKNUPBOUND, mo);
|
|
Outp32(base + TBTS_TKNLOBOUND, mo);
|
|
|
|
Outp32(base + TBTS_DEMTH, mo);
|
|
Outp32(base + TBTS_PRMTH, mo);
|
|
|
|
Outp32(base + TBTS_RCON, 0x11); // MO mode & Blocking on
|
|
Outp32(base + TBTS_WCON, 0x11);
|
|
}
|
|
|
|
void bts_settrexqos_urgent_off(addr_u32 base)
|
|
{
|
|
Outp32(base + TBTS_CON, 0x001001); // Time out, Urgent disable
|
|
}
|
|
void bts_settrexqos_urgent_on(addr_u32 base)
|
|
{
|
|
Outp32(base + TBTS_CON, 0x101101); // Time out, Urgent enable
|
|
}
|
|
|
|
void bts_settrexqos_bw(addr_u32 base, unsigned int priority, unsigned int decval, unsigned int master_id, unsigned int mask)
|
|
{
|
|
Outp32(base + TBTS_CON, 0x0);
|
|
Outp32(base + TBTS_RCON, 0x0);
|
|
Outp32(base + TBTS_WCON, 0x0);
|
|
|
|
Outp32(base + TBTS_TKNUPBOUND, 0x3FFF);
|
|
Outp32(base + TBTS_TKNLOBOUND, 0x3FF7);
|
|
Outp32(base + TBTS_RTKNINIT, 0x3FFF);
|
|
Outp32(base + TBTS_WTKNINIT, 0x3FFF);
|
|
|
|
Outp32(base + TBTS_DEMQOS, priority & 0xF);
|
|
Outp32(base + TBTS_DEFQOS, priority & 0xF);
|
|
Outp32(base + TBTS_PRMQOS, priority & 0xF);
|
|
|
|
Outp32(base + TBTS_RTKNDEC, decval);
|
|
Outp32(base + TBTS_WTKNDEC, decval);
|
|
|
|
Outp32(base + TBTS_RCON, 0x1); // Blocking on
|
|
Outp32(base + TBTS_WCON, 0x1);
|
|
Outp32(base + TBTS_EMERGENTID, master_id);
|
|
Outp32(base + TBTS_MASK, mask);
|
|
Outp32(base + TBTS_CON, 0x1001);
|
|
|
|
}
|
|
|
|
void bts_settrexqos_fbmbw(addr_u32 base, unsigned int priority, unsigned int master_id, unsigned int mask)
|
|
{
|
|
Outp32(base + TBTS_CON, 0x0);
|
|
Outp32(base + TBTS_RCON, 0x0);
|
|
Outp32(base + TBTS_WCON, 0x0);
|
|
|
|
Outp32(base + TBTS_DEMQOS, priority & 0xF);
|
|
Outp32(base + TBTS_DEFQOS, priority & 0xF);
|
|
Outp32(base + TBTS_PRMQOS, priority & 0xF);
|
|
|
|
Outp32(base + TBTS_RCON, 0x1); // Blocking on
|
|
Outp32(base + TBTS_WCON, 0x1);
|
|
Outp32(base + TBTS_EMERGENTID, master_id);
|
|
Outp32(base + TBTS_MASK, mask);
|
|
Outp32(base + TBTS_CON, 0x1001);
|
|
}
|
|
|
|
|
|
void bts_trexdisable(addr_u32 base, unsigned int master_id, unsigned int mask)
|
|
{
|
|
Outp32(base + TBTS_CON, 0x00010000);
|
|
Outp32(base + TBTS_RCON, 0x0);
|
|
Outp32(base + TBTS_WCON, 0x0);
|
|
|
|
Outp32(base + TBTS_TKNUPBOUND, 0x5FFF);
|
|
Outp32(base + TBTS_TKNLOBOUND, 0x1FFF);
|
|
|
|
Outp32(base + TBTS_DEMTH, 0x5FFF);
|
|
Outp32(base + TBTS_PRMTH, 0x1FFF);
|
|
|
|
Outp32(base + TBTS_DEMQOS, 0x2);
|
|
Outp32(base + TBTS_DEFQOS, 0x4);
|
|
Outp32(base + TBTS_PRMQOS, 0x9);
|
|
|
|
Outp32(base + TBTS_QURGUPTH, 0x8);
|
|
Outp32(base + TBTS_QURGDOWNTH, 0x8);
|
|
Outp32(base + TBTS_RTKNINIT, 0x3FFF);
|
|
Outp32(base + TBTS_WTKNINIT, 0x3FFF);
|
|
Outp32(base + TBTS_RTKNDEC, 0x0);
|
|
Outp32(base + TBTS_WTKNDEC, 0x0);
|
|
Outp32(base + TBTS_EMERGENTID, master_id);
|
|
Outp32(base + TBTS_MASK, mask);
|
|
}
|
|
|
|
|
|
|
|
void bts_setnsp(addr_u32 base, unsigned int nsp)
|
|
{
|
|
Outp32(base , nsp);
|
|
}
|