+//! MSDelay
+void msdelay(unsigned int ms){
+ volatile unsigned int i,j;
+ i=100;
+ while(i--){
+ j=ms;
+ while(j--) asm("nop");
+ }
+ //Using TimerA might be cleaner.
+}
+
+
+/* To better satisfy the somewhat odd timing requirements for
+ PIC33F/24H/24F ICSP programming, and for better control of GoodFET
+ timing more generally, here are a few delay routines that use Timer B.
+
+ Note that I wrote these referring only to the MSP430x2xx family
+ manual. Beware on MSP430x1xx chips. Further note that, assuming
+ some minor errors will be made, I try to err on the side of
+ delaying slightly longer than requested. */
+void prep_timer()
+{
+ #ifdef MSP430
+ BCSCTL2 = 0x00; /* In particular, use DCOCLK as SMCLK source with
+ divider 1. Hence, Timer B ticks with system
+ clock at 16 MHz. */
+
+ TBCTL = 0x0204; /* Driven by SMCLK; disable Timer B interrupts;
+ reset timer in case it was previously in use */
+ #else
+ #warning "Function unimplemented for this platform."
+ #endif
+}
+#if (platform != tilaunchpad)
+//! Delay for specified number of milliseconds (given 16 MHz clock)
+void delay_ms( unsigned int ms )
+{
+ #ifdef MSP430
+ // 16000 ticks = 1 ms
+ TBCTL |= 0x20; // Start timer!
+ while (ms--) {
+ while (TBR < 16000)
+ asm( "nop" );
+ TBCTL = 0x0224;
+ }
+ TBCTL = 0x0204; // Reset Timer B, till next time
+ #else
+ debugstr("delay_ms unimplemented");
+ #endif
+}
+
+//! Delay for specified number of microseconds (given 16 MHz clock)
+void delay_us( unsigned int us )
+{
+ #ifdef MSP430
+ // 16 ticks = 1 us
+ TBCTL |= 0x20; // Start timer!
+ while (us--) {
+ while (TBR < 16)
+ asm( "nop" );
+ TBCTL = 0x0224;
+ }
+ TBCTL = 0x0204; // Reset Timer B, till next time
+ #else
+ debugstr("delay_us unimplemented");
+ #endif
+}
+
+//! Delay for specified number of clock ticks (16 MHz clock implies 62.5 ns per tick).
+void delay_ticks( unsigned int num_ticks )
+{
+ #ifdef MSP430
+ TBCTL |= 0x20; // Start timer
+ while (TBR < num_ticks)
+ asm( "nop" );
+ TBCTL = 0x0204; // Reset Timer B, till next time
+ #else
+ debugstr("delay_ticks unimplemented");
+ #endif
+}
+#endif