void init(void) {
setup_flash();
setup_clocks();
setup_nvic();
systick_init(SYSTICK_RELOAD_VAL);
wirish::priv::board_setup_gpio();
setup_adcs();
setup_timers();
wirish::priv::board_setup_usb();
wirish::priv::series_init();
boardInit();
}
//Initialize functions for the board
//Starts up
void init(void) {
setup_flash();
setup_clocks();
setup_nvic();
systick_init(SYSTICK_RELOAD_VAL);
board_setup_gpio();
setup_timers();
board_setup_usb();
series_init();
disableDebugPorts();
}
void freq_main(void)
{
cli();
counter_init();
gate_init();
stop();
reset();
ff_clr();
key_init();
setup_timers();
setup_interrupts();
adc_init();
sti();
/*clear counter*/
TCNT2= 0;
TCNT0= 0;
TCNT1= 0xFF00;
T0_ovc = T1_ovc =0;
start();
//fast clear screen...
post_display(filter());//really result
while(1) {
key_process();
keep_live();
mode = read_adc_mode();
update_lcd_status();
if(is_stop()&&soft_stop){
calc_freq();
post_display(filter());//really result
c_live() ; //mark succeufull ..
if(loop>=(ST)){ //never clear
reset();
}
loop=0;
start();
}
}
}
static void
arch_init( void )
{
void setup_timers(void);
openbios_init();
modules_init();
#ifdef CONFIG_DRIVER_IDE
setup_timers();
ob_ide_init("/pci/pci-ata", 0x1f0, 0x3f4, 0x170, 0x374);
#endif
device_end();
bind_func("platform-boot", boot );
}
void
arch_of_init( void )
{
#if USE_RTAS
phandle_t ph;
#endif
int autoboot;
devtree_init();
node_methods_init();
modules_init();
setup_timers();
#ifdef CONFIG_DRIVER_PCI
ob_pci_init();
#endif
#if USE_RTAS
if( !(ph=find_dev("/rtas")) )
printk("Warning: No /rtas node\n");
else {
ulong size = 0x1000;
while( size < (ulong)of_rtas_end - (ulong)of_rtas_start )
size *= 2;
set_property( ph, "rtas-size", (char*)&size, sizeof(size) );
}
#endif
#if 0
/* tweak boot settings */
autoboot = !!get_bool_res("autoboot");
#endif
autoboot = 0;
if( !autoboot )
printk("Autobooting disabled - dropping into OpenFirmware\n");
setenv("auto-boot?", autoboot ? "true" : "false" );
setenv("boot-command", "briqboot");
#if 0
if( get_bool_res("tty-interface") == 1 )
#endif
fword("activate-tty-interface");
/* hack */
device_end();
bind_func("briqboot", boot );
}
void setup() {
fatal_set_blink(blink);
DDRD |= LED_ALL | DEBUG_PIN | IOBIT_MASK;
PORTD = LED_ALL;
setup_timers(F_CPU);
uart_setup(BAUDRATE);
uart_send_all(3, online_packet);
power_adc_enable();
DDRB |= 0x3f; // direction, output
DDRC |= 0x3f; // step, output
PORTC &= ~0x3f; // Start low
PORTB &= ~0x3f; // Start low
MCUCR &= ~(1 << PUD);
after(0, main_loop, 0);
// turn off red and yellow
PORTD &= ~(LED_RED | LED_YELLOW);
}
int main( void )
{
cli();
SetupPins();
setup_clock();
setup_timers();
// setup_spi();
sei();
while(1)
{
// ReportCalibration();
if (DoShutterEvent != NULL) TryShutterEvent();
if ((flags & _BV(BUTTON_UPDATE))>0) ButtonFeedback();
if ((flags & _BV(BUTTON_RELEASED))>0) ProcesButton();
}
return 0;
}
int main()
{
// Set ports direction
DDRB = 0x30;
DDRC = 0x3f;
DDRD = 0x3c;
//////////////////////
uart0_init(UART_BAUD_SELECT(9600, F_CPU)); // Initialize UART.
setup_timers(); // Setup timers
sei(); // Globally enable interrupts
uint8_t cmdbuf[3];
uint8_t ret;
// Main loop
for(;;)
{
ret = read_msg(cmdbuf);
if(!ret)
process_msg(cmdbuf);
}
}
int main(void)
{
uart0_init();
setup_timers();
setup_inputs();
printf("EMU ECU\n");
sei(); // Enable Global Interrupt
uint16_t engine_stop_ms = ticks_ms();
uint16_t loop_ms = 0;
while (1)
{
uint16_t curr_rpm = rpm();
if (!curr_rpm)
{
// keep the stop time sliding for when we attempt to start again
if ((ticks_ms() - engine_stop_ms) > DWELL_TIME_MS)
{
engine_stop_ms = ticks_ms() - DWELL_TIME_MS;
}
}
if (!ignition_enabled())
{
if (curr_rpm > 0 && (ticks_ms() - engine_stop_ms) > DWELL_TIME_MS)
{
ignition_enable();
pump_enable();
printf("engine start\n");
}
}
else
{
if (curr_rpm > RPM_LIMIT)
{
printf("overrev - forced engine stop\n");
ignition_disable();
pump_disable();
engine_stop_ms = ticks_ms();
}
if (!curr_rpm)
{
printf("engine has stopped\n");
ignition_disable();
pump_disable();
}
}
uint16_t pwm_in = pwm_input();
uint16_t pwm_out = clamp_pwm(pwm_in);
set_pwm(0, pwm_out);
const float t_scale = 1.0 / (float)(PWM_MAX - PWM_MIN);
float throttle = (float)(pwm_out - PWM_MIN) * t_scale;
update_inj_row(throttle);
uint16_t ms = ticks_ms();
//uint32_t us = ticks_us();
if ((ms - loop_ms) >= 1000)
{
loop_ms += 1000;
//start_adc();
//int16_t a = analogue(0);
//printf("pwm_in=%u pwm_out=%u us=%lu a0=%d\n", pwm_in, pwm_out, us, a);
printf("pwm=%d throttle=%d rpm=%u ticks=%u \n", pwm_in, (int)(100*throttle), rpm(), inj_ticks_(rpm()));
}
//sleep(1000);
//_delay_ms(1000);
}
}
int main(int argc, char *argv[])
{
mrp_mainloop_t *ml;
mrp_clear(&cfg);
parse_cmdline(&cfg, argc, argv);
mrp_log_set_mask(cfg.log_mask);
mrp_log_set_target(cfg.log_target);
ml = mainloop_create(&cfg);
if (ml == NULL)
fatal("failed to create main loop.");
dbus_test.ml = ml;
setup_dbus_tests(ml);
ml = dbus_test.ml;
setup_timers(ml);
setup_io(ml);
setup_signals(ml);
MRP_UNUSED(setup_deferred); /* XXX TODO: add deferred tests... */
#ifdef GLIB_ENABLED
if (cfg.mainloop_type != MAINLOOP_GLIB && cfg.mainloop_type != MAINLOOP_QT) {
if (cfg.ngio > 0 || cfg.ngtimer > 0)
glib_pump_setup(ml);
}
setup_glib_io();
setup_glib_timers();
#endif
if (mrp_add_timer(ml, 1000, check_quit, NULL) == NULL)
fatal("failed to create quit-check timer");
setup_wakeup(ml);
mainloop_run(&cfg);
check_io();
check_timers();
check_signals();
#ifdef GLIB_ENABLED
check_glib_io();
check_glib_timers();
#endif
if (dbus_test.client != 0)
close(dbus_test.pipe[1]); /* let the client continue */
check_dbus();
#ifdef GLIB_ENABLED
if (cfg.mainloop_type != MAINLOOP_GLIB) {
if (cfg.ngio > 0 || cfg.ngtimer > 0)
glib_pump_cleanup();
}
#endif
cleanup_wakeup();
mainloop_cleanup(&cfg);
}
void setup() {
setup_timers(F_CPU);
DDRD |= 0x04;
after(200, blink, 0);
}
int main( void )
{
int32_t tmp = 0x0;
// uint8_t tmp8;
cli();
SetupInterruptPins();
y_pos = 0;
x_pos = 0;
// DDRC = _BV(PC6); //output pin
SetupDriverPins();
setup_clock();
setup_timers();
SetupPrintf();
USB_ZeroPrescaler();
USB_Init();
sei();
printf("hello world");
// motorflags |= 0x01;
// set_motor_pwm(PWM_MAX);
// forward();
// while(1);
//AutoSlop();
/*
AutoSlop();
while(1);
*/
// dec_backward();
// set_dec_pwm(0x1fff);
// ra_forward();
// set_ra_pwm(0x3fff);
while(1)
{
cli();
// tmp8 = usbHasEvent;
//add accumulated radial encoder output
y_pos += y_tmp;
y_tmp = 0;
x_pos += x_tmp;
x_tmp = 0;
sei();
if (usbHasEvent) ProcessUSB();
if (jog_value_dec == 0) {
tmp = ComputeOffset(&y_pos,&y_dest); //pid error value
slew_dec(&tmp);
}
if (jog_value_ra == 0) {
tmp = ComputeOffset(&x_pos,&x_dest); //pid error value
slew_ra(&tmp);
}
}
return 0;
}
