static void power_off_lcd(void)
{
msleep(50);
//AVDD EIO -> OD4: 0
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 0, 4);
#endif
msleep(20);
//LCD3.3V EIO -> OD0: 1
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 1, 0);
#endif
}
static void power_on_lcd(void)
{
//int setIO_level(unsigned char port, unsigned char iobits, unsigned char offset);
//LCD3.3V EIO -> OD0: 0
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 0, 0);
#endif
msleep(20);
//AVDD EIO -> OD4: 1
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 1, 4);
#endif
msleep(50);
}
static void power_off_lcd(void)
{
//EIO -> OD0: 1
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 1, 0);
#endif
}
static void power_off_lcd(void)
{
msleep(50);
//AVDD EIO -> OD4: 0
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 0, 4);
#else
set_gpio_val(GPIOA_bank_bit(3), GPIOA_bit_bit0_14(3), 0);
set_gpio_mode(GPIOA_bank_bit(3), GPIOA_bit_bit0_14(3), GPIO_OUTPUT_MODE);
#endif
msleep(20);
//LCD3.3V EIO -> OD0: 1
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 1, 0);
#else
set_gpio_val(GPIOD_bank_bit2_24(20), GPIOD_bit_bit2_24(20), 1);
set_gpio_mode(GPIOD_bank_bit2_24(20), GPIOD_bit_bit2_24(20), GPIO_OUTPUT_MODE);
#endif
}
static void power_on_lcd(void)
{
//EIO -> OD0: 0
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 0, 0);
#endif
msleep(10);
//VCCx2_EN D17 GPIOA_6 --> H
set_gpio_val(GPIOA_bank_bit(6), GPIOA_bit_bit0_14(6), 1);
set_gpio_mode(GPIOA_bank_bit(6), GPIOA_bit_bit0_14(6), GPIO_OUTPUT_MODE);
}
void power_off_backlight(void)
{
//EIO -> PP1: 0 //EIO -> OD4: 1
#ifdef CONFIG_SN7325
configIO(1, 0); //configIO(0, 0);
setIO_level(1, 1, 1); //setIO_level(0, 1, 4);
#endif
CLEAR_CBUS_REG_MASK(PERIPHS_PIN_MUX_2, (1<<31));
CLEAR_CBUS_REG_MASK(PWM_MISC_REG_AB, (1 << 0));
set_gpio_val(GPIOA_bank_bit(7), GPIOA_bit_bit0_14(7), 0);
set_gpio_mode(GPIOA_bank_bit(7), GPIOA_bit_bit0_14(7), GPIO_OUTPUT_MODE);
}
static void power_on_lcd(void)
{
//int setIO_level(unsigned char port, unsigned char iobits, unsigned char offset);
//LCD3.3V EIO -> OD0: 0
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 0, 0);
#else
set_gpio_val(GPIOD_bank_bit2_24(20), GPIOD_bit_bit2_24(20), 0);
set_gpio_mode(GPIOD_bank_bit2_24(20), GPIOD_bit_bit2_24(20), GPIO_OUTPUT_MODE);
#endif
msleep(20);
//AVDD EIO -> OD4: 1
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 1, 4);
#else
set_gpio_val(GPIOA_bank_bit(3), GPIOA_bit_bit0_14(3), 1);
set_gpio_mode(GPIOA_bank_bit(3), GPIOA_bit_bit0_14(3), GPIO_OUTPUT_MODE);
#endif
msleep(50);
}
static void set_tcon_pinmux(void)
{
/* TCON control pins pinmux */
/* GPIOA_5 -> LCD_Clk, GPIOA_0 -> TCON_STH1, GPIOA_1 -> TCON_STV1, GPIOA_2 -> TCON_OEH, */
set_mio_mux(0, ((1<<11)|(1<<14)|(1<<15)|(1<<16)));
set_mio_mux(4, (1<<0)|(1<<2)|(1<<4) ); //For 6bits
//PP1 -> UPDN:0, PP2 -> SHLR:1
#ifdef CONFIG_SN7325
configIO(1, 0);
setIO_level(1, 0, 1);
setIO_level(1, 1, 2);
#endif
}
static void power_off_lcd(void)
{
msleep(50);
//AVDD & BL VCC EIO -> OD4: 0
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 0, 4);
#endif
// msleep(20);
// //AVDD EIO -> PP5: 0
//#ifdef CONFIG_SN7325
// configIO(1, 0);
// setIO_level(1, 0, 5);
//#endif
msleep(50);
//LCD3.3V EIO -> OD0: 1
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 1, 0);
#endif
}
void power_on_backlight(void)
{
msleep(100);
SET_CBUS_REG_MASK(PWM_MISC_REG_AB, (1 << 0));
msleep(100);
SET_CBUS_REG_MASK(PERIPHS_PIN_MUX_2, (1<<31));
msleep(100);
//EIO -> PP1: 0 //EIO -> OD4: 0
#ifdef CONFIG_SN7325
configIO(1, 0); //configIO(0, 0);
setIO_level(1, 0, 1); //setIO_level(0, 0, 4);
#endif
printk("\n\npower_on_backlight.\n\n");
}
static void aml_8726m_power_on_bl(void)
{
debug("%s\n", __FUNCTION__);
mdelay(100);
SET_CBUS_REG_MASK(PWM_MISC_REG_AB, (1 << 0));
mdelay(100);
SET_CBUS_REG_MASK(PERIPHS_PIN_MUX_2, (1<<31));
mdelay(100);
//EIO -> OD4: 1
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 1, 4);
#endif
}
static void power_on_lcd(void)
{
//int setIO_level(unsigned char port, unsigned char iobits, unsigned char offset);
//LCD3.3V EIO -> OD0: 0
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 0, 0);
#endif
msleep(80);
// //AVDD EIO -> PP5: 1
//#ifdef CONFIG_SN7325
// configIO(1, 0);
// setIO_level(1, 1, 5);
//#endif
// msleep(50);
//AVDD & BL VCC EIO -> OD4: 1
#ifdef CONFIG_SN7325
configIO(0, 0);
setIO_level(0, 1, 4);
#endif
msleep(80);
}
void main(void){
R = 0;
Y = 0;
O = 0;
PR = 0;
PY = 0;
PO = 0;
fa = 0;
fb = 0;
ma = 0;
mb = 0;
d1 = 0;
d2 = 0;
InitTIMERS();
configurations_init();
MotorsPWM();
configIO();
//L_RED = 1;
//L_YELLOW = 0;
//L_ORANGE = 1;
state = INIT;
while (1){
switch (state){
case INIT:
/* if (IR0 == 0 ){
L_RED = 1;
L_YELLOW = 1;
L_ORANGE = 0;
}else{
L_RED = 0;
L_YELLOW = 0;
L_ORANGE = 1;
}*/
L_RED = IR_DER;
L_YELLOW = IR_CEN;
L_ORANGE = IR_IZQ;
//L_YELLOW = 1;
//L_ORANGE = 0;
//L_RED = 0;
/*if (B_ORANGE == 0){
state = WAIT;
TIME = 0;
//MotorsSpeed(-500,0);
}else if (B_RED == 0){
//MotorsSpeed(0,500);
}else{
MotorsSpeed(0,0);
}
MotorsSpeed(0,0);*/
MotorsSpeed(0,0);
if (B_RED == 0){
sd = 1;
state = WAIT;
TIME = 0;
}
if (B_ORANGE == 0){
sd = 2;
state = WAIT;
TIME = 0;
}
break;
case WAIT:
MotorsSpeed(0,0);
/*L_RED = TIME % 1000 > 500;
L_YELLOW = 0;
L_ORANGE = 0;*/
L_YELLOW = TIME % 1000 > 500;
L_RED = sd == 1;
L_ORANGE = sd == 2;
if (TIME > 5000){
state = MOVE;
}
break;
case MOVE:
/*if (IR0 == 0){
MotorsSpeed(-1000,1000);
L_RED = 1;
}else{
L_RED = 0;
MotorsSpeed(-900,-500);
}
L_YELLOW = 0;
L_ORANGE = 0;
if (B_ORANGE == 0){
state = INIT;
}*/
L_RED = sd == 1;
L_ORANGE = sd == 2;
if (IR_CEN){
if (IR_IZQ and IR_DER){
MotorsSpeed(1000,1000);
L_YELLOW = TIME % 200 > 100;
}else if(not(IR_IZQ) and not(IR_DER)){
L_YELLOW = TIME % 400 > 200;
MotorsSpeed(1000,1000);
}else if (IR_IZQ and not(IR_DER)){
L_YELLOW = 1;
MotorsSpeed(1000,400);
}else if(IR_DER and not(IR_IZQ)){
L_YELLOW = 1;
MotorsSpeed(400,1000);
}
}else if(IR_IZQ and not(IR_DER)){
L_YELLOW = 0;
MotorsSpeed(1000,-500);
}else if(IR_DER and not(IR_IZQ)){
L_YELLOW = 0;
MotorsSpeed(-500,1000);
}else if(sd == 1){
L_YELLOW = 0;
MotorsSpeed(1000,-500);
}else if(sd == 2){
L_YELLOW = 0;
MotorsSpeed(-500,1000);
}
if(IR_IZQ and not(IR_DER)){
sd = 2;
}
if(IR_DER and not(IR_IZQ)){
sd = 1;
}
break;
}
//MotorsSpeed(500 ,500);
/*if (IR0 == 0 ){
L_RED = 1;
L_YELLOW = 1;
L_ORANGE = 0;
}else{
L_RED = 0;
L_YELLOW = 0;
L_ORANGE = 1;
}*/
/* if (not B_RED and not ma){
ma = 1;
d1 = d1 == 10 ? -10 : (d1 + 1);
}
if (not B_ORANGE and not mb){
mb = 1;
d2 = d2 == 10 ? -10 : (d2 + 1);
}
if (B_RED) ma = 0;
if (B_ORANGE) mb = 0;
L_RED = d1 != 0;
L_YELLOW = 1;
L_ORANGE = d2 != 0;
if (TIME > 10000){
TIME = 0;
}*/
//MotorsSpeed(d1 * 100, d2*100);
//MotorsSpeed(TIME / 10 ,TIME / 10);
}
}
