#include "project.h"

#define WIGGLE	GPIO4
#define WIGGLE_PORT GPIOB

int
main (void)
{
  unsigned cnt=0;

  //nvic_set_priority_grouping(NVIC_PriorityGroup_4);

  /*set up pll */
  rcc_clock_setup_in_hse_8mhz_out_72mhz ();

  /*turn on clocks which aren't done elsewhere */
  rcc_periph_clock_enable (RCC_GPIOA);
  rcc_periph_clock_enable (RCC_GPIOB);
  rcc_periph_clock_enable (RCC_GPIOC);
  rcc_periph_clock_enable (RCC_AFIO);


  /*Adjust interrupt priorities so that taco trumps uarts trumps timer trumps dma */
  nvic_set_priority (TACHO_IRQ,0x20);
  nvic_set_priority (NVIC_USART1_IRQ, 0x40);
  nvic_set_priority (NVIC_SYSTICK_IRQ, 0x60);
  nvic_set_priority (NVIC_DMA1_CHANNEL6_IRQ, 0x80);

  /* Claw some pins pack*/
  gpio_primary_remap (AFIO_MAPR_SWJ_CFG_JTAG_OFF_SW_ON, 0);

  dwt_enable_cycle_counter();

  ticker_init ();


  led_init ();
  usart_init ();
  i2cp_init ();

  printf ("Hello world\n");

  led_set ();

  oled_init ();

  tacho_init();

  font8x8_put_str ("ABC fish soup!", 0, 0);

  MAP_OUTPUT_PP(WIGGLE);


  for (;;)
    {
 	char buf[20];

     sprintf(buf,"%6u rpm",(unsigned) raw_tacho);
     font8x16_put_str (buf, 30, 8);

     sprintf(buf,"%8d",cnt++);
     font8x8_put_str (buf, 0, 24);


    if (cnt&1) 
		SET(WIGGLE);
	else
		CLEAR(WIGGLE);

    }

  return 0;
}