static void _dumpReg(void) {
int i = 0;
Ftr();
for( ; i < sizeof(mHW.reg)/sizeof(mHW.reg[0]); i++) {
printk("%d ",mHW.reg[i]);
}
Ftr();
}
int hw_sendData(
const int REG,
const unsigned char data_) {
unsigned long int_flags;
struct timeval tv1,tv2;
unsigned char data = data_;
Fin();
if (REG<0 || REG>8) {
Ftr();
return -1;
}
Ftr(" echo %d > %d", data, REG);
if (REG == 0) {
// 1110 0111
data &= 0xe7;
// To disable unstable flags, vendor suggests it.
}
do_gettimeofday(&tv1);
spin_lock_irqsave(&my_lock, int_flags);
mHW.reg[REG] = data;
gpio_set_value(mHW.CTRL, 1);
udelay(20); // TDS: data start. typical 10 us
// fill the address.
if (REG&0x08) SEND_HIGH(); else SEND_LOW();
if (REG&0x04) SEND_HIGH(); else SEND_LOW();
if (REG&0x02) SEND_HIGH(); else SEND_LOW();
if (REG&0x01) SEND_HIGH(); else SEND_LOW();
// fill the data.
if (data&0x80) SEND_HIGH(); else SEND_LOW();
if (data&0x40) SEND_HIGH(); else SEND_LOW();
if (data&0x20) SEND_HIGH(); else SEND_LOW();
if (data&0x10) SEND_HIGH(); else SEND_LOW();
if (data&0x08) SEND_HIGH(); else SEND_LOW();
if (data&0x04) SEND_HIGH(); else SEND_LOW();
if (data&0x02) SEND_HIGH(); else SEND_LOW();
if (data&0x01) SEND_HIGH(); else SEND_LOW();
// fill EOD
gpio_set_value(mHW.CTRL,0);
udelay(8); //typical val: 2 us
gpio_set_value(mHW.CTRL,1);
udelay(400); //typical val: 350 us
spin_unlock_irqrestore(&my_lock, int_flags);
do_gettimeofday(&tv2);
Fout("at %d, tv: (%d)us", REG, tv2.tv_usec - tv1.tv_usec);
return 1;
}
int hw_getReg(const int REG){
Fin();
if (REG<0 || REG>8) {
Ftr("No such reg:%d", (unsigned int)REG);
return -1;
}
Fout("reg:%d has %X", REG, mHW.reg[REG]);
return mHW.reg[REG];
}
/* No need to implement state machine handling suspend/resume mode.
** By check the gpio#0 state, if gpio#0 can not be re-request in resume procedure,
** the suspend() does not free gpio#0 yet.
*/
int hw_resume(void) {
int res = 0;
res = gpio_request(mHW.CTRL, "rgb_ctrl");
if (res<0) {
Ftr("Can not request CTRL pin.");
return res;
}
hw_wakeup();
return 0;
}
int hw_trySuspend(void) {
_dumpReg();
if (0) {
unsigned *p = &mHW.reg[0];
if (p[6]!=0 || p[7]!=0 || p[8]!=0)
return -EBUSY;
if (p[4]!=0)
return -EBUSY;
}
Ftr("Entery suspend mode.");
gpio_free(mHW.CTRL);
return 0;
}
//goes from ya to yb as x goes from xa to xb
array Ftrgen(const array x, const array xa, const array xb, const array ya, const array yb )
{
array res = ya + (yb-ya)*Ftr( (x-xa)/(xb-xa) );
res.eval();
return res;
}
array Ftrgenlin( const array x, const array xa, const array xb, const array ya, const array yb )
{
array res = (x*ya)/xa + (-((x*ya)/xa) + ((x - xb)*(1 - yb))/(1 - xb) + yb)*Ftr((x - xa)/(xb - xa));
res.eval();
return res;
}
int hw_freeGPIO(void) {
Ftr();
gpio_free(mHW.CTRL);
return 0;
}
