Version 0.11

eventflag API addtiion
Add eventflag_set_poll_desc
2016-05-19 12:22:30 +09:00 · 2016-05-19 11:48:01 +09:00 · 2016-05-18 21:32:32 +09:00 · 2016-05-18 17:00:25 +09:00 · 2016-05-18 16:52:00 +09:00 · 2016-05-18 14:43:30 +09:00
59 changed files with 7569 additions and 1163 deletions
--- a/8
+++ b/8
@@ -5,6 +5,7 @@ Aidan Thornton:
 Kaz Kojima:
    Added STM32 Primer2 support.
 	board/board-stm32-primer2.h
+	example-primer2

 Kenji Rikitake:
    Added ST Dongle support.
@@ -16,9 +17,14 @@ Kiwamu Okabe:
    Wrote an OpenOCD scirpt:
        example-fsm-55/stlink-v2.cfg

+Mateusz Zalega:
+    Added Nitrokey-Start support.
+	board/board-nitrokey-start.h
+
 NIIBE Yutaka:
    Write the library:
-	chopstx.c, eventflag.c, entry.c, clk_gpio_init.c
+	chopstx.c, eventflag.c, entry.c,
+	clk_gpio_init-kl.c, clk_gpio_init-stm32.c
        chopstx.h, eventflag.h
    Draw the logo:
 	chopstx.svg, chopstx.png
--- a/338
+++ b/338
@@ -1,3 +1,337 @@
+2016-05-19  NIIBE Yutaka  <gniibe@fsij.org>
+
+	* VERSION: 0.11.
+	* doc/chopstx.texi (VERSION): 0.11.
+
+2016-05-18  NIIBE Yutaka  <gniibe@fsij.org>
+
+	* eventflag.c: Update using chopstx_poll and offer API for poll.
+
+	* chopstx.c (requeue): New.
+	(chopstx_mutex_lock, chopstx_join): Fix by requeue.
+	(chopstx_main_init): Remove.
+	(chopstx_setpriority): New.
+
+	* example-cdc/usb-cdc.c: Prepare for multiple TTYs.
+
+2016-05-17  NIIBE Yutaka  <gniibe@fsij.org>
+
+	* example-cdc/usb-cdc.c: Update as TTY input/output with line
+	editing support.
+	* example-cdc/sample.c: Likewise.
+	* example-cdc/tty.h: Rename from stream.h.
+
+	* chopstx.c (chopstx_poll): Set ->ready = 0.
+	Add spinlock for ll_dequeue.
+
+2016-05-16  NIIBE Yutaka  <gniibe@fsij.org>
+
+	* example-cdc/sys.c (nvic_enable_vector): Remove.
+	(usb_lld_sys_init): Don't setup NVIC priority.
+	(sys_version): sys version 3.0.
+
+2016-05-16  NIIBE Yutaka  <gniibe@fsij.org>
+
+	* chopstx.h (CHOPSTX_EXIT_SUCCESS, CHOPSTX_EXIT_CANCELED)
+	(CHOPSTX_EXIT_CANCELED_IN_SYNC): Remove.
+	(CHOPSTX_CANCELED): New.
+
+	* chopstx.c (chopstx_testcancel): Use CHOPSTX_CANCELED.
+	(chx_sched, chx_snooze): Re-define return values cleanly.
+	(chopstx_cancel): Use return value of chx_sched to cancel.
+	(chopstx_cond_wait, chopstx_join, chopstx_poll): Implement
+	cancellation rather easier way with return value of chx_sched.
+
+2016-05-15  NIIBE Yutaka  <gniibe@fsij.org>
+
+	* chopstx.c (chopstx_claim_irq): Don't register clean up function.
+	(chx_release_irq): Remove.
+	(chopstx_cancel): Disable IRQ when canceled at POLL.
+	(chopstx_poll): Fix IRQ handling.
+
+2016-05-13  NIIBE Yutaka  <gniibe@fsij.org>
+
+	* chopstx.c (chx_handle_intr): Call chx_request_preemption.
+	(chx_wakeup, chopstx_cond_signal, chopstx_cond_broadcast)
+	(chx_intr_hook, chopstx_poll): Cleanup.
+
+2016-05-13  NIIBE Yutaka  <gniibe@fsij.org>
+
+	* chopstx.c (chopstx_exit): Don't call chx_release_irq_thread.
+	(chx_release_irq_thread): Remove.
+	(q_intr): New variable.
+	(intr_top): Remove.
+	(chx_handle_intr, chx_init, chopstx_claim_irq)
+	(chopstx_intr_wait): Use Q_INTR.
+	(chx_intr_hook): New.
+	(chopstx_poll): Support CHOPSTX_POLL_INTR.
+	(chopstx_release_irq): Remove.
+	(chx_release_irq): New internal function.
+	(THREAD_WAIT_INT): Remove.
+	(chopstx_intr_wait): Rewrite by chopstx_poll.
+
+2016-05-13  NIIBE Yutaka  <gniibe@fsij.org>
+
+	* chopstx.c (chx_sched) [__ARM_ARCH_6M__]: Fix asm.
+	(chx_handle_intr, chx_wakeup, chopstx_cancel): Fix for polling
+	with no timeout.
+
+	* example-cdc/sample.c (main): Update chopstx_poll example.
+	* example-fs-bb48/sample.c (main): Ditto.
+
+	* chopstx.c (struct chx_px): Add READY_P and LOCK.
+	(chx_proxy_init): Add initialization of new members.
+	(chx_wakeup): Spinlock PX.
+	(chopstx_mutex_lock): Add protection by splinlock.
+	(chx_cond_hook, chx_join_hook): Change arguments.
+	(chx_cond_unhook, chx_join_unhook): Remove.
+	(chopstx_claim_irq): Compatible to chx_poll.
+	(chopstx_join): Fix spinlocking.
+	(chopstx_cancel): Fix spinlocking.
+
+2016-05-12  NIIBE Yutaka  <gniibe@fsij.org>
+
+	* example-cdc/sample.c: Update using chopstx_poll.
+	* example-cdc/sample.ld: Likewise.
+	* example-cdc/stream.h: Likewise.
+	* example-cdc/usb-cdc.c: Likewise.
+
+	* chopstx.c (chopstx_mutex_init): Initialize OWNER, too.
+	(preempt) [__ARM_ARCH_7M__]: Bug fix for register 0 to inhibit
+	scheduling.
+	(chx_sched) [__ARM_ARCH_6M__]: Return YIELD normally.
+	(MAX_USEC_FOR_TIMER): Guarantee 24-bit tick.
+	(chx_snooze): Revert the change of 2016-04-24 and modify
+	chopstx_poll instead.
+	(chopstx_poll): Support waiting forever.
+
+2016-04-24  Niibe Yutaka  <gniibe@fsij.org>
+
+	* chopstx.c (chx_snooze): Wait forever when it's POLL and usec==0.
+
+2016-04-22  Niibe Yutaka  <gniibe@fsij.org>
+
+	* example-fs-bb48/first-pages.c: Rename from reset.c and merge
+	crc32.c.
+	* example-fs-bb48/sample.ld: Define section for first two pages.
+	* example-fs-bb48/usb_kl27z.c (__usb_buf__): Remove.
+
+	* chopstx.c (chx_cond_hook): Rename from chopstx_cond_hook and make
+	it internal.
+	(chx_cond_unhook): Likewise.
+	(chx_join_hook, chx_join_unhook): New.
+	(chopstx_poll): Change API, not exposing internals of hook/unhook.
+
+	* example-fs-bb48/sample.c (main): Follow the API change of
+	chopstx_poll.
+
+2016-04-21  Niibe Yutaka  <gniibe@fsij.org>
+
+	* chopstx.c (chx_snooze, chx_wakeup): New.
+	(chopstx_cond_hook, chopstx_cond_unhook): New.
+	(chopstx_cond_signal, chopstx_cond_broadcast): Fix for poll.
+	(chx_proxy_init): Initialize with RUNNING.
+	(chopstx_poll): Fix with chx_snooze.
+	(chx_exit): Use chx_wakeup.
+
+	* example-fs-bb48/sample.c (main): Update with chopstx_poll.
+	* example-fs-bb48/usb-cdc.c (stream_recv): Fix the loop clear
+	FLAG_RECV_AVAIL only after we process it.
+
+2016-04-20  Niibe Yutaka  <gniibe@fsij.org>
+
+	* example-cdc/usb_stm32f103.c (usb_lld_reset): Supply FEATURE
+	argument.  Call usb_lld_set_configuration internally and set
+	FEATURE.
+	(usb_lld_set_feature): Remove.
+	* example-cdc/usb-cdc.c (usb_cb_device_reset): Update with new
+	API.
+
+	* example-cdc/sys.c: Include clk_gpio_init-stm32.c.
+	* example-led/sys.c, example-primer2/sys.c: Ditto.
+
+2016-04-19  Niibe Yutaka  <gniibe@fsij.org>
+
+	* example-fs-bb48/sample.c (main): Change the example to display
+	CRC32 value from input line.
+
+2016-04-18  Niibe Yutaka  <gniibe@fsij.org>
+
+	* example-fs-bb48: New directory for FS-BB48.
+
+	* clk_gpio_init-kl.c: New.
+	* clk_gpio_init-stm32.c: Rename from clk_gpio_init.c.
+
+2016-04-07  Niibe Yutaka  <gniibe@fsij.org>
+
+	* example-fsm-55/sys.c: Update for non-SVC Chopstx.
+
+2016-04-07  Niibe Yutaka  <gniibe@fsij.org>
+
+	* example-cdc/usb-cdc.c: Update.
+
+	* example-cdc/usb_stm32f103.c (usb_handle_transfer): Don't use
+	weak symbols for callbacks, but use explicit callbacks of
+	usb_cb_tx_done and usb_cb_rx_ready.
+
+	* example-cdc/usb_lld.h (usb_cb_tx_done, usb_cb_rx_ready): New
+	callbacks.
+
+2016-04-07  Niibe Yutaka  <gniibe@fsij.org>
+
+	* chopstx.c (chx_cpu_sched_lock, chx_cpu_sched_unlock): Use SVC
+	for Cortex-M3, because of ICI/IT of ESPR.
+	(chx_sched): Invoke svc for Cortex-M3.
+	(preempt, svc): Change back for Cortex-M3.
+
+2016-04-07  Niibe Yutaka  <gniibe@fsij.org>
+
+	* entry.c (vector_table): Since IDLE thread runs with PSP now, use
+	different value for MSP.
+
+	* chopstx.c (chx_sched): Push LR value to PC slot on stack, so
+	that it returns directly to caller.
+
+2016-04-06  Niibe Yutaka  <gniibe@fsij.org>
+
+	* chopstx.c (struct chx_pq): New struct for priority queue.
+	(struct chx_px): New struct for proxy.
+	(struct chx_thread): New member FLAG_IS_PROXY.
+	(ll_dequeue, ll_insert, ll_pop, ll_prio_push, ll_prio_enqueue)
+	Change API.
+	(THREAD_WAIT_POLL): New thread status.
+	(chx_ready_pop, chx_ready_push, chx_ready_enqueue): Type coercion.
+	(chx_timer_insert, chx_timer_dequeue, chx_timer_expired): Use
+	chx_pq.
+	(chx_handle_intr, chopstx_cancel): Handle THREAD_WAIT_POLL.
+	(chx_init): Type coercion.
+	(chx_exit): Handle proxy for join.
+	(chopstx_create): Initialize the member FLAG_IS_PROXY.
+	(chopstx_cond_signal) Handle proxy.
+	(chx_proxy_init, chopstx_poll): New.
+
+2016-04-06  Niibe Yutaka  <gniibe@fsij.org>
+
+	* chopstx.h (struct chx_qh): New struct.
+
+	* chopstx.c (struct chx_queue): Use chx_qh.
+	(struct chx_thread): New member PARENT.
+	(ll_empty): Use chx_qh.
+	(ll_prio_push, ll_prio_enqueue): Set the member PARENT.
+	(chx_ready_pop, chx_ready_push, chx_ready_enqueue): Use the
+	member Q.
+	(chx_timer_insert): Return TP.
+	(chx_timer_dequeue, chx_timer_expired): Use the member Q.
+	(chx_init): Initialize change for Q_READY, Q_TIMER, Q_JOIN.
+	(chx_sched, preempt): Handle return value of chx_timer_insert.
+	(chx_exit, chopstx_mutex_init, chopstx_cond_init): Use the member Q.
+	(chx_mutex_unlock): Type coercion to CHX_THREAD.
+	(chopstx_create): Initialize PARENT field.
+	(chopstx_mutex_lock): Use the PARENT field.
+	(chopstx_join): Use ll_prio_enqueue, instead of ll_insert.
+	(chopstx_wakeup_usec_wait): Set REG_R0 on the stack.
+
+2016-04-06  Niibe Yutaka  <gniibe@fsij.org>
+
+	* chopstx.c (struct chx_thread): Move tcontext field.
+	(chx_cpu_sched_lock, chx_cpu_sched_unlock): Use CPSID/CPSIE.
+	(chx_sched): Don't use SVC.  Return integer value.
+	(chopstx_usec_wait_var): Don't use R8.
+	(preempt): Modify so that we don't use SVC.
+
+2016-04-05  Niibe Yutaka  <gniibe@fsij.org>
+
+	* chopstx.c (struct NVIC): Add volatile qualifier to members.
+	(chx_spin_init): New.
+	(chopstx_mutex_init, chopstx_cond_init): Call chx_spin_init.
+	(chx_init): Initialize the spinlocks for INTR_LOCK, Q_READY,
+	Q_TIMER, and Q_JOIN.
+
+2016-03-08  Niibe Yutaka  <gniibe@fsij.org>
+
+	* chopstx.h (CHOPSTX_THREAD_SIZE): Align by 8.
+	* chopstx.c (struct chx_thread): Add W field to align.  This is to
+	comply AAPCS (ARM Architecture Procedure Call Standard).
+	(chx_init): Initialize W.
+
+	* example-cdc/usb_stm32f103.c, usb_lld.h: Update from Gnuk.
+	* example-cdc/usb-cdc.c: Update.
+
+2015-11-05  Niibe Yutaka  <gniibe@fsij.org>
+
+	* example-cdc/sample.c: Enhanced to be echo service.
+
+2015-09-15  Niibe Yutaka  <gniibe@fsij.org>
+
+	* VERSION: 0.10.
+	* doc/chopstx.texi (VERSION): 0.10.
+
+	* example-cdc/usb_stm32f103.c: Update from Gnuk.
+
+2015-09-14  Niibe Yutaka  <gniibe@fsij.org>
+
+	* chopstx.c (q_exit): Remove.
+	(chx_init, chx_exit): Remove access to Q_EXIT.
+	(chx_release_irq_thread): Fix removing from the list.
+
+2015-09-11  Niibe Yutaka  <gniibe@fsij.org>
+
+	* chopstx.c (chx_init, chopstx_create): Fix the initial value
+	of flag_cancelable.
+
+2015-09-10  Niibe Yutaka  <gniibe@fsij.org>
+
+	* VERSION: 0.09.
+	* doc/chopstx.texi (VERSION): 0.09.
+
+	* chopstx.c (chx_release_irq_thread): Rename.
+
+2015-09-09  Niibe Yutaka  <gniibe@fsij.org>
+
+	* example-cdc/usb-cdc.c (usb_cb_ctrl_write_finish): Distinguish
+	DTR signal.
+	(usb_cb_device_reset): Fix USB reset handling.
+
+	* chopstx.c (chopstx_usec_wait_var, chopstx_cond_wait)
+	(chopstx_intr_wait): Call chopstx_testcancel.
+	(chopstx_setcancelstate): New.
+
+	* chopstx.c (chx_systick_reset, chx_systick_reload)
+	(chx_systick_get): Factor out systick functions.
+	(chx_prio_init): Factor out.
+
+2015-09-08  Niibe Yutaka  <gniibe@fsij.org>
+
+	* chopstx.c (chx_request_preemption): Add PRIO argument and check
+	the condition inside.
+	(chx_timer_expired, chx_handle_intr): Call unconditionally.
+	(intr_lock): New variable.
+	(chx_handle_intr, chopstx_claim_irq, chopstx_release_irq)
+	(chopstx_release_irq_thread): Add spin lock with intr_lock.
+
+	* chopstx.h (chx_intr): Remove member LOCK.
+
+2015-09-07  Niibe Yutaka  <gniibe@fsij.org>
+
+	* example-primer2: New from Kazumoto Kojima.
+
+	* board/board-nitrokey-start.h (VAL_GPIO_USB_ODR)
+	(VAL_GPIO_USB_CRL): Fix the values for NeuG settings.
+
+2015-09-04  Niibe Yutaka  <gniibe@fsij.org>
+
+	* example-cdc/sys.h (BOARD_ID_NITROKEY_START): New.
+	* board/board-nitrokey-start.h (BOARD_ID): Fix the value.
+	* clk_gpio_init.c (AFIO_MAPR_SWJ_CFG_JTAGDISABLE): New.
+
+2015-08-07  Mateusz Zalega <mateusz@nitrokey.com>
+
+	* board/board-nitrokey-start.h: New.
+
+2015-08-06  Niibe Yutaka  <gniibe@fsij.org>
+
+	* example-fsm-55/README: Updated.
+
 2015-07-31  Niibe Yutaka  <gniibe@fsij.org>

 	* VERSION: 0.08.
@@ -8,7 +342,7 @@
 	* example-fsm-55/hacker-emblem.ld: Put vectors on ROM.
 	* example-fsm-55/sys.c: No system services.
 	* entry.c (entry): Can be public.
-	* clk_gpio_init.c [MCU_STM32F0] (clock_init): Don't change CFGR1.
+	* clk_gpio_init.c (clock_init) [MCU_STM32F0]: Don't change CFGR1.

 2015-07-30  Niibe Yutaka  <gniibe@fsij.org>

@@ -38,7 +372,7 @@
 	* example-cdc/sys.c (sys_board_id): New.
 	* example-cdc/sample.ld (.sys.board_id): New.
 	(__flash_start__, __flash_end__): Remove.
-	* entry.c [HAVE_SYS_H] (vector_table): By undefining STM32F10X_MD,
+	* entry.c (vector_table) [HAVE_SYS_H]: By undefining STM32F10X_MD,
 	prepare for high density device even compiled for MD device.

 2015-07-13  Kaz Kojima  <kkojima@rr.iij4u.or.jp>
--- a/72
+++ b/72
@@ -1,6 +1,78 @@
 NEWS - Noteworthy changes


+* Major changes in Chopstx 0.11
+
+  Released 2016-05-19
+
+** New feature: polling
+New function chopstx_poll is added to watch multiple condition
+variables, threads' exit, or IRQ, simultaneously with timeout.
+
+** Change API of eventflag
+The initialization function eventflag_init only has an argument of EV.
+An eventflag can be waited with timeout or can be waited with no
+timeout, as caller like.  It is not determined at initialization time
+now.  Besides, the eventflag can be waited by any threads.  Functions
+to poll eventflag together with other events (cond, join, and IRQ) are
+provided.
+
+** Removal of the function chopstx_release_irq
+IRQ is enabled only when a thread is blocked in polling.  When it (the
+thread in polling) is canceled, IRQ is disabled.
+
+** Removal of the function chopstx_main_init
+It is removed because it's too special.  Please use
+chopstx_setpriority instead.
+
+** New function: chopstx_setpriority
+This function is not recommended in general.  It is only added to
+support the usage when main thread wants to change the schedule
+priority after creating other threads.
+
+** Function chopstx_intr_wait is deprecated
+Use of chopstx_poll is recommended.
+
+** FS-BB48: Kinetis L MCU
+Support for FS-BB48 board with Kinetis L MCU is added.
+
+** No HardFault at context switch on Cortex-M0
+By its design, Chopstx does context switch holding the scheduler lock.
+This is implemented with the feature of BASEPRI on Cortex-M3.  Because
+Cortex-M0 doesn't have support of BASEPRI, the context switch (before
+version 0.11) always caused HardFault exception.  Since Cortex-M0
+doesn't have complex exception mechism of ICI/IT (which is supported
+on Cortex-M3), it is actually possible to implement the context switch
+in user mode.  This is done.
+
+** New sys.c (3.0)
+Don't touch NVIC in usb_lld_sys_init.
+
+
+* Major changes in Chopstx 0.10
+
+  Released 2015-09-15
+
+** Thread cancellation bug fix
+Thread cancellation didn't work well with 0.09 because
+of initial configuration mistake.  It's fixed.
+
+** Interrupt handler bug fix
+Interrupt handler wasn't unregistered on exit well.
+It's fixed.
+
+
+* Major changes in Chopstx 0.09
+
+  Released 2015-09-10
+
+** New board support: Nitrokey-Start
+It is contributed by Mateusz Zalega.
+
+** Thread cancellation
+Add new API: chopstx_setcancelstate.
+
+
 * Major changes in Chopstx 0.08

  Released 2015-07-31
--- a/26
+++ b/26
@@ -1,14 +1,14 @@
 Chopstx - Threads and only Threads
-							Version 0.08
-							  2015-07-31
+							Version 0.11
+							  2016-05-19
 							Niibe Yutaka
 					     Flying Stone Technology

 What's Chopstx?
 ===============

-Chopstx is an RT thread library for STM32F103 (ARM Cortex-M3)
-or STM32F0 (ARM Cortex-M0).
+Chopstx is an RT thread library for STM32F103 (ARM Cortex-M3),
+STM32F0 (ARM Cortex-M0), or KL27Z (ARM Cortex-M0plus).

 While most RTOSes come with many features, drivers, and stacks,
 Chopstx just offers a simple RT thread library.
@@ -28,21 +28,27 @@ EXCEPTION.
 Example code
 ============

-We have two examples in this distribution, LED blinker and
-USB CDC-ACM function.  You can build it like:
+We have some examples in this distribution; Useful ones are LED
+blinker and USB CDC-ACM function.  For STM32F103, you can build it
+USB CDC-ACM demo by:

   $ cd example-cdc
-   $ ln -s ../board/board-olimex-stm32-h103.h board.h
+   $ ln -sf ../board/board-olimex-stm32-h103.h board.h
   $ make

 For a specific board named FSM-55, an example of LED matrix dynamic
 driver is provided.  See the directory: example-fsm-55.

+For STM32 Primer2, see the directory: example-primer2.
+

 Future Works
 ============

-Convenience function to determine bottom of thread stack, thread local
-storage and support of interface like poll/select would be next thing
-to be done.
+Convenience function to determine the bottom of thread stack, thread
+local storage would be next thing to be done.
+
+Experimental SMP port for Cortex-A7 is under development.  For SMP,
+more careful considerations for shared access to objects of struct
+chx_pq is needed.  So, modifications required will not be small.
 -- 
--- a/2
+++ b/2
@@ -1 +1 @@
-release/0.08
+release/0.11
--- a/board/board-fs-bb48.h
+++ b/board/board-fs-bb48.h
@@ -0,0 +1,5 @@
+#define BOARD_NAME "FS-BB48"
+#define BOARD_ID    0xd1f5119c
+/* echo -n "FST-01" | sha256sum | sed -e 's/^.*\(........\)  -$/\1/' */
+
+#define MCU_KINETIS_L      1
--- a/board/board-fsm-55.h
+++ b/board/board-fsm-55.h
@@ -31,13 +31,12 @@
 #define RCC_ENR_IOP_EN   (RCC_AHBENR_IOPAEN | RCC_AHBENR_IOPFEN)
 #define RCC_RSTR_IOP_RST (RCC_AHBRSTR_IOPARST | RCC_AHBRSTR_IOPFRST)

-/* ??? NeuG settings for ADC2 is default (PA0: Analog IN0, PA1: Analog IN1).  */
-
 /*
 * Port F setup.
 * PF0  - USER Button
+ * PF1  - SPEAKER
 */
-#define VAL_GPIO_OTHER_MODER   0x00000000 /* Input Pin0 */
-#define VAL_GPIO_OTHER_OTYPER  0x00000000
+#define VAL_GPIO_OTHER_MODER   0x00000004 /* Input Pin0, Output Pin1 */
+#define VAL_GPIO_OTHER_OTYPER  0x00000000 /* Push-Pull Pin1 */
 #define VAL_GPIO_OTHER_OSPEEDR 0x00000000
-#define VAL_GPIO_OTHER_PUPDR   0x00000001 /* Pull-up Pin0 */
+#define VAL_GPIO_OTHER_PUPDR   0x00000009 /* Pull-up Pin0, Pull-down Pin1 */
--- a/board/board-nitrokey-start.h
+++ b/board/board-nitrokey-start.h
@@ -0,0 +1,59 @@
+#define BOARD_NAME "NITROKEY-START"
+#define BOARD_ID    0xad1e7ebd
+
+#define STM32F10X_MD		/* Medium-density device */
+
+#define STM32_PLLXTPRE                  STM32_PLLXTPRE_DIV1
+#define STM32_PLLMUL_VALUE              6
+#define STM32_HSECLK                    12000000
+
+#define GPIO_LED_BASE   GPIOB_BASE
+#define GPIO_LED_SET_TO_EMIT            0
+#define GPIO_USB_BASE   GPIOA_BASE
+#define GPIO_USB_SET_TO_ENABLE          15
+#undef  GPIO_OTHER_BASE
+
+/*
+ * Port A setup.
+ * PA0 - input with pull-up: AN0 for NeuG
+ * PA1 - input with pull-up: AN1 for NeuG
+ * PA2 - floating input
+ * PA3 - floating input
+ * PA4 - floating input
+ * PA5 - floating input
+ * PA6 - floating input
+ * PA7 - Push pull output   (LED1 1:ON 0:OFF)
+ * PA8 - floating input (smartcard, SCDSA)
+ * PA9 - floating input
+ * PA10 - floating input
+ * PA11 - Push Pull output 10MHz 0 default (until USB enabled) (USBDM)
+ * PA12 - Push Pull output 10MHz 0 default (until USB enabled) (USBDP)
+ * PA15 - Push pull output  (USB_EN 1:ON 0:OFF)
+ * ------------------------ Default
+ * PA8  - input with pull-up.
+ * PA9  - floating input.
+ * PA10 - floating input.
+ * PA13 - input with pull-up.
+ * PA14 - input with pull-up.
+ * PA15 - Push pull output   (USB 1:ON 0:OFF)
+ */
+#define VAL_GPIO_USB_ODR            0xFFFFE7FF
+#define VAL_GPIO_USB_CRL            0x34444488      /*  PA7...PA0 */
+#define VAL_GPIO_USB_CRH            0x38811444      /* PA15...PA8 */
+
+/*
+ * Port B setup.
+ * PB0  - Push pull output   (LED2 1:ON 0:OFF)
+ * ------------------------ Default
+ * PBx  - input with pull-up.
+ */
+#define VAL_GPIO_LED_ODR            0xFFFFFFFF
+#define VAL_GPIO_LED_CRL            0x88888883      /*  PA7...PA0 */
+#define VAL_GPIO_LED_CRH            0x88888888      /* PA15...PA8 */
+
+#define RCC_ENR_IOP_EN      \
+	(RCC_APB2ENR_IOPAEN | RCC_APB2ENR_IOPBEN | RCC_APB2ENR_AFIOEN)
+#define RCC_RSTR_IOP_RST    \
+	(RCC_APB2RSTR_IOPARST | RCC_APB2RSTR_IOPBRST | RCC_APB2RSTR_AFIORST)
+
+#define AFIO_MAPR_SOMETHING   AFIO_MAPR_SWJ_CFG_JTAGDISABLE
--- a/chopstx.c
+++ b/chopstx.c
--- a/chopstx.h
+++ b/chopstx.h
@@ -1,7 +1,7 @@
 /*
 * chopstx.h - Threads and only threads.
 *
- * Copyright (C) 2013 Flying Stone Technology
+ * Copyright (C) 2013, 2016 Flying Stone Technology
 * Author: NIIBE Yutaka <gniibe@fsij.org>
 *
 * This file is a part of Chopstx, a thread library for embedded.
@@ -26,12 +26,15 @@
 *
 */

+struct chx_qh {
+  struct chx_pq *next, *prev;
+};
+
 typedef uint32_t chopstx_t;
 typedef uint8_t chopstx_prio_t;

 extern chopstx_t chopstx_main;

-void chopstx_main_init (chopstx_prio_t);

 /* NOTE: This signature is different to PTHREAD's one.  */
 chopstx_t
