int main(void)
{
DDRC |= (1 << DDRC7);
PORTC |= (1 << PORTC7);
_delay_ms(2);
PORTC &= ~(1 << PORTC7);
init_power();
init_timeout_timer();
init_switch();
init_ref_clock();
init_spi(2);
init_buttons();
init_serial(2400);
init_adc();
init_i2c();
//Turn on interrupts
sei();
play_sounds();
//Debug: Never Gets here
while(1)
{
_delay_ms(1000);
get_POT_set_TWIPOT();
}
}
int main(void)
{
/* hardware initialisation: */
init_motor();
init_buzzr();
init_leds();
init_switch();
uint8_t mode = 0;
for(;;) /* ever */ {
//do something
switch(mode){
case 1:
mode_blinktest();
break;
case 2:
mode_motortest();
break;
case 3:
mode_beeptest();
break;
default: //mode=0;
blinkrattlebeep();
}
//check switches and change mode
switch( PIND & 0b00000011){
case 0b00000010: //left switch pressed
mode--;
if (mode > 3) mode =3;
flashleds(LED_L);
break;
case 0b00000001: //right switch pressed
mode++;
if (mode > 3) mode = 0;
flashleds(LED_R);
break;
case 0b00000000: //both switches pressed
flashleds(LED_R|LED_L);
break;
}
}
/* never return 0; */
return 0;
}
void init()
{
prc2 = 1; /*PACRの書込み許可*/
pacr = 3; /*80ピンに設定*/
/*クロック設定*/
prc0=1;
cm21=0;
cm06=0;
prc0=0;
//
init_led();
//
init_switch();
}
int main(int argc, char **argv) {
// initialize gpio17 that is hooked up to the switch
if(init_gpio()) {
perror("could not initialize gpio17");
return 1;
}
// S points to the switch values structure
SWITCH_T * S = init_switch();
while(1) {
// read the switch values
if(get_debounce_vals(S)) {
perror("could not read values");
}
// print the state of the switch and light led accordingly
switch_led(S);
}
return 0;
}
void init(void){
DIR_DATA = STD_DIR_DATA;
DIR_REGA = STD_DIR_REGA;
DIR_REGB = STD_DIR_REGB;
DIR_MC2 = STD_DIR_MC2;
PORT_DATA = STD_PORT_DATA;
PORT_REGA = STD_PORT_REGA;
PORT_REGB = STD_PORT_REGB;
PORT_MC2 = STD_PORT_MC2;
init_mux();
init_switch();
init_buffer();
init_processing();
for(char i = 0; i<10; i++){
for(char j = 0; j<13; j++){
CUBE[i][j]=0x01;
}
}
//Timer A:
TCCR1A = 0x00;
TCCR1B = (1<<WGM12)|(1<CS12);
OCR1AH = TM1ZAEHLER>>8;
OCR1AL = TM1ZAEHLER & 0x00FF;
TIMSK = (1<<OCIE1A);
sei();
PORT_REGB |= (1<<PIN_ENABLE_CUBE); // CUBE EINSCHALTEN
}
// used for various testing
static int rctest_main(int argc, char *argv[])
{
int on;
if (argc < 3) {
_dprintf("test what?\n");
}
else if (strcmp(argv[1], "rc_service")==0) {
notify_rc(argv[2]);
}
else if(strcmp(argv[1], "get_phy_status")==0) {
int mask;
mask = atoi(argv[2]);
TRACE_PT("debug for phy_status %x\n", get_phy_status(mask));
}
else if(strcmp(argv[1], "get_phy_speed")==0) {
int mask;
mask = atoi(argv[2]);
TRACE_PT("debug for phy_speed %x\n", get_phy_speed(mask));
}
else if(strcmp(argv[1], "set_phy_ctrl")==0) {
int mask, ctrl;
mask = atoi(argv[2]);
ctrl = atoi(argv[3]);
TRACE_PT("debug for phy_speed %x\n", set_phy_ctrl(mask, ctrl));
}
else if(strcmp(argv[1], "handle_notifications")==0) {
handle_notifications();
}
else if(strcmp(argv[1], "check_action")==0) {
_dprintf("check: %d\n", check_action());
}
else if(strcmp(argv[1], "nvramhex")==0) {
int i;
char *nv;
nv = nvram_safe_get(argv[2]);
_dprintf("nvram %s(%d): ", nv, strlen(nv));
for(i=0;i<strlen(nv);i++) {
_dprintf(" %x", (unsigned char)*(nv+i));
}
_dprintf("\n");
}
else {
on = atoi(argv[2]);
_dprintf("%s %d\n", argv[1], on);
if (strcmp(argv[1], "vlan") == 0)
{
if(on) start_vlan();
else stop_vlan();
}
else if (strcmp(argv[1], "lan") == 0) {
if(on) start_lan();
else stop_lan();
}
else if (strcmp(argv[1], "wl") == 0) {
if(on)
{
start_wl();
lanaccess_wl();
}
}
else if (strcmp(argv[1], "wan") == 0) {
if(on) start_wan();
else stop_wan();
}
else if (strcmp(argv[1], "firewall") == 0) {
//if(on) start_firewall();
//else stop_firewall();
}
else if (strcmp(argv[1], "watchdog") == 0) {
if(on) start_watchdog();
else stop_watchdog();
}
#ifdef RTCONFIG_FANCTRL
else if (strcmp(argv[1], "phy_tempsense") == 0) {
if(on) start_phy_tempsense();
else stop_phy_tempsense();
}
#endif
#ifdef RTCONFIG_BCMWL6
#ifdef RTCONFIG_PROXYSTA
else if (strcmp(argv[1], "psta_monitor") == 0) {
if(on) start_psta_monitor();
else stop_psta_monitor();
}
#endif
#endif
else if (strcmp(argv[1], "qos") == 0) {//qos test
if(on){
#ifdef RTCONFIG_RALINK
if (module_loaded("hw_nat"))
{
modprobe_r("hw_nat");
sleep(1);
#if 0
system("echo 0 > /proc/sys/net/ipv4/conf/default/force_igmp_version");
system("echo 0 > /proc/sys/net/ipv4/conf/all/force_igmp_version");
#endif
}
#endif
add_iQosRules(get_wan_ifname(0));
start_iQos();
}
else
{
#ifdef RTCONFIG_RALINK
if (nvram_get_int("hwnat") &&
/* TODO: consider RTCONFIG_DUALWAN case */
// !nvram_match("wan0_proto", "l2tp") &&
// !nvram_match("wan0_proto", "pptp") &&
// !(nvram_get_int("fw_pt_l2tp") || nvram_get_int("fw_pt_ipsec") &&
// (nvram_match("wl0_radio", "0") || nvram_get_int("wl0_mrate_x")) &&
// (nvram_match("wl1_radio", "0") || nvram_get_int("wl1_mrate_x")) &&
!module_loaded("hw_nat"))
{
#if 0
system("echo 2 > /proc/sys/net/ipv4/conf/default/force_igmp_version");
system("echo 2 > /proc/sys/net/ipv4/conf/all/force_igmp_version");
#endif
modprobe("hw_nat");
sleep(1);
}
#endif
stop_iQos();
del_iQosRules();
}
}
#ifdef RTCONFIG_WEBDAV
else if (strcmp(argv[1], "webdav") == 0) {
if(on)
start_webdav();
}
#endif
else if (strcmp(argv[1], "gpiow") == 0) {
if(argc>=4) set_gpio(atoi(argv[2]), atoi(argv[3]));
}
else if (strcmp(argv[1], "gpior") == 0) {
_dprintf("%d\n", get_gpio(atoi(argv[2])));
}
else if (strcmp(argv[1], "gpiod") == 0) {
if(argc>=4) gpio_dir(atoi(argv[2]), atoi(argv[3]));
}
else if (strcmp(argv[1], "init_switch") == 0) {
init_switch(on);
}
else if (strcmp(argv[1], "set_action") == 0) {
set_action(on);
}
else if (strcmp(argv[1], "pwr_usb") == 0) {
set_pwr_usb(atoi(argv[2]));
_dprintf("done.\n");
}
else {
printf("what?\n");
}
}
return 0;
}
int main(int argc, char *argv[] ){
init_switch();
return 0;
}
// used for various testing
static int rctest_main(int argc, char *argv[])
{
int on;
if (argc < 2) {
_dprintf("test what?\n");
}
else if (strcmp(argv[1], "rc_service")==0) {
notify_rc(argv[2]);
}
else if(strcmp(argv[1], "get_phy_status")==0) {
int mask;
mask = atoi(argv[2]);
TRACE_PT("debug for phy_status %x\n", get_phy_status(mask));
}
else if(strcmp(argv[1], "get_phy_speed")==0) {
int mask;
mask = atoi(argv[2]);
TRACE_PT("debug for phy_speed %x\n", get_phy_speed(mask));
}
else if(strcmp(argv[1], "set_phy_ctrl")==0) {
int mask, ctrl;
mask = atoi(argv[2]);
ctrl = atoi(argv[3]);
TRACE_PT("debug for phy_speed %x\n", set_phy_ctrl(mask, ctrl));
}
else if(strcmp(argv[1], "handle_notifications")==0) {
handle_notifications();
}
else if(strcmp(argv[1], "check_action")==0) {
_dprintf("check: %d\n", check_action());
}
else if(strcmp(argv[1], "nvramhex")==0) {
int i;
char *nv;
nv = nvram_safe_get(argv[2]);
_dprintf("nvram %s(%d): ", nv, strlen(nv));
for(i=0;i<strlen(nv);i++) {
_dprintf(" %x", (unsigned char)*(nv+i));
}
_dprintf("\n");
}
else {
on = atoi(argv[2]);
_dprintf("%s %d\n", argv[1], on);
if (strcmp(argv[1], "vlan") == 0)
{
if(on) start_vlan();
else stop_vlan();
}
else if (strcmp(argv[1], "lan") == 0) {
if(on) start_lan();
else stop_lan();
}
else if (strcmp(argv[1], "wl") == 0) {
if(on)
{
start_wl();
lanaccess_wl();
}
}
else if (strcmp(argv[1], "wan") == 0) {
if(on) start_wan();
else stop_wan();
}
else if (strcmp(argv[1], "wan_port") == 0) {
if(on) start_wan_port();
else stop_wan_port();
}
else if (strcmp(argv[1], "firewall") == 0) {
//if(on) start_firewall();
//else stop_firewall();
}
else if (strcmp(argv[1], "watchdog") == 0) {
if(on) start_watchdog();
else stop_watchdog();
}
#if ! (defined(RTCONFIG_QCA) || defined(RTCONFIG_RALINK))
else if (strcmp(argv[1], "watchdog02") == 0) {
if(on) start_watchdog02();
else stop_watchdog02();
}
#endif /* ! (RTCONFIG_QCA || RTCONFIG_RALINK) */
else if (strcmp(argv[1], "sw_devled") == 0) {
if(on) start_sw_devled();
else stop_sw_devled();
}
#ifdef RTCONFIG_FANCTRL
else if (strcmp(argv[1], "phy_tempsense") == 0) {
if(on) start_phy_tempsense();
else stop_phy_tempsense();
}
#endif
#ifdef RTCONFIG_BCMWL6
#ifdef RTCONFIG_PROXYSTA
else if (strcmp(argv[1], "psta_monitor") == 0) {
if(on) start_psta_monitor();
else stop_psta_monitor();
}
#endif
#endif
#ifdef RTCONFIG_IPERF
else if (strcmp(argv[1], "monitor") == 0) {
if(on) start_monitor();
else stop_monitor();
}
#endif
else if (strcmp(argv[1], "qos") == 0) {//qos test
if(on){
#ifdef RTCONFIG_RALINK
if (module_loaded("hw_nat"))
{
modprobe_r("hw_nat");
sleep(1);
#if 0
f_write_string("/proc/sys/net/ipv4/conf/default/force_igmp_version", "0", 0, 0);
f_write_string("/proc/sys/net/ipv4/conf/all/force_igmp_version", "0", 0, 0);
#endif
}
#endif
add_iQosRules(get_wan_ifname(wan_primary_ifunit()));
#ifdef RTCONFIG_BWDPI
if(nvram_get_int("qos_type") == 1) {
start_dpi_engine_service();
// force to rebuild firewall to avoid some loopback issue
if (nvram_match("fw_nat_loopback", "2"))
start_firewall(wan_primary_ifunit(), 0);
}
else
#endif
start_iQos();
}
else
{
#ifdef RTCONFIG_RALINK
if (nvram_get_int("hwnat") &&
/* TODO: consider RTCONFIG_DUALWAN case */
// !nvram_match("wan0_proto", "l2tp") &&
// !nvram_match("wan0_proto", "pptp") &&
// !(nvram_get_int("fw_pt_l2tp") || nvram_get_int("fw_pt_ipsec") &&
// (nvram_match("wl0_radio", "0") || nvram_get_int("wl0_mrate_x")) &&
// (nvram_match("wl1_radio", "0") || nvram_get_int("wl1_mrate_x")) &&
!module_loaded("hw_nat"))
{
#if 0
f_write_string("/proc/sys/net/ipv4/conf/default/force_igmp_version", "2", 0, 0);
f_write_string("/proc/sys/net/ipv4/conf/all/force_igmp_version", "2", 0, 0);
#endif
#if defined(RTN14U) || defined(RTAC52U) || defined(RTAC51U) || defined(RTN11P) || defined(RTN300) || defined(RTN54U) || defined(RTAC1200HP) || defined(RTN56UB1) || defined(RTAC54U) || defined(RTN56UB2)
if (!(!nvram_match("switch_wantag", "none")&&!nvram_match("switch_wantag", "")))
#endif
{
modprobe("hw_nat");
sleep(1);
}
}
#endif
#ifdef RTCONFIG_BWDPI
if(nvram_get_int("qos_type") == 1){
stop_dpi_engine_service(1);
}
else
#endif
stop_iQos();
del_iQosRules();
}
}
#ifdef RTCONFIG_WEBDAV
else if (strcmp(argv[1], "webdav") == 0) {
if(on)
start_webdav();
}
#endif
#ifdef RTCONFIG_TUNNEL
else if (strcmp(argv[1], "mastiff") == 0) {
if(on)
start_mastiff();
}
#endif
else if (strcmp(argv[1], "gpiow") == 0) {
if(argc>=4) set_gpio(atoi(argv[2]), atoi(argv[3]));
}
else if (strcmp(argv[1], "gpior") == 0) {
printf("%d\n", get_gpio(atoi(argv[2])));
}
else if (strcmp(argv[1], "gpiod") == 0) {
if(argc>=4) gpio_dir(atoi(argv[2]), atoi(argv[3]));
}
else if (strcmp(argv[1], "init_switch") == 0) {
init_switch();
}
else if (strcmp(argv[1], "set_action") == 0) {
set_action(on);
}
else if (strcmp(argv[1], "pwr_usb") == 0) {
set_pwr_usb(atoi(argv[2]));
_dprintf("done.\n");
}
else if (strcmp(argv[1], "enc_chk") == 0) {
unsigned char enc_buf[ENC_WORDS_LEN];
unsigned char dec_buf[DATA_WORDS_LEN + 1];
_dprintf("get enc str:[%s]\n", enc_str(argv[2], (char *) enc_buf));
_dprintf("get dec str:[%s]\n", dec_str((char *) enc_buf, (char *) dec_buf));
_dprintf("done(%d)\n", strcmp(argv[2], (const char *) dec_buf));
}
#ifdef RTCONFIG_BCMFA
else if (strcmp(argv[1], "fa_rev") == 0) {
_dprintf("(%d) done.\n", get_fa_rev());
}
else if (strcmp(argv[1], "fa_dump") == 0) {
_dprintf("(%d) done.\n", get_fa_dump());
}
#endif
else {
printf("what?\n");
}
}
return 0;
}
void init_motor(void){
init_switch();
init_motorPWM();
}
void init_buttons(){
init_switch();
init_led();
init_heater();
}