X-Git-Url: https://git.zerfleddert.de/cgi-bin/gitweb.cgi/rsbs2/blobdiff_plain/93402c2ce5aadfca70133b3e6a43352b0e29cddc..ae50f4d4b8167088d5bac42cdc07407ab96c4bb4:/bmc/chassis.c

diff --git a/bmc/chassis.c b/bmc/chassis.c
index ed24063..2259d86 100644
--- a/bmc/chassis.c
+++ b/bmc/chassis.c
@@ -2,6 +2,7 @@
 #include <avr/interrupt.h>
 #include <stdio.h>
 
+#include "config.h"
 #include "chassis.h"
 
 #ifdef __AVR_ATmega16__
@@ -23,6 +24,7 @@
 
 static volatile int power_cnt = 0;
 static volatile int reset_cnt = 0;
+static volatile int power_cycle = 0;
 
 static void chassis_set_pins(uint8_t pins, uint8_t state);
 
@@ -32,9 +34,9 @@ void chassis_init()
 	CDDR |= ((1<<POWER_PIN) | (1<<RESET_PIN));
 
 	/* About 1ms */
-	OCR0 = ((F_CPU/256)/1000)-1;
+	OCR0 = ((F_CPU/64)/1000) - 1;
 
-	TCCR0 = ((1<<WGM01) | (1<<CS02)); /* CTC, Prescaler 256 */
+	TCCR0 = ((1<<WGM01) | (1<<CS01) | (1<<CS00)); /* CTC, Prescaler 64 */
 	TIMSK |= (1<<OCIE0);
 
 }
@@ -78,23 +80,31 @@ static void chassis_reset(int msec)
 
 void chassis_control(unsigned char action)
 {
+	uint8_t old_SREG = SREG;
+
 #ifdef DEBUG
 	printf("Chassis control 0x%02x\n", action);
 #endif
 
 	switch(action) {
 		case CHASSIS_ACTION_POWER_DOWN:
-			chassis_power(5000);
+			chassis_power(POWERDOWN_TIME_MS);
 			break;
 
 		case CHASSIS_ACTION_POWER_UP:
-			chassis_power(500);
+			chassis_power(POWERUP_TIME_MS);
 			break;
 
 		case CHASSIS_ACTION_HARD_RESET:
-			chassis_reset(500);
+			chassis_reset(RESET_TIME_MS);
 			break;
 
+		case CHASSIS_ACTION_POWER_CYCLE:
+			cli();
+			power_cycle = POWER_CYCLE_PAUSE_MS;
+			SREG = old_SREG;
+			chassis_power(POWERDOWN_TIME_MS);
+
 		default:
 #ifdef DEBUG
 			printf("Unimplemented chassis action 0x%02x\n", action);
@@ -110,6 +120,13 @@ ISR(TIMER0_COMP_vect)
 
 		if (!power_cnt)
 			chassis_set_pins((1<<POWER_PIN), 0);
+	} else if (power_cycle) {
+		power_cycle--;
+
+		if (!power_cycle) {
+			chassis_set_pins((1<<POWER_PIN), 1);
+			power_cnt = POWERUP_TIME_MS;
+		}
 	}
 	if (reset_cnt) {
 		reset_cnt--;