@@ -44,8 +47,6 @@ chopstx_create (uint32_t flags_and_prio,

 #define CHOPSTX_PRIO_INHIBIT_PREEMPTION 248

-void chopstx_usec_wait_var (uint32_t *arg);
-
 void chopstx_usec_wait (uint32_t usec);

 struct chx_spinlock {
@@ -53,9 +54,7 @@ struct chx_spinlock {
 };

 typedef struct chx_mtx {
-  struct {
-    struct chx_thread *next, *prev;
-  } q;
+  struct chx_qh q;
  struct chx_spinlock lock;
  struct chx_thread *owner;
  struct chx_mtx *list;
@@ -69,9 +68,7 @@ void chopstx_mutex_lock (chopstx_mutex_t *mutex);
 void chopstx_mutex_unlock (chopstx_mutex_t *mutex);

 typedef struct chx_cond {
-  struct {
-    struct chx_thread *next, *prev;
-  } q;
+  struct chx_qh q;
  struct chx_spinlock lock;
 } chopstx_cond_t;

@@ -82,26 +79,13 @@ void chopstx_cond_wait (chopstx_cond_t *cond, chopstx_mutex_t *mutex);
 void chopstx_cond_signal (chopstx_cond_t *cond);
 void chopstx_cond_broadcast (chopstx_cond_t *cond);

-typedef struct chx_intr {
-  struct chx_intr *next;
-  struct chx_spinlock lock;
-  struct chx_thread *tp;
-  uint32_t ready;
-  uint8_t irq_num;
-} chopstx_intr_t;
-
-void chopstx_claim_irq (chopstx_intr_t *intr, uint8_t irq_num);
-void chopstx_release_irq (chopstx_intr_t *intr);
-
-void chopstx_intr_wait (chopstx_intr_t *intr);
-
 /*
 * Library provides default implementation as weak reference.
 * User can replace it.
  */
 void chx_fatal (uint32_t err_code) __attribute__((__weak__, __noreturn__));

-void chopstx_join (chopstx_t, void **);
+int chopstx_join (chopstx_t, void **);
 void chopstx_exit (void *retval) __attribute__((__noreturn__));


@@ -111,26 +95,68 @@ enum {
  CHOPSTX_ERR_JOIN,
 };

-enum {
-  CHOPSTX_EXIT_SUCCESS = 0,
-  CHOPSTX_EXIT_CANCELED         = 256,
-  CHOPSTX_EXIT_CANCELED_IN_SYNC = 257,
-};
+#define CHOPSTX_CANCELED ((void *) -1)

 void chopstx_cancel (chopstx_t thd);
 void chopstx_testcancel (void);

-struct chx_cleanup {
+/* NOTE: This signature is different to PTHREAD's one.  */
+int chopstx_setcancelstate (int);
+
+typedef struct chx_cleanup {
  struct chx_cleanup *next;
  void (*routine) (void *);
  void *arg;
-};
+} chopstx_cleanup_t;

 /* NOTE: This signature is different to PTHREAD's one.  */
-void chopstx_cleanup_push (struct chx_cleanup *clp);
+void chopstx_cleanup_push (chopstx_cleanup_t *clp);
 void chopstx_cleanup_pop (int execute);


-void chopstx_wakeup_usec_wait (chopstx_t thd);
+void chopstx_setpriority (chopstx_prio_t);

-#define CHOPSTX_THREAD_SIZE 60
+void chopstx_usec_wait_var (uint32_t *arg); /* DEPRECATED */
+void chopstx_wakeup_usec_wait (chopstx_t thd); /* DEPRECATED */
+
+enum {
+  CHOPSTX_POLL_COND = 0,
+  CHOPSTX_POLL_INTR,
+  CHOPSTX_POLL_JOIN,
+};
+
+struct chx_poll_cond {
+  uint16_t type;
+  uint16_t ready;
+  /**/
+  chopstx_cond_t *cond;
+  chopstx_mutex_t *mutex;
+  int (*check) (void *);
+  void *arg;
+};
+typedef struct chx_poll_cond chopstx_poll_cond_t;
+
+struct chx_poll_join {
+  uint16_t type;
+  uint16_t ready;
+  /**/
+  chopstx_t thd;
+};
+typedef struct chx_poll_join chopstx_poll_join_t;
+
+struct chx_intr {
+  uint16_t type;
+  uint16_t ready;
+  /**/
+  uint8_t irq_num;
+};
+typedef struct chx_intr chopstx_intr_t;
+
+void chopstx_claim_irq (chopstx_intr_t *intr, uint8_t irq_num);
+
+void chopstx_intr_wait (chopstx_intr_t *intr); /* DEPRECATED */
+
+
+int chopstx_poll (uint32_t *usec_p, int n, ...);
+
+#define CHOPSTX_THREAD_SIZE 64
--- a/clk_gpio_init-kl.c
+++ b/clk_gpio_init-kl.c
@@ -0,0 +1,140 @@
+/*
+ * clk_gpio_init-kl.c - Clock and GPIO initialization for Kinetis L.
+ *
+ * Copyright (C) 2016  Flying Stone Technology
+ * Author: NIIBE Yutaka <gniibe@fsij.org>
+ *
+ * This file is a part of Chopstx, a thread library for embedded.
+ *
+ * Chopstx is free software: you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * Chopstx is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ *
+ * As additional permission under GNU GPL version 3 section 7, you may
+ * distribute non-source form of the Program without the copy of the
+ * GNU GPL normally required by section 4, provided you inform the
+ * receipents of GNU GPL by a written offer.
+ *
+ */
+
+#include "kl_sim.h"
+
+struct MCG {
+  volatile uint8_t C1;   /* MCG Control Register 1             */
+  volatile uint8_t C2;   /* MCG Control Register 2             */
+  uint8_t reserved0[4];  /*                                    */
+  volatile uint8_t S;    /* MCG Status Register                */
+  uint8_t reserved1[1];  /*                                    */
+  volatile uint8_t SC;   /* MCG Status and Control Register    */
+  uint8_t reserved2[15]; /*                                    */
+  volatile uint8_t MC;   /* MCG Miscellaneous Control Register */
+};
+static struct MCG *const MCG = (struct MCG *const)0x40064000;
+
+struct USB_CLK_RECOVER {
+  volatile uint8_t CTRL;           /* USB Clock             */
+  uint8_t rsvd38[3];               /*     recovery control  */
+  volatile uint8_t IRC_EN;         /* IRC48M oscillator     */
+  uint8_t rsvd39[3];               /*     enable register   */
+  volatile uint8_t INT_EN;         /* Clock recovery        */
+  uint8_t rsvd40[3];               /*     interrupt enable  */
+  volatile uint8_t INT_STATUS;     /* Clock recovery        */
+                                   /*     interrupt status  */
+};
+static struct USB_CLK_RECOVER *const USB_CLK_RECOVER =
+  (struct USB_CLK_RECOVER *const)0x40072140;
+
+static void __attribute__((used))
+clock_init (void)
+{
+  SIM->CLKDIV1 = (SIM->CLKDIV1 & 0xF0070000)
+               | (1 << 16)	/* OUTDIV4 = 001: Divide-by-2 */
+               ;
+
+  MCG->MC = 0x80; /* HIRC Enable, LIRC_DIV2=000: Division factor=1 */
+  MCG->C1 = 0x00; /* Select HIRC clock, LIRC disabled. */
+  /* Make sure HIRC clock is selected.  */
+  while ((MCG->S & 0x0c) != 0)
+    ;
+
+  SIM->SOPT2 = 0x00040060;	/* USBSRC=IRC48, CLOKOUTSEL=LPO, RTC-clock */
+
+  SIM->SCGC4 = (1 << 18);	/* Enable USB FS clock         */
+  SIM->SCGC5 = (1 << 10);	/* Enable Port B clock        */
+  SIM->COPC = 0;		/* COP disabled               */
+
+  /* Crystal-less USB setup.  */
+  USB_CLK_RECOVER->IRC_EN = 0x02;
+  USB_CLK_RECOVER->CTRL = 0x80;
+}
+
+
+struct PORT {
+  volatile uint32_t PCR0;  volatile uint32_t PCR1;
+  volatile uint32_t PCR2;  volatile uint32_t PCR3;
+  volatile uint32_t PCR4;  volatile uint32_t PCR5;
+  volatile uint32_t PCR6;  volatile uint32_t PCR7;
+  volatile uint32_t PCR8;  volatile uint32_t PCR9;
+  volatile uint32_t PCR10; volatile uint32_t PCR11;
+  volatile uint32_t PCR12; volatile uint32_t PCR13;
+  volatile uint32_t PCR14; volatile uint32_t PCR15;
+  volatile uint32_t PCR16; volatile uint32_t PCR17;
+  volatile uint32_t PCR18; volatile uint32_t PCR19;
+  volatile uint32_t PCR20; volatile uint32_t PCR21;
+  volatile uint32_t PCR22; volatile uint32_t PCR23;
+  volatile uint32_t PCR24; volatile uint32_t PCR25;
+  volatile uint32_t PCR26; volatile uint32_t PCR27;
+  volatile uint32_t PCR28; volatile uint32_t PCR29;
+  volatile uint32_t PCR30; volatile uint32_t PCR31;
+  volatile uint32_t GPCLR; volatile uint32_t GPCHR;
+  uint32_t reserved[6];
+  volatile uint32_t ISFR;
+};
+static struct PORT *const PORTB = (struct PORT *const)0x4004A000;
+static struct PORT *const PORTD = (struct PORT *const)0x4004C000;
+static struct PORT *const PORTE = (struct PORT *const)0x4004D000;
+
+struct GPIO {
+  volatile uint32_t PDOR; /* Port Data Output Register    */
+  volatile uint32_t PSOR; /* Port Set Output Register     */
+  volatile uint32_t PCOR; /* Port Clear Output Register   */
+  volatile uint32_t PTOR; /* Port Toggle Output Register  */
+  volatile uint32_t PDIR; /* Port Data Input Register     */
+  volatile uint32_t PDDR; /* Port Data Direction Register */
+};
+static struct GPIO *const GPIOB = (struct GPIO *const)0x400FF040;
+static struct GPIO *const GPIOD = (struct GPIO *const)0x400FF0C0;
+static struct GPIO *const GPIOE = (struct GPIO *const)0x400FF100;
+
+
+static void __attribute__((used))
+gpio_init (void)
+{
+  PORTB->PCR0 = (1<<8) /* GPIO                  */
+              | (0<<6) /* DriveStrengthEnable=0 */
+              | (0<<4) /* PassiveFilterEnable=0 */
+              | (1<<2) /* SlewRateEnable = slow */
+              | (0<<1) /* pull enable = 0       */ 
+              | (0<<0) /* puddselect= 0         */
+              ;
+  PORTB->PCR1 = (1<<8) /* GPIO                  */
+              | (0<<6) /* DriveStrengthEnable=0 */
+              | (0<<4) /* PassiveFilterEnable=0 */
+              | (1<<2) /* SlewRateEnable = slow */
+              | (0<<1) /* pull enable = 0       */ 
+              | (0<<0) /* puddselect= 0         */
+              ;
+
+  GPIOB->PDDR = (1 << 1) | (1 << 0); /* PTB0, PTB1 : Output    */
+  GPIOB->PSOR = (1 << 0);            /* PTB0: Set  : Light off */
+  GPIOB->PCOR = (1 << 1);            /* PTB1: Clear: Output 0  */
+}
--- a/clk_gpio_init-stm32.c
+++ b/clk_gpio_init-stm32.c
@@ -1,5 +1,5 @@
 /*
- * clk_gpio_init.c - Clock and GPIO initialization.
+ * clk_gpio_init-stm32.c - Clock and GPIO initialization for STM32.
 *
 * Copyright (C) 2015  Flying Stone Technology
 * Author: NIIBE Yutaka <gniibe@fsij.org>
@@ -230,7 +230,7 @@ clock_init (void)
  RCC->APB2ENR |= RCC_APB2ENR_SYSCFGEN;
  RCC->APB2RSTR = RCC_APB2RSTR_SYSCFGRST;
  RCC->APB2RSTR = 0;
-  
+
 # if defined(HAVE_SYS_H)
  /* Use vectors on RAM */
  SYSCFG->CFGR1 = (SYSCFG->CFGR1 & ~SYSCFG_CFGR1_MEM_MODE) | 3;
@@ -283,6 +283,7 @@ static struct AFIO *const AFIO = (struct AFIO *const)AFIO_BASE;

 #define AFIO_MAPR_TIM3_REMAP_PARTIALREMAP 0x00000800
 #define AFIO_MAPR_SWJ_CFG_DISABLE         0x04000000
+#define AFIO_MAPR_SWJ_CFG_JTAGDISABLE     0x02000000


 struct GPIO {
--- a/doc/chopstx-api.texi
+++ b/doc/chopstx-api.texi
@@ -7,16 +7,6 @@ When it detects a coding error, this function will be called to
 stop further execution of code.  It never returns.
@end deftypefun

-@subheading chopstx_main_init
-@anchor{chopstx_main_init}
-@deftypefun {void} {chopstx_main_init} (chopstx_prio_t @var{prio})
-@var{prio}: priority
-
-Initialize main thread with @var{prio}.
-The thread main is created with priority CHX_PRIO_MAIN_INIT,
-and it runs with that priority until this routine will is called.
-@end deftypefun
-
@subheading chopstx_create
@anchor{chopstx_create}
@deftypefun {chopstx_t} {chopstx_create} (uint32_t @var{flags_and_prio}, uint32_t @var{stack_addr}, size_t @var{stack_size}, voidfunc @var{thread_entry}, void * @var{arg})
@@ -30,7 +20,7 @@ and it runs with that priority until this routine will is called.

@var{arg}: Argument to the thread entry function

-Create a thread.
+Create a thread.  Returns thread ID.
@end deftypefun

@subheading chopstx_usec_wait_var
@@ -40,6 +30,8 @@ Create a thread.

 Sleep for micro seconds, specified by @var{var}.
 Another thread can clear @var{var} to stop the caller going into sleep.
+
+This function is DEPRECATED.  Please use chopstx_poll.
@end deftypefun

@subheading chopstx_usec_wait
@@ -118,20 +110,14 @@ Wake up all threads waiting on @var{cond}.
 Claim interrupt @var{intr} with @var{irq_num} for this thread.
@end deftypefun

-@subheading chopstx_release_irq
-@anchor{chopstx_release_irq}
-@deftypefun {void} {chopstx_release_irq} (chopstx_intr_t * @var{intr0})
-@var{intr0}: Interrupt request to be unregistered
-
-Release the interrupt request specified by @var{intr0}.
-@end deftypefun
-
@subheading chopstx_intr_wait
@anchor{chopstx_intr_wait}
@deftypefun {void} {chopstx_intr_wait} (chopstx_intr_t * @var{intr})
@var{intr}: Pointer to INTR structure

 Wait for the interrupt @var{intr} to be occured.
+
+This function is DEPRECATED.  Please use chopstx_poll.
@end deftypefun

@subheading chopstx_cleanup_push
@@ -156,20 +142,21 @@ clean-up will be executed.
@deftypefun {void} {chopstx_exit} (void * @var{retval})
@var{retval}: Return value (to be caught by a joining thread)

-Calling this function terminates the execution of thread, after
-calling clean up functions.  If the calling thread still holds
-mutexes, they will be released.  If the calling thread claiming
-IRQ, it will be released, too.  This function never returns.
+Calling this function terminates the execution of running thread,
+after calling clean up functions.  If the calling thread still
+holds mutexes, they will be released.  This function never
+returns.
@end deftypefun

@subheading chopstx_join
@anchor{chopstx_join}
-@deftypefun {void} {chopstx_join} (chopstx_t @var{thd}, void ** @var{ret})
+@deftypefun {int} {chopstx_join} (chopstx_t @var{thd}, void ** @var{ret})
@var{thd}: Thread to wait

@var{ret}: Pointer to void * to store return value

 Waits for the thread of @var{thd} to terminate.
+Returns 0 on success, 1 when waiting is interrupted.
@end deftypefun

@subheading chopstx_wakeup_usec_wait
@@ -179,6 +166,9 @@ Waits for the thread of @var{thd} to terminate.

 Canceling the timer, wake up the sleeping thread.
 No return value.
+
+This function is DEPRECATED.  Please use chopstx_cond_signal,
+where sleeping process calls chopstx_poll.
@end deftypefun

@subheading chopstx_cancel
@@ -199,3 +189,37 @@ No return value.  If the thread is canceled, this function
 does not return.
@end deftypefun

+@subheading chopstx_setcancelstate
+@anchor{chopstx_setcancelstate}
+@deftypefun {int} {chopstx_setcancelstate} (int @var{cancel_disable})
+@var{cancel_disable}: 0 to enable cancelation, otherwise disabled.
+
+Calling chopstx_setcancelstate sets cancelability state.
+
+Returns old state which is 0 when it was enabled.
+@end deftypefun
+
+@subheading chopstx_poll
+@anchor{chopstx_poll}
+@deftypefun {int} {chopstx_poll} (uint32_t * @var{usec_p}, int @var{n},  @var{...})
+@var{usec_p}: Pointer to usec for timeout.  Forever if NULL.
+
+@var{n}: Number of poll descriptors
+
+Returns number of active descriptors.
+@end deftypefun
+
+@subheading chopstx_setpriority
+@anchor{chopstx_setpriority}
+@deftypefun {void} {chopstx_setpriority} (chopstx_prio_t @var{prio})
+@var{prio}: priority
+
+Change the schedule priority with @var{prio}.
+
+In general, it is not recommended to use this function because
+dynamically changing schedule priorities complicates the system.
+Only a possible valid usage of this function is in the main thread
+which starts its execution with priority of CHX_PRIO_MAIN_INIT, and
+let it change its priority after initialization of other threads.
+@end deftypefun
+
--- a/doc/chopstx.texi
+++ b/doc/chopstx.texi
@@ -1,7 +1,7 @@
 \input texinfo                      @c -*-texinfo-*-
@c %**start of header
@setfilename chopstx.info
-@set VERSION 0.08
+@set VERSION 0.11
@settitle Chopstx Reference Manual
@c Unify some of the indices.
@syncodeindex tp fn
@@ -11,7 +11,7 @@
 This manual is for Chopstx (version @value{VERSION}).

@noindent
-Copyright @copyright{} 2013 Flying Stone Technology @*
+Copyright @copyright{} 2013, 2015, 2016 Flying Stone Technology @*

@quotation
 Permission is granted to copy, distribute and/or modify this document
@@ -83,8 +83,8 @@ Indexes
@node Introduction
@chapter Introduction

-Chopstx is an RT thread library for ARM Cortex-M3, specifically,
-STM32F103.
+Chopstx is an RT thread library for ARM Cortex-M0 and Cortex-M3.
+Specifically, it is used for STM32F030, STM32F103, and KL27Z.

 While most RTOSes come with many features, drivers, and stacks,
 Chopstx just offers a RT thread library.
--- a/entry.c
+++ b/entry.c
@@ -1,7 +1,8 @@
 /*
 * entry.c - Entry routine when reset and interrupt vectors.
 *
- * Copyright (C) 2013, 2014, 2015  Flying Stone Technology
+ * Copyright (C) 2013, 2014, 2015, 2016
+ *               Flying Stone Technology
 * Author: NIIBE Yutaka <gniibe@fsij.org>
 *
 * This file is a part of Chopstx, a thread library for embedded.
@@ -37,7 +38,11 @@
 #undef STM32F10X_MD		/* Prepare for high density device, too.  */
 #else
 #include "board.h"
-#include "clk_gpio_init.c"
+#if defined (MCU_KINETIS_L)
+#include "clk_gpio_init-kl.c"
+#else
+#include "clk_gpio_init-stm32.c"
+#endif
 #endif


@@ -48,7 +53,9 @@
 #endif

 extern uint8_t __main_stack_end__;
+#if defined(__ARM_ARCH_7M__)
 extern void svc (void);
+#endif
 extern void preempt (void);
 extern void chx_timer_expired (void);
 extern void chx_handle_intr (void);
@@ -60,18 +67,7 @@ static void nmi (void)

 static void hard_fault (void)
 {
-#if defined(__ARM_ARCH_6M__)
-  register uint32_t primask;
-
-  asm ("mrs	%0, PRIMASK" : "=r" (primask));
-
-  if (primask)
-    asm volatile ("b	svc");
-  else
-    for (;;);
-#else
  for (;;);
-#endif
 }

 static void mem_manage (void)
@@ -105,7 +101,8 @@ uint32_t vectors_in_ram[48];
 * This routine only changes PSP and not MSP.
 */
 STATIC_ENTRY __attribute__ ((naked,section(".text.startup.0")))
-void entry (void)
+void
+entry (void)
 {
  asm volatile ("bl	clock_init\n\t"
 		/* Clear BSS section.  */
@@ -169,7 +166,7 @@ void entry (void)
 typedef void (*handler)(void);

 handler vector_table[] __attribute__ ((section(".startup.vectors"))) = {
-  (handler)&__main_stack_end__,
+  (handler)(&__main_stack_end__ - 32),
  entry,
  nmi,		/* nmi */
  hard_fault,		/* hard fault */
@@ -180,7 +177,11 @@ handler vector_table[] __attribute__ ((section(".startup.vectors"))) = {
  none,
  /* 0x20 */
  none, none, none,		/* reserved */
+#if defined(__ARM_ARCH_6M__)
+  none,				/* SVCall */
+#elif defined(__ARM_ARCH_7M__)
  svc,				/* SVCall */
+#endif  
  none,				/* Debug */
  none,				/* reserved */
  preempt,			/* PendSV */
@@ -199,7 +200,7 @@ handler vector_table[] __attribute__ ((section(".startup.vectors"))) = {
  chx_handle_intr /* DMA1 CH6 */, chx_handle_intr /* DMA1 CH7 */,
  chx_handle_intr /* ADC1_2 */,   chx_handle_intr /* USB HP */,
  /* 0x90 */
-  chx_handle_intr /* USB LP */,   chx_handle_intr /* CAN */, 
+  chx_handle_intr /* USB LP */,   chx_handle_intr /* CAN */,
  /* ... and more.  EXT9_5, TIMx, I2C, SPI, USART, EXT15_10 */
  chx_handle_intr,                chx_handle_intr,
  /* 0xA0 */
--- a/eventflag.c
+++ b/eventflag.c
@@ -1,7 +1,7 @@
 /*
- * eventflag.c - Eventflag with/without timeout
+ * eventflag.c - Eventflag
 *
- * Copyright (C) 2013 Flying Stone Technology
+ * Copyright (C) 2013, 2016  Flying Stone Technology
 * Author: NIIBE Yutaka <gniibe@fsij.org>
 *
 * This file is a part of Chopstx, a thread library for embedded.
@@ -31,24 +31,55 @@
 #include <chopstx.h>
 #include <eventflag.h>

-enum {
-  EVENTFLAG_ERR_WAIT = CHOPSTX_ERR_JOIN + 1,
-  EVENTFLAG_ERR_TIMED_WAIT,
-};
+
+void
+eventflag_init (struct eventflag *ev)
+{
+  ev->flags = 0;
+  chopstx_cond_init (&ev->cond);
+  chopstx_mutex_init (&ev->mutex);
+}
+
+
+static int
+eventflag_check (void *arg)
+{
+  struct eventflag *ev = arg;
+
+  return ev->flags != 0;
+}


 void
-eventflag_init (struct eventflag *ev, chopstx_t sleeper)
+eventflag_prepare_poll (struct eventflag *ev, chopstx_poll_cond_t *poll_desc)
+{ 
+  poll_desc->type = CHOPSTX_POLL_COND;
+  poll_desc->ready = 0;
+  poll_desc->cond = &ev->cond;
+  poll_desc->mutex = &ev->mutex;
+  poll_desc->check = eventflag_check;
+  poll_desc->arg = ev;
+}
+
+
+eventmask_t
+eventflag_get (struct eventflag *ev)
 {
-  ev->sleeper = sleeper;
+  int n;
+  eventmask_t m;

-  if (sleeper)
-    ev->u.wait_usec = 0;
+  chopstx_mutex_lock (&ev->mutex);
+  n = __builtin_ffs (ev->flags);
+  if (n)
+    {
+      m = (1 << (n - 1));
+      ev->flags &= ~m;
+    }
  else
-    chopstx_cond_init (&ev->u.cond);
+    m = 0;
+  chopstx_mutex_unlock (&ev->mutex);

-  ev->flag = 0;
-  chopstx_mutex_init (&ev->mutex);
+  return m;
 }


@@ -56,50 +87,34 @@ eventmask_t
 eventflag_wait (struct eventflag *ev)
 {
  int n;
-
-  if (ev->sleeper)
-    chx_fatal (EVENTFLAG_ERR_WAIT);
+  eventmask_t m;

  chopstx_mutex_lock (&ev->mutex);
-  if (!ev->flag)
-    chopstx_cond_wait (&ev->u.cond, &ev->mutex);
+  if (!ev->flags)
+    chopstx_cond_wait (&ev->cond, &ev->mutex);

-  n = __builtin_ffs (ev->flag);
-  ev->flag &= ~(1 << (n - 1));
+  n = __builtin_ffs (ev->flags);
+  if (n) /* Always n > 0 when waked up, but make sure no bad things.  */
+    {
+      m = (1 << (n - 1));
+      ev->flags &= ~m;
+    }
+  else
+    m = 0;
  chopstx_mutex_unlock (&ev->mutex);

-  return (1 << (n - 1));
+  return m;
 }

+
 eventmask_t
 eventflag_wait_timeout (struct eventflag *ev, uint32_t usec)
 {
-  eventmask_t em = 0;
-  int n;
+  chopstx_poll_cond_t poll_desc;

-  if (ev->sleeper == 0)
-    chx_fatal (EVENTFLAG_ERR_TIMED_WAIT);
-
-  chopstx_mutex_lock (&ev->mutex);
-
-  if (!ev->flag)
-    {
-      ev->u.wait_usec = usec;
-      chopstx_mutex_unlock (&ev->mutex);
-      chopstx_usec_wait_var (&ev->u.wait_usec);
-      chopstx_mutex_lock (&ev->mutex);
-      ev->u.wait_usec = 0;
-    }
-
-  n = __builtin_ffs (ev->flag);
-  if (n)
-    {
-      em = (1 << (n - 1));
-      ev->flag &= ~em;
-    }
-
-  chopstx_mutex_unlock (&ev->mutex);
-  return em;
+  eventflag_prepare_poll (ev, &poll_desc);
+  chopstx_poll (&usec, 1, &poll_desc);
+  return eventflag_get (ev);
 }


@@ -107,16 +122,7 @@ void
 eventflag_signal (struct eventflag *ev, eventmask_t m)
 {
  chopstx_mutex_lock (&ev->mutex);
-  ev->flag |= m;
-  if (ev->sleeper)
-    {
-      if (ev->u.wait_usec)
-	{
-	  ev->u.wait_usec = 0;
-	  chopstx_wakeup_usec_wait (ev->sleeper);
-	}
-    }
-  else
-    chopstx_cond_signal (&ev->u.cond);
+  ev->flags |= m;
+  chopstx_cond_signal (&ev->cond);
  chopstx_mutex_unlock (&ev->mutex);
 }
--- a/eventflag.h
+++ b/eventflag.h
@@ -1,16 +1,16 @@
 typedef uint32_t eventmask_t;

 struct eventflag {
-  chopstx_t sleeper;
-  eventmask_t flag;
+  eventmask_t flags;
  chopstx_mutex_t mutex;
-  union {
-    uint32_t wait_usec;
-    chopstx_cond_t cond;
-  } u;
+  chopstx_cond_t cond;
 };

-void eventflag_init (struct eventflag *ev, chopstx_t owner);
+void eventflag_init (struct eventflag *ev);
 eventmask_t eventflag_wait (struct eventflag *ev);
 eventmask_t eventflag_wait_timeout (struct eventflag *ev, uint32_t usec);
 void eventflag_signal (struct eventflag *ev, eventmask_t m);
+
+/* For polling */
+void eventflag_prepare_poll (struct eventflag *ev, chopstx_poll_cond_t *p);
+eventmask_t eventflag_get (struct eventflag *ev);
--- a/example-cdc/sample.c
+++ b/example-cdc/sample.c
@@ -2,16 +2,15 @@
 #include <stdlib.h>
 #include <string.h>
 #include <chopstx.h>
+
 #include "sys.h" /* for set_led */
-#include "usb_lld.h" /* for set_led */
+#include "usb_lld.h"
+#include "tty.h"

 static chopstx_mutex_t mtx;
 static chopstx_cond_t cnd0;
 static chopstx_cond_t cnd1;

-chopstx_mutex_t usb_mtx;
-chopstx_cond_t cnd_usb;
-
 static uint8_t u, v;
 static uint8_t m;		/* 0..100 */

@@ -55,55 +54,12 @@ blk (void *arg)
  return NULL;
 }

-#define INTR_REQ_USB 20
-
-static void *
-usb_intr (void *arg)
-{
-  extern void usb_lld_init (uint8_t feature);
-  extern void usb_interrupt_handler (void);
-
-  chopstx_intr_t interrupt;
-
-  (void)arg;
-  usb_lld_init (0x80);		/* Bus powered. */
-  chopstx_claim_irq (&interrupt, INTR_REQ_USB);
-
-  /*
-   * When USB interrupt occurs between usb_lld_init (which assumes
-   * ISR) and chopstx_claim_irq (which clears pending interrupt),
-   * invocation of usb_interrupt_handler won't occur.
-   *
-   * We can't call usb_lld_init after chopstx_claim_irq, as
-   * usb_lld_init does its own setting for NVIC.  Calling
-   * chopstx_claim_irq after usb_lld_init overrides that.
-   *
-   * Calling usb_interrupt_handler is no harm even if there were no
-   * interrupts, thus, we call it unconditionally here, just in case
-   * if there is a request.
-   *
-   */
-  usb_interrupt_handler ();
-
-  while (1)
-    {
-      chopstx_intr_wait (&interrupt);
-
-      /* Process interrupt. */
-      usb_interrupt_handler ();
-    }
-
-  chopstx_release_irq (&interrupt);
-  return NULL;
-}

 #define PRIO_PWM 3
 #define PRIO_BLK 2
-#define PRIO_INTR 4

 extern uint8_t __process1_stack_base__, __process1_stack_size__;
 extern uint8_t __process2_stack_base__, __process2_stack_size__;
-extern uint8_t __process3_stack_base__, __process3_stack_size__;

 const uint32_t __stackaddr_pwm = (uint32_t)&__process1_stack_base__;
 const size_t __stacksize_pwm = (size_t)&__process1_stack_size__;
@@ -111,11 +67,10 @@ const size_t __stacksize_pwm = (size_t)&__process1_stack_size__;
 const uint32_t __stackaddr_blk = (uint32_t)&__process2_stack_base__;
 const size_t __stacksize_blk = (size_t)&__process2_stack_size__;

-const uint32_t __stackaddr_intr = (uint32_t)&__process3_stack_base__;
-const size_t __stacksize_intr = (size_t)&__process3_stack_size__;

 static char hexchar (uint8_t x)
 {
+  x &= 0x0f;
  if (x <= 0x09)
    return '0' + x;
  else if (x <= 0x0f)
@@ -128,6 +83,7 @@ static char hexchar (uint8_t x)
 int
 main (int argc, const char *argv[])
 {
+  struct tty *tty;
  uint8_t count;

  (void)argc;
@@ -137,15 +93,10 @@ main (int argc, const char *argv[])
  chopstx_cond_init (&cnd0);
  chopstx_cond_init (&cnd1);

-  chopstx_mutex_init (&usb_mtx);
-  chopstx_cond_init (&cnd_usb);
-
  m = 10;

  chopstx_create (PRIO_PWM, __stackaddr_pwm, __stacksize_pwm, pwm, NULL);
  chopstx_create (PRIO_BLK, __stackaddr_blk, __stacksize_blk, blk, NULL);
-  chopstx_create (PRIO_INTR, __stackaddr_intr, __stacksize_intr,
-		  usb_intr, NULL);

  chopstx_usec_wait (200*1000);

@@ -154,41 +105,57 @@ main (int argc, const char *argv[])
  chopstx_cond_signal (&cnd1);
  chopstx_mutex_unlock (&mtx);

+  u = 1;
+
+  tty = tty_open ();
+  tty_wait_configured (tty);
+
+  count = 0;
+  m = 50;
  while (1)
    {
-      extern uint8_t connected;
+      uint8_t s[LINEBUFSIZE];

-      count= 0;
      u = 1;
-      /* waiting USB connection */
-      chopstx_mutex_lock (&usb_mtx);
-      if (!connected)
-	chopstx_cond_wait (&cnd_usb, &usb_mtx);
-      chopstx_mutex_unlock (&usb_mtx);
+      tty_wait_connection (tty);
+
+      chopstx_usec_wait (500*1000);
+
+      /* Send ZLP at the beginning.  */
+      tty_send (tty, s, 0);
+
+      memcpy (s, "xx: Hello, World with Chopstx!\r\n", 32);
+      s[0] = hexchar (count >> 4);
+      s[1] = hexchar (count & 0x0f);
+      count++;
+
+      if (tty_send (tty, s, 32) < 0)
+	continue;

      while (1)
 	{
-	  char s[32];
+	  int size;
+	  uint32_t usec;
+
+	  usec = 3000000;	/* 3.0 seconds */
+	  size = tty_recv (tty, s + 4, &usec);
+	  if (size < 0)
+	    break;
+
+	  if (usec)
+	    {
+	      s[0] = hexchar (size >> 4);
+	      s[1] = hexchar (size & 0x0f);
+	      s[2] = ':';
+	      s[3] = ' ';
+	      s[size + 4] = '\r';
+	      s[size + 5] = '\n';
+	      if (tty_send (tty, s, size + 6) < 0)
+		break;
+	    }

 	  u ^= 1;
-	  chopstx_usec_wait (200*1000*6);
-
-	  memcpy (s, "xx: Hello, World with Chopstx!\r\n", 32);
-	  s[0] = hexchar (count >> 4);
-	  s[1] = hexchar (count & 0x0f);
-	  count++;
-
-	  chopstx_mutex_lock (&usb_mtx);
-	  if (connected)
-	    {
-	      usb_lld_write (ENDP1, s, 32);
-	      chopstx_cond_wait (&cnd_usb, &usb_mtx);
-	    }
-	  else
-	    break;
-	  chopstx_mutex_unlock (&usb_mtx);
 	}
-      chopstx_mutex_unlock (&usb_mtx);
    }

  return 0;
--- a/example-cdc/sample.ld
+++ b/example-cdc/sample.ld
@@ -2,10 +2,10 @@
 * ST32F103 memory setup.
 */
 __main_stack_size__     = 0x0100;  /* Exception handlers     */
-__process0_stack_size__  = 0x0100;  /* Main program           */
-__process1_stack_size__  = 0x0100; /* first thread program */
-__process2_stack_size__  = 0x0100; /* second thread program */
-__process3_stack_size__  = 0x0100; /* third thread program */
+__process0_stack_size__  = 0x0400; /* Main program           */
+__process1_stack_size__  = 0x0200; /* first thread program   */
+__process2_stack_size__  = 0x0200; /* second thread program  */
+__process3_stack_size__  = 0x0200; /* third thread program   */

 MEMORY
 {
--- a/example-cdc/sys.c
+++ b/example-cdc/sys.c
@@ -1,7 +1,7 @@
 /*
 * sys.c - system routines for the initial page for STM32F103.
 *
- * Copyright (C) 2013, 2014, 2015 Flying Stone Technology
+ * Copyright (C) 2013, 2014, 2015, 2016  Flying Stone Technology
 * Author: NIIBE Yutaka <gniibe@fsij.org>
 *
 * Copying and distribution of this file, with or without modification,
@@ -17,41 +17,8 @@
 #include <stdlib.h>
 #include "board.h"

-#include "clk_gpio_init.c"
+#include "clk_gpio_init-stm32.c"

-#define CORTEX_PRIORITY_BITS    4
-#define CORTEX_PRIORITY_MASK(n)  ((n) << (8 - CORTEX_PRIORITY_BITS))
-#define USB_LP_CAN1_RX0_IRQn	 20
-#define STM32_USB_IRQ_PRIORITY   11
-
-struct NVIC {
-  uint32_t ISER[8];
-  uint32_t unused1[24];
-  uint32_t ICER[8];
-  uint32_t unused2[24];
-  uint32_t ISPR[8];
-  uint32_t unused3[24];
-  uint32_t ICPR[8];
-  uint32_t unused4[24];
-  uint32_t IABR[8];
-  uint32_t unused5[56];
-  uint32_t IPR[60];
-};
-
-static struct NVIC *const NVICBase = ((struct NVIC *const)0xE000E100);
-#define NVIC_ISER(n)	(NVICBase->ISER[n >> 5])
-#define NVIC_ICPR(n)	(NVICBase->ICPR[n >> 5])
-#define NVIC_IPR(n)	(NVICBase->IPR[n >> 2])
-
-static void
-nvic_enable_vector (uint32_t n, uint32_t prio)
-{
-  unsigned int sh = (n & 3) << 3;
-
-  NVIC_IPR (n) = (NVIC_IPR(n) & ~(0xFF << sh)) | (prio << sh);
-  NVIC_ICPR (n) = 1 << (n & 0x1F);
-  NVIC_ISER (n) = 1 << (n & 0x1F);
-}

 static void
 usb_cable_config (int enable)
@@ -118,13 +85,6 @@ usb_lld_sys_init (void)

  usb_cable_config (1);
  RCC->APB1ENR |= RCC_APB1ENR_USBEN;
-  nvic_enable_vector (USB_LP_CAN1_RX0_IRQn,
-		      CORTEX_PRIORITY_MASK (STM32_USB_IRQ_PRIORITY));
-  /*
-   * Note that we also have other IRQ(s):
-   * 	USB_HP_CAN1_TX_IRQn (for double-buffered or isochronous)
-   * 	USBWakeUp_IRQn (suspend/resume)
-   */
  RCC->APB1RSTR = RCC_APB1RSTR_USBRST;
  RCC->APB1RSTR = 0;
 }
@@ -423,8 +383,8 @@ handler vector[] __attribute__ ((section(".vectors"))) = {
 const uint8_t sys_version[8] __attribute__((section(".sys.version"))) = {
  3*2+2,	     /* bLength */
  0x03,		     /* bDescriptorType = USB_STRING_DESCRIPTOR_TYPE */
-  /* sys version: "2.1" */
-  '2', 0, '.', 0, '1', 0,
+  /* sys version: "3.0" */
+  '3', 0, '.', 0, '0', 0,
 };

 const uint32_t __attribute__((section(".sys.board_id")))
--- a/example-cdc/sys.h
+++ b/example-cdc/sys.h
@@ -9,6 +9,7 @@
 #define BOARD_ID_STM8S_DISCOVERY   0x2f0976bb
 #define BOARD_ID_ST_DONGLE         0x2cd4e471
 #define BOARD_ID_ST_NUCLEO_F103    0x9b87c16d
+#define BOARD_ID_NITROKEY_START    0xad1e7ebd

 extern const uint8_t sys_version[8];
 extern const uint32_t sys_board_id;
--- a/example-cdc/tty.h
+++ b/example-cdc/tty.h
@@ -0,0 +1,9 @@
+#define LINEBUFSIZE 128
+
+struct tty;
+
+struct tty *tty_open (void);
+void tty_wait_configured (struct tty *tty);
+void tty_wait_connection (struct tty *tty);
+int tty_send (struct tty *tty, uint8_t *buf, int count);
+int tty_recv (struct tty *tty, uint8_t *buf, uint32_t *timeout);
--- a/example-cdc/usb-cdc.c
+++ b/example-cdc/usb-cdc.c
@@ -1,10 +1,84 @@
 #include <stdint.h>
 #include <stdlib.h>
 #include <chopstx.h>
+#include <string.h>
 #include "usb_lld.h"
+#include "tty.h"
+
+static chopstx_intr_t usb_intr;
+
+struct line_coding
+{
+  uint32_t bitrate;
+  uint8_t format;
+  uint8_t paritytype;
+  uint8_t datatype;
+}  __attribute__((packed));
+
+static const struct line_coding line_coding0 = {
+  115200, /* baud rate: 115200    */
+  0x00,   /* stop bits: 1         */
+  0x00,   /* parity:    none      */
+  0x08    /* bits:      8         */
+};
+
+/*
+ * Currently, we only support a single TTY.
+ *
+ * It is possible to extend to support multiple TTYs, for multiple
+ * interfaces.
+ *
+ * In that case, add argument to TTY_OPEN function and
+ * modify TTY_GET function to get the TTY structure.  Functions which
+ * directy accesses TTY0 (usb_cb_device_reset and usb_cb_handle_event)
+ * should be modified, too.
+ *
+ * Modification of TTY_MAIN thread will be also needed to echo back
+ * input for each TTY, and the thread should run if one of TTY is
+ * opened.
+ */
+
+struct tty {
+  chopstx_mutex_t mtx;
+  chopstx_cond_t cnd;
+  uint8_t inputline[LINEBUFSIZE];   /* Line editing is supported */
+  uint8_t send_buf[LINEBUFSIZE];    /* Sending ring buffer for echo back */
+  uint32_t inputline_len    : 8;
+  uint32_t send_head        : 8;
+  uint32_t send_tail        : 8;
+  uint32_t flag_connected   : 1;
+  uint32_t flag_send_ready  : 1;
+  uint32_t flag_input_avail : 1;
+  uint32_t                  : 2;
+  uint32_t device_state     : 3;     /* USB device status */
+  struct line_coding line_coding;
+};
+
+static struct tty tty0;
+
+/*
+ * Locate TTY structure from interface number or endpoint number.
+ * Currently, it always returns tty0, because we only have the one.
+ */
+static struct tty *
+tty_get (int interface, uint8_t ep_num)
+{
+  struct tty *t = &tty0;
+
+  if (interface >= 0)
+    {
+      if (interface == 0)
+	t = &tty0;
+    }
+  else
+    {
+      if (ep_num == ENDP1 || ep_num == ENDP2 || ep_num == ENDP3)
+	t = &tty0;
+    }
+
+  return t;
+}

-extern chopstx_mutex_t usb_mtx;
-extern chopstx_cond_t cnd_usb;

 #define ENDP0_RXADDR        (0x40)
 #define ENDP0_TXADDR        (0x80)
@@ -20,7 +94,7 @@ extern chopstx_cond_t cnd_usb;
 /* USB Device Descriptor */
 static const uint8_t vcom_device_desc[18] = {
  18,   /* bLength */
-  USB_DEVICE_DESCRIPTOR_TYPE,	/* bDescriptorType */
+  DEVICE_DESCRIPTOR,		/* bDescriptorType */
  0x10, 0x01,			/* bcdUSB = 1.1 */
  0x02,				/* bDeviceClass (CDC).              */
  0x00,				/* bDeviceSubClass.                 */
@@ -35,20 +109,22 @@ static const uint8_t vcom_device_desc[18] = {
  1				/* bNumConfigurations.              */
 };

+#define VCOM_FEATURE_BUS_POWERED	0x80
+
 /* Configuration Descriptor tree for a CDC.*/
 static const uint8_t vcom_config_desc[67] = {
  9,
-  USB_CONFIGURATION_DESCRIPTOR_TYPE, /* bDescriptorType: Configuration */
+  CONFIG_DESCRIPTOR,		/* bDescriptorType: Configuration */
  /* Configuration Descriptor.*/
  67, 0x00,			/* wTotalLength.                    */
  0x02,				/* bNumInterfaces.                  */
  0x01,				/* bConfigurationValue.             */
  0,				/* iConfiguration.                  */
-  0x80,				/* bmAttributes (bus powered).      */
+  VCOM_FEATURE_BUS_POWERED,	/* bmAttributes.                    */
  50,				/* bMaxPower (100mA).               */
  /* Interface Descriptor.*/
  9,
-  USB_INTERFACE_DESCRIPTOR_TYPE,
+  INTERFACE_DESCRIPTOR,
  0x00,		   /* bInterfaceNumber.                */
  0x00,		   /* bAlternateSetting.               */
  0x01,		   /* bNumEndpoints.                   */
@@ -87,14 +163,14 @@ static const uint8_t vcom_config_desc[67] = {
  0x01,         /* bSlaveInterface0 (Data Class Interface).  */
  /* Endpoint 2 Descriptor.*/
  7,
-  USB_ENDPOINT_DESCRIPTOR_TYPE,
+  ENDPOINT_DESCRIPTOR,
  ENDP2|0x80,    /* bEndpointAddress.    */
  0x03,          /* bmAttributes (Interrupt).        */
  0x08, 0x00,	 /* wMaxPacketSize.                  */
  0xFF,		 /* bInterval.                       */
  /* Interface Descriptor.*/
  9,
-  USB_INTERFACE_DESCRIPTOR_TYPE, /* bDescriptorType: */
+  INTERFACE_DESCRIPTOR, /* bDescriptorType: */
  0x01,          /* bInterfaceNumber.                */
  0x00,          /* bAlternateSetting.               */
  0x02,          /* bNumEndpoints.                   */
@@ -104,14 +180,14 @@ static const uint8_t vcom_config_desc[67] = {
  0x00,		 /* iInterface.                      */
  /* Endpoint 3 Descriptor.*/
  7,
-  USB_ENDPOINT_DESCRIPTOR_TYPE,	/* bDescriptorType: Endpoint */
+  ENDPOINT_DESCRIPTOR,		/* bDescriptorType: Endpoint */
  ENDP3,    /* bEndpointAddress. */
  0x02,				/* bmAttributes (Bulk).             */
  0x40, 0x00,			/* wMaxPacketSize.                  */
  0x00,				/* bInterval.                       */
  /* Endpoint 1 Descriptor.*/
  7,
-  USB_ENDPOINT_DESCRIPTOR_TYPE,	/* bDescriptorType: Endpoint */
+  ENDPOINT_DESCRIPTOR,		/* bDescriptorType: Endpoint */
  ENDP1|0x80,			/* bEndpointAddress. */
  0x02,				/* bmAttributes (Bulk).             */
  0x40, 0x00,			/* wMaxPacketSize.                  */
@@ -124,13 +200,13 @@ static const uint8_t vcom_config_desc[67] = {
 */
 static const uint8_t vcom_string0[4] = {
  4,				/* bLength */
-  USB_STRING_DESCRIPTOR_TYPE,
+  STRING_DESCRIPTOR,
  0x09, 0x04			/* LangID = 0x0409: US-English */
 };

 static const uint8_t vcom_string1[] = {
  23*2+2,			/* bLength */
-  USB_STRING_DESCRIPTOR_TYPE,	/* bDescriptorType */
+  STRING_DESCRIPTOR,		/* bDescriptorType */
  /* Manufacturer: "Flying Stone Technology" */
  'F', 0, 'l', 0, 'y', 0, 'i', 0, 'n', 0, 'g', 0, ' ', 0, 'S', 0,
  't', 0, 'o', 0, 'n', 0, 'e', 0, ' ', 0, 'T', 0, 'e', 0, 'c', 0,
@@ -139,7 +215,7 @@ static const uint8_t vcom_string1[] = {

 static const uint8_t vcom_string2[] = {
  14*2+2,			/* bLength */
-  USB_STRING_DESCRIPTOR_TYPE,	/* bDescriptorType */
+  STRING_DESCRIPTOR,		/* bDescriptorType */
  /* Product name: "Chopstx Sample" */
  'C', 0, 'h', 0, 'o', 0, 'p', 0, 's', 0, 't', 0, 'x', 0, ' ', 0,
  'S', 0, 'a', 0, 'm', 0, 'p', 0, 'l', 0, 'e', 0,
@@ -150,78 +226,76 @@ static const uint8_t vcom_string2[] = {
 */
 static const uint8_t vcom_string3[28] = {
  28,				    /* bLength */
-  USB_STRING_DESCRIPTOR_TYPE,	    /* bDescriptorType */
+  STRING_DESCRIPTOR,		    /* bDescriptorType */
  '0', 0,  '.', 0,  '0', 0, '0', 0, /* Version number */
 };


 #define NUM_INTERFACES 2

-uint32_t bDeviceState = UNCONNECTED; /* USB device status */
-uint8_t connected;

 void
 usb_cb_device_reset (void)
 {
-  /* Set DEVICE as not configured */
-  usb_lld_set_configuration (0);
-
-  /* Current Feature initialization */
-  usb_lld_set_feature (vcom_config_desc[7]);
-
-  usb_lld_reset ();
+  usb_lld_reset (VCOM_FEATURE_BUS_POWERED);

  /* Initialize Endpoint 0 */
  usb_lld_setup_endpoint (ENDP0, EP_CONTROL, 0, ENDP0_RXADDR, ENDP0_TXADDR, 64);
+
+  chopstx_mutex_lock (&tty0.mtx);
+  tty0.inputline_len = 0;
+  tty0.send_head = tty0.send_tail = 0;
+  tty0.flag_connected = 0;
+  tty0.flag_send_ready = 1;
+  tty0.flag_input_avail = 0;
+  tty0.device_state = ATTACHED;
+  memcpy (&tty0.line_coding, &line_coding0, sizeof (struct line_coding));
+  chopstx_mutex_unlock (&tty0.mtx);
 }


+#define CDC_CTRL_DTR            0x0001
+
 void
-usb_cb_ctrl_write_finish (uint8_t req, uint8_t req_no, uint16_t value)
+usb_cb_ctrl_write_finish (uint8_t req, uint8_t req_no, struct req_args *arg)
 {
  uint8_t type_rcp = req & (REQUEST_TYPE|RECIPIENT);

-  if (type_rcp == (CLASS_REQUEST | INTERFACE_RECIPIENT)
+  if (type_rcp == (CLASS_REQUEST | INTERFACE_RECIPIENT) && arg->index == 0
      && USB_SETUP_SET (req) && req_no == USB_CDC_REQ_SET_CONTROL_LINE_STATE)
    {
+      struct tty *t = tty_get (arg->index, 0);
+
      /* Open/close the connection.  */
-      chopstx_mutex_lock (&usb_mtx);
-      connected = (value != 0)? 1 : 0;
-      chopstx_cond_signal (&cnd_usb);
-      chopstx_mutex_unlock (&usb_mtx);
+      chopstx_mutex_lock (&t->mtx);
+      t->flag_connected = ((arg->value & CDC_CTRL_DTR) != 0);
+      chopstx_cond_signal (&t->cnd);
+      chopstx_mutex_unlock (&t->mtx);
    }
 }

-struct line_coding
-{
-  uint32_t bitrate;
-  uint8_t format;
-  uint8_t paritytype;
-  uint8_t datatype;
-}  __attribute__((packed));
-
-static struct line_coding line_coding = {
-  115200, /* baud rate: 115200    */
-  0x00,   /* stop bits: 1         */
-  0x00,   /* parity:    none      */
-  0x08    /* bits:      8         */
-};


 static int
-vcom_port_data_setup (uint8_t req, uint8_t req_no, struct control_info *detail)
+vcom_port_data_setup (uint8_t req, uint8_t req_no, struct req_args *arg)
 {
  if (USB_SETUP_GET (req))
    {
+      struct tty *t = tty_get (arg->index, 0);
+
      if (req_no == USB_CDC_REQ_GET_LINE_CODING)
-	return usb_lld_reply_request (&line_coding, sizeof(line_coding), detail);
+	return usb_lld_reply_request (&t->line_coding,
+				      sizeof (struct line_coding), arg);
    }
  else  /* USB_SETUP_SET (req) */
    {
      if (req_no == USB_CDC_REQ_SET_LINE_CODING
-	  && detail->len == sizeof (line_coding))
+	  && arg->len == sizeof (struct line_coding))
 	{
-	  usb_lld_set_data_to_recv (&line_coding, sizeof (line_coding));
+	  struct tty *t = tty_get (arg->index, 0);
+
+	  usb_lld_set_data_to_recv (&t->line_coding,
+				    sizeof (struct line_coding));
 	  return USB_SUCCESS;
 	}
      else if (req_no == USB_CDC_REQ_SET_CONTROL_LINE_STATE)
@@ -232,29 +306,29 @@ vcom_port_data_setup (uint8_t req, uint8_t req_no, struct control_info *detail)
 }

 int
-usb_cb_setup (uint8_t req, uint8_t req_no, struct control_info *detail)
+usb_cb_setup (uint8_t req, uint8_t req_no, struct req_args *arg)
 {
  uint8_t type_rcp = req & (REQUEST_TYPE|RECIPIENT);

-  if (type_rcp == (CLASS_REQUEST | INTERFACE_RECIPIENT) && detail->index == 0)
-    return vcom_port_data_setup (req, req_no, detail);
+  if (type_rcp == (CLASS_REQUEST | INTERFACE_RECIPIENT) && arg->index == 0)
+    return vcom_port_data_setup (req, req_no, arg);

  return USB_UNSUPPORT;
 }

 int
 usb_cb_get_descriptor (uint8_t rcp, uint8_t desc_type, uint8_t desc_index,
-		       struct control_info *detail)
+		       struct req_args *arg)
 {
  if (rcp != DEVICE_RECIPIENT)
    return USB_UNSUPPORT;

  if (desc_type == DEVICE_DESCRIPTOR)
    return usb_lld_reply_request (vcom_device_desc, sizeof (vcom_device_desc),
-				  detail);
+				  arg);
  else if (desc_type == CONFIG_DESCRIPTOR)
    return usb_lld_reply_request (vcom_config_desc, sizeof (vcom_config_desc),
-				  detail);
+				  arg);
  else if (desc_type == STRING_DESCRIPTOR)
    {
      const uint8_t *str;
@@ -282,7 +356,7 @@ usb_cb_get_descriptor (uint8_t rcp, uint8_t desc_type, uint8_t desc_index,
 	  return USB_UNSUPPORT;
 	}

-      return usb_lld_reply_request (str, size, detail);
+      return usb_lld_reply_request (str, size, arg);
    }

  return USB_UNSUPPORT;
@@ -304,6 +378,8 @@ vcom_setup_endpoints_for_interface (uint16_t interface, int stop)
 	{
 	  usb_lld_setup_endpoint (ENDP1, EP_BULK, 0, 0, ENDP1_TXADDR, 0);
 	  usb_lld_setup_endpoint (ENDP3, EP_BULK, 0, ENDP3_RXADDR, 0, 64);
+	  /* Start with no data receiving */
+	  usb_lld_stall_rx (ENDP3);
 	}
      else
 	{
@@ -313,7 +389,8 @@ vcom_setup_endpoints_for_interface (uint16_t interface, int stop)
    }
 }

-int usb_cb_handle_event (uint8_t event_type, uint16_t value)
+int
+usb_cb_handle_event (uint8_t event_type, uint16_t value)
 {
  int i;
  uint8_t current_conf;
@@ -321,7 +398,9 @@ int usb_cb_handle_event (uint8_t event_type, uint16_t value)
  switch (event_type)
    {
    case USB_EVENT_ADDRESS:
-      bDeviceState = ADDRESSED;
+      chopstx_mutex_lock (&tty0.mtx);
+      tty0.device_state = ADDRESSED;
+      chopstx_mutex_unlock (&tty0.mtx);
      return USB_SUCCESS;
    case USB_EVENT_CONFIG:
      current_conf = usb_lld_current_configuration ();
@@ -333,7 +412,9 @@ int usb_cb_handle_event (uint8_t event_type, uint16_t value)
 	  usb_lld_set_configuration (1);
 	  for (i = 0; i < NUM_INTERFACES; i++)
 	    vcom_setup_endpoints_for_interface (i, 0);
-	  bDeviceState = CONFIGURED;
+	  chopstx_mutex_lock (&tty0.mtx);
+	  tty0.device_state = CONFIGURED;
+	  chopstx_mutex_unlock (&tty0.mtx);
 	}
      else if (current_conf != value)
 	{
@@ -343,12 +424,12 @@ int usb_cb_handle_event (uint8_t event_type, uint16_t value)
 	  usb_lld_set_configuration (0);
 	  for (i = 0; i < NUM_INTERFACES; i++)
 	    vcom_setup_endpoints_for_interface (i, 1);
-	  bDeviceState = ADDRESSED;
+	  chopstx_mutex_lock (&tty0.mtx);
+	  tty0.device_state = ADDRESSED;
+	  chopstx_mutex_unlock (&tty0.mtx);
 	}
      /* Do nothing when current_conf == value */
      return USB_SUCCESS;
-
-      return USB_SUCCESS;
    default:
      break;
    }
@@ -357,11 +438,12 @@ int usb_cb_handle_event (uint8_t event_type, uint16_t value)
 }


-int usb_cb_interface (uint8_t cmd, struct control_info *detail)
+int
+usb_cb_interface (uint8_t cmd, struct req_args *arg)
 {
  const uint8_t zero = 0;
-  uint16_t interface = detail->index;
-  uint16_t alt = detail->value;
+  uint16_t interface = arg->index;
+  uint16_t alt = arg->value;

  if (interface >= NUM_INTERFACES)
    return USB_UNSUPPORT;
@@ -378,7 +460,7 @@ int usb_cb_interface (uint8_t cmd, struct control_info *detail)
 	}

    case USB_GET_INTERFACE:
-      return usb_lld_reply_request (&zero, 1, detail);
+      return usb_lld_reply_request (&zero, 1, arg);

    default:
    case USB_QUERY_INTERFACE:
@@ -386,21 +468,367 @@ int usb_cb_interface (uint8_t cmd, struct control_info *detail)
    }
 }

-void
-EP1_IN_Callback (void)
+
+/*
+ * Put a character into the ring buffer to be send back.
+ */
+static void
+put_char_to_ringbuffer (struct tty *t, int c)
 {
-  chopstx_mutex_lock (&usb_mtx);
-  chopstx_cond_signal (&cnd_usb);
-  chopstx_mutex_unlock (&usb_mtx);
+  uint32_t next = (t->send_tail + 1) % LINEBUFSIZE;
+
+  if (t->send_head == next)
+    /* full */
+    /* All that we can do is ignore this char. */
+    return;
+  
+  t->send_buf[t->send_tail] = c;
+  t->send_tail = next;
+}
+
+/*
+ * Get characters from ring buffer into S.
+ */
+static int
+get_chars_from_ringbuffer (struct tty *t, uint8_t *s, int len)
+{
+  int i = 0;
+
+  if (t->send_head == t->send_tail)
+    /* Empty */
+    return i;
+
+  do
+    {
+      s[i++] = t->send_buf[t->send_head];
+      t->send_head = (t->send_head + 1) % LINEBUFSIZE;
+    }
+  while (t->send_head != t->send_tail && i < len);
+
+  return i;
+}
+
+
+static void
+tty_echo_char (struct tty *t, int c)
+{
+  put_char_to_ringbuffer (t, c);
+}
+
+
+void
+usb_cb_tx_done (uint8_t ep_num)
+{
+  struct tty *t = tty_get (-1, ep_num);
+
+  if (ep_num == ENDP1)
+    {
+      chopstx_mutex_lock (&t->mtx);
+      if (t->flag_send_ready == 0)
+	{
+	  t->flag_send_ready = 1;
+	  chopstx_cond_signal (&t->cnd);
+	}
+      chopstx_mutex_unlock (&t->mtx);
+    }
+  else if (ep_num == ENDP2)
+    {
+      /* Nothing */
+    }
+}
+
+
+static int
+tty_input_char (struct tty *t, int c)
+{
+  unsigned int i;
+  int r = 0;
+
+  /* Process DEL, C-U, C-R, and RET as editing command. */
+  chopstx_mutex_lock (&t->mtx);
+  switch (c)
+    {
+    case 0x0d: /* Control-M */
+      tty_echo_char (t, 0x0d);
+      tty_echo_char (t, 0x0a);
+      t->flag_input_avail = 1;
+      r = 1;
+      chopstx_cond_signal (&t->cnd);
+      break;
+    case 0x12: /* Control-R */
+      tty_echo_char (t, '^');
+      tty_echo_char (t, 'R');
+      tty_echo_char (t, 0x0d);
+      tty_echo_char (t, 0x0a);
+      for (i = 0; i < t->inputline_len; i++)
+	tty_echo_char (t, t->inputline[i]);
+      break;
+    case 0x15: /* Control-U */
+      for (i = 0; i < t->inputline_len; i++)
+	{
+	  tty_echo_char (t, 0x08);
+	  tty_echo_char (t, 0x20);
+	  tty_echo_char (t, 0x08);
+	}
+      t->inputline_len = 0;
+      break;
+    case 0x7f: /* DEL    */
+      if (t->inputline_len > 0)
+	{
+	  tty_echo_char (t, 0x08);
+	  tty_echo_char (t, 0x20);
+	  tty_echo_char (t, 0x08);
+	  t->inputline_len--;
+	}
+      break;
+    default:
+      if (t->inputline_len < sizeof (t->inputline))
+	{
+	  tty_echo_char (t, c);
+	  t->inputline[t->inputline_len++] = c;
+	}
+      else
+	/* Beep */
+	tty_echo_char (t, 0x0a);
+      break;
+    }
+  chopstx_mutex_unlock (&t->mtx);
+  return r;
 }

 void
-EP2_IN_Callback (void)
+usb_cb_rx_ready (uint8_t ep_num)
 {
+  uint8_t recv_buf[64];
+  struct tty *t = tty_get (-1, ep_num);
+
+  if (ep_num == ENDP3)
+    {
+      int i, r;
+
+      r = usb_lld_rx_data_len (ENDP3);
+      usb_lld_rxcpy (recv_buf, ep_num, 0, r);
+      for (i = 0; i < r; i++)
+	if (tty_input_char (t, recv_buf[i]))
+	  break;
+
+      chopstx_mutex_lock (&t->mtx);
+      if (t->flag_input_avail == 0)
+	usb_lld_rx_enable (ENDP3);
+      chopstx_mutex_unlock (&t->mtx);
+    }
 }

-void
-EP3_OUT_Callback (void)
+static void *tty_main (void *arg);
+
+#define INTR_REQ_USB 20
+#define PRIO_TTY      4
+
+extern uint8_t __process3_stack_base__, __process3_stack_size__;
+const uint32_t __stackaddr_tty = (uint32_t)&__process3_stack_base__;
+const size_t __stacksize_tty = (size_t)&__process3_stack_size__;
+
+struct tty *
+tty_open (void)
 {
-  usb_lld_rx_enable (ENDP3);
+  chopstx_mutex_init (&tty0.mtx);
+  chopstx_cond_init (&tty0.cnd);
+  tty0.inputline_len = 0;
+  tty0.send_head = tty0.send_tail = 0;
+  tty0.flag_connected = 0;
+  tty0.flag_send_ready = 1;
+  tty0.flag_input_avail = 0;
+  tty0.device_state = UNCONNECTED;
+  memcpy (&tty0.line_coding, &line_coding0, sizeof (struct line_coding));
+
+  chopstx_create (PRIO_TTY, __stackaddr_tty, __stacksize_tty, tty_main, &tty0);
+  return &tty0;
+}
+
+
+static void *
+tty_main (void *arg)
+{
+  struct tty *t = arg;
+
+#if defined(OLDER_SYS_H)
+  /*
+   * Historically (before sys < 3.0), NVIC priority setting for USB
+   * interrupt was done in usb_lld_sys_init.  Thus this code.
+   *
+   * When USB interrupt occurs between usb_lld_init (which assumes
+   * ISR) and chopstx_claim_irq (which clears pending interrupt),
+   * invocation of usb_interrupt_handler won't occur.
+   *
+   * Calling usb_interrupt_handler is no harm even if there were no
+   * interrupts, thus, we call it unconditionally here, just in case
+   * if there is a request.
+   *
+   * We can't call usb_lld_init after chopstx_claim_irq, as
+   * usb_lld_init does its own setting for NVIC.  Calling
+   * chopstx_claim_irq after usb_lld_init overrides that.
+   *
+   */
+  usb_lld_init (VCOM_FEATURE_BUS_POWERED);
+  chopstx_claim_irq (&usb_intr, INTR_REQ_USB);
+  usb_interrupt_handler ();
+#else
+  chopstx_claim_irq (&usb_intr, INTR_REQ_USB);
+  usb_lld_init (VCOM_FEATURE_BUS_POWERED);
+#endif
+
+  while (1)
+    {
+      chopstx_poll (NULL, 1, &usb_intr);
+      if (usb_intr.ready)
+	usb_interrupt_handler ();
+
+      chopstx_mutex_lock (&t->mtx);
+      if (t->device_state == CONFIGURED && t->flag_connected
+	  && t->flag_send_ready)
+	{
+	  uint8_t line[32];
+	  int len = get_chars_from_ringbuffer (t, line, sizeof (len));
+
+	  if (len)
+	    {
+	      usb_lld_txcpy (line, ENDP1, 0, len);
+	      usb_lld_tx_enable (ENDP1, len);
+	      t->flag_send_ready = 0;
+	    }
+	}
+      chopstx_mutex_unlock (&t->mtx);
+    }
+
+  return NULL;
+}
+
+
+void
+tty_wait_configured (struct tty *t)
+{
+  chopstx_mutex_lock (&t->mtx);
+  while (t->device_state != CONFIGURED)
+    chopstx_cond_wait (&t->cnd, &t->mtx);
+  chopstx_mutex_unlock (&t->mtx);
+}
+
+
+void
+tty_wait_connection (struct tty *t)
+{
+  chopstx_mutex_lock (&t->mtx);
+  while (t->flag_connected == 0)
+    chopstx_cond_wait (&t->cnd, &t->mtx);
+  t->flag_send_ready = 1;
+  t->flag_input_avail = 0;
+  t->send_head = t->send_tail = 0;
+  t->inputline_len = 0;
+  usb_lld_rx_enable (ENDP3);	/* Accept input for line */
+  chopstx_mutex_unlock (&t->mtx);
+}
+
+static int
+check_tx (struct tty *t)
+{
+  if (t->flag_send_ready)
+    /* TX done */
+    return 1;
+  if (t->flag_connected == 0)
+    /* Disconnected */
+    return -1;
+  return 0;
+}
+
+int
+tty_send (struct tty *t, uint8_t *buf, int len)
+{
+  int r;
+  uint8_t *p;
+  int count;
+
+  p = buf;
+  count = len >= 64 ? 64 : len;
+
+  while (1)
+    {
+      chopstx_mutex_lock (&t->mtx);
+      while ((r = check_tx (t)) == 0)
+	chopstx_cond_wait (&t->cnd, &t->mtx);
+      if (r > 0)
+	{
+	  usb_lld_txcpy (p, ENDP1, 0, count);
+	  usb_lld_tx_enable (ENDP1, count);
+	  t->flag_send_ready = 0;
+	}
+      chopstx_mutex_unlock (&t->mtx);
+
+      len -= count;
+      p += count;
+      if (len == 0 && count != 64)
+	/*
+	 * The size of the last packet should be != 0
+	 * If 64, send ZLP (zelo length packet)
+	 */
+	break;
+      count = len >= 64 ? 64 : len;
+    }
+
+  return r;
+}
+
+
+static int
+check_rx (void *arg)
+{
+  struct tty *t = arg;
+
+  if (t->flag_input_avail)
+    /* RX */
+    return 1;
+  if (t->flag_connected == 0)
+    /* Disconnected */
+    return 1;
+  return 0;
+}
+
+int
+tty_recv (struct tty *t, uint8_t *buf, uint32_t *timeout)
+{
+  int r;
+  chopstx_poll_cond_t poll_desc;
+
+  poll_desc.type = CHOPSTX_POLL_COND;
+  poll_desc.ready = 0;
+  poll_desc.cond = &t->cnd;
+  poll_desc.mutex = &t->mtx;
+  poll_desc.check = check_rx;
+  poll_desc.arg = t;
+
+  while (1)
+    {
+      chopstx_poll (timeout, 1, &poll_desc);
+      chopstx_mutex_lock (&t->mtx);
+      r = check_rx (t);
+      chopstx_mutex_unlock (&t->mtx);
+      if (r || (timeout != NULL && *timeout == 0))
+	break;
+    }
+
+  chopstx_mutex_lock (&t->mtx);
+  if (t->flag_connected == 0)
+    r = -1;
+  else if (t->flag_input_avail)
+    {
+      r = t->inputline_len;
+      memcpy (buf, t->inputline, r);
+      t->flag_input_avail = 0;
+      usb_lld_rx_enable (ENDP3);
+      t->inputline_len = 0;
+    }
+  else
+    r = 0;
+  chopstx_mutex_unlock (&t->mtx);
+
+  return r;
 }
--- a/example-cdc/usb_lld.h
+++ b/example-cdc/usb_lld.h
@@ -1,9 +1,3 @@
-#define USB_DEVICE_DESCRIPTOR_TYPE              0x01
-#define USB_CONFIGURATION_DESCRIPTOR_TYPE       0x02
-#define USB_STRING_DESCRIPTOR_TYPE              0x03
-#define USB_INTERFACE_DESCRIPTOR_TYPE           0x04
-#define USB_ENDPOINT_DESCRIPTOR_TYPE            0x05
-
 #define STANDARD_ENDPOINT_DESC_SIZE             0x09

 /* endpoints enumeration */
@@ -24,7 +18,7 @@

 enum RECIPIENT_TYPE
 {
-  DEVICE_RECIPIENT,     /* Recipient device    */
+  DEVICE_RECIPIENT = 0, /* Recipient device    */
  INTERFACE_RECIPIENT,  /* Recipient interface */
  ENDPOINT_RECIPIENT,   /* Recipient endpoint  */
  OTHER_RECIPIENT
@@ -55,19 +49,22 @@ enum
  USB_SUCCESS = 1,
 };

-struct control_info {
+struct req_args {
  uint16_t value;
  uint16_t index;
  uint16_t len;
 };

 void usb_cb_device_reset (void);
-int usb_cb_setup (uint8_t req, uint8_t req_no, struct control_info *detail);
-int usb_cb_interface (uint8_t cmd, struct control_info *detail);
+int usb_cb_setup (uint8_t req, uint8_t req_no, struct req_args *arg);
+int usb_cb_interface (uint8_t cmd, struct req_args *arg);
 int usb_cb_get_descriptor (uint8_t rcp, uint8_t desc_type, uint8_t desc_index,
-			   struct control_info *detail);
+			   struct req_args *arg);
 int usb_cb_handle_event (uint8_t event_type, uint16_t value);
-void usb_cb_ctrl_write_finish (uint8_t req, uint8_t req_no, uint16_t value);
+void usb_cb_ctrl_write_finish (uint8_t req, uint8_t req_no,
+			       struct req_args *arg);
+void usb_cb_tx_done (uint8_t ep_num);
+void usb_cb_rx_ready (uint8_t ep_num);

 enum {
  USB_EVENT_ADDRESS,
@@ -103,18 +100,17 @@ void usb_lld_txcpy (const void *src, int ep_num, int offset, size_t len);
 void usb_lld_tx_enable (int ep_num, size_t len);
 void usb_lld_write (uint8_t ep_num, const void *buf, size_t len);
 int usb_lld_reply_request (const void *buf, size_t buflen,
-			   struct control_info *ctrl);
+			   struct req_args *arg);
 void usb_lld_rx_enable (int ep_num);
 int usb_lld_rx_data_len (int ep_num);
 void usb_lld_rxcpy (uint8_t *dst, int ep_num, int offset, size_t len);
-void usb_lld_reset (void);
+void usb_lld_reset (uint8_t feature);
 void usb_lld_setup_endpoint (int ep_num, int ep_type, int ep_kind,
 			     int ep_rx_addr, int ep_tx_addr,
 			     int ep_rx_memory_size);
 void usb_lld_set_configuration (uint8_t config);
 uint8_t usb_lld_current_configuration (void);
-void usb_lld_set_feature (uint8_t feature);
-void usb_lld_set_data_to_recv (const void *p, size_t len);
+void usb_lld_set_data_to_recv (void *p, size_t len);

 void usb_lld_prepare_shutdown (void);
 void usb_lld_shutdown (void);
--- a/example-cdc/usb_stm32f103.c
+++ b/example-cdc/usb_stm32f103.c
@@ -62,6 +62,8 @@ struct DEVICE_INFO
  uint8_t bRequest;
  /**/
  uint16_t value;
+  uint16_t index;
+  uint16_t len;
 };

 static struct DEVICE_INFO device_info;
@@ -353,7 +355,7 @@ void usb_lld_init (uint8_t feature)
  dev_p->state = IN_DATA;

  usb_lld_set_configuration (0);
-  usb_lld_set_feature (feature);
+  dev_p->current_feature = feature;

  /* Reset USB */
  st103_set_cntr (CNTR_FRES);
@@ -462,26 +464,26 @@ static void handle_datastage_in (void)
  st103_ep_set_tx_status (ENDP0, EP_TX_VALID);
 }

-typedef int (*HANDLER) (uint8_t req, struct control_info *detail);
+typedef int (*HANDLER) (uint8_t req, struct req_args *arg);

-static int std_none (uint8_t req, struct control_info *detail)
+static int std_none (uint8_t req, struct req_args *arg)
 {
-  (void)req; (void)detail;
+  (void)req; (void)arg;
  return USB_UNSUPPORT;
 }

-static int std_get_status (uint8_t req, struct control_info *detail)
+static int std_get_status (uint8_t req, struct req_args *arg)
 {
  uint8_t rcp = req & RECIPIENT;
  uint16_t status_info = 0;

-  if (detail->value != 0 || detail->len != 2 || (detail->index >> 8) != 0
-      || (req & REQUEST_DIR) == 0)
+  if (arg->value != 0 || arg->len != 2 || (arg->index >> 8) != 0
+      || USB_SETUP_SET (req))
    return USB_UNSUPPORT;

  if (rcp == DEVICE_RECIPIENT)
    {
-      if (detail->index == 0)
+      if (arg->index == 0)
 	{
 	  /* Get Device Status */
 	  uint8_t feature = dev_p->current_feature;
@@ -498,7 +500,7 @@ static int std_get_status (uint8_t req, struct control_info *detail)
 	  else /* Self-powered */
 	    status_info &= ~1;

-	  return usb_lld_reply_request (&status_info, 2, detail);
+	  return usb_lld_reply_request (&status_info, 2, arg);
 	}
    }
  else if (rcp == INTERFACE_RECIPIENT)
@@ -508,21 +510,21 @@ static int std_get_status (uint8_t req, struct control_info *detail)
      if (dev_p->current_configuration == 0)
 	return USB_UNSUPPORT;

-      r = usb_cb_interface (USB_QUERY_INTERFACE, detail);
+      r = usb_cb_interface (USB_QUERY_INTERFACE, arg);
      if (r != USB_SUCCESS)
 	return USB_UNSUPPORT;

-      return usb_lld_reply_request (&status_info, 2, detail);
+      return usb_lld_reply_request (&status_info, 2, arg);
    }
  else if (rcp == ENDPOINT_RECIPIENT)
    {
-      uint8_t endpoint = (detail->index & 0x0f);
+      uint8_t endpoint = (arg->index & 0x0f);
      uint16_t status;

-      if ((detail->index & 0x70) || endpoint == ENDP0)
+      if ((arg->index & 0x70) || endpoint == ENDP0)
 	return USB_UNSUPPORT;

-      if ((detail->index & 0x80))
+      if ((arg->index & 0x80))
 	{
 	  status = st103_ep_get_tx_status (endpoint);
 	  if (status == 0)		/* Disabled */
@@ -539,25 +541,25 @@ static int std_get_status (uint8_t req, struct control_info *detail)
 	    status_info |= 1; /* OUT Endpoint stalled */
 	}

-      return usb_lld_reply_request (&status_info, 2, detail);
+      return usb_lld_reply_request (&status_info, 2, arg);
    }

  return USB_UNSUPPORT;
 }

-static int std_clear_feature (uint8_t req, struct control_info *detail)
+static int std_clear_feature (uint8_t req, struct req_args *arg)
 {
  uint8_t rcp = req & RECIPIENT;

-  if ((req & REQUEST_DIR) == 1)
+  if (USB_SETUP_GET (req))
    return USB_UNSUPPORT;

  if (rcp == DEVICE_RECIPIENT)
    {
-      if (detail->len != 0 || detail->index != 0)
+      if (arg->len != 0 || arg->index != 0)
 	return USB_UNSUPPORT;

-      if (detail->value == DEVICE_REMOTE_WAKEUP)
+      if (arg->value == DEVICE_REMOTE_WAKEUP)
 	{
 	  dev_p->current_feature &= ~(1 << 5);
 	  return USB_SUCCESS;
@@ -565,17 +567,17 @@ static int std_clear_feature (uint8_t req, struct control_info *detail)
    }
  else if (rcp == ENDPOINT_RECIPIENT)
    {
-      uint8_t endpoint = (detail->index & 0x0f);
+      uint8_t endpoint = (arg->index & 0x0f);
      uint16_t status;

      if (dev_p->current_configuration == 0)
 	return USB_UNSUPPORT;

-      if (detail->len != 0 || (detail->index >> 8) != 0
-	  || detail->value != ENDPOINT_STALL || endpoint == ENDP0)
+      if (arg->len != 0 || (arg->index >> 8) != 0
+	  || arg->value != ENDPOINT_STALL || endpoint == ENDP0)
 	return USB_UNSUPPORT;

-      if ((detail->index & 0x80))
+      if ((arg->index & 0x80))
 	status = st103_ep_get_tx_status (endpoint);
      else
 	status = st103_ep_get_rx_status (endpoint);
@@ -583,7 +585,7 @@ static int std_clear_feature (uint8_t req, struct control_info *detail)
      if (status == 0)		/* Disabled */
 	return USB_UNSUPPORT;

-      if (detail->index & 0x80)		/* IN endpoint */
+      if (arg->index & 0x80)		/* IN endpoint */
 	st103_ep_clear_dtog_tx (endpoint);
      else			/* OUT endpoint */
 	st103_ep_clear_dtog_rx (endpoint);
@@ -595,19 +597,19 @@ static int std_clear_feature (uint8_t req, struct control_info *detail)
  return USB_UNSUPPORT;
 }

-static int std_set_feature (uint8_t req, struct control_info *detail)
+static int std_set_feature (uint8_t req, struct req_args *arg)
 {
  uint8_t rcp = req & RECIPIENT;

-  if ((req & REQUEST_DIR) == 1)
+  if (USB_SETUP_GET (req))
    return USB_UNSUPPORT;

  if (rcp == DEVICE_RECIPIENT)
    {
-      if (detail->len != 0 || detail->index != 0)
+      if (arg->len != 0 || arg->index != 0)
 	return USB_UNSUPPORT;

-      if (detail->value == DEVICE_REMOTE_WAKEUP)
+      if (arg->value == DEVICE_REMOTE_WAKEUP)
 	{
 	  dev_p->current_feature |= 1 << 5;
 	  // event??
@@ -616,17 +618,17 @@ static int std_set_feature (uint8_t req, struct control_info *detail)
    }
  else if (rcp == ENDPOINT_RECIPIENT)
    {
-      uint8_t endpoint = (detail->index & 0x0f);
+      uint8_t endpoint = (arg->index & 0x0f);
      uint32_t status;

      if (dev_p->current_configuration == 0)
 	return USB_UNSUPPORT;

-      if (detail->len != 0 || (detail->index >> 8) != 0
-	  || detail->value != 0 || endpoint == ENDP0)
+      if (arg->len != 0 || (arg->index >> 8) != 0
+	  || arg->value != 0 || endpoint == ENDP0)
 	return USB_UNSUPPORT;

-      if ((detail->index & 0x80))
+      if ((arg->index & 0x80))
 	status = st103_ep_get_tx_status (endpoint);
      else
 	status = st103_ep_get_rx_status (endpoint);
@@ -634,7 +636,7 @@ static int std_set_feature (uint8_t req, struct control_info *detail)
      if (status == 0)		/* Disabled */
 	return USB_UNSUPPORT;

-      if (detail->index & 0x80)
+      if (arg->index & 0x80)
 	/* IN endpoint */
 	st103_ep_set_tx_status (endpoint, EP_TX_STALL);
      else
@@ -648,96 +650,94 @@ static int std_set_feature (uint8_t req, struct control_info *detail)
  return USB_UNSUPPORT;
 }

-static int std_set_address (uint8_t req, struct control_info *detail)
+static int std_set_address (uint8_t req, struct req_args *arg)
 {
  uint8_t rcp = req & RECIPIENT;

-  if ((req & REQUEST_DIR) == 1)
+  if (USB_SETUP_GET (req))
    return USB_UNSUPPORT;

-  if (rcp == DEVICE_RECIPIENT && detail->len == 0 && detail->value <= 127
-      && detail->index == 0 && dev_p->current_configuration == 0)
+  if (rcp == DEVICE_RECIPIENT && arg->len == 0 && arg->value <= 127
+      && arg->index == 0 && dev_p->current_configuration == 0)
    return USB_SUCCESS;

  return USB_UNSUPPORT;
 }

-static int std_get_descriptor (uint8_t req, struct control_info *detail)
+static int std_get_descriptor (uint8_t req, struct req_args *arg)
 {
  uint8_t rcp = req & RECIPIENT;

-  if ((req & REQUEST_DIR) == 0)
+  if (USB_SETUP_SET (req))
    return USB_UNSUPPORT;

-  return usb_cb_get_descriptor (rcp, (detail->value >> 8),
-				(detail->value & 0xff), detail);
+  return usb_cb_get_descriptor (rcp, (arg->value >> 8),
+				(arg->value & 0xff), arg);
 }

-static int std_get_configuration (uint8_t req,  struct control_info *detail)
+static int std_get_configuration (uint8_t req,  struct req_args *arg)
 {
  uint8_t rcp = req & RECIPIENT;

-  (void)detail;
-  if ((req & REQUEST_DIR) == 0)
+  if (USB_SETUP_SET (req))
    return USB_UNSUPPORT;

  if (rcp == DEVICE_RECIPIENT)
-    return usb_lld_reply_request (&dev_p->current_configuration, 1, detail);
+    return usb_lld_reply_request (&dev_p->current_configuration, 1, arg);

  return USB_UNSUPPORT;
 }

-static int std_set_configuration (uint8_t req, struct control_info *detail)
+static int std_set_configuration (uint8_t req, struct req_args *arg)
 {
  uint8_t rcp = req & RECIPIENT;

-  if ((req & REQUEST_DIR) == 1)
+  if (USB_SETUP_GET (req))
    return USB_UNSUPPORT;

-  if (rcp == DEVICE_RECIPIENT && detail->index == 0 && detail->len == 0)
-    return usb_cb_handle_event (USB_EVENT_CONFIG, detail->value);
+  if (rcp == DEVICE_RECIPIENT && arg->index == 0 && arg->len == 0)
+    return usb_cb_handle_event (USB_EVENT_CONFIG, arg->value);

  return USB_UNSUPPORT;
 }

-static int std_get_interface (uint8_t req, struct control_info *detail)
+static int std_get_interface (uint8_t req, struct req_args *arg)
 {
  uint8_t rcp = req & RECIPIENT;

-  if ((req & REQUEST_DIR) == 0)
+  if (USB_SETUP_SET (req))
    return USB_UNSUPPORT;

  if (rcp == INTERFACE_RECIPIENT)
    {
-      if (detail->value != 0 || (detail->index >> 8) != 0 || detail->len != 1)
+      if (arg->value != 0 || (arg->index >> 8) != 0 || arg->len != 1)
 	return USB_UNSUPPORT;

      if (dev_p->current_configuration == 0)
 	return USB_UNSUPPORT;

-      return usb_cb_interface (USB_GET_INTERFACE, detail);
+      return usb_cb_interface (USB_GET_INTERFACE, arg);
    }

  return USB_UNSUPPORT;
 }

-static int std_set_interface (uint8_t req, struct control_info *detail)
+static int std_set_interface (uint8_t req, struct req_args *arg)
 {
  uint8_t rcp = req & RECIPIENT;

-  if ((req & REQUEST_DIR) == 1 || rcp != INTERFACE_RECIPIENT
-      || detail->len != 0 || (detail->index >> 8) != 0
-      || (detail->value >> 8) != 0 || dev_p->current_configuration != 0)
+  if (USB_SETUP_GET (req) || rcp != INTERFACE_RECIPIENT
+      || arg->len != 0 || (arg->index >> 8) != 0
+      || (arg->value >> 8) != 0 || dev_p->current_configuration == 0)
    return USB_UNSUPPORT;

-  return usb_cb_interface (USB_SET_INTERFACE, detail);
+  return usb_cb_interface (USB_SET_INTERFACE, arg);
 }


 static void handle_setup0 (void)
 {
  const uint16_t *pw;
-  struct control_info ctrl;
  uint16_t w;
  uint8_t req_no;
  int r = USB_UNSUPPORT;
@@ -749,11 +749,11 @@ static void handle_setup0 (void)
  dev_p->bmRequestType = w & 0xff;
  dev_p->bRequest = req_no = w >> 8;
  pw++;
-  ctrl.value = *pw++;
+  dev_p->value = *pw++;
  pw++;
-  ctrl.index  = *pw++;
+  dev_p->index = *pw++;
  pw++;
-  ctrl.len = *pw;
+  dev_p->len = *pw;

  data_p->addr = NULL;
  data_p->len = 0;
@@ -777,11 +777,13 @@ static void handle_setup0 (void)
 	    default: handler = std_none;  break;
 	    }

-	  r = (*handler) (dev_p->bmRequestType, &ctrl);
+	  r = (*handler) (dev_p->bmRequestType,
+			  (struct req_args *)&dev_p->value);
 	}
    }
  else
-    r = usb_cb_setup (dev_p->bmRequestType, req_no, &ctrl);
+    r = usb_cb_setup (dev_p->bmRequestType, req_no,
+		      (struct req_args *)&dev_p->value);

  if (r != USB_SUCCESS)
    dev_p->state = STALLED;
@@ -789,8 +791,7 @@ static void handle_setup0 (void)
    {
      if (USB_SETUP_SET (dev_p->bmRequestType))
 	{
-	  dev_p->value = ctrl.value;
-	  if (ctrl.len == 0)
+	  if (dev_p->len == 0)
 	    {
 	      dev_p->state = WAIT_STATUS_IN;
 	      st103_set_tx_count (ENDP0, 0);
@@ -819,8 +820,8 @@ static void handle_in0 (void)
 	  usb_cb_handle_event (USB_EVENT_ADDRESS, dev_p->value);
 	}
      else
-	usb_cb_ctrl_write_finish  (dev_p->bmRequestType, dev_p->bRequest,
-				   dev_p->value);
+	usb_cb_ctrl_write_finish (dev_p->bmRequestType, dev_p->bRequest,
+				  (struct req_args *)&dev_p->value);

      dev_p->state = STALLED;
    }
@@ -842,27 +843,6 @@ static void handle_out0 (void)
    dev_p->state = STALLED;
 }

-static void nop_proc (void)
-{
-}
-
-#define WEAK __attribute__ ((weak, alias ("nop_proc")))
-void WEAK EP1_IN_Callback (void);
-void WEAK EP2_IN_Callback (void);
-void WEAK EP3_IN_Callback (void);
-void WEAK EP4_IN_Callback (void);
-void WEAK EP5_IN_Callback (void);
-void WEAK EP6_IN_Callback (void);
-void WEAK EP7_IN_Callback (void);
-
-void WEAK EP1_OUT_Callback (void);
-void WEAK EP2_OUT_Callback (void);
-void WEAK EP3_OUT_Callback (void);
-void WEAK EP4_OUT_Callback (void);
-void WEAK EP5_OUT_Callback (void);
-void WEAK EP6_OUT_Callback (void);
-void WEAK EP7_OUT_Callback (void);
-
 static void
 usb_handle_transfer (uint16_t istr_value)
 {
@@ -900,37 +880,21 @@ usb_handle_transfer (uint16_t istr_value)
      if ((ep_value & EP_CTR_RX))
 	{
 	  st103_ep_clear_ctr_rx (ep_index);
-	  switch ((ep_index - 1))
-	    {
-	    case 0: EP1_OUT_Callback ();  break;
-	    case 1: EP2_OUT_Callback ();  break;
-	    case 2: EP3_OUT_Callback ();  break;
-	    case 3: EP4_OUT_Callback ();  break;
-	    case 4: EP5_OUT_Callback ();  break;
-	    case 5: EP6_OUT_Callback ();  break;
-	    case 6: EP7_OUT_Callback ();  break;
-	    }
+	  usb_cb_rx_ready (ep_index);
 	}

      if ((ep_value & EP_CTR_TX))
 	{
 	  st103_ep_clear_ctr_tx (ep_index);
-	  switch ((ep_index - 1))
-	    {
-	    case 0: EP1_IN_Callback ();  break;
-	    case 1: EP2_IN_Callback ();  break;
-	    case 2: EP3_IN_Callback ();  break;
-	    case 3: EP4_IN_Callback ();  break;
-	    case 4: EP5_IN_Callback ();  break;
-	    case 5: EP6_IN_Callback ();  break;
-	    case 6: EP7_IN_Callback ();  break;
-	    }
+	  usb_cb_tx_done (ep_index);
 	}
    }
 }

-void usb_lld_reset (void)
+void usb_lld_reset (uint8_t feature)
 {
+  usb_lld_set_configuration (0);
+  dev_p->current_feature = feature;
  st103_set_btable ();
  st103_set_daddr (0);
 }
@@ -1037,14 +1001,9 @@ uint8_t usb_lld_current_configuration (void)
  return dev_p->current_configuration;
 }

-void usb_lld_set_feature (uint8_t feature)
+void usb_lld_set_data_to_recv (void *p, size_t len)
 {
-  dev_p->current_feature = feature;
-}
-
-void usb_lld_set_data_to_recv (const void *p, size_t len)
-{
-  data_p->addr = (uint8_t *)p;
+  data_p->addr = p;
  data_p->len = len;
 }

@@ -1129,7 +1088,7 @@ void usb_lld_from_pmabuf (void *dst, uint16_t addr, size_t n)
 * BUFLEN: size of the data.
 */
 int
-usb_lld_reply_request (const void *buf, size_t buflen, struct control_info *ctl)
+usb_lld_reply_request (const void *buf, size_t buflen, struct req_args *ctl)
 {
  uint32_t len_asked = ctl->len;
  uint32_t len;
--- a/example-fs-bb48/Makefile
+++ b/example-fs-bb48/Makefile
@@ -0,0 +1,31 @@
+# Makefile for example application of Chopstx
+
+PROJECT = sample
+
+### Currently, it's for FS-BB48.
+
+CHOPSTX = ..
+LDSCRIPT= sample.ld
+CSRC = sample.c first-pages.c usb_kl27z.c usb-cdc.c adc_kl27z.c
+
+###################################
+CROSS = arm-none-eabi-
+CC   = $(CROSS)gcc
+LD   = $(CROSS)gcc
+OBJCOPY   = $(CROSS)objcopy
+
+MCU   = cortex-m0plus
+CWARN = -Wall -Wextra -Wstrict-prototypes
+DEFS  = -DFREE_STANDING -DMHZ=48
+OPT   = -O3 -Os -g
+LIBS  =
+
+####################
+include ../rules.mk
+
+board.h:
+	@echo Please make a symbolic link \'board.h\' to a file in ../board;
+	@exit 1
+
+distclean: clean
+	rm -f board.h
--- a/example-fs-bb48/adc.h
+++ b/example-fs-bb48/adc.h
@@ -0,0 +1,8 @@
+void adc_init (void);
+void adc_start (void);
+void adc_stop (void);
+
+extern uint32_t adc_buf[64];
+
+void adc_start_conversion (int offset, int count);
+int adc_wait_completion (chopstx_intr_t *intr);
--- a/example-fs-bb48/adc_kl27z.c
+++ b/example-fs-bb48/adc_kl27z.c
@@ -0,0 +1,223 @@
+/*
+ * adc_kl27z.c - ADC driver for KL27Z
+ *               In this ADC driver, there are NeuG specific parts.
+ *               You need to modify to use this as generic ADC driver.
+ *
+ * Copyright (C) 2016  Flying Stone Technology
+ * Author: NIIBE Yutaka <gniibe@fsij.org>
+ *
+ * This file is a part of Chopstx, a thread library for embedded.
+ *
+ * Chopstx is free software: you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * Chopstx is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ *
+ * As additional permission under GNU GPL version 3 section 7, you may
+ * distribute non-source form of the Program without the copy of the
+ * GNU GPL normally required by section 4, provided you inform the
+ * receipents of GNU GPL by a written offer.
+ *
+ */
+
+#include <stdint.h>
+#include <stdlib.h>
+#include <chopstx.h>
+#include "kl_sim.h"
+
+#define INTR_REQ_ADC 15
+
+struct ADC {
+  volatile uint32_t SC1[2];/* Status and Control Registers 1 */
+  volatile uint32_t CFG1;  /* Configuration Register 1       */
+  volatile uint32_t CFG2;  /* Configuration Register 2       */
+  volatile uint32_t R[2];  /* Data Result Register           */
+
+  /* Compare Value Registers 1, 2 */
+  volatile uint32_t CV1;
+  volatile uint32_t CV2;
+
+  volatile uint32_t SC2;   /* Status and Control Register 2  */
+  volatile uint32_t SC3;   /* Status and Control Register 3  */
+
+  volatile uint32_t OFS;   /* Offset Correction Register     */
+  volatile uint32_t PG;    /* Plus-Side Gain Register        */
+  volatile uint32_t MG;    /* Minus-Side Gain Register       */
+
+  /* Plus-Side General Calibration Value Registers */
+  volatile uint32_t CLPD;
+  volatile uint32_t CLPS;
+  volatile uint32_t CLP4;
+  volatile uint32_t CLP3;
+  volatile uint32_t CLP2;
+  volatile uint32_t CLP1;
+  volatile uint32_t CLP0;
+  uint32_t rsvd0;
+  /* Minus-Side General Calibration Value Registers */
+  volatile uint32_t CLMD;
+  volatile uint32_t CLMS;
+  volatile uint32_t CLM4;
+  volatile uint32_t CLM3;
+  volatile uint32_t CLM2;
+  volatile uint32_t CLM1;
+  volatile uint32_t CLM0;
+};
+static struct ADC *const ADC = (struct ADC *const)0x4003B000;
+
+/* SC1 */
+#define ADC_SC1_DIFF            (1 << 5)
+#define ADC_SC1_AIEN            (1 << 6)
+#define ADC_SC1_COCO            (1 << 7)
+#define ADC_SC1_TEMPSENSOR      26
+#define ADC_SC1_BANDGAP         27
+#define ADC_SC1_ADCSTOP         31
+
+/* CFG1 */
+#define ADC_CLOCK_SOURCE_ASYNCH 3
+#define ADC_RESOLUTION_16BIT    3
+#define ADC_ADLSMP_SHORT        0
+#define ADC_ADLSMP_LONG         1
+#define ADC_ADIV_1              0
+#define ADC_ADIV_8              3
+#define ADC_ADLPC_NORMAL        1
+/**/
+#define ADC_CLOCK_SOURCE ADC_CLOCK_SOURCE_ASYNCH
+#define ADC_MODE         (ADC_RESOLUTION_16BIT << 2)
+#define ADC_ADLSMP       (ADC_ADLSMP_SHORT << 4)
+#define ADC_ADIV         (ADC_ADIV_8 << 5)
+#define ADC_ADLPC        (ADC_ADLPC_NORMAL << 7)
+
+/* CFG2 */
+#define ADC_ADLSTS_DEFAULT      0 /* 24 cycles if CFG1.ADLSMP=1, 4 if not.  */
+#define ADC_ADHSC_NORMAL        0
+#define ADC_ADHSC_HIGHSPEED     1
+#define ADC_ADACK_ENABLE        1
+#define ADC_ADACK_DISABLE       0
+#define ADC_MUXSEL_A            0
+#define ADC_MUXSEL_B            1
+/**/
+#define ADC_ADLSTS       ADC_ADLSTS_DEFAULT 
+#define ADC_ADHSC        (ADC_ADHSC_NORMAL << 2)
+#define ADC_ADACKEN      (ADC_ADACK_ENABLE << 3)
+#define ADC_MUXSEL       (ADC_MUXSEL_A << 4) 
+
+/* SC2 */
+#define ADC_SC2_ADTRG		(1 << 6) /* For hardware trigger */
+#define ADC_SC2_ACFE            (1 << 5)
+#define ADC_SC2_ACFGT           (1 << 4)
+#define ADC_SC2_ACREN           (1 << 3)
+#define ADC_SC2_DMAEN           (1 << 2)
+#define ADC_SC2_REFSEL_DEFAULT  0
+
+/* SC3 */
+#define ADC_SC3_CAL             (1 << 7)
+#define ADC_SC3_CALF            (1 << 6)
+#define ADC_SC3_ADCO            (1 << 3)
+#define ADC_SC3_AVGE            (1 << 2)
+#define ADC_SC3_AVGS11          0x03
+
+/*
+ * Initialize ADC module, do calibration.
+ * This is called by MAIN, only once, before creating any other threads.
+ */
+int
+adc_init (void)
+{
+  uint32_t v;
+
+  /* Enable ADC0 clock.  */
+  SIM->SCGC6 |= (1 << 27);
+
+  ADC->CFG1 = ADC_CLOCK_SOURCE | ADC_MODE | ADC_ADLSMP | ADC_ADIV | ADC_ADLPC;
+  ADC->CFG2 = ADC_ADLSTS | ADC_ADHSC | ADC_ADACKEN | ADC_MUXSEL;
+  ADC->SC2 = 0;
+  ADC->SC3 = ADC_SC3_CAL | ADC_SC3_CALF | ADC_SC3_AVGE | ADC_SC3_AVGS11;
+  ADC->SC1[0] = ADC_SC1_TEMPSENSOR;
+
+  /* Wait ADC completion */
+  while ((ADC->SC1[0] & ADC_SC1_COCO) == 0)
+    if ((ADC->SC3 & ADC_SC3_CALF) != 0)
+      /* Calibration failure */
+      return -1;
+
+  if ((ADC->SC3 & ADC_SC3_CALF) != 0)
+    /* Calibration failure */
+    return -1;
+
+  /* Configure PG by the calibration values.  */
+  v = ADC->CLP0 + ADC->CLP1 + ADC->CLP2 + ADC->CLP3 + ADC->CLP4 + ADC->CLPS;
+  ADC->PG = 0x8000 | (v >> 1);
+
+  /* Configure MG by the calibration values.  */
+  v = ADC->CLM0 + ADC->CLM1 + ADC->CLM2 + ADC->CLM3 + ADC->CLM4 + ADC->CLMS;
+  ADC->MG = 0x8000 | (v >> 1);
+
+  return 0;
+}
+
+/*
+ * Start using ADC.
+ */
+void
+adc_start (void)
+{
+  ADC->CFG1 = ADC_CLOCK_SOURCE | ADC_MODE | ADC_ADLSMP | ADC_ADIV | ADC_ADLPC;
+  ADC->CFG2 = ADC_ADLSTS | ADC_ADHSC | ADC_ADACKEN | ADC_MUXSEL;
+  ADC->SC2 = 0;
+  ADC->SC3 = 0;
+}
+
+/*
+ * Buffer to save ADC data.
+ */
+uint32_t adc_buf[64];
+
+/*
+ * Kick getting data for COUNT times.
+ * Data will be saved in ADC_BUF starting at OFFSET.
+ */
+void
+adc_start_conversion (int offset, int count)
+{
+  ADC->SC1[0] = /*ADC_SC1_AIEN*/0 | ADC_SC1_TEMPSENSOR;
+}
+
+
+static void
+adc_stop_conversion (void)
+{
+  ADC->SC1[0] = ADC_SC1_ADCSTOP;
+}
+
+/*
+ * Stop using ADC.
+ */
+void
+adc_stop (void)
+{
+  SIM->SCGC6 &= ~(1 << 27);
+}
+
+/*
+ * Return 0 on success.
+ * Return 1 on error.
+ */
+int
+adc_wait_completion (chopstx_intr_t *intr)
+{
+  /* Wait ADC completion */
+  while ((ADC->SC1[0] & ADC_SC1_COCO) == 0)
+    ;
+
+  adc_buf[0] = ADC->R[0];
+  adc_stop_conversion ();
+  return 0;
+}
--- a/example-fs-bb48/board.h
+++ b/example-fs-bb48/board.h
@@ -0,0 +1 @@
+../board/board-fs-bb48.h
--- a/example-fs-bb48/crc32.h
+++ b/example-fs-bb48/crc32.h
@@ -0,0 +1,5 @@
+void crc32_init (void);
+void crc32_u8 (unsigned char);
+void crc32_u32 (unsigned int);
+
+unsigned int crc32_value (void);
--- a/example-fs-bb48/first-pages.c
+++ b/example-fs-bb48/first-pages.c
@@ -0,0 +1,151 @@
+/*
+ * first-pages.c - First pages for MKL27Z256.
+ *
+ * Copyright (C) 2016 Flying Stone Technology
+ * Author: NIIBE Yutaka <gniibe@fsij.org>
+ *
+ * Copying and distribution of this file, with or without modification,
+ * are permitted in any medium without royalty provided the copyright
+ * notice and this notice are preserved.  This file is offered as-is,
+ * without any warranty.
+ *
+ *
+ * First two pages of Flash ROM is difficult to use because of
+ * predefined purposes.  It's defined as a default vector page and
+ * flash configuration page.
+ *
+ * We put something useful to those two pages, together with the
+ * data for predefined purposes.
+ */
+
+
+#include <stdint.h>
+
+extern uint8_t __main_stack_end__;
+
+static void __attribute__ ((naked,section(".flash_config_page")))
+reset (void)
+{
+  uint32_t r3 = 0xe000ed08;
+
+  asm volatile ("str	%2, [%0]\n\t"	  /* Set SCR->VTOR     */
+		"ldr	%0, [%2, #4]\n\t" /* Jump to the entry */
+		"bx	%0\n\t"
+		".align	2\n"
+		: "=r" (r3)
+		: "0" (r3), "r" (0x00000800)
+		: "memory");
+
+  /* Never reach here. */
+}
+
+
+static uint32_t
+stack_entry[] __attribute__ ((section(".first_page.first_words"),used)) = {
+  (uint32_t)(&__main_stack_end__ - 32),
+  (uint32_t)reset,
+};
+
+/*
+ * NOTE: We don't use backdoor comparison key.  The area is used by
+ * CRC32 table.
+ */
+static uint32_t
+flash_config[] __attribute__ ((section(".flash_config"),used)) = {
+  0xffffffff, /* Protection bytes */
+  0xffff3ffe, /* FSEC=0xfe, FOPT=0x3f */
+  /* FOPT=0x3f:
+   * BOOTSRC_SEL=00: Boot from flash
+   */
+  /* FSEC=0xfe:
+   * unsecure
+   */
+};
+
+
+/*
+ * CRC32 calculation routines.
+ */
+
+/*
+ * Table of CRC32, generated by gen_crc_table.py
+ */
+static unsigned int
+crc32_table[256] __attribute__ ((section(".first_page"))) = {
+  0x00000000, 0x77073096, 0xee0e612c, 0x990951ba, 0x076dc419, 0x706af48f, 
+  0xe963a535, 0x9e6495a3, 0x0edb8832, 0x79dcb8a4, 0xe0d5e91e, 0x97d2d988, 
+  0x09b64c2b, 0x7eb17cbd, 0xe7b82d07, 0x90bf1d91, 0x1db71064, 0x6ab020f2, 
+  0xf3b97148, 0x84be41de, 0x1adad47d, 0x6ddde4eb, 0xf4d4b551, 0x83d385c7, 
+  0x136c9856, 0x646ba8c0, 0xfd62f97a, 0x8a65c9ec, 0x14015c4f, 0x63066cd9, 
+  0xfa0f3d63, 0x8d080df5, 0x3b6e20c8, 0x4c69105e, 0xd56041e4, 0xa2677172, 
+  0x3c03e4d1, 0x4b04d447, 0xd20d85fd, 0xa50ab56b, 0x35b5a8fa, 0x42b2986c, 
+  0xdbbbc9d6, 0xacbcf940, 0x32d86ce3, 0x45df5c75, 0xdcd60dcf, 0xabd13d59, 
+  0x26d930ac, 0x51de003a, 0xc8d75180, 0xbfd06116, 0x21b4f4b5, 0x56b3c423, 
+  0xcfba9599, 0xb8bda50f, 0x2802b89e, 0x5f058808, 0xc60cd9b2, 0xb10be924, 
+  0x2f6f7c87, 0x58684c11, 0xc1611dab, 0xb6662d3d, 0x76dc4190, 0x01db7106, 
+  0x98d220bc, 0xefd5102a, 0x71b18589, 0x06b6b51f, 0x9fbfe4a5, 0xe8b8d433, 
+  0x7807c9a2, 0x0f00f934, 0x9609a88e, 0xe10e9818, 0x7f6a0dbb, 0x086d3d2d, 
+  0x91646c97, 0xe6635c01, 0x6b6b51f4, 0x1c6c6162, 0x856530d8, 0xf262004e, 
+  0x6c0695ed, 0x1b01a57b, 0x8208f4c1, 0xf50fc457, 0x65b0d9c6, 0x12b7e950, 
+  0x8bbeb8ea, 0xfcb9887c, 0x62dd1ddf, 0x15da2d49, 0x8cd37cf3, 0xfbd44c65, 
+  0x4db26158, 0x3ab551ce, 0xa3bc0074, 0xd4bb30e2, 0x4adfa541, 0x3dd895d7, 
+  0xa4d1c46d, 0xd3d6f4fb, 0x4369e96a, 0x346ed9fc, 0xad678846, 0xda60b8d0, 
+  0x44042d73, 0x33031de5, 0xaa0a4c5f, 0xdd0d7cc9, 0x5005713c, 0x270241aa, 
+  0xbe0b1010, 0xc90c2086, 0x5768b525, 0x206f85b3, 0xb966d409, 0xce61e49f, 
+  0x5edef90e, 0x29d9c998, 0xb0d09822, 0xc7d7a8b4, 0x59b33d17, 0x2eb40d81, 
+  0xb7bd5c3b, 0xc0ba6cad, 0xedb88320, 0x9abfb3b6, 0x03b6e20c, 0x74b1d29a, 
+  0xead54739, 0x9dd277af, 0x04db2615, 0x73dc1683, 0xe3630b12, 0x94643b84, 
+  0x0d6d6a3e, 0x7a6a5aa8, 0xe40ecf0b, 0x9309ff9d, 0x0a00ae27, 0x7d079eb1, 
+  0xf00f9344, 0x8708a3d2, 0x1e01f268, 0x6906c2fe, 0xf762575d, 0x806567cb, 
+  0x196c3671, 0x6e6b06e7, 0xfed41b76, 0x89d32be0, 0x10da7a5a, 0x67dd4acc, 
+  0xf9b9df6f, 0x8ebeeff9, 0x17b7be43, 0x60b08ed5, 0xd6d6a3e8, 0xa1d1937e, 
+  0x38d8c2c4, 0x4fdff252, 0xd1bb67f1, 0xa6bc5767, 0x3fb506dd, 0x48b2364b, 
+  0xd80d2bda, 0xaf0a1b4c, 0x36034af6, 0x41047a60, 0xdf60efc3, 0xa867df55, 
+  0x316e8eef, 0x4669be79, 0xcb61b38c, 0xbc66831a, 0x256fd2a0, 0x5268e236, 
+  0xcc0c7795, 0xbb0b4703, 0x220216b9, 0x5505262f, 0xc5ba3bbe, 0xb2bd0b28, 
+  0x2bb45a92, 0x5cb36a04, 0xc2d7ffa7, 0xb5d0cf31, 0x2cd99e8b, 0x5bdeae1d, 
+  0x9b64c2b0, 0xec63f226, 0x756aa39c, 0x026d930a, 0x9c0906a9, 0xeb0e363f, 
+  0x72076785, 0x05005713, 0x95bf4a82, 0xe2b87a14, 0x7bb12bae, 0x0cb61b38, 
+  0x92d28e9b, 0xe5d5be0d, 0x7cdcefb7, 0x0bdbdf21, 0x86d3d2d4, 0xf1d4e242, 
+  0x68ddb3f8, 0x1fda836e, 0x81be16cd, 0xf6b9265b, 0x6fb077e1, 0x18b74777, 
+  0x88085ae6, 0xff0f6a70, 0x66063bca, 0x11010b5c, 0x8f659eff, 0xf862ae69, 
+  0x616bffd3, 0x166ccf45, 0xa00ae278, 0xd70dd2ee, 0x4e048354, 0x3903b3c2, 
+  0xa7672661, 0xd06016f7, 0x4969474d, 0x3e6e77db, 0xaed16a4a, 0xd9d65adc, 
+  0x40df0b66, 0x37d83bf0, 0xa9bcae53, 0xdebb9ec5, 0x47b2cf7f, 0x30b5ffe9, 
+  0xbdbdf21c, 0xcabac28a, 0x53b39330, 0x24b4a3a6, 0xbad03605, 0xcdd70693, 
+  0x54de5729, 0x23d967bf, 0xb3667a2e, 0xc4614ab8, 0x5d681b02, 0x2a6f2b94, 
+  0xb40bbe37, 0xc30c8ea1, 0x5a05df1b, 0x2d02ef8d,
+};
+
+static unsigned int crc_reg;
+
+__attribute__ ((section(".flash_config_page")))
+void
+crc32_init (void)
+{
+  crc_reg = 0xffffffff;
+}
+
+__attribute__ ((section(".flash_config_page")))
+unsigned int
+crc32_value (void)
+{
+  return crc_reg;
+}
+
+__attribute__ ((section(".flash_config_page")))
+void
+crc32_u8 (unsigned char bits_eight)
+{
+  crc_reg = crc32_table[(crc_reg & 0xff) ^ bits_eight] ^ (crc_reg >> 8);
+}
+
+__attribute__ ((section(".flash_config_page")))
+void
+crc32_u32 (unsigned int u)
+{
+  crc32_u8 (u & 0xff);
+  crc32_u8 ((u >> 8)& 0xff);
+  crc32_u8 ((u >> 16)& 0xff);
+  crc32_u8 ((u >> 24)& 0xff);
+}
--- a/example-fs-bb48/gen_crc_table.py
+++ b/example-fs-bb48/gen_crc_table.py
@@ -0,0 +1,22 @@
+# 
+# Polynomial for CRC32:
+#    x26 + x23 + x22 + x16 + x12 + x11 + x10 + x8 + x7 + x5 + x4 + x2 + x + 1
+#
+# When it is represented in binary, it's:
+#    0x04C11DB7
+#    =
+#    0000 0100 1100 0001 0001 1101 1011 0111
+# 
+# When we put in reverse bit-order, it's
+#    0xedb88320
+
+for i in range(0,256):
+    c = i
+    for j in range(0,8):
+        if (c&1):
+            c = 0xEDB88320 ^ (c >> 1)
+        else:
+            c = c >> 1
+    print("0x%08x," % c),
+    if (i % 6) == 5:
+        print("")
--- a/example-fs-bb48/kl_sim.h
+++ b/example-fs-bb48/kl_sim.h
@@ -0,0 +1,31 @@
+/* System Integration Module.  */
+struct SIM {
+  volatile uint32_t SOPT1;    /* System Options Register 1               */
+  volatile uint32_t SOPT1CFG; /* SOPT1 Configuration Register            */
+  uint32_t reserved0[1023];   /*                                         */
+  volatile uint32_t SOPT2;    /* System Options Register 2               */
+  uint32_t reserved1[1];      /*                                         */
+  volatile uint32_t SOPT4;    /* System Options Register 4               */
+  volatile uint32_t SOPT5;    /* System Options Register 5               */
+  uint32_t reserved2[1];      /*                                         */
+  volatile uint32_t SOPT7;    /* System Options Register 7               */
+  uint32_t reserved3[2];       /*                                         */
+  volatile uint32_t SDID;     /* System Device Identification Register   */
+  uint32_t reserved4[3];      /*                                         */
+  volatile uint32_t SCGC4;    /* System Clock Gating Control Register 4  */
+  volatile uint32_t SCGC5;    /* System Clock Gating Control Register 5  */
+  volatile uint32_t SCGC6;    /* System Clock Gating Control Register 6  */
+  volatile uint32_t SCGC7;    /* System Clock Gating Control Register 7  */
+  volatile uint32_t CLKDIV1;  /* System Clock Divider Register 1         */
+  uint32_t reserved5[1];      /*                                         */
+  volatile uint32_t FCFG1;    /* Flash Configuration Register 1          */
+  volatile uint32_t FCFG2;    /* Flash Configuration Register 2          */
+  uint32_t reserved6[1];      /*                                         */
+  volatile uint32_t UIDMH;    /* Unique Identification Register Mid-High */
+  volatile uint32_t UIDML;    /* Unique Identification Register Mid Low  */
+  volatile uint32_t UIDL;     /* Unique Identification Register Low      */
+  uint32_t reserved7[39];     /*                                         */
+  volatile uint32_t COPC;     /* COP Control Register                    */
+  volatile uint32_t SRVCOP;   /* Service COP                             */
+};
+static struct SIM *const SIM = (struct SIM *const)0x40047000;
--- a/example-fs-bb48/sample.c
+++ b/example-fs-bb48/sample.c
@@ -0,0 +1,298 @@
+#include <stdint.h>
+#include <stdlib.h>
+#include <string.h>
+#include <chopstx.h>
+
+#include "usb_lld.h"
+#include "stream.h"
+#include "board.h"
+
+#include "crc32.h"
+#include "adc.h"
+
+struct GPIO {
+  volatile uint32_t PDOR; /* Port Data Output Register    */
+  volatile uint32_t PSOR; /* Port Set Output Register     */
+  volatile uint32_t PCOR; /* Port Clear Output Register   */
+  volatile uint32_t PTOR; /* Port Toggle Output Register  */
+  volatile uint32_t PDIR; /* Port Data Input Register     */
+  volatile uint32_t PDDR; /* Port Data Direction Register */
+};
+static struct GPIO *const GPIOB = (struct GPIO *const)0x400FF040;
+static struct GPIO *const GPIOD = (struct GPIO *const)0x400FF0C0;
+static struct GPIO *const GPIOE = (struct GPIO *const)0x400FF100;
+
+static void
+set_led (int on)
+{
+  if (on)
+    GPIOB->PCOR = (1 << 0); /* PTB0: Clear: Light on  */
+  else
+    GPIOB->PSOR = (1 << 0); /* PTB0: Set  : Light off */
+}
+
+static chopstx_mutex_t mtx;
+static chopstx_cond_t cnd0;
+static chopstx_cond_t cnd1;
+
+uint8_t u;
+static uint8_t v;
+static uint8_t m;		/* 0..100 */
+
+static void
+wait_for (uint32_t usec)
+{
+#if defined(BUSY_LOOP)
+  uint32_t count = usec * 6;
+  uint32_t i;
+
+  for (i = 0; i < count; i++)
+    asm volatile ("" : : "r" (i) : "memory");
+#else
+  chopstx_usec_wait (usec);
+#endif
+}
+
+static void *
+pwm (void *arg)
+{
+  (void)arg;
+
+  chopstx_mutex_lock (&mtx);
+  chopstx_cond_wait (&cnd0, &mtx);
+  chopstx_mutex_unlock (&mtx);
+
+  while (1)
+    {
+      set_led (u&v);
+      wait_for (m);
+      set_led (0);
+      wait_for (100-m);
+    }
+
+  return NULL;
+}
+
+static void *
+blk (void *arg)
+{
+  (void)arg;
+
+  chopstx_mutex_lock (&mtx);
+  chopstx_cond_wait (&cnd1, &mtx);
+  chopstx_mutex_unlock (&mtx);
+
+  while (1)
+    {
+      v = 0;
+      wait_for (200*1000);
+      v = 1;
+      wait_for (200*1000);
+    }
+
+  return NULL;
+}
+
+#define INTR_REQ_USB 24
+
+static void *
+usb_intr (void *arg)
+{
+  extern void usb_lld_init (uint8_t feature);
+  extern void usb_interrupt_handler (void);
+
+  chopstx_intr_t interrupt;
+
+  (void)arg;
+  chopstx_claim_irq (&interrupt, INTR_REQ_USB);
+  usb_lld_init (0x80);		/* Bus powered. */
+
+  while (1)
+    {
+      chopstx_intr_wait (&interrupt);
+
+      /* Process interrupt. */
+      usb_interrupt_handler ();
+    }
+
+  return NULL;
+}
+
+#if defined(BUSY_LOOP)
+#define PRIO_PWM (CHOPSTX_SCHED_RR|1)
+#define PRIO_BLK (CHOPSTX_SCHED_RR|1)
+#else
+#define PRIO_PWM 3
+#define PRIO_BLK 2
+#endif
+#define PRIO_INTR 4
+
+extern uint8_t __process1_stack_base__, __process1_stack_size__;
+extern uint8_t __process2_stack_base__, __process2_stack_size__;
+extern uint8_t __process3_stack_base__, __process3_stack_size__;
+
+const uint32_t __stackaddr_pwm = (uint32_t)&__process1_stack_base__;
+const size_t __stacksize_pwm = (size_t)&__process1_stack_size__;
+
+const uint32_t __stackaddr_blk = (uint32_t)&__process2_stack_base__;
+const size_t __stacksize_blk = (size_t)&__process2_stack_size__;
+
+const uint32_t __stackaddr_intr = (uint32_t)&__process3_stack_base__;
+const size_t __stacksize_intr = (size_t)&__process3_stack_size__;
+
+
+static char hexchar (uint8_t x)
+{
+  x &= 0x0f;
+  if (x <= 0x09)
+    return '0' + x;
+  else if (x <= 0x0f)
+    return 'a' + x - 10;
+  else
+    return '?';
+}
+
+
+static int
+check_recv (void *arg)
+{
+  struct stream *s = arg;
+  if ((s->flags & FLAG_CONNECTED) == 0)
+    return 1;
+  if ((s->flags & FLAG_RECV_AVAIL))
+    return 1;
+  return 0;
+}
+
+
+int
+main (int argc, const char *argv[])
+{
+  struct stream *st;
+  uint8_t count;
+  extern uint32_t bDeviceState;
+
+  (void)argc;
+  (void)argv;
+
+  adc_init ();
+  adc_start ();
+
+  chopstx_mutex_init (&mtx);
+  chopstx_cond_init (&cnd0);
+  chopstx_cond_init (&cnd1);
+
+  st = stream_open ();
+
+  m = 10;
+
+  chopstx_create (PRIO_PWM, __stackaddr_pwm, __stacksize_pwm, pwm, NULL);
+  chopstx_create (PRIO_BLK, __stackaddr_blk, __stacksize_blk, blk, NULL);
+  chopstx_create (PRIO_INTR, __stackaddr_intr, __stacksize_intr,
+		  usb_intr, NULL);
+
+  chopstx_usec_wait (200*1000);
+
+  chopstx_mutex_lock (&mtx);
+  chopstx_cond_signal (&cnd0);
+  chopstx_cond_signal (&cnd1);
+  chopstx_mutex_unlock (&mtx);
+
+  u = 1;
+  while (bDeviceState != CONFIGURED)
+    chopstx_usec_wait (500*1000);
+
+  count = 0;
+  while (1)
+    {
+      uint8_t s[64];
+
+      u = 1;
+      if (stream_wait_connection (st) < 0)
+	{
+	  chopstx_usec_wait (1000*1000);
+	  continue;
+	}
+
+      chopstx_usec_wait (500*1000);
+
+      /* Send ZLP at the beginning.  */
+      stream_send (st, s, 0);
+
+      memcpy (s, "xx: Hello, World with Chopstx!\r\n", 32);
+      s[0] = hexchar (count >> 4);
+      s[1] = hexchar (count & 0x0f);
+      count++;
+
+      if (stream_send (st, s, 32) < 0)
+	continue;
+
+      while (1)
+	{
+	  int size;
+	  uint32_t usec;
+	  struct chx_poll_cond poll_desc;
+
+	  poll_desc.type = CHOPSTX_POLL_COND;
+	  poll_desc.ready = 0;
+	  poll_desc.cond = &st->cnd;
+	  poll_desc.mutex = &st->mtx;
+	  poll_desc.check = check_recv;
+	  poll_desc.arg = st;
+
+	  /* With chopstx_poll, we can do timed cond_wait */
+	  usec = 3000000;
+	  if (chopstx_poll (&usec, 1, &poll_desc))
+	    {
+	      size = stream_recv (st, s + 4);
+
+	      if (size < 0)
+		break;
+
+	      if (size >= 0)
+		{
+		  unsigned int value;
+
+		  if (s[4] == 't')
+		    {
+		      s[0] = 'T';
+		      s[1] = 'M';
+
+		      adc_start_conversion (0, 1);
+		      adc_wait_completion (NULL);
+		      value = adc_buf[0];
+		    }
+		  else
+		    {
+		      int i;
+
+		      crc32_init ();
+		      s[0] = hexchar (size >> 4);
+		      s[1] = hexchar (size & 0x0f);
+
+		      for (i = 0; i < size; i++)
+			crc32_u8 (s[4 + i]);
+		      value = crc32_value () ^ 0xffffffff;
+		    }
+
+		  s[4] = hexchar (value >> 28);
+		  s[5] = hexchar (value >> 24);
+		  s[6] = hexchar (value >> 20);
+		  s[7] = hexchar (value >> 16);
+		  s[8] = hexchar (value >> 12);
+		  s[9] = hexchar (value >> 8);
+		  s[10] = hexchar (value >> 4);
+		  s[11] = hexchar (value);
+		  s[12] = '\r';
+		  s[13] = '\n';
+		  if (stream_send (st, s, 14) < 0)
+		    break;
+		}
+	    }
+
+	  u ^= 1;
+	}
+    }
+
+  return 0;
+}
--- a/example-fs-bb48/sample.ld
+++ b/example-fs-bb48/sample.ld
@@ -0,0 +1,135 @@
+/*
+ * MK27Z memory setup.
+ */
+__main_stack_size__      = 0x0100; /* Exception handlers     */
+__process0_stack_size__  = 0x0300; /* Main program           */
+__process1_stack_size__  = 0x0200; /* first thread program   */
+__process2_stack_size__  = 0x0100; /* second thread program  */
+__process3_stack_size__  = 0x0200; /* third thread program   */
+
+MEMORY
+{
+    flash  : org = 0x00000000, len = 256k
+    ram : org = 0x1fffe000, len = 32k
+}
+
+__ram_start__           = ORIGIN(ram);
+__ram_size__            = 32k;
+__ram_end__             = __ram_start__ + __ram_size__;
+
+SECTIONS
+{
+    . = 0;
+
+    _text = .;
+
+    .f2 : ALIGN(16) SUBALIGN(8)
+    {
+        KEEP(*(.first_page.first_words))
+        KEEP(*(.first_page))
+        KEEP(*(.flash_config))
+	KEEP(*(.flash_config_page))
+    } > flash =0xffffffff
+
+    .text : ALIGN(16) SUBALIGN(16)
+    {
+	. = ALIGN(1024);
+        KEEP(*(.startup.vectors))
+	. = ALIGN(16);
+        *(.text.startup.*)
+        *(.text)
+        *(.text.*)
+        *(.rodata)
+        *(.rodata.*)
+        *(.glue_7t)
+        *(.glue_7)
+        *(.gcc*)
+	. = ALIGN(8);
+    } > flash =0xffffffff
+
+    /DISCARD/ :
+    {
+        *(.bss.startup.0)
+    }
+
+    .ARM.extab : {*(.ARM.extab* .gnu.linkonce.armextab.*)} > flash
+
+    .ARM.exidx : {
+        PROVIDE(__exidx_start = .);
+        *(.ARM.exidx* .gnu.linkonce.armexidx.*)
+        PROVIDE(__exidx_end = .);
+     } > flash =0xffffffff
+
+    .eh_frame_hdr : {*(.eh_frame_hdr)} > flash
+
+    .eh_frame : ONLY_IF_RO {*(.eh_frame)} > flash
+
+    .textalign : ONLY_IF_RO { . = ALIGN(8); } > flash
+
+    _etext = .;
+    _textdata = _etext;
+
+    .process_stack :
+    {
+        . = ALIGN(8);
+        __process3_stack_base__ = .;
+        . += __process3_stack_size__;
+        . = ALIGN(8);
+        __process3_stack_end__ = .;
+        __process2_stack_base__ = .;
+        . += __process2_stack_size__;
+        . = ALIGN(8);
+        __process2_stack_end__ = .;
+        __process1_stack_base__ = .;
+        . += __process1_stack_size__;
+        . = ALIGN(8);
+        __process1_stack_end__ = .;
+        __process0_stack_base__ = .;
+        . += __process0_stack_size__;
+        . = ALIGN(8);
+        __process0_stack_end__ = .;
+    } > ram
+
+    .main_stack :
+    {
+        . = ALIGN(8);
+        __main_stack_base__ = .;
+        . += __main_stack_size__;
+        . = ALIGN(8);
+        __main_stack_end__ = .;
+    } > ram
+
+    .data :
+    {
+        . = ALIGN(4);
+        PROVIDE(_data = .);
+        *(.data)
+        . = ALIGN(4);
+        *(.data.*)
+        . = ALIGN(4);
+        *(.ramtext)
+        . = ALIGN(4);
+        PROVIDE(_edata = .);
+    } > ram AT > flash =0xffffffff
+
+    .bss :
+    {
+        . = ALIGN(4);
+        PROVIDE(_bss_start = .);
+        *(.bss)
+        . = ALIGN(4);
+        *(.bss.*)
+        . = ALIGN(4);
+        *(COMMON)
+        . = ALIGN(512);
+	__usb_bdt__ = .;
+        . += 512;
+        PROVIDE(_bss_end = .);
+    } > ram
+
+    PROVIDE(end = .);
+    _end            = .;
+}
+
+__heap_base__   = _end;
+__heap_end__    = __ram_end__;
--- a/example-fs-bb48/stream.h
+++ b/example-fs-bb48/stream.h
@@ -0,0 +1,26 @@
+#define BUFSIZE 128
+#define FLAG_CONNECTED   (1 << 0)
+#define FLAG_SEND_AVAIL  (1 << 1)
+#define FLAG_RECV_AVAIL  (1 << 2)
+
+/*
+ * Current implementation is synchronous and buffers are not yet used.
+ */
+struct stream {
+  chopstx_mutex_t mtx;
+  chopstx_cond_t cnd;
+  int sending;
+  unsigned int recv_len;
+  uint8_t recv_buf[BUFSIZE];
+  uint8_t buf_send[BUFSIZE];	/* Not yet used. */
+  uint8_t cnt_send_head;	/* Not yet used. */
+  uint8_t cnt_send_tail;	/* Not yet used. */
+  uint8_t cnt_recv_head;	/* Not yet used. */
+  uint8_t cnt_recv_tail;	/* Not yet used. */
+  uint32_t flags;
+};
+
+struct stream *stream_open (void);
+int stream_wait_connection (struct stream *st);
+int stream_send (struct stream *st, uint8_t *buf, uint8_t count);
+int stream_recv (struct stream *st, uint8_t *buf);
--- a/example-fs-bb48/usb-cdc.c
+++ b/example-fs-bb48/usb-cdc.c
@@ -0,0 +1,617 @@
+#include <stdint.h>
+#include <stdlib.h>
+#include <chopstx.h>
+#include <string.h>
+#include "usb_lld.h"
+#include "stream.h"
+
+static uint8_t send_buf[64];
+static unsigned int send_len;
+static uint8_t send_buf1[64];
+
+static uint8_t recv_buf[64];
+static unsigned int recv_len;
+
+static uint8_t inputline[64];
+static unsigned int inputline_len;
+
+static struct stream stream;
+
+#define USB_CDC_REQ_SET_LINE_CODING             0x20
+#define USB_CDC_REQ_GET_LINE_CODING             0x21
+#define USB_CDC_REQ_SET_CONTROL_LINE_STATE      0x22
+#define USB_CDC_REQ_SEND_BREAK                  0x23
+
+/* USB Device Descriptor */
+static const uint8_t vcom_device_desc[18] = {
+  18,   /* bLength */
+  DEVICE_DESCRIPTOR,		/* bDescriptorType */
+  0x10, 0x01,			/* bcdUSB = 1.1 */
+  0x02,				/* bDeviceClass (CDC).              */
+  0x00,				/* bDeviceSubClass.                 */
+  0x00,				/* bDeviceProtocol.                 */
+  0x40,				/* bMaxPacketSize.                  */
+  0xFF, 0xFF, /* idVendor  */
+  0x01, 0x00, /* idProduct */
+  0x00, 0x01, /* bcdDevice  */
+  1,				/* iManufacturer.                   */
+  2,				/* iProduct.                        */
+  3,				/* iSerialNumber.                   */
+  1				/* bNumConfigurations.              */
+};
+
+/* Configuration Descriptor tree for a CDC.*/
+static const uint8_t vcom_config_desc[67] = {
+  9,
+  CONFIG_DESCRIPTOR,		/* bDescriptorType: Configuration */
+  /* Configuration Descriptor.*/
+  67, 0x00,			/* wTotalLength.                    */
+  0x02,				/* bNumInterfaces.                  */
+  0x01,				/* bConfigurationValue.             */
+  0,				/* iConfiguration.                  */
+  0x80,				/* bmAttributes (bus powered).      */
+  50,				/* bMaxPower (100mA).               */
+  /* Interface Descriptor.*/
+  9,
+  INTERFACE_DESCRIPTOR,
+  0x00,		   /* bInterfaceNumber.                */
+  0x00,		   /* bAlternateSetting.               */
+  0x01,		   /* bNumEndpoints.                   */
+  0x02,		   /* bInterfaceClass (Communications Interface Class,
+		      CDC section 4.2).  */
+  0x02,		   /* bInterfaceSubClass (Abstract Control Model, CDC
+		      section 4.3).  */
+  0x01,		   /* bInterfaceProtocol (AT commands, CDC section
+		      4.4).  */
+  0,	           /* iInterface.                      */
+  /* Header Functional Descriptor (CDC section 5.2.3).*/
+  5,	      /* bLength.                         */
+  0x24,	      /* bDescriptorType (CS_INTERFACE).  */
+  0x00,	      /* bDescriptorSubtype (Header Functional Descriptor). */
+  0x10, 0x01, /* bcdCDC.                          */
+  /* Call Management Functional Descriptor. */
+  5,            /* bFunctionLength.                 */
+  0x24,         /* bDescriptorType (CS_INTERFACE).  */
+  0x01,         /* bDescriptorSubtype (Call Management Functional
+		   Descriptor). */
+  0x03,         /* bmCapabilities (D0+D1).          */
+  0x01,         /* bDataInterface.                  */
+  /* ACM Functional Descriptor.*/
+  4,            /* bFunctionLength.                 */
+  0x24,         /* bDescriptorType (CS_INTERFACE).  */
+  0x02,         /* bDescriptorSubtype (Abstract Control Management
+		   Descriptor).  */
+  0x02,         /* bmCapabilities.                  */
+  /* Union Functional Descriptor.*/
+  5,            /* bFunctionLength.                 */
+  0x24,         /* bDescriptorType (CS_INTERFACE).  */
+  0x06,         /* bDescriptorSubtype (Union Functional
+		   Descriptor).  */
+  0x00,         /* bMasterInterface (Communication Class
+		   Interface).  */
+  0x01,         /* bSlaveInterface0 (Data Class Interface).  */
+  /* Endpoint 2 Descriptor.*/
+  7,
+  ENDPOINT_DESCRIPTOR,
+  ENDP2|0x80,    /* bEndpointAddress.    */
+  0x03,          /* bmAttributes (Interrupt).        */
+  0x08, 0x00,	 /* wMaxPacketSize.                  */
+  0xFF,		 /* bInterval.                       */
+  /* Interface Descriptor.*/
+  9,
+  INTERFACE_DESCRIPTOR, /* bDescriptorType: */
+  0x01,          /* bInterfaceNumber.                */
+  0x00,          /* bAlternateSetting.               */
+  0x02,          /* bNumEndpoints.                   */
+  0x0A,          /* bInterfaceClass (Data Class Interface, CDC section 4.5). */
+  0x00,          /* bInterfaceSubClass (CDC section 4.6). */
+  0x00,          /* bInterfaceProtocol (CDC section 4.7). */
+  0x00,		 /* iInterface.                      */
+  /* Endpoint 3 Descriptor.*/
+  7,
+  ENDPOINT_DESCRIPTOR,		/* bDescriptorType: Endpoint */
+  ENDP3,    /* bEndpointAddress. */
+  0x02,				/* bmAttributes (Bulk).             */
+  0x40, 0x00,			/* wMaxPacketSize.                  */
+  0x00,				/* bInterval.                       */
+  /* Endpoint 1 Descriptor.*/
+  7,
+  ENDPOINT_DESCRIPTOR,		/* bDescriptorType: Endpoint */
+  ENDP1|0x80,			/* bEndpointAddress. */
+  0x02,				/* bmAttributes (Bulk).             */
+  0x40, 0x00,			/* wMaxPacketSize.                  */
+  0x00				/* bInterval.                       */
+};
+
+
+/*
+ * U.S. English language identifier.
+ */
+static const uint8_t vcom_string0[4] = {
+  4,				/* bLength */
+  STRING_DESCRIPTOR,
+  0x09, 0x04			/* LangID = 0x0409: US-English */
+};
+
+static const uint8_t vcom_string1[] = {
+  23*2+2,			/* bLength */
+  STRING_DESCRIPTOR,		/* bDescriptorType */
+  /* Manufacturer: "Flying Stone Technology" */
+  'F', 0, 'l', 0, 'y', 0, 'i', 0, 'n', 0, 'g', 0, ' ', 0, 'S', 0,
+  't', 0, 'o', 0, 'n', 0, 'e', 0, ' ', 0, 'T', 0, 'e', 0, 'c', 0,
+  'h', 0, 'n', 0, 'o', 0, 'l', 0, 'o', 0, 'g', 0, 'y', 0, 
+};
+
+static const uint8_t vcom_string2[] = {
+  14*2+2,			/* bLength */
+  STRING_DESCRIPTOR,		/* bDescriptorType */
+  /* Product name: "Chopstx Sample" */
+  'C', 0, 'h', 0, 'o', 0, 'p', 0, 's', 0, 't', 0, 'x', 0, ' ', 0,
+  'S', 0, 'a', 0, 'm', 0, 'p', 0, 'l', 0, 'e', 0,
+};
+
+/*
+ * Serial Number string.
+ */
+static const uint8_t vcom_string3[28] = {
+  28,				    /* bLength */
+  STRING_DESCRIPTOR,		    /* bDescriptorType */
+  '0', 0,  '.', 0,  '0', 0, '0', 0, /* Version number */
+};
+
+
+#define NUM_INTERFACES 2
+
+uint32_t bDeviceState = UNCONNECTED; /* USB device status */
+
+
+void
+usb_cb_device_reset (void)
+{
+  usb_lld_reset (vcom_config_desc[7]);
+
+  /* Initialize Endpoint 0 */
+  usb_lld_setup_endpoint (ENDP0, 1, 1);
+
+  chopstx_mutex_lock (&stream.mtx);
+  stream.flags = 0;
+  bDeviceState = ATTACHED;
+  chopstx_mutex_unlock (&stream.mtx);
+}
+
+
+#define CDC_CTRL_DTR            0x0001
+
+void
+usb_cb_ctrl_write_finish (uint8_t req, uint8_t req_no, struct req_args *arg)
+{
+  uint8_t type_rcp = req & (REQUEST_TYPE|RECIPIENT);
+
+  if (type_rcp == (CLASS_REQUEST | INTERFACE_RECIPIENT)
+      && USB_SETUP_SET (req) && req_no == USB_CDC_REQ_SET_CONTROL_LINE_STATE)
+    {
+      /* Open/close the connection.  */
+      chopstx_mutex_lock (&stream.mtx);
+      stream.flags &= ~FLAG_CONNECTED;
+      stream.flags |= ((arg->value & CDC_CTRL_DTR) != 0)? FLAG_CONNECTED : 0;
+      chopstx_cond_signal (&stream.cnd);
+      recv_len = 0;
+      usb_lld_rx_enable (ENDP3, recv_buf, 64);
+      chopstx_mutex_unlock (&stream.mtx);
+    }
+}
+
+struct line_coding
+{
+  uint32_t bitrate;
+  uint8_t format;
+  uint8_t paritytype;
+  uint8_t datatype;
+}  __attribute__((packed));
+
+static struct line_coding line_coding = {
+  115200, /* baud rate: 115200    */
+  0x00,   /* stop bits: 1         */
+  0x00,   /* parity:    none      */
+  0x08    /* bits:      8         */
+};
+
+
+static int
+vcom_port_data_setup (uint8_t req, uint8_t req_no, struct req_args *arg)
+{
+  if (USB_SETUP_GET (req))
+    {
+      if (req_no == USB_CDC_REQ_GET_LINE_CODING)
+	return usb_lld_reply_request (&line_coding, sizeof(line_coding), arg);
+    }
+  else  /* USB_SETUP_SET (req) */
+    {
+      if (req_no == USB_CDC_REQ_SET_LINE_CODING
+	  && arg->len == sizeof (line_coding))
+	{
+	  usb_lld_set_data_to_recv (&line_coding, sizeof (line_coding));
+	  return USB_SUCCESS;
+	}
+      else if (req_no == USB_CDC_REQ_SET_CONTROL_LINE_STATE)
+	return USB_SUCCESS;
+    }
+
+  return USB_UNSUPPORT;
+}
+
+int
+usb_cb_setup (uint8_t req, uint8_t req_no, struct req_args *arg)
+{
+  uint8_t type_rcp = req & (REQUEST_TYPE|RECIPIENT);
+
+  if (type_rcp == (CLASS_REQUEST | INTERFACE_RECIPIENT) && arg->index == 0)
+    return vcom_port_data_setup (req, req_no, arg);
+
+  return USB_UNSUPPORT;
+}
+
+int
+usb_cb_get_descriptor (uint8_t rcp, uint8_t desc_type, uint8_t desc_index,
+		       struct req_args *arg)
+{
+  if (rcp != DEVICE_RECIPIENT)
+    return USB_UNSUPPORT;
+
+  if (desc_type == DEVICE_DESCRIPTOR)
+    return usb_lld_reply_request (vcom_device_desc, sizeof (vcom_device_desc),
+				  arg);
+  else if (desc_type == CONFIG_DESCRIPTOR)
+    return usb_lld_reply_request (vcom_config_desc, sizeof (vcom_config_desc),
+				  arg);
+  else if (desc_type == STRING_DESCRIPTOR)
+    {
+      const uint8_t *str;
+      int size;
+
+      switch (desc_index)
+	{
+	case 0:
+	  str = vcom_string0;
+	  size = sizeof (vcom_string0);
+	  break;
+	case 1:
+	  str = vcom_string1;
+	  size = sizeof (vcom_string1);
+	  break;
+	case 2:
+	  str = vcom_string2;
+	  size = sizeof (vcom_string2);
+	  break;
+	case 3:
+	  str = vcom_string3;
+	  size = sizeof (vcom_string3);
+	  break;
+	default:
+	  return USB_UNSUPPORT;
+	}
+
+      return usb_lld_reply_request (str, size, arg);
+    }
+
+  return USB_UNSUPPORT;
+}
+
+static void
+vcom_setup_endpoints_for_interface (uint16_t interface, int stop)
+{
+  if (interface == 0)
+    {
+      if (!stop)
+	usb_lld_setup_endpoint (ENDP2, 0, 1);
+      else
+	usb_lld_stall (ENDP2);
+    }
+  else if (interface == 1)
+    {
+      if (!stop)
+	{
+	  usb_lld_setup_endpoint (ENDP1, 0, 1);
+	  usb_lld_setup_endpoint (ENDP3, 1, 0);
+#if 0
+	  /* Start with no data receiving */
+	  usb_lld_stall (ENDP3);
+#endif
+	}
+      else
+	{
+	  usb_lld_stall (ENDP1);
+	  usb_lld_stall (ENDP3);
+	}
+    }
+}
+
+int
+usb_cb_handle_event (uint8_t event_type, uint16_t value)
+{
+  int i;
+  uint8_t current_conf;
+
+  switch (event_type)
+    {
+    case USB_EVENT_ADDRESS:
+      bDeviceState = ADDRESSED;
+      return USB_SUCCESS;
+    case USB_EVENT_CONFIG:
+      current_conf = usb_lld_current_configuration ();
+      if (current_conf == 0)
+	{
+	  if (value != 1)
+	    return USB_UNSUPPORT;
+
+	  usb_lld_set_configuration (1);
+	  for (i = 0; i < NUM_INTERFACES; i++)
+	    vcom_setup_endpoints_for_interface (i, 0);
+	  bDeviceState = CONFIGURED;
+	}
+      else if (current_conf != value)
+	{
+	  if (value != 0)
+	    return USB_UNSUPPORT;
+
+	  usb_lld_set_configuration (0);
+	  for (i = 0; i < NUM_INTERFACES; i++)
+	    vcom_setup_endpoints_for_interface (i, 1);
+	  bDeviceState = ADDRESSED;
+	}
+      /* Do nothing when current_conf == value */
+      return USB_SUCCESS;
+
+      return USB_SUCCESS;
+    default:
+      break;
+    }
+
+  return USB_UNSUPPORT;
+}
+
+
+int
+usb_cb_interface (uint8_t cmd, struct req_args *arg)
+{
+  const uint8_t zero = 0;
+  uint16_t interface = arg->index;
+  uint16_t alt = arg->value;
+
+  if (interface >= NUM_INTERFACES)
+    return USB_UNSUPPORT;
+
+  switch (cmd)
+    {
+    case USB_SET_INTERFACE:
+      if (alt != 0)
+	return USB_UNSUPPORT;
+      else
+	{
+	  vcom_setup_endpoints_for_interface (interface, 0);
+	  return USB_SUCCESS;
+	}
+
+    case USB_GET_INTERFACE:
+      return usb_lld_reply_request (&zero, 1, arg);
+
+    default:
+    case USB_QUERY_INTERFACE:
+      return USB_SUCCESS;
+    }
+}
+
+
+static void
+stream_echo_char (int c)
+{
+  chopstx_mutex_lock (&stream.mtx);
+  if (send_len < sizeof (send_buf))
+    send_buf[send_len++] = c;
+  else
+    {
+      /* All that we can is ignoring the output.  */
+      ;
+    }
+
+  if (stream.sending == 0)
+    {
+      memcpy (send_buf1, send_buf, send_len);
+      usb_lld_tx_enable (ENDP1, send_buf1, send_len);
+      send_len = 0;
+      stream.sending = 1;
+    }
+  chopstx_mutex_unlock (&stream.mtx);
+}
+
+
+void
+usb_cb_tx_done (uint8_t ep_num)
+{
+  if (ep_num == ENDP1)
+    {
+      chopstx_mutex_lock (&stream.mtx);
+      stream.sending = 0;
+      if (send_len)
+	{
+	  stream.sending = 1;
+	  memcpy (send_buf1, send_buf, send_len);
+	  usb_lld_tx_enable (ENDP1, send_buf1, send_len);
+	  send_len = 0;
+	}
+      else
+	{
+	  if ((stream.flags & FLAG_SEND_AVAIL))
+	    {
+	      stream.flags &= ~FLAG_SEND_AVAIL;
+	      chopstx_cond_signal (&stream.cnd);
+	    }
+	}
+      chopstx_mutex_unlock (&stream.mtx);
+    }
+  else if (ep_num == ENDP2)
+    {
+      /* Nothing */
+    }
+}
+
+
+static void
+stream_input_char (int c)
+{
+  unsigned int i;
+
+  /* Process DEL, C-U, C-R, and RET as editing command. */
+  switch (c)
+    {
+    case 0x0d: /* Control-M */
+      stream_echo_char (0x0d);
+      stream_echo_char (0x0a);
+      chopstx_mutex_lock (&stream.mtx);
+      if ((stream.flags & FLAG_RECV_AVAIL) == 0)
+	{
+	  memcpy (stream.recv_buf, inputline, inputline_len);
+	  stream.recv_len = inputline_len;
+	  stream.flags |= FLAG_RECV_AVAIL;
+	  chopstx_cond_signal (&stream.cnd);
+	}
+      chopstx_mutex_unlock (&stream.mtx);
+      inputline_len = 0;
+      break;
+    case 0x12: /* Control-R */
+      stream_echo_char ('^');
+      stream_echo_char ('R');
+      stream_echo_char (0x0d);
+      stream_echo_char (0x0a);
+      for (i = 0; i < inputline_len; i++)
+	stream_echo_char (inputline[i]);
+      break;
+    case 0x15: /* Control-U */
+      for (i = 0; i < inputline_len; i++)
+	{
+	  stream_echo_char (0x08);
+	  stream_echo_char (0x20);
+	  stream_echo_char (0x08);
+	}
+      inputline_len = 0;
+      break;
+    case 0x7f: /* DEL    */
+      if (inputline_len > 0)
+	{
+	  stream_echo_char (0x08);
+	  stream_echo_char (0x20);
+	  stream_echo_char (0x08);
+	  inputline_len--;
+	}
+      break;
+    default:
+      if (inputline_len < sizeof (inputline))
+	{
+	  stream_echo_char (c);
+	  inputline[inputline_len++] = c;
+	}
+      else
+	/* Beep */
+	stream_echo_char (0x0a);
+      break;
+    }
+}
+
+void
+usb_cb_rx_ready (uint8_t ep_num)
+{
+  if (ep_num == ENDP3)
+    {
+      int i, r;
+
+      r = usb_lld_rx_data_len (ENDP3);
+      for (i = 0; i < r; i++)
+	stream_input_char (recv_buf[i]);
+
+      usb_lld_rx_enable (ENDP3, recv_buf, 64);
+    }
+}
+
+struct stream *
+stream_open (void)
+{
+  chopstx_mutex_init (&stream.mtx);
+  chopstx_cond_init (&stream.cnd);
+  return &stream;
+}
+
+int
+stream_wait_connection (struct stream *st)
+{
+  chopstx_mutex_lock (&st->mtx);
+  while ((stream.flags & FLAG_CONNECTED) == 0)
+    chopstx_cond_wait (&st->cnd, &st->mtx);
+  chopstx_mutex_unlock (&st->mtx);
+  stream.flags &= ~FLAG_SEND_AVAIL;
+  return 0;
+}
+
+
+int
+stream_send (struct stream *st, uint8_t *buf, uint8_t count)
+{
+  int r = 0;
+
+  chopstx_mutex_lock (&st->mtx);
+  if ((stream.flags & FLAG_CONNECTED) == 0)
+    r = -1;
+  else
+    {
+      stream.sending = 1;
+      usb_lld_tx_enable (ENDP1, buf, count);
+      stream.flags |= FLAG_SEND_AVAIL;
+      do
+	{
+	  chopstx_cond_wait (&st->cnd, &st->mtx);
+	  if ((stream.flags & FLAG_SEND_AVAIL) == 0)
+	    break;
+	  else if ((stream.flags & FLAG_CONNECTED) == 0)
+	    {
+	      r = -1;
+	      break;
+	    }
+	}
+      while (1);
+    }
+  stream.sending = 0;
+  chopstx_mutex_unlock (&st->mtx);
+  return r;
+}
+
+
+int
+stream_recv (struct stream *st, uint8_t *buf)
+{
+  int r;
+
+  chopstx_mutex_lock (&st->mtx);
+  if ((stream.flags & FLAG_CONNECTED) == 0)
+    r = -1;
+  else
+    {
+      while (1)
+	{
+	  if ((stream.flags & FLAG_RECV_AVAIL))
+	    {
+	      r = stream.recv_len;
+	      memcpy (buf, stream.recv_buf, r);
+	      stream.flags &= ~FLAG_RECV_AVAIL;
+	      break;
+	    }
+	  else if ((stream.flags & FLAG_CONNECTED) == 0)
+	    {
+	      r = -1;
+	      break;
+	    }
+	  chopstx_cond_wait (&st->cnd, &st->mtx);
+	}
+    }
+  chopstx_mutex_unlock (&st->mtx);
+
+  return r;
+}
--- a/example-fs-bb48/usb_kl27z.c
+++ b/example-fs-bb48/usb_kl27z.c
--- a/example-fs-bb48/usb_lld.h
+++ b/example-fs-bb48/usb_lld.h
@@ -0,0 +1,115 @@
+#define STANDARD_ENDPOINT_DESC_SIZE             0x09
+
+/* endpoints enumeration */
+#define ENDP0       ((uint8_t)0)
+#define ENDP1       ((uint8_t)1)
+#define ENDP2       ((uint8_t)2)
+#define ENDP3       ((uint8_t)3)
+#define ENDP4       ((uint8_t)4)
+#define ENDP5       ((uint8_t)5)
+#define ENDP6       ((uint8_t)6)
+#define ENDP7       ((uint8_t)7)
+
+/* EP_TYPE[1:0] EndPoint TYPE */
+#define EP_BULK        (0x0000) /* EndPoint BULK        */
+#define EP_CONTROL     (0x0200) /* EndPoint CONTROL     */
+#define EP_ISOCHRONOUS (0x0400) /* EndPoint ISOCHRONOUS */
+#define EP_INTERRUPT   (0x0600) /* EndPoint INTERRUPT   */
+
+enum RECIPIENT_TYPE
+{
+  DEVICE_RECIPIENT,     /* Recipient device    */
+  INTERFACE_RECIPIENT,  /* Recipient interface */
+  ENDPOINT_RECIPIENT,   /* Recipient endpoint  */
+  OTHER_RECIPIENT
+};
+
+enum DESCRIPTOR_TYPE
+{
+  DEVICE_DESCRIPTOR = 1,
+  CONFIG_DESCRIPTOR,
+  STRING_DESCRIPTOR,
+  INTERFACE_DESCRIPTOR,
+  ENDPOINT_DESCRIPTOR
+};
+
+#define REQUEST_DIR       0x80  /* Mask to get request dir  */
+#define REQUEST_TYPE      0x60  /* Mask to get request type */
+#define STANDARD_REQUEST  0x00  /* Standard request         */
+#define CLASS_REQUEST     0x20  /* Class request            */
+#define VENDOR_REQUEST    0x40  /* Vendor request           */
+#define RECIPIENT         0x1F  /* Mask to get recipient    */
+
+#define USB_SETUP_SET(req) ((req & REQUEST_DIR) == 0)
+#define USB_SETUP_GET(req) ((req & REQUEST_DIR) != 0)
+
+enum
+{
+  USB_UNSUPPORT = 0,
+  USB_SUCCESS = 1,
+};
+
+struct req_args {
+  uint16_t value;
+  uint16_t index;
+  uint16_t len;
+};
+
+void usb_cb_device_reset (void);
+int usb_cb_setup (uint8_t req, uint8_t req_no, struct req_args *arg);
+int usb_cb_interface (uint8_t cmd, struct req_args *arg);
+int usb_cb_get_descriptor (uint8_t rcp, uint8_t desc_type, uint8_t desc_index,
+			   struct req_args *arg);
+int usb_cb_handle_event (uint8_t event_type, uint16_t value);
+void usb_cb_ctrl_write_finish (uint8_t req, uint8_t req_no,
+			       struct req_args *arg);
+void usb_cb_tx_done (uint8_t ep_num);
+void usb_cb_rx_ready (uint8_t ep_num);
+
+enum {
+  USB_EVENT_ADDRESS,
+  USB_EVENT_CONFIG,
+  USB_EVENT_SUSPEND,
+  USB_EVENT_WAKEUP,
+  USB_EVENT_STALL,
+};
+
+enum {
+  USB_SET_INTERFACE,
+  USB_GET_INTERFACE,
+  USB_QUERY_INTERFACE,
+};
+
+enum DEVICE_STATE
+{
+  UNCONNECTED,
+  ATTACHED,
+  POWERED,
+  SUSPENDED,
+  ADDRESSED,
+  CONFIGURED
+};
+
+void usb_lld_init (uint8_t feature);
+
+int usb_lld_reply_request (const void *buf, size_t buflen,
+			   struct req_args *arg);
+void usb_lld_set_data_to_recv (void *p, size_t len);
+
+void usb_lld_tx_enable (uint8_t ep_num, const void *buf, size_t len);
+int usb_lld_tx_result (int ep_num);
+
+void usb_lld_rx_enable (int ep_num, void *buf, size_t len);
+int usb_lld_rx_data_len (int ep_num);
+
+void usb_lld_stall (int ep_num);
+
+void usb_lld_reset (uint8_t feature);
+void usb_lld_setup_endpoint (int n, int rx_en, int tx_en);
+void usb_lld_set_configuration (uint8_t config);
+uint8_t usb_lld_current_configuration (void);
+
+void usb_lld_prepare_shutdown (void);
+void usb_lld_shutdown (void);
+
+void usb_interrupt_handler (void);
--- a/example-fsm-55/Makefile
+++ b/example-fsm-55/Makefile
@@ -4,7 +4,17 @@ PROJECT = hacker-emblem

 CHOPSTX = ..
 LDSCRIPT= hacker-emblem.ld
-CSRC = sys.c hacker-emblem.c
+
+CSRC = sys.c hh.c
+
+# Hacker Emblem and "Happy Hacking!" demonstration
+# CSRC = sys.c hh.c
+
+# Debian logo demonstration
+# CSRC = sys.c debian-logo.c
+
+# "Hiroshi & Ayumi with Tulip" demonstration
+# CSRC = sys.c hiroshi-ayumi.c

 ###################################
 CROSS = arm-none-eabi-
--- a/example-fsm-55/README
+++ b/example-fsm-55/README
@@ -3,10 +3,15 @@ Display.  Please see the product page:

    http://www.seeedstudio.com/depot/FSM55-LED-Matrix-Display-p-2121.html

+There are three demonstrations and default is Hacker Emblem and "Happy
+Hacking!".  Please edit CSRC variable in the Makefile to select other
+applications.
+
+
 The file stlink-v2.cfg can be used for ST-Link/V2 with OpenOCD.  You
 can flash by typing:

-    $ openocd -f ./stlink-v2.cfg -c "program build/hacker-emblem.elf"
+    $ openocd -f ./stlink-v2.cfg -c "program build/hacker-emblem.elf; reset run; shutdown"

 Thanks to Kiwamu Okabe who kindly tested OpenOCD and wrote the
 configuration.
--- a/example-fsm-55/hacker-emblem.c
+++ b/example-fsm-55/hacker-emblem.c
@@ -1 +0,0 @@
-hh.c
--- a/example-fsm-55/hiroshi-ayumi.c
+++ b/example-fsm-55/hiroshi-ayumi.c
@@ -1,5 +1,6 @@
 #include <stdint.h>
 #include <stdlib.h>
+#include <string.h>
 #include <chopstx.h>

 #include "board.h"
@@ -32,11 +33,13 @@ struct GPIO {
 #define GPIOF_BASE	(AHB2PERIPH_BASE + 0x1400)
 #define GPIOF		((struct GPIO *) GPIOF_BASE)

+#define GPIO_SPEAKER_PIN    1
+
 static struct GPIO *const GPIO_LED = ((struct GPIO *const) GPIO_LED_BASE);
 static struct GPIO *const GPIO_OTHER = ((struct GPIO *const) GPIO_OTHER_BASE);

 static chopstx_mutex_t mtx;
-static chopstx_cond_t cnd0;
+static chopstx_cond_t cnd;

 static uint8_t
 user_button (void)
@@ -82,13 +85,21 @@ led_enable_column (uint8_t col)
  GPIO_LED->BRR = (1 << col);
 }

+
+#define PRIO_LED 3
+
+extern uint8_t __process1_stack_base__, __process1_stack_size__;
+
+const uint32_t stackaddr_led = (uint32_t)&__process1_stack_base__;
+const size_t stacksize_led = (size_t)&__process1_stack_size__;
+
 static void *
 led (void *arg)
 {
  (void)arg;

  chopstx_mutex_lock (&mtx);
-  chopstx_cond_wait (&cnd0, &mtx);
+  chopstx_cond_wait (&cnd, &mtx);
  chopstx_mutex_unlock (&mtx);

  while (1)
@@ -106,12 +117,168 @@ led (void *arg)
  return NULL;
 }

-#define PRIO_LED 3

-extern uint8_t __process1_stack_base__, __process1_stack_size__;
+#define PRIO_SPK 4
+extern uint8_t __process2_stack_base__, __process2_stack_size__;
+
+const uint32_t stackaddr_spk = (uint32_t)&__process2_stack_base__;
+const size_t stacksize_spk = (size_t)&__process2_stack_size__;
+
+static chopstx_mutex_t spk_mtx;
+static chopstx_cond_t spk_cnd;
+static chopstx_cond_t spk_cnd_no_tone;
+
+static uint8_t tone;
+#define NO_TONE 255
+
+
+static uint16_t tone_table[] = {
+  568, /* a = 880Hz */
+  /* 536, */
+  506, /* b */
+  478, /* c */
+  /* 451, */
+  426, /* d */
+  /* 402, */
+  379, /* e */
+  358, /* f*/
+  /* 338, */
+  319, /* g */
+  /* 301, */
+  284, /* A = 1760Hz */
+  /* 268 */
+  253, /* B */
+  239, /* C */
+};
+
+static void
+change_tone (uint8_t t)
+{
+  chopstx_mutex_lock (&spk_mtx);
+  tone = t;
+  chopstx_cond_signal (&spk_cnd_no_tone);
+  chopstx_cond_wait (&spk_cnd, &spk_mtx);
+  chopstx_mutex_unlock (&spk_mtx);
+}
+
+static void *
+spk (void *arg)
+{
+  (void)arg;
+
+  while (1)
+    {
+      uint8_t t;
+      uint16_t w;
+
+      chopstx_mutex_lock (&spk_mtx);
+      t = tone;
+      chopstx_cond_signal (&spk_cnd);
+      if (t == NO_TONE)
+	{
+	  chopstx_cond_wait (&spk_cnd_no_tone, &spk_mtx);
+	  t = tone;
+	}
+      chopstx_mutex_unlock (&spk_mtx);
+
+      w = tone_table[t]*5/3;
+      GPIO_OTHER->BSRR = (1 << GPIO_SPEAKER_PIN);
+      wait_for (w);
+      GPIO_OTHER->BRR = (1 << GPIO_SPEAKER_PIN);
+      wait_for (w);
+    }
+
+  return NULL;
+}
+
+
+#define PRIO_MUSIC 2
+extern uint8_t __process3_stack_base__, __process3_stack_size__;
+
+const uint32_t stackaddr_music = (uint32_t)&__process3_stack_base__;
+const size_t stacksize_music = (size_t)&__process3_stack_size__;
+
+#define C 0
+#define D 1
+#define E 2
+#define F 3
+#define G 4
+#define A 5
+#define B 6
+
+#if 0 /* twinkle stars */
+static const char *musical_score = 
+  "c4c4g4g4A4A4g2f4f4e4e4d4d4c2"
+  "g4g4f4f4e4e4d2g4g4f4f4e4e4d2"
+  "c4c4g4g4A4A4g2f4f4e4e4d4d4c2";
+#else /* tulip */
+static const char *musical_score = 
+  "c4d4e2c4d4e2g4e4d4c4d4e4d2"
+  "c4d4e2c4d4e2g4e4d4c4d4e4c2"
+  "g4g4e4g4A4A4g2e4e4d4d4c2";
+#endif
+
+static int get_t_and_l (char *tp, char *lp)
+{
+  static unsigned int i = 0;
+  char tl, ll;
+
+  tl = musical_score[i++];
+  ll = musical_score[i++];
+
+  if (tl >= 'a')
+    *tp = tl - 'a';
+  else
+    *tp = tl - 'A' + 7;
+
+  *lp = ll - '0';
+
+  if (i >= strlen (musical_score))
+    {
+      i = 0;
+      return 0;
+    }
+  else
+    return 1;
+}
+
+#define WAIT_FOR_NO_TONE (1000*20)
+#define WAIT_FOR_TONE (1000000*3/2)
+
+static void *
+music (void *arg)
+{
+  (void)arg;
+
+  chopstx_mutex_init (&spk_mtx);
+  chopstx_cond_init (&spk_cnd);
+  chopstx_cond_init (&spk_cnd_no_tone);
+
+  chopstx_create (PRIO_SPK, stackaddr_spk, stacksize_spk, spk, NULL);
+
+  while (1)
+    {
+      char t, l;
+      int r;
+
+      r = get_t_and_l (&t, &l);
+
+      change_tone (NO_TONE);
+      wait_for (WAIT_FOR_NO_TONE);
+      change_tone (t);
+      wait_for (WAIT_FOR_TONE / l);
+
+      if (!r)
+	{
+	  change_tone (NO_TONE);
+	  wait_for (WAIT_FOR_TONE * 3);
+	}
+    }
+
+  return NULL;
+}
+

-const uint32_t __stackaddr_led = (uint32_t)&__process1_stack_base__;
-const size_t __stacksize_led = (size_t)&__process1_stack_size__;

 #define DATA55(x0,x1,x2,x3,x4) (x0<<20)|(x1<<15)|(x2<<10)|(x3<< 5)|(x4<< 0)
 #define SIZE55(img) (sizeof (img) / sizeof (uint32_t))
@@ -181,14 +348,15 @@ main (int argc, const char *argv[])
  (void)argv;

  chopstx_mutex_init (&mtx);
-  chopstx_cond_init (&cnd0);
+  chopstx_cond_init (&cnd);

-  chopstx_create (PRIO_LED, __stackaddr_led, __stacksize_led, led, NULL);
+  chopstx_create (PRIO_LED, stackaddr_led, stacksize_led, led, NULL);
+  chopstx_create (PRIO_MUSIC, stackaddr_music, stacksize_music, music, NULL);

  chopstx_usec_wait (200*1000);

  chopstx_mutex_lock (&mtx);
-  chopstx_cond_signal (&cnd0);
+  chopstx_cond_signal (&cnd);
  chopstx_mutex_unlock (&mtx);

  while (1)
@@ -196,21 +364,21 @@ main (int argc, const char *argv[])
      unsigned int i;

      if (state)
-	for (i = 0; i < SIZE55 (image0); i++)
-	  {
-	    if (user_button ())
-	      state = 0;
-	    set_led_display (image0[i]);
-	    wait_for (200*1000);
-	  }
-      else
 	for (i = 0; i < SIZE55 (image1); i++)
 	  {
 	    if (user_button ())
-	      state = 1;
+	      state = 0;
 	    set_led_display (image1[i]);
 	    wait_for (200*1000);
 	  }
+      else
+	for (i = 0; i < SIZE55 (image0); i++)
+	  {
+	    if (user_button ())
+	      state = 1;
+	    set_led_display (image0[i]);
+	    wait_for (200*1000);
+	  }
    }

  return 0;
--- a/example-fsm-55/stlink-v2.cfg
+++ b/example-fsm-55/stlink-v2.cfg
@@ -9,3 +9,4 @@ set WORKAREASIZE 0x1000
 source [find target/stm32f0x.cfg]

 # use hardware reset, connect under reset
+reset_config srst_only srst_nogate connect_assert_srst
--- a/example-fsm-55/sys.c
+++ b/example-fsm-55/sys.c
@@ -31,7 +31,6 @@ reset (void)
 }

 extern uint8_t __main_stack_end__;
-extern void svc (void);
 extern void preempt (void);
 extern void chx_timer_expired (void);
 extern void chx_handle_intr (void);
@@ -44,14 +43,7 @@ static void nmi (void)
 static void __attribute__ ((naked))
 hard_fault (void)
 {
-  register uint32_t primask;
-
-  asm ("mrs	%0, PRIMASK" : "=r" (primask));
-
-  if (primask)
-    asm volatile ("b	svc");
-  else
-    for (;;);
+  for (;;);
 }

 static void mem_manage (void)
@@ -89,7 +81,7 @@ handler vector[] __attribute__ ((section(".vectors"))) = {
  none,
  /* 0x20 */
  none, none, none,		/* reserved */
-  svc,				/* SVCall */
+  none,				/* SVCall */
  none,				/* Debug */
  none,				/* reserved */
  preempt,			/* PendSV */
--- a/example-led/sys.c
+++ b/example-led/sys.c
@@ -17,7 +17,7 @@
 #include <stdlib.h>
 #include "board.h"

-#include "clk_gpio_init.c"
+#include "clk_gpio_init-stm32.c"

 #define CORTEX_PRIORITY_BITS    4
 #define CORTEX_PRIORITY_MASK(n)  ((n) << (8 - CORTEX_PRIORITY_BITS))
@@ -25,17 +25,17 @@
 #define STM32_USB_IRQ_PRIORITY   11

 struct NVIC {
-  uint32_t ISER[8];
-  uint32_t unused1[24];
-  uint32_t ICER[8];
-  uint32_t unused2[24];
-  uint32_t ISPR[8];
-  uint32_t unused3[24];
-  uint32_t ICPR[8];
-  uint32_t unused4[24];
-  uint32_t IABR[8];
-  uint32_t unused5[56];
-  uint32_t IPR[60];
+  volatile uint32_t ISER[8];
+  volatile uint32_t unused1[24];
+  volatile uint32_t ICER[8];
+  volatile uint32_t unused2[24];
+  volatile uint32_t ISPR[8];
+  volatile uint32_t unused3[24];
+  volatile uint32_t ICPR[8];
+  volatile uint32_t unused4[24];
+  volatile uint32_t IABR[8];
+  volatile uint32_t unused5[56];
+  volatile uint32_t IPR[60];
 };

 static struct NVIC *const NVICBase = ((struct NVIC *const)0xE000E100);
--- a/example-primer2/Makefile
+++ b/example-primer2/Makefile
@@ -0,0 +1,40 @@
+# Makefile for example application of Chopstx
+
+PROJECT = lcd
+
+CHOPSTX = ..
+NEUGSRC = ./neug/src
+LDSCRIPT= lcd.ld
+CSRC = sys.c aes-constant-ft.c primer2-switches.c primer2-ts.c lcd.c main.c \
+       adc_stm32f103.c neug.c sha256.c
+
+###################################
+CROSS = arm-none-eabi-
+CC   = $(CROSS)gcc
+LD   = $(CROSS)gcc
+OBJCOPY   = $(CROSS)objcopy
+MCU   = cortex-m3
+CWARN = -Wall -Wextra -Wstrict-prototypes
+DEFS  = -DHAVE_SYS_H -DFREE_STANDING -DMHZ=48
+# DEFS  = -DFREE_STANDING -DHAVE_SYS_H -DBUSY_LOOP -DCHX_FLAGS_MAIN=CHOPSTX_SCHED_RR
+OPT   = -O3 -Os -g
+INCDIR = $(NEUGSRC)
+LIBS  =
+
+####################
+include ../rules.mk
+
+board.h: ../board/board-stm32-primer2.h neug
+	ln -s ../board/board-stm32-primer2.h ./board.h
+
+sys.c: board.h
+
+neug:
+	@echo Please make a symbolic link \'neug\' to the neug directory;
+	@exit 1
+
+adc_stm32f103.c neug.c sha256.c:
+	ln -s $(NEUGSRC)/$@ $@
+
+distclean: clean
+	rm -f board.h neug adc_stm32f103.c neug.c sha256.c
--- a/example-primer2/README
+++ b/example-primer2/README
@@ -0,0 +1,18 @@
+Example for STM32 Primer2 by Kazmoto Kojima
+
+It is taken from:
+
+   http://www.rr.iij4u.or.jp/~kkojima/letschopstx.html
+
+From the original tar archive, chopstx-logo.data is removed because
+it's too big.
+
+You can generate it by ImageMagick.
+
+  $ convert ../chopstx.svg -depth 8 -flip \( +clone -channel B -fx R \) +swap -channel R -fx v.B -resize 128x160 -background white -compress none -flatten chopstx.ppm
+
+  $ tail -n +4 chopstx.ppm | sed -e 's/ /, /g' > chopstx-logo.data
+
+
+Since it was written for Chopstx 0.06, you would need to change a bit,
+perhaps.
--- a/example-primer2/aes-constant-ft.c
+++ b/example-primer2/aes-constant-ft.c
@@ -0,0 +1,145 @@
+/*
+ * aes-constant-ft.c - AES forward tables.
+ *
+ * We need something useful for the initial flash ROM page (4 Ki
+ * bytes), which cannot be modified after installation.  Even after
+ * upgrade of the firmware, it stays intact.
+ *
+ * We decide to put 3/4 of AES forward tables to fill 3 Ki bytes, as
+ * its useful and it won't change.
+ *
+ * The code was taken from aes.c of PolarSSL version 0.14, and then,
+ * modified to add section names.
+ *
+ * Since this is just a data, it wouldn't be copyright-able, but the
+ * original auther would claim so.  Thus, we put original copyright
+ * notice here.  It is highly likely that there will be no such a
+ * thing for copyright.  Nevertheless, we think that PolarSSL is good
+ * software to address here, and encourage people using it.
+ *
+ */
+
+#include <stdint.h>
+
+/*
+ * Original copyright notice is below:
+ */
+
+/*
+ *  FIPS-197 compliant AES implementation
+ *
+ *  Copyright (C) 2006-2010, Brainspark B.V.
+ *
+ *  This file is part of PolarSSL (http://www.polarssl.org)
+ *  Lead Maintainer: Paul Bakker <polarssl_maintainer at polarssl.org>
+ *
+ *  All rights reserved.
+ *
+ *  This program is free software; you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License as published by
+ *  the Free Software Foundation; either version 2 of the License, or
+ *  (at your option) any later version.
+ *
+ *  This program is distributed in the hope that it will be useful,
+ *  but WITHOUT ANY WARRANTY; without even the implied warranty of
+ *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ *  GNU General Public License for more details.
+ *
+ *  You should have received a copy of the GNU General Public License along
+ *  with this program; if not, write to the Free Software Foundation, Inc.,
+ *  51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
+ */
+/*
+ *  The AES block cipher was designed by Vincent Rijmen and Joan Daemen.
+ *
+ *  http://csrc.nist.gov/encryption/aes/rijndael/Rijndael.pdf
+ *  http://csrc.nist.gov/publications/fips/fips197/fips-197.pdf
+ */
+
+/*
+ * Forward tables
+ */
+#define FT \
+\
+    V(A5,63,63,C6), V(84,7C,7C,F8), V(99,77,77,EE), V(8D,7B,7B,F6), \
+    V(0D,F2,F2,FF), V(BD,6B,6B,D6), V(B1,6F,6F,DE), V(54,C5,C5,91), \
+    V(50,30,30,60), V(03,01,01,02), V(A9,67,67,CE), V(7D,2B,2B,56), \
+    V(19,FE,FE,E7), V(62,D7,D7,B5), V(E6,AB,AB,4D), V(9A,76,76,EC), \
+    V(45,CA,CA,8F), V(9D,82,82,1F), V(40,C9,C9,89), V(87,7D,7D,FA), \
+    V(15,FA,FA,EF), V(EB,59,59,B2), V(C9,47,47,8E), V(0B,F0,F0,FB), \
+    V(EC,AD,AD,41), V(67,D4,D4,B3), V(FD,A2,A2,5F), V(EA,AF,AF,45), \
+    V(BF,9C,9C,23), V(F7,A4,A4,53), V(96,72,72,E4), V(5B,C0,C0,9B), \
+    V(C2,B7,B7,75), V(1C,FD,FD,E1), V(AE,93,93,3D), V(6A,26,26,4C), \
+    V(5A,36,36,6C), V(41,3F,3F,7E), V(02,F7,F7,F5), V(4F,CC,CC,83), \
+    V(5C,34,34,68), V(F4,A5,A5,51), V(34,E5,E5,D1), V(08,F1,F1,F9), \
+    V(93,71,71,E2), V(73,D8,D8,AB), V(53,31,31,62), V(3F,15,15,2A), \
+    V(0C,04,04,08), V(52,C7,C7,95), V(65,23,23,46), V(5E,C3,C3,9D), \
+    V(28,18,18,30), V(A1,96,96,37), V(0F,05,05,0A), V(B5,9A,9A,2F), \
+    V(09,07,07,0E), V(36,12,12,24), V(9B,80,80,1B), V(3D,E2,E2,DF), \
+    V(26,EB,EB,CD), V(69,27,27,4E), V(CD,B2,B2,7F), V(9F,75,75,EA), \
+    V(1B,09,09,12), V(9E,83,83,1D), V(74,2C,2C,58), V(2E,1A,1A,34), \
+    V(2D,1B,1B,36), V(B2,6E,6E,DC), V(EE,5A,5A,B4), V(FB,A0,A0,5B), \
+    V(F6,52,52,A4), V(4D,3B,3B,76), V(61,D6,D6,B7), V(CE,B3,B3,7D), \
+    V(7B,29,29,52), V(3E,E3,E3,DD), V(71,2F,2F,5E), V(97,84,84,13), \
+    V(F5,53,53,A6), V(68,D1,D1,B9), V(00,00,00,00), V(2C,ED,ED,C1), \
+    V(60,20,20,40), V(1F,FC,FC,E3), V(C8,B1,B1,79), V(ED,5B,5B,B6), \
+    V(BE,6A,6A,D4), V(46,CB,CB,8D), V(D9,BE,BE,67), V(4B,39,39,72), \
+    V(DE,4A,4A,94), V(D4,4C,4C,98), V(E8,58,58,B0), V(4A,CF,CF,85), \
+    V(6B,D0,D0,BB), V(2A,EF,EF,C5), V(E5,AA,AA,4F), V(16,FB,FB,ED), \
+    V(C5,43,43,86), V(D7,4D,4D,9A), V(55,33,33,66), V(94,85,85,11), \
+    V(CF,45,45,8A), V(10,F9,F9,E9), V(06,02,02,04), V(81,7F,7F,FE), \
+    V(F0,50,50,A0), V(44,3C,3C,78), V(BA,9F,9F,25), V(E3,A8,A8,4B), \
+    V(F3,51,51,A2), V(FE,A3,A3,5D), V(C0,40,40,80), V(8A,8F,8F,05), \
+    V(AD,92,92,3F), V(BC,9D,9D,21), V(48,38,38,70), V(04,F5,F5,F1), \
+    V(DF,BC,BC,63), V(C1,B6,B6,77), V(75,DA,DA,AF), V(63,21,21,42), \
+    V(30,10,10,20), V(1A,FF,FF,E5), V(0E,F3,F3,FD), V(6D,D2,D2,BF), \
+    V(4C,CD,CD,81), V(14,0C,0C,18), V(35,13,13,26), V(2F,EC,EC,C3), \
+    V(E1,5F,5F,BE), V(A2,97,97,35), V(CC,44,44,88), V(39,17,17,2E), \
+    V(57,C4,C4,93), V(F2,A7,A7,55), V(82,7E,7E,FC), V(47,3D,3D,7A), \
+    V(AC,64,64,C8), V(E7,5D,5D,BA), V(2B,19,19,32), V(95,73,73,E6), \
+    V(A0,60,60,C0), V(98,81,81,19), V(D1,4F,4F,9E), V(7F,DC,DC,A3), \
+    V(66,22,22,44), V(7E,2A,2A,54), V(AB,90,90,3B), V(83,88,88,0B), \
+    V(CA,46,46,8C), V(29,EE,EE,C7), V(D3,B8,B8,6B), V(3C,14,14,28), \
+    V(79,DE,DE,A7), V(E2,5E,5E,BC), V(1D,0B,0B,16), V(76,DB,DB,AD), \
+    V(3B,E0,E0,DB), V(56,32,32,64), V(4E,3A,3A,74), V(1E,0A,0A,14), \
+    V(DB,49,49,92), V(0A,06,06,0C), V(6C,24,24,48), V(E4,5C,5C,B8), \
+    V(5D,C2,C2,9F), V(6E,D3,D3,BD), V(EF,AC,AC,43), V(A6,62,62,C4), \
+    V(A8,91,91,39), V(A4,95,95,31), V(37,E4,E4,D3), V(8B,79,79,F2), \
+    V(32,E7,E7,D5), V(43,C8,C8,8B), V(59,37,37,6E), V(B7,6D,6D,DA), \
+    V(8C,8D,8D,01), V(64,D5,D5,B1), V(D2,4E,4E,9C), V(E0,A9,A9,49), \
+    V(B4,6C,6C,D8), V(FA,56,56,AC), V(07,F4,F4,F3), V(25,EA,EA,CF), \
+    V(AF,65,65,CA), V(8E,7A,7A,F4), V(E9,AE,AE,47), V(18,08,08,10), \
+    V(D5,BA,BA,6F), V(88,78,78,F0), V(6F,25,25,4A), V(72,2E,2E,5C), \
+    V(24,1C,1C,38), V(F1,A6,A6,57), V(C7,B4,B4,73), V(51,C6,C6,97), \
+    V(23,E8,E8,CB), V(7C,DD,DD,A1), V(9C,74,74,E8), V(21,1F,1F,3E), \
+    V(DD,4B,4B,96), V(DC,BD,BD,61), V(86,8B,8B,0D), V(85,8A,8A,0F), \
+    V(90,70,70,E0), V(42,3E,3E,7C), V(C4,B5,B5,71), V(AA,66,66,CC), \
+    V(D8,48,48,90), V(05,03,03,06), V(01,F6,F6,F7), V(12,0E,0E,1C), \
+    V(A3,61,61,C2), V(5F,35,35,6A), V(F9,57,57,AE), V(D0,B9,B9,69), \
+    V(91,86,86,17), V(58,C1,C1,99), V(27,1D,1D,3A), V(B9,9E,9E,27), \
+    V(38,E1,E1,D9), V(13,F8,F8,EB), V(B3,98,98,2B), V(33,11,11,22), \
+    V(BB,69,69,D2), V(70,D9,D9,A9), V(89,8E,8E,07), V(A7,94,94,33), \
+    V(B6,9B,9B,2D), V(22,1E,1E,3C), V(92,87,87,15), V(20,E9,E9,C9), \
+    V(49,CE,CE,87), V(FF,55,55,AA), V(78,28,28,50), V(7A,DF,DF,A5), \
+    V(8F,8C,8C,03), V(F8,A1,A1,59), V(80,89,89,09), V(17,0D,0D,1A), \
+    V(DA,BF,BF,65), V(31,E6,E6,D7), V(C6,42,42,84), V(B8,68,68,D0), \
+    V(C3,41,41,82), V(B0,99,99,29), V(77,2D,2D,5A), V(11,0F,0F,1E), \
+    V(CB,B0,B0,7B), V(FC,54,54,A8), V(D6,BB,BB,6D), V(3A,16,16,2C)
+
+#define V(a,b,c,d) 0x##a##b##c##d
+const uint32_t FT0[256] __attribute__((section(".sys.0"))) = { FT };
+#undef V
+
+#define V(a,b,c,d) 0x##b##c##d##a
+const uint32_t FT1[256] __attribute__((section(".sys.1"))) = { FT };
+#undef V
+
+#define V(a,b,c,d) 0x##c##d##a##b
+const uint32_t FT2[256] __attribute__((section(".sys.2"))) = { FT };
+#undef V
+
+#ifdef ORIGINAL_IMPLEMENTATION 
+#define V(a,b,c,d) 0x##d##a##b##c
+const uint32_t FT3[256] = { FT };
+#undef V
+#endif
--- a/example-primer2/lcd.c
+++ b/example-primer2/lcd.c
@@ -0,0 +1,388 @@
+#include <stdint.h>
+#include <stdlib.h>
+#include <chopstx.h>
+#include "sys.h" /* for set_led */
+#include "st7732.h"
+#include "board.h"
+
+#define PERIPH_BASE	0x40000000
+#define APBPERIPH_BASE   PERIPH_BASE
+#define APB2PERIPH_BASE	(PERIPH_BASE + 0x10000)
+
+struct GPIO {
+  volatile uint32_t CRL;
+  volatile uint32_t CRH;
+  volatile uint32_t IDR;
+  volatile uint32_t ODR;
+  volatile uint32_t BSRR;
+  volatile uint32_t BRR;
+  volatile uint32_t LCKR;
+};
+
+#define GPIOA_BASE	(APB2PERIPH_BASE + 0x0800)
+#define GPIOA		((struct GPIO *) GPIOA_BASE)
+#define GPIOB_BASE	(APB2PERIPH_BASE + 0x0C00)
+#define GPIOB		((struct GPIO *) GPIOB_BASE)
+#define GPIOC_BASE	(APB2PERIPH_BASE + 0x1000)
+#define GPIOC		((struct GPIO *) GPIOC_BASE)
+#define GPIOD_BASE	(APB2PERIPH_BASE + 0x1400)
+#define GPIOD		((struct GPIO *) GPIOD_BASE)
+#define GPIOE_BASE	(APB2PERIPH_BASE + 0x1800)
+#define GPIOE		((struct GPIO *) GPIOE_BASE)
+
+static struct GPIO *const GPIO_LCD = ((struct GPIO *const) GPIO_LED_BASE);
+static struct GPIO *const GPIO_LCD_CTRL = ((struct GPIO *const) GPIO_USB_BASE);
+
+#define GPIO_LCD_RD	4
+#define GPIO_LCD_WR	5
+#define GPIO_LCD_RST	6
+#define GPIO_LCD_CS	7
+#define GPIO_LCD_RS	11
+/* PE7:LCD_D0 - PE14:LCD_D7 */
+#define GPIO_DATA_SHIFT	7
+#define GPIO_DATA_MASK (0xff << GPIO_DATA_SHIFT)
+
+static void
+lcd_command_common (st7732_cmd_t cmd)
+{
+  /* Set command. */
+  GPIO_LCD->BRR = GPIO_DATA_MASK & ~(cmd << GPIO_DATA_SHIFT);
+  GPIO_LCD->BSRR = GPIO_DATA_MASK & (cmd << GPIO_DATA_SHIFT);
+  /* Set CMD mode.  */
+  GPIO_LCD_CTRL->BRR = (1 << GPIO_LCD_RS);
+  /* Asert /CS.  */
+  GPIO_LCD_CTRL->BRR = (1<< GPIO_LCD_CS);
+  /* Asert /WR.  */
+  GPIO_LCD_CTRL->BRR = (1<< GPIO_LCD_WR);
+  // chopstx_usec_wait (1);
+  /* Negate /WR.  */
+  GPIO_LCD_CTRL->BSRR = (1<< GPIO_LCD_WR);
+
+  /* Return DATA mode.  */
+  GPIO_LCD_CTRL->BSRR = (1 << GPIO_LCD_RS);
+}
+
+/* Issue command with no data read/write.  */
+void
+lcd_command_no (st7732_cmd_t cmd)
+{
+  lcd_command_common (cmd);
+
+  /* Negate /CS.  */
+  GPIO_LCD_CTRL->BSRR = (1<< GPIO_LCD_CS);
+}
+
+#if 0
+void
+lcd_command_readn (st7732_cmd_t cmd, uint8_t *data, size_t n)
+{
+  volatile int dummy __attribute__ ((unused));
+
+  lcd_command_common (cmd);
+
+  /* Set GPIO_LCD to input mode.  */
+  GPIO_LCD->CRH = 0x88888888;
+  GPIO_LCD->CRL = 0x88888833;
+
+  /* Assert /RD.  */
+  GPIO_LCD_CTRL->BRR = (1<< GPIO_LCD_RD);
+  // chopstx_usec_wait (1);
+  /* Dummy read.  */
+  dummy = GPIO_LCD->IDR;
+  /* Negate /RD.  */
+  GPIO_LCD_CTRL->BSRR = (1<< GPIO_LCD_RD);
+
+  /* Read loop.  */
+  while (n-- > 0)
+    {
+      /* Assert /RD.  */
+      GPIO_LCD_CTRL->BRR = (1<< GPIO_LCD_RD);
+      // chopstx_usec_wait (1);
+      /* Negate /RD.  */
+      GPIO_LCD_CTRL->BSRR = (1<< GPIO_LCD_RD);
+      *data++ = GPIO_LCD->IDR >> GPIO_DATA_SHIFT;
+    }
+	  
+  /* Negate /CS.  */
+  GPIO_LCD_CTRL->BSRR = (1<< GPIO_LCD_CS);
+
+  /* Set GPIO_LCD to output mode.  */
+  GPIO_LCD->CRH = 0x83333333;
+  GPIO_LCD->CRL = 0x38888833;
+}
+#endif
+
+/* Issue command with N data write.  */
+void
+lcd_command_writen (st7732_cmd_t cmd, uint8_t *data, size_t n)
+{
+  lcd_command_common (cmd);
+
+  /* Write loop.  */
+  while (n-- > 0)
+    {
+      uint8_t b = *data++;
+
+      GPIO_LCD->BRR = GPIO_DATA_MASK & ~(b << GPIO_DATA_SHIFT);
+      GPIO_LCD->BSRR = GPIO_DATA_MASK & (b << GPIO_DATA_SHIFT);
+      /* Assert /WR.  */
+      GPIO_LCD_CTRL->BRR = (1<< GPIO_LCD_WR);
+      // chopstx_usec_wait (1);
+      /* Negate /WR.  */
+      GPIO_LCD_CTRL->BSRR = (1<< GPIO_LCD_WR);
+    }
+
+  /* Negate /CS.  */
+  GPIO_LCD_CTRL->BSRR = (1<< GPIO_LCD_CS);
+}
+
+/* Issue command with N same data write.  */
+void
+lcd_command_filln (st7732_cmd_t cmd, uint8_t b, size_t n)
+{
+  lcd_command_common (cmd);
+
+  /* Write loop.  */
+  while (n-- > 0)
+    {
+      GPIO_LCD->BRR = GPIO_DATA_MASK & ~(b << GPIO_DATA_SHIFT);
+      GPIO_LCD->BSRR = GPIO_DATA_MASK & (b << GPIO_DATA_SHIFT);
+      /* Assert /WR.  */
+      GPIO_LCD_CTRL->BRR = (1<< GPIO_LCD_WR);
+      // chopstx_usec_wait (1);
+      /* Negate /WR.  */
+      GPIO_LCD_CTRL->BSRR = (1<< GPIO_LCD_WR);
+    }
+
+  /* Negate /CS.  */
+  GPIO_LCD_CTRL->BSRR = (1<< GPIO_LCD_CS);
+}
+
+static chopstx_mutex_t lcd_mtx;
+static chopstx_cond_t lcd_cnd0;
+static chopstx_cond_t lcd_cnd1;
+
+/* Process for initializing ST7732.  */
+static void *
+lcd_initializer (void *arg __attribute__((unused)))
+{
+  uint8_t args[16];
+
+  chopstx_mutex_lock (&lcd_mtx);
+  chopstx_cond_wait (&lcd_cnd0, &lcd_mtx);
+  chopstx_mutex_unlock (&lcd_mtx);
+
+ /* Set GPIO_LCD to write mode.  */
+  GPIO_LCD->CRH = 0x83333333;
+  GPIO_LCD->CRL = 0x38888833;
+
+  /* Set GPIO_LCD_CTRL IO mode.  */
+  GPIO_LCD_CTRL->CRH = 0x88883888;
+  GPIO_LCD_CTRL->CRL = 0x33333888;
+
+  /* Restart ST7732.  */
+  /* Hard reset.  */
+  chopstx_usec_wait (100000);
+  GPIO_LCD_CTRL->BRR = (1 << GPIO_LCD_RST);
+  chopstx_usec_wait (100000);
+  GPIO_LCD_CTRL->BSRR = (1 << GPIO_LCD_RST);
+  chopstx_usec_wait (100000);
+
+  /* Software reset.  */
+  lcd_command_no (SWRESET);
+  chopstx_usec_wait (150000);
+
+  /* Sleep in.  */
+  lcd_command_no (SLPIN);
+  chopstx_usec_wait (100000);
+
+  /* Sleep out.  */
+  lcd_command_no (SLPOUT);
+  chopstx_usec_wait (100000);
+
+  /* Configure ST7732.  Set display mode, pixel mode, etc.  */
+  /* FRMCTR1, 6, 3, 2  */
+  args[0] = 0x06; args[1] = 0x03; args[2] = 0x02;
+  lcd_command_writen (FRMCTR1, args, 3);
+  /* INVCTR, 3  */
+  args[0] = 0x03;
+  lcd_command_writen (INVCTR, args, 1);
+  /* DISSET5, 2, eh  */
+  args[0] = 0x02; args[1] = 0x0e;
+  lcd_command_writen (DISSET5, args, 2);
+  /* DISPCTRL, 1ah  */
+  args[0] = 0x1a;
+  lcd_command_writen (DISPCTRL, args, 1);
+  /* PWCTR1, 2, 0  */
+  args[0] = 0x02; args[1] = 0x00;
+  lcd_command_writen (PWCTR1, args, 2);
+  /* PWCTR2, 5  */
+  args[0] = 0x05;
+  lcd_command_writen (PWCTR2, args, 1);
+  /* PWCTR3, 2, 2  */
+  args[0] = 0x02; args[1] = 0x02;
+  lcd_command_writen (PWCTR3, args, 2);
+  /* PWCTR4, 1, 2  */
+  args[0] = 0x01; args[1] = 0x00;
+  lcd_command_writen (PWCTR4, args, 2);
+  /* PWCTR5, 1, 2  */
+  args[0] = 0x01; args[1] = 0x00;
+  lcd_command_writen (PWCTR5, args, 2);
+  /* VMCTR1, 47h, 2ah  */
+  args[0] = 0x47; args[1] = 0x2a;
+  lcd_command_writen (VMCTR1, args, 2);
+  /* OSCADJ, 4ch  */
+  args[0] = 0x4c;
+  lcd_command_writen (OSCADJ, args, 1);
+  /* DEFADJ, 6  */
+  args[0] = 0x06;
+  lcd_command_writen (DEFADJ, args, 1);
+
+  /* gamma adjust  */
+
+  /* MADCTL, c0h  MY=1, MX=1  */
+  args[0] = 0xc0;
+  lcd_command_writen (MADCTL, args, 1);
+
+  /* Set RA and CA.  */
+  /* RASET, 0, 0, 0, 159  */
+  args[0] = 0x00; args[1] = 0x00; args[2] = 0x00; args[3] = LCD_ROW-1;
+  lcd_command_writen (RASET, args, 4);
+  /* CASET, 0, 0, 0, 127  */
+  args[0] = 0x00; args[1] = 0x00; args[2] = 0x00; args[3] = LCD_COLUMN-1;
+  lcd_command_writen (CASET, args, 4);
+
+  /* 0x06: RGB 6-6-6-bit.  */
+  args[0] = 0x06;
+  lcd_command_writen (COLMOD, args, 1);
+
+  args[0] = 0;
+  lcd_command_writen (TEON, args, 1);
+
+  lcd_command_no (DISPON);
+
+  /* Wait 20ms.  */
+  chopstx_usec_wait (20000);
+
+  chopstx_mutex_lock (&lcd_mtx);
+  chopstx_cond_signal (&lcd_cnd1);
+  chopstx_mutex_unlock (&lcd_mtx);
+
+  return NULL;
+}
+
+/* Plot a point with rgb color.  2 LSBs of rgb values will be ignored.  */
+void
+lcd_draw_point (int x, int y, int r, int g, int b)
+{
+  uint8_t args[4];
+
+  /* Set RA and CA.  */
+  /* RASET, 0, y, 0, y  */
+  args[0] = 0x00; args[1] = y; args[2] = 0x00; args[3] = y;
+  lcd_command_writen (RASET, args, 4);
+  /* CASET, 0, x, 0, x  */
+  args[0] = 0x00; args[1] = x; args[2] = 0x00; args[3] = x;
+  lcd_command_writen (CASET, args, 4);
+
+  args[0] = r; args[1] = g; args[2] = b; 
+  lcd_command_writen (RAMWR, args, 3);
+}
+
+static uint8_t hexfont5x8[16*5] = {
+  0x7e, 0x89, 0x91, 0xa1, 0x7e, /* 0 */
+  0x00, 0x41, 0xff, 0x01, 0x00, /* 1 */
+  0x43, 0x85, 0x89, 0x91, 0x61, /* 2 */
+  0x42, 0x81, 0x91, 0x91, 0x6e, /* 3 */
+  0x18, 0x28, 0x48, 0xff, 0x08, /* 4 */
+  0xf2, 0x91, 0x91, 0x91, 0x8e, /* 5 */
+  0x1e, 0x29, 0x49, 0x89, 0x86, /* 6 */
+  0x80, 0x8f, 0x90, 0xa0, 0xc0, /* 7 */
+  0x6e, 0x91, 0x91, 0x91, 0x6e, /* 8 */
+  0x70, 0x89, 0x89, 0x8a, 0x7c, /* 9 */
+  0x7f, 0x88, 0x88, 0x88, 0x7f, /* A */
+  0xff, 0x91, 0x91, 0x91, 0x6e, /* B */
+  0x7e, 0x81, 0x81, 0x81, 0x42, /* C */
+  0xff, 0x81, 0x81, 0x42, 0x3c, /* D */
+  0xff, 0x91, 0x91, 0x91, 0x81, /* E */
+  0xff, 0x90, 0x90, 0x90, 0x80, /* F */
+};
+
+/* Draw hex number with rgb color.  */
+void
+lcd_draw_hexfont5x8 (uint32_t hex, int x, int y, int r, int g, int b, int bg)
+{
+  int i, j;
+  uint8_t *p;
+  uint8_t args[5*8*3];
+
+  p = &hexfont5x8[(hex & 0xf)*5];
+
+  /* Set RA and CA.  */
+  /* RASET, 0, y, 0, y+8-1  */
+  args[0] = 0x00; args[1] = y; args[2] = 0x00; args[3] = y+7;
+  lcd_command_writen (RASET, args, 4);
+  /* CASET, 0, x, 0, x+5-1  */
+  args[0] = 0x00; args[1] = x; args[2] = 0x00; args[3] = x+4;
+  lcd_command_writen (CASET, args, 4);
+
+  for (i = 0; i < 5; i++)
+    {
+      uint8_t rb = *p++;
+      for (j = 0; j < 8; j++)
+	{
+	  int k = (5*j+i)*3;
+	  if (rb & (0x80 >> j))
+	    {
+	      args[k] = r; args[k+1] = g; args[k+2] = b;
+	    }
+	  else
+	    {
+	      args[k] = bg; args[k+1] = bg; args[k+2] = bg;
+	    }
+	}
+    }
+
+  lcd_command_writen (RAMWR, args, 5*8*3);
+}
+
+void
+lcd_printhex (uint32_t hex, int x, int y, int r, int g, int b, int bg)
+{
+  int i;
+
+  if (y < 0 || y >= LCD_ROW - 8)
+    return;
+  for (i = 7; i >= 0; i--)
+    {
+      lcd_draw_hexfont5x8 ((hex >> 4*i)&0xf, x, y, r, g, b, bg);
+      x += 5;
+      if (x >= LCD_COLUMN - 5)
+	break;
+    }
+}
+
+#define PRIO_LCD 3
+
+extern uint8_t __process1_stack_base__, __process1_stack_size__;
+const uint32_t __stackaddr_lcd = (uint32_t)&__process1_stack_base__;
+const size_t __stacksize_lcd = (size_t)&__process1_stack_size__;
+
+/* Initialize LCD.  */
+void
+lcd_init (void)
+{
+  chopstx_mutex_init (&lcd_mtx);
+  chopstx_cond_init (&lcd_cnd0);
+  chopstx_cond_init (&lcd_cnd1);
+
+  chopstx_create (PRIO_LCD, __stackaddr_lcd, __stacksize_lcd,
+		  lcd_initializer, NULL);
+
+  chopstx_usec_wait (200*1000);
+
+  chopstx_mutex_lock (&lcd_mtx);
+  chopstx_cond_signal (&lcd_cnd0);
+  chopstx_cond_wait (&lcd_cnd1, &lcd_mtx);
+  chopstx_mutex_unlock (&lcd_mtx);
+}
--- a/example-primer2/lcd.ld
+++ b/example-primer2/lcd.ld
@@ -0,0 +1,148 @@
+/*
+ * ST32F103 memory setup.
+ */
+__main_stack_size__      = 0x0100;      /* Exception handlers     */
+__process0_stack_size__  = 0x0200;      /* main */
+__process1_stack_size__  = 0x0100;      /* lcd init */
+__process2_stack_size__  = 0x0180;      /* rng */
+__process3_stack_size__  = 0x0100;      /* None yet */
+
+MEMORY
+{
+    flash0 : org = 0x08000000, len = 4k
+    flash : org = 0x08000000+0x1000, len = 512k - 4k
+    ram : org = 0x20000000, len = 64k
+}
+
+/* __flash_start__: flash ROM start address regardless of DFU_SUPPORT */
+__flash_start__         = 0x08001000;
+__flash_end__           = ORIGIN(flash) + LENGTH(flash);
+
+__ram_start__           = ORIGIN(ram);
+__ram_size__            = LENGTH(ram);
+__ram_end__             = __ram_start__ + __ram_size__;
+
+SECTIONS
+{
+    . = 0;
+
+    .sys : ALIGN(4) SUBALIGN(4)
+    {
+        _sys = .;
+        KEEP(*(.vectors))
+        . = ALIGN(16);
+        *(.sys.version)
+        build/sys.o(.text)
+        build/sys.o(.text.*)
+        build/sys.o(.rodata)
+        build/sys.o(.rodata.*)
+        . = ALIGN(1024);
+        *(.sys.0)
+        *(.sys.1)
+        *(.sys.2)
+    } > flash0
+
+    _text = .;
+
+    .startup : ALIGN(128) SUBALIGN(128)
+    {
+        KEEP(*(.startup.vectors))
+        . = ALIGN (16);
+    } > flash =0xffffffff
+
+    .text : ALIGN(16) SUBALIGN(16)
+    {
+        *(.text.startup.*)
+        *(.text)
+        *(.text.*)
+        *(.rodata)
+        *(.rodata.*)
+        *(.glue_7t)
+        *(.glue_7)
+        *(.gcc*)
+	. = ALIGN(8);
+    } > flash
+
+    .ARM.extab : {*(.ARM.extab* .gnu.linkonce.armextab.*)} > flash
+
+    .ARM.exidx : {
+        PROVIDE(__exidx_start = .);
+        *(.ARM.exidx* .gnu.linkonce.armexidx.*)
+        PROVIDE(__exidx_end = .);
+     } > flash
+
+    .eh_frame_hdr : {*(.eh_frame_hdr)} > flash
+
+    .eh_frame : ONLY_IF_RO {*(.eh_frame)} > flash
+
+    .textalign : ONLY_IF_RO { . = ALIGN(8); } > flash
+
+    _etext = .;
+    _textdata = _etext;
+
+    .stacks :
+    {
+        . = ALIGN(8);
+        __main_stack_base__ = .;
+        . += __main_stack_size__;
+        . = ALIGN(8);
+        __main_stack_end__ = .;
+        __process0_stack_base__ = .;
+        . += __process0_stack_size__;
+        . = ALIGN(8);
+        __process0_stack_end__ = .;
+        __process1_stack_base__ = .;
+        . += __process1_stack_size__;
+        . = ALIGN(8);
+        __process1_stack_end__ = .;
+        __process2_stack_base__ = .;
+        . += __process2_stack_size__;
+        . = ALIGN(8);
+        __process2_stack_end__ = .;
+        __process3_stack_base__ = .;
+        . += __process3_stack_size__;
+        . = ALIGN(8);
+        __process3_stack_end__ = .;
+    } > ram
+
+    .data :
+    {
+        . = ALIGN(4);
+        PROVIDE(_data = .);
+        *(.data)
+        . = ALIGN(4);
+        *(.data.*)
+        . = ALIGN(4);
+        *(.ramtext)
+        . = ALIGN(4);
+        PROVIDE(_edata = .);
+    } > ram AT > flash
+
+    .bss :
+    {
+        . = ALIGN(4);
+        PROVIDE(_bss_start = .);
+        *(.bss)
+        . = ALIGN(4);
+        *(.bss.*)
+        . = ALIGN(4);
+        *(COMMON)
+        . = ALIGN(4);
+        PROVIDE(_bss_end = .);
+    } > ram
+
+    PROVIDE(end = .);
+    _end            = .;
+    . = ALIGN(512);
+    /* reGNUal is now relocatable, it's OK not using fixed address. */
+    _regnual_start = .;
+
+    .fill_ffff :
+    {
+        . = ALIGN (2048);
+	*(.passwd)
+    } > flash =0xffffffff
+}
+
+__heap_base__   = _end;
+__heap_end__    = __ram_end__;
--- a/example-primer2/main.c
+++ b/example-primer2/main.c
@@ -0,0 +1,266 @@
+#include <stdint.h>
+#include <stdlib.h>
+#include <chopstx.h>
+#include "neug.h"
+#include "sys.h" /* for set_led */
+#include "stm32f103.h"
+#include "adc.h"
+#include "st7732.h"
+#include "primer2-switches.h"
+#include "primer2-ts.h"
+#include "board.h"
+
+#ifdef TEST_DISPLAY_LOGO
+static uint8_t buf[LCD_COLUMN*LCD_ROW*BYTES_PER_PIXEL] = {
+#include "chopstx-logo.data"
+};
+
+void
+lcd_logo (void)
+{
+  uint8_t args[4];
+
+  /* Set RA and CA.  */
+  /* RASET, 0, 0, 0, 159  */
+  args[0] = 0x00; args[1] = 0; args[2] = 0x00; args[3] = LCD_ROW-1;
+  lcd_command_writen (RASET, args, 4);
+  /* CASET, 0, 0, 0, 127  */
+  args[0] = 0x00; args[1] = 0; args[2] = 0x00; args[3] = LCD_COLUMN-1;
+  lcd_command_writen (CASET, args, 4);
+
+  /* Write logo.  */
+  lcd_command_writen (RAMWR, buf, LCD_COLUMN*LCD_ROW*BYTES_PER_PIXEL);
+}
+#endif
+
+/* Table of 32*(cos, sin) for range 0 to pi/2 with step pi/256.  */
+static uint8_t ctable[128*2] = {
+32, 0, 31, 0, 31, 0, 31, 1, 31, 1, 31, 1, 31, 2, 31, 2,
+31, 3, 31, 3, 31, 3, 31, 4, 31, 4, 31, 5, 31, 5, 31, 5,
+31, 6, 31, 6, 31, 7, 31, 7, 31, 7, 30, 8, 30, 8, 30, 8,
+30, 9, 30, 9, 30, 10, 30, 10, 30, 10, 29, 11, 29, 11, 29, 11,
+29, 12, 29, 12, 29, 12, 29, 13, 28, 13, 28, 14, 28, 14, 28, 14,
+28, 15, 28, 15, 27, 15, 27, 16, 27, 16, 27, 16, 27, 17, 26, 17,
+26, 17, 26, 18, 26, 18, 25, 18, 25, 19, 25, 19, 25, 19, 24, 19,
+24, 20, 24, 20, 24, 20, 23, 21, 23, 21, 23, 21, 23, 22, 22, 22,
+22, 22, 22, 22, 22, 23, 21, 23, 21, 23, 21, 23, 20, 24, 20, 24,
+20, 24, 19, 24, 19, 25, 19, 25, 19, 25, 18, 25, 18, 26, 18, 26,
+17, 26, 17, 26, 17, 27, 16, 27, 16, 27, 16, 27, 15, 27, 15, 28,
+15, 28, 14, 28, 14, 28, 14, 28, 13, 28, 13, 29, 12, 29, 12, 29,
+12, 29, 11, 29, 11, 29, 11, 29, 10, 30, 10, 30, 10, 30, 9, 30,
+9, 30, 8, 30, 8, 30, 8, 30, 7, 31, 7, 31, 7, 31, 6, 31,
+6, 31, 5, 31, 5, 31, 5, 31, 4, 31, 4, 31, 3, 31, 3, 31,
+3, 31, 2, 31, 2, 31, 1, 31, 1, 31, 1, 31, 0, 31, 0, 31,
+};
+
+#ifdef TEST_LCD_CIRCLE
+void
+lcd_circle (void)
+{
+  int i, j;
+  uint8_t *p;
+  int x, y;
+
+  /* Clear display.  */
+  /* Set RA and CA.  */
+  /* RASET, 0, 0, 0, 159  */
+  args[0] = 0x00; args[1] = 0; args[2] = 0x00; args[3] = LCD_ROW-1;
+  lcd_command_writen (RASET, args, 4);
+  /* CASET, 0, 0, 0, 127  */
+  args[0] = 0x00; args[1] = 0; args[2] = 0x00; args[3] = LCD_COLUMN-1;
+  lcd_command_writen (CASET, args, 4);
+
+  lcd_command_writen (RAMWR, 0, LCD_COLUMN*LCD_ROW*BYTES_PER_PIXEL);
+
+  /* Draw a circle.  */
+  for (i = 0; i < 128; i++)
+    {
+      x = 64 + ctable[2*i];
+      y = 80 + ctable[2*i+1];
+      lcd_draw_point (x, y, 0xfc, 0xfc, 0xfc);
+    }
+  for (i = 0; i < 128; i++)
+    {
+      x = 64 - ctable[2*i+1];
+      y = 80 + ctable[2*i];
+      lcd_draw_point (x, y, 0xfc, 0, 0xfc);
+    }
+  for (i = 0; i < 128; i++)
+    {
+      x = 64 - ctable[2*i];
+      y = 80 - ctable[2*i+1];
+      lcd_draw_point (x, y, 0, 0xfc, 0xfc);
+    }
+  for (i = 0; i < 128; i++)
+    {
+      x = 64 + ctable[2*i+1];
+      y = 80 - ctable[2*i];
+      lcd_draw_point (x, y, 0xfc, 0xfc, 0);
+    }
+}
+#endif
+
+#define RANDOM_BYTES_LENGTH 64
+static uint32_t random_word[RANDOM_BYTES_LENGTH/sizeof (uint32_t)];
+
+int
+main (int argc, const char *argv[])
+{
+  int count;
+  int vx, vy;
+  int r, g, b;
+  uint8_t args[4];
+
+  (void)argc;
+  (void)argv;
+
+  set_led (1);
+  set_backlight (1);
+
+  adc_init ();
+  neug_init (random_word, RANDOM_BYTES_LENGTH/sizeof (uint32_t));
+
+  lcd_init ();
+
+#ifdef TEST_LCD_LOGO
+  lcd_logo ();
+
+  while (! joystick ())
+    chopstx_usec_wait (500*1000);
+#endif
+
+  /* Set RA and CA.  */
+  /* RASET, 0, 0, 0, 159  */
+  args[0] = 0x00; args[1] = 0; args[2] = 0x00; args[3] = LCD_ROW-1;
+  lcd_command_writen (RASET, args, 4);
+  /* CASET, 0, 0, 0, 127  */
+  args[0] = 0x00; args[1] = 0; args[2] = 0x00; args[3] = LCD_COLUMN-1;
+  lcd_command_writen (CASET, args, 4);
+
+  /* Fill display.  */
+  lcd_command_filln (RAMWR, 0xfc, LCD_COLUMN*LCD_ROW*BYTES_PER_PIXEL);
+
+  vx = (LCD_COLUMN/2) << 5;
+  vy = (LCD_ROW/2) << 5;
+  r = g = b = 0;
+#if 1
+  adc3_init ();
+  adc3_start ();
+
+  count = 0;
+  while (1)
+    {
+      uint32_t resv[4];
+
+      adc3_conversion (resv);
+      if (ts_pushed (resv[2]))
+	{
+	  int reg[3], point[2];
+
+	  ts_conversion (resv, reg);
+#if 0
+	  lcd_printhex (reg[0], 5,  8, 0x00, 0x00, 0xfc, 0xfc);
+	  lcd_printhex (reg[1], 5,  18, 0x00, 0x00, 0xfc, 0xfc);
+	  lcd_printhex (reg[2], 5,  28, 0x00, 0x00, 0xfc, 0xfc);
+#endif
+	  if (!ts_adjust (reg, point))
+	    {
+	      chopstx_usec_wait (50*1000);
+	      continue;
+	    }
+
+	  lcd_draw_point (point[0], point[1], r, g, b);
+	}
+      else
+	ts_adjust (NULL, NULL);
+
+      chopstx_usec_wait (50*1000);
+      count++;
+      if ((count/10) & 1)
+	set_led (0);
+      else
+	set_led (1);
+      if (pbutton())
+	break;
+    }
+
+  adc3_stop ();
+#endif
+
+  count = 0;
+  while (1)
+    {
+      int jo;
+      uint32_t th = neug_get (NEUG_KICK_FILLING) & 0x1ff;
+
+      /* Get random point on a circle with the radius of 32 and walk
+	 towards it.  */
+      if (th < 128)
+	{
+	  vx += ctable[2*th];
+	  vy += ctable[2*th+1];
+	}
+      else if (th < 256)
+	{
+	  vx -= ctable[2*(th & 0x7f)+1];
+	  vy += ctable[2*(th & 0x7f)];
+	}
+      else if (th < 384)
+	{
+	  vx -= ctable[2*(th & 0x7f)];
+	  vy -= ctable[2*(th & 0x7f)+1];
+	}
+      else
+	{
+	  vx += ctable[2*(th & 0x7f)+1];
+	  vy -= ctable[2*(th & 0x7f)];
+	}
+
+      if (vx < 0)
+	vx += (LCD_COLUMN << 5);
+      if (vy < 0)
+	vy += (LCD_ROW << 5);
+
+      /* Change draw color with joystick.  */
+      jo = joystick ();
+      if (JOYSTICK_L (jo))
+	r = 0xfc;
+      if (JOYSTICK_R (jo))
+	g = 0xfc;
+      if (JOYSTICK_U (jo))
+	b = 0xfc;
+      if (JOYSTICK_D (jo))
+	r = g = b = 0;
+
+      /* 2-dim random walk on torus.  */
+      lcd_draw_point ((vx>>5)%LCD_COLUMN, (vy>>5)%LCD_ROW, r, g, b);
+      chopstx_usec_wait (10*1000);
+
+      if (pbutton ())
+	count++;
+      /* Shutdown when p-button is held down for 5 sec.  */
+      if (count > 500)
+	{
+	  set_led (0);
+	  shutdown ();
+	}
+      else
+	{
+	  /* Disable backlight when p-button is held down for 3 sec.  */
+	  if (count > 300)
+	    set_backlight (0);
+
+	  /* Blink led when p-button is held.  */
+	  if ((count/50) & 1)
+	    set_led (0);
+	  else
+	    set_led (1);
+	}
+#if 1
+      lcd_printhex (count, 5,  8, 0x00, 0x00, 0xfc, 0xfc);
+#endif
+
+    }
+
+  return 0;
+}
--- a/example-primer2/primer2-switches.c
+++ b/example-primer2/primer2-switches.c
@@ -0,0 +1,73 @@
+#include <stdint.h>
+#include <stdlib.h>
+#include <chopstx.h>
+#include "board.h"
+
+#define PERIPH_BASE	0x40000000
+#define APBPERIPH_BASE   PERIPH_BASE
+#define APB2PERIPH_BASE	(PERIPH_BASE + 0x10000)
+
+struct GPIO {
+  volatile uint32_t CRL;
+  volatile uint32_t CRH;
+  volatile uint32_t IDR;
+  volatile uint32_t ODR;
+  volatile uint32_t BSRR;
+  volatile uint32_t BRR;
+  volatile uint32_t LCKR;
+};
+
+#define GPIOA_BASE	(APB2PERIPH_BASE + 0x0800)
+#define GPIOA		((struct GPIO *) GPIOA_BASE)
+#define GPIOB_BASE	(APB2PERIPH_BASE + 0x0C00)
+#define GPIOB		((struct GPIO *) GPIOB_BASE)
+#define GPIOC_BASE	(APB2PERIPH_BASE + 0x1000)
+#define GPIOC		((struct GPIO *) GPIOC_BASE)
+#define GPIOD_BASE	(APB2PERIPH_BASE + 0x1400)
+#define GPIOD		((struct GPIO *) GPIOD_BASE)
+#define GPIOE_BASE	(APB2PERIPH_BASE + 0x1800)
+#define GPIOE		((struct GPIO *) GPIOE_BASE)
+
+static struct GPIO *const GPIO_STICK = ((struct GPIO *const) GPIO_LED_BASE);
+static struct GPIO *const GPIO_OTHER = ((struct GPIO *const) GPIO_OTHER_BASE);
+static struct GPIO *const GPIO_OTHER1 = ((struct GPIO *const) GPIOC_BASE);
+static struct GPIO *const GPIO_OTHER2 = ((struct GPIO *const) GPIOB_BASE);
+
+#define GPIO_STICK_L	3
+#define GPIO_STICK_R	4
+#define GPIO_STICK_U	5
+#define GPIO_STICK_D	6
+#define GPIO_SHUTDOWN	13
+#define GPIO_PBUTTON	8
+#define GPIO_BACKLIGHT	8
+
+void
+shutdown (void)
+{
+  GPIO_OTHER1->BRR = (1 << GPIO_SHUTDOWN);
+  GPIO_OTHER1->BSRR = (1 << GPIO_SHUTDOWN);
+
+  while (1)
+    chopstx_usec_wait (500*1000);
+}
+
+void
+set_backlight (int on)
+{
+  if (on)
+    GPIO_OTHER2->BSRR = (1 << GPIO_BACKLIGHT);
+  else
+    GPIO_OTHER2->BRR = (1 << GPIO_BACKLIGHT);
+}
+
+int
+joystick (void)
+{
+  return (GPIO_STICK->IDR >> GPIO_STICK_L) & 0xf;
+}
+
+int
+pbutton (void)
+{
+  return (GPIO_OTHER->IDR >> GPIO_PBUTTON) & 1;
+}
--- a/example-primer2/primer2-switches.h
+++ b/example-primer2/primer2-switches.h
@@ -0,0 +1,9 @@
+extern void shutdown (void);
+extern void set_backlight (int on);
+extern int pbutton (void);
+extern int joystick (void);
+
+#define JOYSTICK_L(x) ((x) & 1)
+#define JOYSTICK_R(x) ((x) & 2)
+#define JOYSTICK_U(x) ((x) & 4)
+#define JOYSTICK_D(x) ((x) & 8)
--- a/example-primer2/primer2-ts.c
+++ b/example-primer2/primer2-ts.c
@@ -0,0 +1,219 @@
+#include <stdint.h>
+#include <stdlib.h>
+#include <chopstx.h>
+#include "stm32f103.h"
+#include "st7732.h"
+#include "primer2-ts.h"
+
+/* ADC3 routines.  */
+
+#define ADC3_BASE		(APB2PERIPH_BASE + 0x3c00)
+static struct ADC *const ADC3 = (struct ADC *const)ADC3_BASE;
+
+#define RCC_APB2ENR_ADC3EN	0x8000
+#define RCC_APB2RSTR_ADC3RST	0x8000
+
+#define ADC_SR_JEOC		0x0004
+
+#define ADC_CR1_JEOCIE		(1 << 7)
+
+#define ADC_CR2_JSWSTART	(1 << 21)
+#define ADC_CR2_JEXTTRIG        (1 << 15)
+#define ADC_CR2_JEXTSEL(n)	((n) << 12)
+
+#define ADC_JSQR_NUM_CH(n)      (((n) - 1) << 20)
+#define ADC_JSQR_JSQ1_N(n)      ((n) << 0)
+#define ADC_JSQR_JSQ2_N(n)      ((n) << 5)
+#define ADC_JSQR_JSQ3_N(n)      ((n) << 10)
+#define ADC_JSQR_JSQ4_N(n)      ((n) << 15)
+
+#define ADC_CHANNEL_IN10        10
+#define ADC_CHANNEL_IN11        11
+#define ADC_CHANNEL_IN12        12
+#define ADC_CHANNEL_IN13        13
+
+#define USE_ADC3_INTR		1
+#define INTR_REQ_ADC3		47
+
+/*
+ * Do calibration for ADC3.
+ */
+void adc3_init (void)
+{
+  RCC->APB2ENR |= RCC_APB2ENR_ADC3EN;
+  RCC->APB2RSTR = RCC_APB2RSTR_ADC3RST;
+  RCC->APB2RSTR = 0;
+
+  ADC3->CR1 = 0;
+  ADC3->CR2 = ADC_CR2_ADON;
+  ADC3->CR2 = ADC_CR2_ADON | ADC_CR2_RSTCAL;
+  while ((ADC3->CR2 & ADC_CR2_RSTCAL) != 0)
+    ;
+  ADC3->CR2 = ADC_CR2_ADON | ADC_CR2_CAL;
+  while ((ADC3->CR2 & ADC_CR2_CAL) != 0)
+    ;
+  ADC3->CR2 = 0;
+  RCC->APB2ENR &= ~RCC_APB2ENR_ADC3EN;
+}
+
+static chopstx_intr_t adc3_intr;
+
+void
+adc3_start (void)
+{
+  RCC->APB2ENR |= RCC_APB2ENR_ADC3EN;
+
+#if USE_ADC3_INTR
+  ADC3->CR1 = ADC_CR1_SCAN | ADC_CR1_JEOCIE;
+#else
+  ADC3->CR1 = ADC_CR1_SCAN;
+#endif
+  ADC3->CR2 = ADC_CR2_JEXTTRIG | ADC_CR2_JEXTSEL(7) | ADC_CR2_ADON;
+  ADC3->SMPR1 = 0xfff;
+  ADC3->SMPR2 = 0;
+  ADC3->JSQR = (ADC_JSQR_NUM_CH(4) | ADC_JSQR_JSQ4_N(ADC_CHANNEL_IN13)
+		| ADC_JSQR_JSQ3_N(ADC_CHANNEL_IN12)
+		| ADC_JSQR_JSQ2_N(ADC_CHANNEL_IN11)
+		| ADC_JSQR_JSQ1_N(ADC_CHANNEL_IN10));
+
+#if USE_ADC3_INTR
+  chopstx_claim_irq (&adc3_intr, INTR_REQ_ADC3);
+#endif
+}
+
+void adc3_conversion (uint32_t *result)
+{
+
+  /* Start conversion.  */
+  ADC3->CR2 |= ADC_CR2_JSWSTART;
+
+#if USE_ADC3_INTR
+  chopstx_intr_wait (&adc3_intr);
+#else
+  while (1)
+    {
+      chopstx_usec_wait (1000);
+      if (ADC3->SR & ADC_SR_JEOC)
+	break;
+    }
+#endif
+  ADC3->SR &= ~ADC_SR_JEOC;
+
+  result[0] = ADC3->JDR1;
+  result[1] = ADC3->JDR2;
+  result[2] = ADC3->JDR3;
+  result[3] = ADC3->JDR4;
+
+  /* Stop conversion.  */
+  ADC3->CR2 &= ~ADC_CR2_JSWSTART;
+
+  return;
+}
+
+void adc3_stop (void)
+{
+
+  /* Power off.  */
+  ADC3->CR1 = 0;
+  ADC3->CR2 = 0;
+
+  RCC->APB2ENR &= ~RCC_APB2ENR_ADC3EN;
+}
+
+/* Touch screen routines.  */
+
+int
+ts_pushed (uint32_t u)
+{
+  return (u < 0xc00);
+}
+
+#define FILTER_SIZE	8
+
+static void
+ts_filter (int buf[FILTER_SIZE][2], int result[2])
+{
+  int s0, s1;
+  int i;
+
+  s0 = 0;
+  s1 = 0;
+  for (i = 0; i < FILTER_SIZE; i++)
+    {
+      s0 += buf[i][0];
+      s1 += buf[i][1];
+    }
+
+  result[0] = s0/FILTER_SIZE;
+  result[1] = s1/FILTER_SIZE;
+}
+
+/* Simple model of primer2 touch screen:
+    Vdd-[R1]-[Ry]-[Rp]-[Rx]-Vss
+            U    D    l    R
+   where R1=1k external register, Rx(resp. Ry)=resisitive component on
+   X(resp. Y) film and Rp=resisitive component of contact point.
+   Convert [L, R, U, D] to [Rx, Ry, Rp].  */
+void
+ts_conversion (uint32_t a[], int r[])
+{
+  int l, u, d, ir1;
+  int x, y, rp;
+
+  l = a[0] & 0xfff;
+  u = a[2] & 0xfff;
+  d = a[3] & 0xfff;
+  ir1 = 4096 - u;
+  /* r1 = 1000 */
+  x = (1000 * l)/ir1;
+  y = (1000 * (u - d))/ir1;
+  rp = (1000 * (d - l))/ir1;
+  r[0] = x;
+  r[1] = y;
+  r[2] = rp;
+}
+
+int
+ts_adjust (int *r, int *cord)
+{
+  int x, y;
+  static int buf[FILTER_SIZE][2];
+  static int i = 0;
+  static int fill = 0;
+
+  if (!r)
+    {
+      i = 0;
+      fill = 0;
+      return 0;
+    }
+
+  /* TODO: We might need calibration.  */
+  x = (LCD_COLUMN * (r[0] - 0x20))/0x100;
+  y = (LCD_ROW * (0x1e0 - r[1]))/0x1c0;
+
+  if (x < 0)
+    x = 0;
+  if (x >= LCD_COLUMN)
+    x = LCD_COLUMN - 1;
+  if (y < 0)
+    y = 0;
+  if (y >= LCD_ROW)
+    y = LCD_ROW - 1;
+
+  buf[i][0] = x;
+  buf[i][1] = y;
+
+  i++;
+  if (i >= FILTER_SIZE)
+    {
+      i = 0;
+      fill = 1;
+    }
+
+  if (!fill)
+    return 0;
+
+  ts_filter (buf, cord);
+  return 1;
+}
--- a/example-primer2/primer2-ts.h
+++ b/example-primer2/primer2-ts.h
@@ -0,0 +1,8 @@
+extern void adc3_init (void);
+extern void adc3_start (void);
+extern void adc3_conversion (uint32_t *result);
+extern void adc3_stop (void);
+
+extern int ts_pushed (uint32_t u);
+extern void ts_conversion (uint32_t a[], int r[]);
+extern int ts_adjust (int r[], int cord[]);
--- a/example-primer2/st7732.h
+++ b/example-primer2/st7732.h
@@ -0,0 +1,83 @@
+/* ST7732 LCD driver chip command byte.
+  command_name = value  read_n_bytes:write_n_bytes: simple description  */
+enum st7732_cmd {
+  NOP = 0x00,		/* 0:0: No Operatin */
+  SWRESET = 0x01,	/* 0:0: Software reset */
+  RDDID = 0x04,		/* 0:3: Read Display ID */
+  RDRST = 0x09,		/* 0:4: Read Display Status */
+  RDDPM = 0x0a,		/* 0:1: Read Display Power Mode */
+  RDD_MADCTL = 0x0b,	/* 0:1: Read Display MADCTL */
+  RDD_COLMOD = 0x0c,	/* 0:1: Read Display Pixel Format */
+  RDDIM = 0x0d,		/* 0:1: Read Display Image Mode */
+  RDDSM = 0x0e,		/* 0:1: Read Display Signal Mode */
+  RDDSDR = 0x0f,	/* 0:1: Read Display Self-diagnostic result */
+  SLPIN = 0x10,		/* 0:0: Sleep in & booster off */
+  SLPOUT = 0x11,	/* 0:0: Sleep out & booster on */
+  PTLON = 0x12,		/* 0:0: Pertial mode on */
+  NORON = 0x13,		/* 0:0: Normal mode on (Pertial off) */
+  INVOFF = 0x20,	/* 0:0: Display inversion off */
+  INVON = 0x21,		/* 0:0: Display inversion on */
+  GAMSET = 0x26,	/* 1:0: Gamma curve select */
+  DISPOFF = 0x28,	/* 0:0: Display off */
+  DISPON = 0x29,	/* 0:0: Display on */
+  CASET = 0x2a,		/* 4:0: Column address set */
+  RASET = 0x2b,		/* 4:0: Raw address set */
+  RAMWR = 0x2c,		/* 1:0: Memory write */
+  RAMRD = 0x2e,		/* 0:1: Memory read */
+  PTLAR = 0x30,		/* 4:0: Partial start/end address set */
+  SCRLAR = 0x33,	/* 6:0: Scroll area set */
+  TEOFF = 0x34,		/* 0:0: Tearing effect line off */
+  TEON = 0x35,		/* 1:0: Tearing effect mode set & on */
+  MADCTL = 0x36,	/* 1:0: Memory data access control */
+  VSCSAD = 0x37,	/* 2:0: Scroll start address of RAM */
+  IDMOFF = 0x38,	/* 0:0: Idle mode off */
+  IDMON = 0x39,		/* 0:0: Idle mode on */
+  COLMOD = 0x3a,	/* 1:0: Interface pixel format */
+  RDID1 = 0xda,		/* 0:1: Read ID1 */
+  RDID2 = 0xdb,		/* 0:1: Read ID2 */
+  RDID3 = 0xdc,		/* 0:1: Read ID3 */
+  RGBCTR = 0xb0,	/* 1:0: Set RGB signal control */
+  FRMCTR1 = 0xb1,	/* 3:0: In normal mode */
+  FRMCTR2 = 0xb2,	/* 3:0: In Idel mode (8-colors) */
+  FRMCTR3 = 0xb3,	/* 6:0: In partial mode + Full colors */
+  INVCTR = 0xb4,	/* 1:0: Display inversion control */
+  RGB_BPCTR = 0xb5,	/* 4:0: RGB I/F Blanking porch setting */
+  DISSET5 = 0xb6,	/* 2:0: Display function setting */
+  PWCTR1 = 0xc0,	/* 2:0: Power control setting */
+  PWCTR2 = 0xc1,	/* 1:0: Power control setting */
+  PWCTR3 = 0xc2,	/* 2:0: Power control setting (Full colors) */
+  PWCTR4 = 0xc3,	/* 2:0: Power control setting (8-colors) */
+  PWCTR5 = 0xc4,	/* 2:0: Power control setting (In partial mode) */
+  VMCTR1 = 0xc5,	/* 2:0: VCOM control */
+  VMOFCTR = 0xc6,	/* 1:0: VCOM offset control */
+  WRID2 = 0xd1,		/* 1:0: Write ID2 value to NV */
+  WRID3 = 0xd2,		/* 1:0: Write ID3 value to NV */
+  RDID4 = 0xd3,		/* 0:4: IC Vender code */
+  NVCTR1 = 0xd9,	/* 0:1:no-fummy NVM control status */
+  NVCTR2 = 0xde,	/* 3:0: NVM read command (aa, 0f, a5) */
+  NVCTR3 = 0xdf,	/* 3:0: NVM write command (55, f0, 5a) */
+  GAMCTRP1 = 0xe0,	/* 13:0: Set Gamma correction + */
+  GAMCTRN1 = 0xe1,	/* 13:0: Set Gamma correction - */
+  AUTO_CTRL = 0xf1,	/* 1:0: NVM write function ON/OFF */
+  OSCADJ = 0xf2,	/* 1:0: Osillator frequency setting */
+  DISPCTRL = 0xf5,	/* 1:0: Display function control */
+  DEFADJ = 0xf6,	/* 1:0: Default mode setting */
+};
+
+typedef enum st7732_cmd st7732_cmd_t;
+
+extern void lcd_command_no (st7732_cmd_t cmd);
+extern void lcd_command_readn (st7732_cmd_t cmd, uint8_t *p, size_t n);
+extern void lcd_command_writen (st7732_cmd_t cmd, uint8_t *p, size_t n);
+extern void lcd_command_filln (st7732_cmd_t cmd, uint8_t b, size_t n);
+extern void lcd_init (void);
+
+extern void lcd_draw_point (int x, int y, int r, int g, int b);
+extern void lcd_draw_hexfont5x8 (uint32_t hex, int x, int y, int r, int g,
+				 int b, int bg);
+extern void lcd_printhex (uint32_t hex, int x, int y, int r, int g, int b,
+			  int bg);
+
+#define LCD_COLUMN	128
+#define LCD_ROW		160
+#define BYTES_PER_PIXEL	3
--- a/example-primer2/sys.c
+++ b/example-primer2/sys.c
@@ -0,0 +1,467 @@
+/*
+ * sys.c - system routines for the initial page for STM32F103.
+ *
+ * Copyright (C) 2013, 2014, 2015 Flying Stone Technology
+ * Author: NIIBE Yutaka <gniibe@fsij.org>
+ *
+ * Copying and distribution of this file, with or without modification,
+ * are permitted in any medium without royalty provided the copyright
+ * notice and this notice are preserved.  This file is offered as-is,
+ * without any warranty.
+ *
+ * When the flash ROM is protected, we cannot modify the initial page.
+ * We put some system routines (which is useful for any program) here.
+ */
+
+#include <stdint.h>
+#include <stdlib.h>
+#include "board.h"
+
+/* Adds port C for shutdown function.  */
+#undef RCC_ENR_IOP_EN
+#undef RCC_RSTR_IOP_RST
+#define RCC_ENR_IOP_EN \
+        (RCC_APB2ENR_IOPAEN | RCC_APB2ENR_IOPDEN | RCC_APB2ENR_IOPEEN \
+	 | RCC_APB2ENR_IOPCEN | RCC_APB2ENR_IOPBEN)
+#define RCC_RSTR_IOP_RST \
+        (RCC_APB2RSTR_IOPARST | RCC_APB2RSTR_IOPDRST | RCC_APB2RSTR_IOPERST \
+	 | RCC_APB2RSTR_IOPCRST | RCC_APB2RSTR_IOPBRST)
+
+#include "clk_gpio_init-stm32.c"
+
+static struct GPIO *const GPIO_OTHER1 = ((struct GPIO *const) GPIOC_BASE);
+static struct GPIO *const GPIO_OTHER2 = ((struct GPIO *const) GPIOB_BASE);
+
+static void __attribute__((used))
+gpio_init_primer2 (void)
+{
+  gpio_init ();
+
+  /*
+   * Port C setup.
+   * Everything input with pull-up except:
+   * PC0  - Analog input (Touch panel L X+)
+   * PC1  - Analog input (Touch panel R X-)
+   * PC2  - Analog input (Touch panel U Y+)
+   * PC3  - Analog input (Touch panel D Y-)
+   * PC6  - Normal input because there is an external resistor.
+   * PC7  - Normal input because there is an external resistor.
+   * PC13 - Push Pull output (SHUTDOWN)
+   */
+  GPIO_OTHER1->ODR = 0xffffdfff;
+  GPIO_OTHER1->CRL = 0x44880000;
+  GPIO_OTHER1->CRH = 0x88388888;
+
+  /*
+   * Port B setup.
+   * Everything input with pull-up except:
+   * PB8  - Backlight enable output.
+   * PB13 - Alternate output  (AUDIO SPI2 SCK).
+   * PB14 - Normal input      (AUDIO SPI2 MISO).
+   * PB15 - Alternate output  (AUDIO SPI2 MOSI).
+   */
+  GPIO_OTHER2->ODR = 0xffffffff;
+  GPIO_OTHER2->CRL = 0x88888888;
+  GPIO_OTHER2->CRH = 0xb4b88883;
+}
+
+#define CORTEX_PRIORITY_BITS    4
+#define CORTEX_PRIORITY_MASK(n)  ((n) << (8 - CORTEX_PRIORITY_BITS))
+#define USB_LP_CAN1_RX0_IRQn	 20
+#define STM32_USB_IRQ_PRIORITY   11
+
+struct NVIC {
+  volatile uint32_t ISER[8];
+  volatile uint32_t unused1[24];
+  volatile uint32_t ICER[8];
+  volatile uint32_t unused2[24];
+  volatile uint32_t ISPR[8];
+  volatile uint32_t unused3[24];
+  volatile uint32_t ICPR[8];
+  volatile uint32_t unused4[24];
+  volatile uint32_t IABR[8];
+  volatile uint32_t unused5[56];
+  volatile uint32_t IPR[60];
+};
+
+static struct NVIC *const NVICBase = ((struct NVIC *const)0xE000E100);
+#define NVIC_ISER(n)	(NVICBase->ISER[n >> 5])
+#define NVIC_ICPR(n)	(NVICBase->ICPR[n >> 5])
+#define NVIC_IPR(n)	(NVICBase->IPR[n >> 2])
+
+static void
+nvic_enable_vector (uint32_t n, uint32_t prio)
+{
+  unsigned int sh = (n & 3) << 3;
+
+  NVIC_IPR (n) = (NVIC_IPR(n) & ~(0xFF << sh)) | (prio << sh);
+  NVIC_ICPR (n) = 1 << (n & 0x1F);
+  NVIC_ISER (n) = 1 << (n & 0x1F);
+}
+
+static void
+usb_cable_config (int enable)
+{
+#if defined(GPIO_USB_SET_TO_ENABLE)
+  if (enable)
+    GPIO_USB->BSRR = (1 << GPIO_USB_SET_TO_ENABLE);
+  else
+    GPIO_USB->BRR = (1 << GPIO_USB_SET_TO_ENABLE);
+#elif defined(GPIO_USB_CLEAR_TO_ENABLE)
+  if (enable)
+    GPIO_USB->BRR = (1 << GPIO_USB_CLEAR_TO_ENABLE);
+  else
+    GPIO_USB->BSRR = (1 << GPIO_USB_CLEAR_TO_ENABLE);
+#else
+  (void)enable;
+#endif
+}
+
+void
+set_led (int on)
+{
+#if defined(GPIO_LED_CLEAR_TO_EMIT)
+  if (on)
+    GPIO_LED->BRR = (1 << GPIO_LED_CLEAR_TO_EMIT);
+  else
+    GPIO_LED->BSRR = (1 << GPIO_LED_CLEAR_TO_EMIT);
+#else
+  if (on)
+    GPIO_LED->BSRR = (1 << GPIO_LED_SET_TO_EMIT);
+  else
+    GPIO_LED->BRR = (1 << GPIO_LED_SET_TO_EMIT);
+#endif
+}
+
+static void wait (int count)
+{
+  int i;
+
+  for (i = 0; i < count; i++)
+    asm volatile ("" : : "r" (i) : "memory");
+}
+
+
+static void
+usb_lld_sys_shutdown (void)
+{
+  RCC->APB1ENR &= ~RCC_APB1ENR_USBEN;
+  RCC->APB1RSTR = RCC_APB1RSTR_USBRST;
+  usb_cable_config (0);
+}
+
+static void
+usb_lld_sys_init (void)
+{
+  if ((RCC->APB1ENR & RCC_APB1ENR_USBEN)
+      && (RCC->APB1RSTR & RCC_APB1RSTR_USBRST) == 0)
+    /* Make sure the device is disconnected, even after core reset.  */
+    {
+      usb_lld_sys_shutdown ();
+      /* Disconnect requires SE0 (>= 2.5uS).  */
+      wait (300);
+    }
+
+  usb_cable_config (1);
+  RCC->APB1ENR |= RCC_APB1ENR_USBEN;
+  nvic_enable_vector (USB_LP_CAN1_RX0_IRQn,
+		      CORTEX_PRIORITY_MASK (STM32_USB_IRQ_PRIORITY));
+  /*
+   * Note that we also have other IRQ(s):
+   * 	USB_HP_CAN1_TX_IRQn (for double-buffered or isochronous)
+   * 	USBWakeUp_IRQn (suspend/resume)
+   */
+  RCC->APB1RSTR = RCC_APB1RSTR_USBRST;
+  RCC->APB1RSTR = 0;
+}
+
+#define FLASH_KEY1               0x45670123UL
+#define FLASH_KEY2               0xCDEF89ABUL
+
+enum flash_status
+{
+  FLASH_BUSY = 1,
+  FLASH_ERROR_PG,
+  FLASH_ERROR_WRP,
+  FLASH_COMPLETE,
+  FLASH_TIMEOUT
+};
+
+static void __attribute__ ((used))
+flash_unlock (void)
+{
+  FLASH->KEYR = FLASH_KEY1;
+  FLASH->KEYR = FLASH_KEY2;
+}
+
+
+#define intr_disable()  asm volatile ("cpsid   i" : : : "memory")
+#define intr_enable()  asm volatile ("cpsie   i" : : : "memory")
+
+#define FLASH_SR_BSY		0x01
+#define FLASH_SR_PGERR		0x04
+#define FLASH_SR_WRPRTERR	0x10
+#define FLASH_SR_EOP		0x20
+
+#define FLASH_CR_PG	0x0001
+#define FLASH_CR_PER	0x0002
+#define FLASH_CR_MER	0x0004
+#define FLASH_CR_OPTPG	0x0010
+#define FLASH_CR_OPTER	0x0020
+#define FLASH_CR_STRT	0x0040
+#define FLASH_CR_LOCK	0x0080
+#define FLASH_CR_OPTWRE	0x0200
+#define FLASH_CR_ERRIE	0x0400
+#define FLASH_CR_EOPIE	0x1000
+
+static int
+flash_wait_for_last_operation (uint32_t timeout)
+{
+  int status;
+
+  do
+    {
+      status = FLASH->SR;
+      if (--timeout == 0)
+	break;
+    }
+  while ((status & FLASH_SR_BSY) != 0);
+
+  return status & (FLASH_SR_BSY|FLASH_SR_PGERR|FLASH_SR_WRPRTERR);
+}
+
+#define FLASH_PROGRAM_TIMEOUT 0x00010000
+#define FLASH_ERASE_TIMEOUT   0x01000000
+
+static int
+flash_program_halfword (uint32_t addr, uint16_t data)
+{
+  int status;
+
+  status = flash_wait_for_last_operation (FLASH_PROGRAM_TIMEOUT);
+
+  intr_disable ();
+  if (status == 0)
+    {
+      FLASH->CR |= FLASH_CR_PG;
+
+      *(volatile uint16_t *)addr = data;
+
+      status = flash_wait_for_last_operation (FLASH_PROGRAM_TIMEOUT);
+      FLASH->CR &= ~FLASH_CR_PG;
+    }
+  intr_enable ();
+
+  return status;
+}
+
+static int
+flash_erase_page (uint32_t addr)
+{
+  int status;
+
+  status = flash_wait_for_last_operation (FLASH_ERASE_TIMEOUT);
+
+  intr_disable ();
+  if (status == 0)
+    {
+      FLASH->CR |= FLASH_CR_PER;
+      FLASH->AR = addr;
+      FLASH->CR |= FLASH_CR_STRT;
+
+      status = flash_wait_for_last_operation (FLASH_ERASE_TIMEOUT);
+      FLASH->CR &= ~FLASH_CR_PER;
+    }
+  intr_enable ();
+
+  return status;
+}
+
+static int
+flash_check_blank (const uint8_t *p_start, size_t size)
+{
+  const uint8_t *p;
+
+  for (p = p_start; p < p_start + size; p++)
+    if (*p != 0xff)
+      return 0;
+
+  return 1;
+}
+
+extern uint8_t __flash_start__, __flash_end__;
+
+static int
+flash_write (uint32_t dst_addr, const uint8_t *src, size_t len)
+{
+  int status;
+  uint32_t flash_start = (uint32_t)&__flash_start__;
+  uint32_t flash_end = (uint32_t)&__flash_end__;
+
+  if (dst_addr < flash_start || dst_addr + len > flash_end)
+    return 0;
+
+  while (len)
+    {
+      uint16_t hw = *src++;
+
+      hw |= (*src++ << 8);
+      status = flash_program_halfword (dst_addr, hw);
+      if (status != 0)
+	return 0;		/* error return */
+
+      dst_addr += 2;
+      len -= 2;
+    }
+
+  return 1;
+}
+
+#define OPTION_BYTES_ADDR 0x1ffff800
+
+static int
+flash_protect (void)
+{
+  int status;
+  uint32_t option_bytes_value;
+
+  status = flash_wait_for_last_operation (FLASH_ERASE_TIMEOUT);
+
+  intr_disable ();
+  if (status == 0)
+    {
+      FLASH->OPTKEYR = FLASH_KEY1;
+      FLASH->OPTKEYR = FLASH_KEY2;
+
+      FLASH->CR |= FLASH_CR_OPTER;
+      FLASH->CR |= FLASH_CR_STRT;
+
+      status = flash_wait_for_last_operation (FLASH_ERASE_TIMEOUT);
+      FLASH->CR &= ~FLASH_CR_OPTER;
+    }
+  intr_enable ();
+
+  if (status != 0)
+    return 0;
+
+  option_bytes_value = *(uint32_t *)OPTION_BYTES_ADDR;
+  return (option_bytes_value & 0xff) == 0xff ? 1 : 0;
+}
+
+static void __attribute__((naked))
+flash_erase_all_and_exec (void (*entry)(void))
+{
+  uint32_t addr = (uint32_t)&__flash_start__;
+  uint32_t end = (uint32_t)&__flash_end__;
+  int r;
+
+  while (addr < end)
+    {
+      r = flash_erase_page (addr);
+      if (r != 0)
+	break;
+
+      addr += FLASH_PAGE_SIZE;
+    }
+
+  if (addr >= end)
+    (*entry) ();
+
+  for (;;);
+}
+
+struct SCB
+{
+  volatile uint32_t CPUID;
+  volatile uint32_t ICSR;
+  volatile uint32_t VTOR;
+  volatile uint32_t AIRCR;
+  volatile uint32_t SCR;
+  volatile uint32_t CCR;
+  volatile uint8_t  SHP[12];
+  volatile uint32_t SHCSR;
+  volatile uint32_t CFSR;
+  volatile uint32_t HFSR;
+  volatile uint32_t DFSR;
+  volatile uint32_t MMFAR;
+  volatile uint32_t BFAR;
+  volatile uint32_t AFSR;
+  volatile uint32_t PFR[2];
+  volatile uint32_t DFR;
+  volatile uint32_t ADR;
+  volatile uint32_t MMFR[4];
+  volatile uint32_t ISAR[5];
+};
+
+#define SCS_BASE	(0xE000E000)
+#define SCB_BASE	(SCS_BASE +  0x0D00)
+static struct SCB *const SCB = ((struct SCB *const) SCB_BASE);
+
+#define SYSRESETREQ 0x04
+static void
+nvic_system_reset (void)
+{
+  SCB->AIRCR = (0x05FA0000 | (SCB->AIRCR & 0x70) | SYSRESETREQ);
+  asm volatile ("dsb");
+  for (;;);
+}
+
+static void __attribute__ ((naked))
+reset (void)
+{
+  extern const unsigned long *FT0, *FT1, *FT2;
+
+  /*
+   * This code may not be at the start of flash ROM, because of DFU.
+   * So, we take the address from PC.
+   */
+  asm volatile ("cpsid	i\n\t"		/* Mask all interrupts. */
+		"ldr	r0, 1f\n\t"     /* r0 = SCR */
+		"mov	r1, pc\n\t"	/* r1 = (PC + 0x1000) & ~0x0fff */
+		"mov	r2, #0x1000\n\t"
+		"add	r1, r1, r2\n\t"
+		"sub	r2, r2, #1\n\t"
+		"bic	r1, r1, r2\n\t"
+		"str	r1, [r0, #8]\n\t"	/* Set SCR->VCR */
+		"ldr	r0, [r1], #4\n\t"
+		"msr	MSP, r0\n\t"	/* Main (exception handler) stack. */
+		"ldr	r0, [r1]\n\t"	/* Reset handler.                  */
+		"bx	r0\n\t"
+		".align	2\n"
+	"1:	.word	0xe000ed00"
+		: /* no output */ : /* no input */ : "memory");
+
+  /* Never reach here. */
+  /* Artificial entry to refer FT0, FT1, and FT2.  */
+  asm volatile (""
+		: : "r" (FT0), "r" (FT1), "r" (FT2));
+}
+
+typedef void (*handler)(void);
+extern uint8_t __ram_end__;
+
+handler vector[] __attribute__ ((section(".vectors"))) = {
+  (handler)&__ram_end__,
+  reset,
+  (handler)set_led,
+  flash_unlock,
+  (handler)flash_program_halfword,
+  (handler)flash_erase_page,
+  (handler)flash_check_blank,
+  (handler)flash_write,
+  (handler)flash_protect,
+  (handler)flash_erase_all_and_exec,
+  usb_lld_sys_init,
+  usb_lld_sys_shutdown,
+  nvic_system_reset,
+  clock_init,
+  gpio_init_primer2,
+  NULL,
+};
+
+const uint8_t sys_version[8] __attribute__((section(".sys.version"))) = {
+  3*2+2,	     /* bLength */
+  0x03,		     /* bDescriptorType = USB_STRING_DESCRIPTOR_TYPE*/
+  /* sys version: "2.0" */
+  '2', 0, '.', 0, '0', 0,
+};
--- a/example-primer2/sys.h
+++ b/example-primer2/sys.h
@@ -0,0 +1,115 @@
+extern const uint8_t sys_version[8];
+
+typedef void (*handler)(void);
+extern handler vector[16];
+
+static inline const uint8_t *
+unique_device_id (void)
+{
+  /* STM32F103 has 96-bit unique device identifier */
+  const uint8_t *addr = (const uint8_t *)0x1ffff7e8;
+
+  return addr;
+}
+
+static inline void
+set_led (int on)
+{
+  void (*func) (int) = (void (*)(int))vector[2];
+
+  return (*func) (on);
+}
+
+static inline void
+flash_unlock (void)
+{
+  (*vector[3]) ();
+}
+
+static inline int
+flash_program_halfword (uint32_t addr, uint16_t data)
+{
+  int (*func) (uint32_t, uint16_t) = (int (*)(uint32_t, uint16_t))vector[4];
+
+  return (*func) (addr, data);
+}
+
+static inline int
+flash_erase_page (uint32_t addr)
+{
+  int (*func) (uint32_t) = (int (*)(uint32_t))vector[5];
+
+  return (*func) (addr);
+}
+
+static inline int
+flash_check_blank (const uint8_t *p_start, size_t size)
+{
+  int (*func) (const uint8_t *, int) = (int (*)(const uint8_t *, int))vector[6];
+
+  return (*func) (p_start, size);
+}
+
+static inline int
+flash_write (uint32_t dst_addr, const uint8_t *src, size_t len)
+{
+  int (*func) (uint32_t, const uint8_t *, size_t)
+    = (int (*)(uint32_t, const uint8_t *, size_t))vector[7];
+
+  return (*func) (dst_addr, src, len);
+}
+
+static inline int
+flash_protect (void)
+{
+  int (*func) (void) = (int (*)(void))vector[8];
+
+  return (*func) ();
+}
+
+static inline void __attribute__((noreturn))
+flash_erase_all_and_exec (void (*entry)(void))
+{
+  void (*func) (void (*)(void)) = (void (*)(void (*)(void)))vector[9];
+
+  (*func) (entry);
+  for (;;);
+}
+
+static inline void
+usb_lld_sys_init (void)
+{
+  (*vector[10]) ();
+}
+
+static inline void
+usb_lld_sys_shutdown (void)
+{
+  (*vector[11]) ();
+}
+
+static inline void
+nvic_system_reset (void)
+{
+  (*vector[12]) ();
+}
+
+/*
+ * Users can override INLINE by 'attribute((used))' to have an
+ * implementation defined.
+ */
+#if !defined(INLINE)
+#define INLINE __inline__
+#endif
+
+static INLINE void
+clock_init (void)
+{
+  (*vector[13]) ();
+}
+
+static INLINE void
+gpio_init (void)
+{
+  (*vector[14]) ();
+}
Author	SHA1	Message	Date
NIIBE Yutaka	5458b77d36	Version 0.11	2016-05-19 12:22:30 +09:00
NIIBE Yutaka	03bba13005	eventflag API addtiion	2016-05-19 11:48:01 +09:00
NIIBE Yutaka	1b0fe5a6e8	Add eventflag_set_poll_desc	2016-05-18 21:32:32 +09:00
NIIBE Yutaka	5e33e7f468	fix eventflag	2016-05-18 17:00:25 +09:00
NIIBE Yutaka	db413813b6	eventflag rewrite	2016-05-18 16:52:00 +09:00
NIIBE Yutaka	7f009dbb5d	update ChangeLog	2016-05-18 14:43:30 +09:00
NIIBE Yutaka	cea3200e48	Cleanup chopstx.c	2016-05-18 13:27:00 +09:00
NIIBE Yutaka	d93206882d	Fix mutex_lock and join	2016-05-18 11:40:15 +09:00
NIIBE Yutaka	a17d12192f	Fix example-cdc more	2016-05-18 09:55:23 +09:00
NIIBE Yutaka	4c1aa50f13	Fix example-cdc	2016-05-18 08:51:50 +09:00
NIIBE Yutaka	cf76b0bf13	example-cdc cleanup more	2016-05-17 21:33:58 +09:00
NIIBE Yutaka	76cbff737b	example-cdc cleanup	2016-05-17 20:49:17 +09:00
NIIBE Yutaka	dce6c70ffc	more fix for chopstx_poll	2016-05-17 17:51:41 +09:00
NIIBE Yutaka	3651aa64b4	ll_dequeue for PX only when not ready	2016-05-16 20:37:33 +09:00
NIIBE Yutaka	98977937cb	fix chx_wakeup	2016-05-16 18:00:41 +09:00
NIIBE Yutaka	06d046b963	Improve system routines API for STM32F103	2016-05-16 14:59:05 +09:00
NIIBE Yutaka	b7c6dadcfb	Fix IRQ handling and improve cancellation implementation	2016-05-16 14:50:04 +09:00
NIIBE Yutaka	a82acac8df	Bug fix for interrupt preemption	2016-05-13 22:27:56 +09:00
NIIBE Yutaka	206f2a5f07	Fix intr_wait	2016-05-13 17:51:12 +09:00
NIIBE Yutaka	5046dd45f2	IRQ handling is now merged into polling	2016-05-13 16:35:35 +09:00
NIIBE Yutaka	db6e668524	more fixes for chopstx_poll	2016-05-13 14:52:38 +09:00
NIIBE Yutaka	daa7aebd6f	Add READY field for chx_poll_XXX so that we can check if it's ready	2016-05-13 14:22:12 +09:00
NIIBE Yutaka	5fc2617ae5	Fix changelog	2016-05-13 11:11:01 +09:00
NIIBE Yutaka	fabd271196	Update example-cdc	2016-05-12 18:14:47 +09:00
NIIBE Yutaka	5730641ffd	Bug fixes for Cortex-M3 and chopstx_poll	2016-05-12 18:12:52 +09:00
NIIBE Yutaka	5c1638c023	Fix mutex init	2016-05-12 11:17:17 +09:00
NIIBE Yutaka	420bd135af	Adding ADC example for FS-BB48	2016-05-11 12:34:17 +09:00
NIIBE Yutaka	a538113c07	change poll behavior	2016-04-24 12:24:36 +09:00
NIIBE Yutaka	8668c8a88a	update sys.c in examples	2016-04-22 17:21:50 +09:00
NIIBE Yutaka	fba1dc05ea	Clean up FS-BB48 example	2016-04-22 17:21:29 +09:00
NIIBE Yutaka	1b12a78054	Modify chopstx_poll API	2016-04-22 13:42:01 +09:00
NIIBE Yutaka	5d40ffbffa	Implement chopstx_poll (2)	2016-04-21 16:10:06 +09:00
NIIBE Yutaka	06d28b62fb	Implement chopstx_poll	2016-04-21 15:59:34 +09:00
NIIBE Yutaka	437b2dc43c	Update for STM32	2016-04-20 17:30:41 +09:00
NIIBE Yutaka	3eac245981	fix	2016-04-19 16:40:25 +09:00
NIIBE Yutaka	7c2cdaa6e4	Example for FS-BB48 to compute CRC32.	2016-04-19 15:58:26 +09:00
NIIBE Yutaka	0bbb43dd3a	Fix USB driver and example	2016-04-18 17:23:10 +09:00
NIIBE Yutaka	82749ab97a	Add support for FS-BB48	2016-04-18 11:46:14 +09:00
NIIBE Yutaka	92e17d3bdf	USB stack for STM32F103 improvement	2016-04-07 14:52:39 +09:00
NIIBE Yutaka	674c19c495	SVC is required for Cortex-M3	2016-04-07 14:36:41 +09:00
NIIBE Yutaka	35426d7715	Fix MSP initial value and improve chx_sched	2016-04-07 09:59:13 +09:00
NIIBE Yutaka	6db2dd96c5	New function: chopstx_poll	2016-04-06 21:04:24 +09:00
NIIBE Yutaka	5e6a433457	New struct: chx_qh	2016-04-06 20:34:28 +09:00
NIIBE Yutaka	fa8dd7afc8	Don't use SVC for context switch	2016-04-06 19:49:18 +09:00
NIIBE Yutaka	8e40065311	Initialization of chx_spinlock	2016-04-05 19:27:25 +09:00
NIIBE Yutaka	a99c5c6048	fix struct NVIC	2016-04-05 19:17:44 +09:00
NIIBE Yutaka	e092a56c17	Fix USB GET	2016-03-15 10:31:16 +09:00
NIIBE Yutaka	25e5f21847	AAPCS stack alignment	2016-03-08 20:27:24 +09:00
NIIBE Yutaka	90ac7f7c13	update usb stack from Gnuk development branch	2016-03-08 20:20:49 +09:00
NIIBE Yutaka	fd8aee3cb0	CDC to be echo service.	2015-11-05 13:54:49 +09:00
NIIBE Yutaka	a30a069ed8	Version 0.10	2015-09-15 10:39:36 +09:00
NIIBE Yutaka	8fed803085	bug fixes around cancel/join/exit	2015-09-15 10:26:40 +09:00
NIIBE Yutaka	4705e2fb15	fix cancellation	2015-09-11 17:04:28 +09:00
NIIBE Yutaka	14ad395523	Version 0.09	2015-09-10 20:22:32 +09:00
NIIBE Yutaka	acd4460a6e	Update API doc	2015-09-09 17:06:51 +09:00
NIIBE Yutaka	79b13fb4a9	Cancellation fixes	2015-09-09 17:04:59 +09:00
NIIBE Yutaka	e9521648d5	move exception handling routines	2015-09-09 11:55:17 +09:00
NIIBE Yutaka	2bd7a8e6db	move svc, preempt, and sched	2015-09-09 11:35:20 +09:00
NIIBE Yutaka	c57b13bedc	factor out chx_prio_init	2015-09-09 11:06:52 +09:00
NIIBE Yutaka	06e4459c21	factoring: systick	2015-09-09 09:47:25 +09:00
NIIBE Yutaka	baef99bf11	fix white spaces	2015-09-08 17:19:14 +09:00
NIIBE Yutaka	1b25cc5dcb	fix more spin lock	2015-09-08 17:14:43 +09:00
NIIBE Yutaka	ee3c5d4e6f	prepare kkojima's patch for Cortex-A7	2015-09-08 17:06:53 +09:00
NIIBE Yutaka	80408902d7	fix spin-locking of INTR_TOP	2015-09-08 14:46:11 +09:00
NIIBE Yutaka	f6d79e6821	Add Mateusz Zalega	2015-09-07 17:10:42 +09:00
NIIBE Yutaka	014dbf25f6	Add example-primer2	2015-09-07 17:06:05 +09:00
NIIBE Yutaka	41610443d4	Netrokey Start change	2015-09-07 15:52:38 +09:00
NIIBE Yutaka	46468760a3	Nitrokey start support	2015-09-04 17:09:56 +09:00
NIIBE Yutaka	85ef4a5391	Fix for Nitrokey-start	2015-09-04 16:43:45 +09:00
Mateusz Zalega	8650bde8a0	board: add Nitrokey Start Signed-off-by: Mateusz Zalega <mateusz@nitrokey.com>	2015-09-04 16:38:01 +09:00
NIIBE Yutaka	6e7334dcff	Fix the score about A and tone-table change	2015-08-08 13:50:20 +09:00
NIIBE Yutaka	04a948024a	Celebrate Happy Hacking Day.	2015-08-06 11:10:48 +09:00
NIIBE Yutaka	1bbbaabe0d	Add a speaker	2015-08-06 11:02:34 +09:00