Module Name:    src
Committed By:   reinoud
Date:           Fri May  9 22:21:46 UTC 2014

Modified Files:
        src/sys/arch/arm/samsung: mct.c mct_var.h

Log Message:
Implement heartbeat LED using the new gpio subsystem


To generate a diff of this commit:
cvs rdiff -u -r1.1 -r1.2 src/sys/arch/arm/samsung/mct.c \
    src/sys/arch/arm/samsung/mct_var.h

Please note that diffs are not public domain; they are subject to the
copyright notices on the relevant files.

Modified files:

Index: src/sys/arch/arm/samsung/mct.c
diff -u src/sys/arch/arm/samsung/mct.c:1.1 src/sys/arch/arm/samsung/mct.c:1.2
--- src/sys/arch/arm/samsung/mct.c:1.1	Sun Apr 13 02:26:26 2014
+++ src/sys/arch/arm/samsung/mct.c	Fri May  9 22:21:46 2014
@@ -1,4 +1,4 @@
-/*	$NetBSD: mct.c,v 1.1 2014/04/13 02:26:26 matt Exp $	*/
+/*	$NetBSD: mct.c,v 1.2 2014/05/09 22:21:46 reinoud Exp $	*/
 
 /*-
  * Copyright (c) 2014 The NetBSD Foundation, Inc.
@@ -31,7 +31,7 @@
 
 #include <sys/cdefs.h>
 
-__KERNEL_RCSID(1, "$NetBSD: mct.c,v 1.1 2014/04/13 02:26:26 matt Exp $");
+__KERNEL_RCSID(1, "$NetBSD: mct.c,v 1.2 2014/05/09 22:21:46 reinoud Exp $");
 
 #include <sys/param.h>
 #include <sys/bus.h>
@@ -155,6 +155,7 @@ mct_attach(device_t parent, device_t sel
 	struct mct_softc * const sc = &mct_sc;
 	prop_dictionary_t dict = device_properties(self);
 	char freqbuf[sizeof("XXX SHz")];
+	const char *pin_name;
 
 	self->dv_private = sc;
 	sc->sc_dev = self;
@@ -186,6 +187,19 @@ mct_attach(device_t parent, device_t sel
 	if (sc->sc_global_ih == NULL)
 		panic("%s: unable to register timer interrupt", __func__);
 	aprint_normal_dev(sc->sc_dev, "interrupting on irq %d\n", sc->sc_irq);
+
+	/* blink led */
+	if (prop_dictionary_get_cstring_nocopy(dict, "heartbeat", &pin_name)) {
+		if (!exynos_gpio_pin_reserve(pin_name, &sc->sc_gpio_led)) {
+			aprint_error_dev(self,
+				"failed to reserve GPIO \"%s\" "
+				"for heartbeat led\n", pin_name);
+		} else {
+			sc->sc_has_blink_led = true;
+			sc->sc_led_state = false;
+			sc->sc_led_timer = hz;
+		}
+	}
 }
 
 
@@ -217,17 +231,29 @@ clockhandler(void *arg)
 	struct mct_softc * const sc = &mct_sc;
 	const uint64_t now = mct_gettime(sc);
 	uint64_t delta = now - sc->sc_lastintr;
+	uint64_t missed = delta / sc->sc_autoinc;
 
 	/* ack the interrupt */
 	mct_write_global(sc, MCT_G_INT_CSTAT, G_INT_CSTAT_CLEAR);
 
 	/* check if we missed clock interrupts */
 	if (delta > sc->sc_autoinc)
-		sc->sc_ev_missing_ticks.ev_count += delta / sc->sc_autoinc;
+		sc->sc_ev_missing_ticks.ev_count += missed;
 
 	sc->sc_lastintr = now;
 	hardclock(cf);
 
+	if (sc->sc_has_blink_led) {
+		sc->sc_led_timer = sc->sc_led_timer - 1 - missed;
+		if (sc->sc_led_timer <= 0) {
+			sc->sc_led_state = !sc->sc_led_state;
+			exynos_gpio_pindata_write(&sc->sc_gpio_led,
+				sc->sc_led_state);
+			while (sc->sc_led_timer <= 0)
+				sc->sc_led_timer += hz;
+		}
+	}
+
 	/* handled */
 	return 1;
 }
Index: src/sys/arch/arm/samsung/mct_var.h
diff -u src/sys/arch/arm/samsung/mct_var.h:1.1 src/sys/arch/arm/samsung/mct_var.h:1.2
--- src/sys/arch/arm/samsung/mct_var.h:1.1	Sun Apr 13 02:26:26 2014
+++ src/sys/arch/arm/samsung/mct_var.h	Fri May  9 22:21:46 2014
@@ -47,6 +47,12 @@ static struct mct_softc {
 	uint64_t		 sc_lastintr;
 	uint32_t		 sc_autoinc;
 	struct evcnt		 sc_ev_missing_ticks;
+
+	/* blinking led */
+	bool			 sc_has_blink_led;
+	struct exynos_gpio_pindata sc_gpio_led;
+	bool			 sc_led_state;
+	int			 sc_led_timer;
 } mct_sc;
 
 void mct_init_cpu_clock(struct cpu_info *ci);

Reply via email to